1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
22e192b24SSimon Glass /*
32e192b24SSimon Glass * (C) Copyright 2001
42e192b24SSimon Glass * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
52e192b24SSimon Glass */
62e192b24SSimon Glass
72e192b24SSimon Glass /*
82e192b24SSimon Glass * Misc functions
92e192b24SSimon Glass */
102e192b24SSimon Glass #include <common.h>
112e192b24SSimon Glass #include <command.h>
122e192b24SSimon Glass #include <console.h>
132e192b24SSimon Glass
do_sleep(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])142e192b24SSimon Glass static int do_sleep(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
152e192b24SSimon Glass {
162e192b24SSimon Glass ulong start = get_timer(0);
17c4974632Smario.six@gdsys.cc ulong mdelay = 0;
182e192b24SSimon Glass ulong delay;
19c4974632Smario.six@gdsys.cc char *frpart;
202e192b24SSimon Glass
212e192b24SSimon Glass if (argc != 2)
222e192b24SSimon Glass return CMD_RET_USAGE;
232e192b24SSimon Glass
242e192b24SSimon Glass delay = simple_strtoul(argv[1], NULL, 10) * CONFIG_SYS_HZ;
252e192b24SSimon Glass
26c4974632Smario.six@gdsys.cc frpart = strchr(argv[1], '.');
27c4974632Smario.six@gdsys.cc
28c4974632Smario.six@gdsys.cc if (frpart) {
29c4974632Smario.six@gdsys.cc uint mult = CONFIG_SYS_HZ / 10;
30c4974632Smario.six@gdsys.cc for (frpart++; *frpart != '\0' && mult > 0; frpart++) {
31c4974632Smario.six@gdsys.cc if (*frpart < '0' || *frpart > '9') {
32c4974632Smario.six@gdsys.cc mdelay = 0;
33c4974632Smario.six@gdsys.cc break;
34c4974632Smario.six@gdsys.cc }
35c4974632Smario.six@gdsys.cc mdelay += (*frpart - '0') * mult;
36c4974632Smario.six@gdsys.cc mult /= 10;
37c4974632Smario.six@gdsys.cc }
38c4974632Smario.six@gdsys.cc }
39c4974632Smario.six@gdsys.cc
40c4974632Smario.six@gdsys.cc delay += mdelay;
41c4974632Smario.six@gdsys.cc
422e192b24SSimon Glass while (get_timer(start) < delay) {
432e192b24SSimon Glass if (ctrlc())
442e192b24SSimon Glass return (-1);
452e192b24SSimon Glass
462e192b24SSimon Glass udelay(100);
472e192b24SSimon Glass }
482e192b24SSimon Glass
492e192b24SSimon Glass return 0;
502e192b24SSimon Glass }
512e192b24SSimon Glass
522e192b24SSimon Glass U_BOOT_CMD(
532e192b24SSimon Glass sleep , 2, 1, do_sleep,
542e192b24SSimon Glass "delay execution for some time",
552e192b24SSimon Glass "N\n"
56c4974632Smario.six@gdsys.cc " - delay execution for N seconds (N is _decimal_ and can be\n"
57c4974632Smario.six@gdsys.cc " fractional)"
582e192b24SSimon Glass );
592e192b24SSimon Glass
602e192b24SSimon Glass #ifdef CONFIG_CMD_TIMER
do_timer(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])612e192b24SSimon Glass static int do_timer(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
622e192b24SSimon Glass {
632e192b24SSimon Glass static ulong start;
642e192b24SSimon Glass
652e192b24SSimon Glass if (argc != 2)
662e192b24SSimon Glass return CMD_RET_USAGE;
672e192b24SSimon Glass
682e192b24SSimon Glass if (!strcmp(argv[1], "start"))
692e192b24SSimon Glass start = get_timer(0);
702e192b24SSimon Glass
712e192b24SSimon Glass if (!strcmp(argv[1], "get")) {
722e192b24SSimon Glass ulong msecs = get_timer(start) * 1000 / CONFIG_SYS_HZ;
732e192b24SSimon Glass printf("%ld.%03d\n", msecs / 1000, (int)(msecs % 1000));
742e192b24SSimon Glass }
752e192b24SSimon Glass
762e192b24SSimon Glass return 0;
772e192b24SSimon Glass }
782e192b24SSimon Glass
792e192b24SSimon Glass U_BOOT_CMD(
802e192b24SSimon Glass timer, 2, 1, do_timer,
812e192b24SSimon Glass "access the system timer",
822e192b24SSimon Glass "start - Reset the timer reference.\n"
832e192b24SSimon Glass "timer get - Print the time since 'start'."
842e192b24SSimon Glass );
852e192b24SSimon Glass #endif
86