check ThisThread::sleep_for() + json MBED_TICKLESS function for CPU IDD reduction
/users/kenjiArai/notebook/standby-mode-current-consumption-on-nucleo-f446re/
IDD Jumper(JP6) | ||||
Mode | Mbed-OS | Board | IDD Current(sleep) | IDD Current(Normal(*1)) |
DeepSleep | 0s5.15.1 | Nucleo-L152RE | 4.23uA | 5mA to 8mA |
^ | 0s6.6.0 | ^ | 4.22uA | 4mA to 7mA |
StandBy | 0s5.15.1 | ^ | 3.90uA | 4mA to 7mA |
^ | 0s6.6.0 | ^ | 3.90uA | 4mA to 7mA |
DeepSleep | 0s5.15.1 | Nucleo-L476RG | 2.13uA | 7mA to 10mA |
^ | 0s6.6.0 | ^ | 2.23uA | 7mA to 10mA |
StandBy | 0s5.15.1 | ^ | -uA(*2) | -mA(*2) |
^ | 0s6.6.0 | ^ | -uA(*2) | -mA(*2) |
DeepSleep | 0s5.15.1 | Nucleo-F411RE | 1.91mA(*3) | 7mA to 10mA |
^ | 0s6.6.0 | ^ | 1.65mA(*3) | 7mA to 10mA |
StandBy | 0s5.15.1 | ^ | 3.35uA | 7mA to 10mA |
^ | 0s6.6.0 | ^ | 3.40uA | 7mA to 9mA |
DeepSleep | 0s5.15.1 | Nucleo-F446RE | 1.67mA(*3) | 14mA to 17mA |
^ | 0s6.6.0 | ^ | 1.76mA(*3) | 14mA to 16mA |
StandBy | 0s5.15.1 | ^ | 3.42uA | 14mA to 17mA |
^ | 0s6.6.0 | ^ | 3.42uA | 14mA to 16mA |
(*1)-> LED1 Blinky every 1sec and change LED1 current
(*2)-> Could NOT make proper program and could NOT measure
(*3)-> NOT uA but mA
All Nucleo boards are stand alone condition(not additional circuit).
Equipment: DMM6500
/users/kenjiArai/code/Check_DeepSleep_os5/
/users/kenjiArai/code/Check_DeepSleep_os6/
/users/kenjiArai/code/Check_StandBy_os5/
/users/kenjiArai/code/Check_StandBy_os6/
main.cpp@1:d6abda61923b, 2021-01-15 (annotated)
- Committer:
- kenjiArai
- Date:
- Fri Jan 15 07:28:31 2021 +0000
- Revision:
- 1:d6abda61923b
- Parent:
- 0:f8c5c7d19d9a
added L476RG board and set 3 modes
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kenjiArai | 0:f8c5c7d19d9a | 1 | /* |
kenjiArai | 0:f8c5c7d19d9a | 2 | * Mbed Application program |
kenjiArai | 0:f8c5c7d19d9a | 3 | * Check Deep Sleep Mode |
kenjiArai | 0:f8c5c7d19d9a | 4 | * |
kenjiArai | 1:d6abda61923b | 5 | * Copyright (c) 2020,'21 Kenji Arai / JH1PJL |
kenjiArai | 0:f8c5c7d19d9a | 6 | * http://www7b.biglobe.ne.jp/~kenjia/ |
kenjiArai | 0:f8c5c7d19d9a | 7 | * https://os.mbed.com/users/kenjiArai/ |
kenjiArai | 0:f8c5c7d19d9a | 8 | * Revised: March 12th, 2020 |
kenjiArai | 1:d6abda61923b | 9 | * Revised: January 15th, 2021 |
kenjiArai | 0:f8c5c7d19d9a | 10 | */ |
kenjiArai | 0:f8c5c7d19d9a | 11 | |
kenjiArai | 0:f8c5c7d19d9a | 12 | /* |
kenjiArai | 0:f8c5c7d19d9a | 13 | Reference information: |
kenjiArai | 0:f8c5c7d19d9a | 14 | https://forums.mbed.com/t/how-to-deep-sleep/7551 |
kenjiArai | 0:f8c5c7d19d9a | 15 | |
kenjiArai | 0:f8c5c7d19d9a | 16 | Tested on |
kenjiArai | 1:d6abda61923b | 17 | Nucleo-L152RE -> 4.23uA (Normal run = 5mA to 8mA) |
kenjiArai | 1:d6abda61923b | 18 | Nucleo-L476RG -> 2.13uA (Normal run = 7mA to 10mA) |
kenjiArai | 1:d6abda61923b | 19 | Nucleo-F411RE -> 1.91mA (not uA)(Normal run = 7mA to 10mA) |
kenjiArai | 1:d6abda61923b | 20 | Nucleo-F446RE -> 1.67mA (not uA)(Normal run = 14mA to 17mA) |
kenjiArai | 1:d6abda61923b | 21 | |
kenjiArai | 1:d6abda61923b | 22 | ---> same results within MODE1,2 and 3 |
kenjiArai | 0:f8c5c7d19d9a | 23 | */ |
kenjiArai | 0:f8c5c7d19d9a | 24 | |
kenjiArai | 0:f8c5c7d19d9a | 25 | // Include -------------------------------------------------------------------- |
kenjiArai | 0:f8c5c7d19d9a | 26 | #include "mbed.h" |
kenjiArai | 0:f8c5c7d19d9a | 27 | |
kenjiArai | 0:f8c5c7d19d9a | 28 | // Definition ----------------------------------------------------------------- |
kenjiArai | 1:d6abda61923b | 29 | #define MODE 1 |
kenjiArai | 0:f8c5c7d19d9a | 30 | |
kenjiArai | 0:f8c5c7d19d9a | 31 | // Constructor ---------------------------------------------------------------- |
kenjiArai | 0:f8c5c7d19d9a | 32 | DigitalIn my_sw(USER_BUTTON); |
kenjiArai | 0:f8c5c7d19d9a | 33 | DigitalOut myled(LED1,1); |
kenjiArai | 0:f8c5c7d19d9a | 34 | Serial pc(USBTX, USBRX); |
kenjiArai | 0:f8c5c7d19d9a | 35 | AnalogIn a_in(A0); |
kenjiArai | 0:f8c5c7d19d9a | 36 | Timer t; |
kenjiArai | 0:f8c5c7d19d9a | 37 | |
kenjiArai | 0:f8c5c7d19d9a | 38 | // RAM ------------------------------------------------------------------------ |
kenjiArai | 0:f8c5c7d19d9a | 39 | |
kenjiArai | 0:f8c5c7d19d9a | 40 | // ROM / Constant data -------------------------------------------------------- |
kenjiArai | 0:f8c5c7d19d9a | 41 | |
kenjiArai | 0:f8c5c7d19d9a | 42 | // Function prototypes -------------------------------------------------------- |
kenjiArai | 0:f8c5c7d19d9a | 43 | void sw_irq(void); |
kenjiArai | 0:f8c5c7d19d9a | 44 | void LowPowerConfiguration(void); |
kenjiArai | 0:f8c5c7d19d9a | 45 | void time_enter_mode(void); |
kenjiArai | 0:f8c5c7d19d9a | 46 | void chk_and_set_time(char *ptr); |
kenjiArai | 0:f8c5c7d19d9a | 47 | int32_t xatoi (char **str, int32_t *res); |
kenjiArai | 1:d6abda61923b | 48 | void get_line (char *buff, int32_t len); |
kenjiArai | 0:f8c5c7d19d9a | 49 | void print_revision(void); |
kenjiArai | 0:f8c5c7d19d9a | 50 | |
kenjiArai | 0:f8c5c7d19d9a | 51 | //------------------------------------------------------------------------------ |
kenjiArai | 0:f8c5c7d19d9a | 52 | // Control Program |
kenjiArai | 0:f8c5c7d19d9a | 53 | //------------------------------------------------------------------------------ |
kenjiArai | 0:f8c5c7d19d9a | 54 | int main() |
kenjiArai | 0:f8c5c7d19d9a | 55 | { |
kenjiArai | 0:f8c5c7d19d9a | 56 | time_t seconds; |
kenjiArai | 0:f8c5c7d19d9a | 57 | char buf[64]; |
kenjiArai | 0:f8c5c7d19d9a | 58 | uint32_t t_pass = 0; |
kenjiArai | 0:f8c5c7d19d9a | 59 | uint32_t loop_count = 1; |
kenjiArai | 0:f8c5c7d19d9a | 60 | float ain; |
kenjiArai | 0:f8c5c7d19d9a | 61 | |
kenjiArai | 0:f8c5c7d19d9a | 62 | printf("\r\nCheck current consumption at Deep-sleep mode.\r\n"); |
kenjiArai | 0:f8c5c7d19d9a | 63 | print_revision(); |
kenjiArai | 1:d6abda61923b | 64 | #if MODE == 1 |
kenjiArai | 1:d6abda61923b | 65 | printf("-->MODE=1 --> Use ThisThread::sleep_for() function.\r\n"); |
kenjiArai | 1:d6abda61923b | 66 | #elif MODE == 2 |
kenjiArai | 1:d6abda61923b | 67 | printf("-->MODE=2 --> Use thread_sleep_for() function.\r\n"); |
kenjiArai | 1:d6abda61923b | 68 | #elif MODE == 3 |
kenjiArai | 1:d6abda61923b | 69 | printf("-->MODE=3 --> Use wait_ms() function.\r\n"); |
kenjiArai | 1:d6abda61923b | 70 | #endif |
kenjiArai | 0:f8c5c7d19d9a | 71 | seconds = time(NULL); |
kenjiArai | 0:f8c5c7d19d9a | 72 | while (my_sw == 0) {;} |
kenjiArai | 1:d6abda61923b | 73 | //ThisThread::sleep_for(10); // without "bare-metal" in mbed_app.json |
kenjiArai | 1:d6abda61923b | 74 | thread_sleep_for(10); // with "bare-metal" |
kenjiArai | 0:f8c5c7d19d9a | 75 | while (true) { |
kenjiArai | 0:f8c5c7d19d9a | 76 | t.reset(); |
kenjiArai | 0:f8c5c7d19d9a | 77 | t.start(); |
kenjiArai | 1:d6abda61923b | 78 | if ((my_sw == 0) || (loop_count > 10)) { |
kenjiArai | 0:f8c5c7d19d9a | 79 | LowPowerConfiguration(); |
kenjiArai | 0:f8c5c7d19d9a | 80 | InterruptIn my_irq(USER_BUTTON); |
kenjiArai | 0:f8c5c7d19d9a | 81 | while (my_irq.read() == 0) {;} |
kenjiArai | 1:d6abda61923b | 82 | //ThisThread::sleep_for(100); |
kenjiArai | 1:d6abda61923b | 83 | thread_sleep_for(100); |
kenjiArai | 0:f8c5c7d19d9a | 84 | my_irq.fall(sw_irq); |
kenjiArai | 0:f8c5c7d19d9a | 85 | t.stop(); |
kenjiArai | 1:d6abda61923b | 86 | #if MODE == 1 |
kenjiArai | 0:f8c5c7d19d9a | 87 | ThisThread::sleep_for(10000); |
kenjiArai | 1:d6abda61923b | 88 | #elif MODE == 2 |
kenjiArai | 1:d6abda61923b | 89 | thread_sleep_for(10000); |
kenjiArai | 1:d6abda61923b | 90 | #elif MODE == 3 |
kenjiArai | 1:d6abda61923b | 91 | wait_ms(10000); |
kenjiArai | 1:d6abda61923b | 92 | #endif |
kenjiArai | 0:f8c5c7d19d9a | 93 | system_reset(); |
kenjiArai | 0:f8c5c7d19d9a | 94 | } |
kenjiArai | 0:f8c5c7d19d9a | 95 | ain = a_in.read(); |
kenjiArai | 0:f8c5c7d19d9a | 96 | myled = !myled; |
kenjiArai | 0:f8c5c7d19d9a | 97 | seconds = time(NULL); |
kenjiArai | 0:f8c5c7d19d9a | 98 | strftime(buf, 50, "%H:%M:%S -> ", localtime(&seconds)); |
kenjiArai | 0:f8c5c7d19d9a | 99 | pc.printf("%s", buf); |
kenjiArai | 0:f8c5c7d19d9a | 100 | pc.printf( |
kenjiArai | 0:f8c5c7d19d9a | 101 | "analog = %4.3f, loop_time=%3d, counter=%4d\r\n", |
kenjiArai | 0:f8c5c7d19d9a | 102 | ain, t_pass, loop_count++ |
kenjiArai | 0:f8c5c7d19d9a | 103 | ); |
kenjiArai | 0:f8c5c7d19d9a | 104 | t_pass = t.read_ms(); |
kenjiArai | 1:d6abda61923b | 105 | //ThisThread::sleep_for(1000 - t_pass); |
kenjiArai | 1:d6abda61923b | 106 | thread_sleep_for(1000 - t_pass); |
kenjiArai | 1:d6abda61923b | 107 | if (pc.readable()) { |
kenjiArai | 1:d6abda61923b | 108 | strftime(buf, 50, " %B %d,'%y, %H:%M:%S\r\n", localtime(&seconds)); |
kenjiArai | 1:d6abda61923b | 109 | pc.printf("[Time] %s\r\n", buf); |
kenjiArai | 1:d6abda61923b | 110 | time_enter_mode(); |
kenjiArai | 1:d6abda61923b | 111 | } |
kenjiArai | 0:f8c5c7d19d9a | 112 | } |
kenjiArai | 0:f8c5c7d19d9a | 113 | } |
kenjiArai | 0:f8c5c7d19d9a | 114 | |
kenjiArai | 0:f8c5c7d19d9a | 115 | |
kenjiArai | 0:f8c5c7d19d9a | 116 | void sw_irq(void) |
kenjiArai | 0:f8c5c7d19d9a | 117 | { |
kenjiArai | 0:f8c5c7d19d9a | 118 | system_reset(); |
kenjiArai | 0:f8c5c7d19d9a | 119 | } |
kenjiArai | 0:f8c5c7d19d9a | 120 | |
kenjiArai | 0:f8c5c7d19d9a | 121 | void LowPowerConfiguration(void) |
kenjiArai | 0:f8c5c7d19d9a | 122 | { |
kenjiArai | 0:f8c5c7d19d9a | 123 | #if defined(TARGET_NUCLEO_L152RE) |
kenjiArai | 0:f8c5c7d19d9a | 124 | RCC->AHBENR |= |
kenjiArai | 0:f8c5c7d19d9a | 125 | (RCC_AHBENR_GPIOAEN | RCC_AHBENR_GPIOBEN | RCC_AHBENR_GPIOCEN | |
kenjiArai | 0:f8c5c7d19d9a | 126 | RCC_AHBENR_GPIODEN | RCC_AHBENR_GPIOHEN); |
kenjiArai | 1:d6abda61923b | 127 | #elif defined(TARGET_NUCLEO_L476RG) |
kenjiArai | 1:d6abda61923b | 128 | |
kenjiArai | 0:f8c5c7d19d9a | 129 | #elif defined(TARGET_NUCLEO_F446RE) |
kenjiArai | 0:f8c5c7d19d9a | 130 | RCC->AHB1ENR |= |
kenjiArai | 0:f8c5c7d19d9a | 131 | (RCC_AHB1ENR_GPIOAEN | RCC_AHB1ENR_GPIOBEN | RCC_AHB1ENR_GPIOCEN | |
kenjiArai | 0:f8c5c7d19d9a | 132 | RCC_AHB1ENR_GPIODEN | RCC_AHB1ENR_GPIOHEN); |
kenjiArai | 0:f8c5c7d19d9a | 133 | #endif |
kenjiArai | 0:f8c5c7d19d9a | 134 | GPIO_InitTypeDef GPIO_InitStruct; |
kenjiArai | 0:f8c5c7d19d9a | 135 | // All other ports are analog input mode |
kenjiArai | 0:f8c5c7d19d9a | 136 | GPIO_InitStruct.Pin = GPIO_PIN_All; |
kenjiArai | 0:f8c5c7d19d9a | 137 | GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
kenjiArai | 0:f8c5c7d19d9a | 138 | GPIO_InitStruct.Pull = GPIO_NOPULL; |
kenjiArai | 0:f8c5c7d19d9a | 139 | GPIO_InitStruct.Speed = GPIO_SPEED_LOW; |
kenjiArai | 0:f8c5c7d19d9a | 140 | HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); |
kenjiArai | 0:f8c5c7d19d9a | 141 | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
kenjiArai | 0:f8c5c7d19d9a | 142 | HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); |
kenjiArai | 0:f8c5c7d19d9a | 143 | HAL_GPIO_Init(GPIOD, &GPIO_InitStruct); |
kenjiArai | 0:f8c5c7d19d9a | 144 | HAL_GPIO_Init(GPIOE, &GPIO_InitStruct); |
kenjiArai | 0:f8c5c7d19d9a | 145 | HAL_GPIO_Init(GPIOH, &GPIO_InitStruct); |
kenjiArai | 0:f8c5c7d19d9a | 146 | #if defined(TARGET_NUCLEO_L152RE) |
kenjiArai | 0:f8c5c7d19d9a | 147 | RCC->AHBENR &= |
kenjiArai | 0:f8c5c7d19d9a | 148 | ~(RCC_AHBENR_GPIOAEN | RCC_AHBENR_GPIOBEN |RCC_AHBENR_GPIOCEN | |
kenjiArai | 0:f8c5c7d19d9a | 149 | RCC_AHBENR_GPIODEN | RCC_AHBENR_GPIOHEN); |
kenjiArai | 1:d6abda61923b | 150 | #elif defined(TARGET_NUCLEO_L476RG) |
kenjiArai | 1:d6abda61923b | 151 | RCC->AHB1ENR = 0; |
kenjiArai | 1:d6abda61923b | 152 | RCC->AHB2ENR = 0; |
kenjiArai | 1:d6abda61923b | 153 | RCC->AHB3ENR = 0; |
kenjiArai | 1:d6abda61923b | 154 | RCC->APB1ENR2 = 0; |
kenjiArai | 1:d6abda61923b | 155 | RCC->APB2ENR = 0; |
kenjiArai | 0:f8c5c7d19d9a | 156 | #elif defined(TARGET_NUCLEO_F446RE) |
kenjiArai | 1:d6abda61923b | 157 | RCC->AHB1ENR = 0; |
kenjiArai | 1:d6abda61923b | 158 | RCC->AHB2ENR = 0; |
kenjiArai | 1:d6abda61923b | 159 | RCC->AHB3ENR = 0; |
kenjiArai | 1:d6abda61923b | 160 | RCC->APB1ENR = 0x8; // alive TIM5 |
kenjiArai | 1:d6abda61923b | 161 | RCC->APB2ENR = 0; |
kenjiArai | 1:d6abda61923b | 162 | RCC->AHB1LPENR = 0; |
kenjiArai | 1:d6abda61923b | 163 | RCC->AHB2LPENR = 0; |
kenjiArai | 1:d6abda61923b | 164 | RCC->APB1LPENR = 0x8; // alive TIM5 |
kenjiArai | 1:d6abda61923b | 165 | RCC->APB2LPENR = 0; |
kenjiArai | 0:f8c5c7d19d9a | 166 | #endif |
kenjiArai | 0:f8c5c7d19d9a | 167 | } |
kenjiArai | 0:f8c5c7d19d9a | 168 | |
kenjiArai | 0:f8c5c7d19d9a | 169 | void time_enter_mode(void) |
kenjiArai | 0:f8c5c7d19d9a | 170 | { |
kenjiArai | 0:f8c5c7d19d9a | 171 | char *ptr; |
kenjiArai | 0:f8c5c7d19d9a | 172 | char linebuf[64]; |
kenjiArai | 0:f8c5c7d19d9a | 173 | |
kenjiArai | 1:d6abda61923b | 174 | if (pc.readable()) { |
kenjiArai | 1:d6abda61923b | 175 | pc.getc(); // dummy read |
kenjiArai | 1:d6abda61923b | 176 | } |
kenjiArai | 0:f8c5c7d19d9a | 177 | pc.printf("\r\nSet time into RTC\r\n"); |
kenjiArai | 1:d6abda61923b | 178 | pc.printf(" e.g. >21 1 12 13 14 15 -> January 12,'21, 13:14:14\r\n"); |
kenjiArai | 0:f8c5c7d19d9a | 179 | pc.putc('>'); |
kenjiArai | 0:f8c5c7d19d9a | 180 | ptr = linebuf; |
kenjiArai | 0:f8c5c7d19d9a | 181 | get_line(ptr, sizeof(linebuf)); |
kenjiArai | 0:f8c5c7d19d9a | 182 | pc.printf("\r"); |
kenjiArai | 0:f8c5c7d19d9a | 183 | chk_and_set_time(ptr); |
kenjiArai | 0:f8c5c7d19d9a | 184 | } |
kenjiArai | 0:f8c5c7d19d9a | 185 | |
kenjiArai | 0:f8c5c7d19d9a | 186 | void get_line (char *buff, int len) |
kenjiArai | 0:f8c5c7d19d9a | 187 | { |
kenjiArai | 0:f8c5c7d19d9a | 188 | char c; |
kenjiArai | 0:f8c5c7d19d9a | 189 | uint32_t idx = 0; |
kenjiArai | 0:f8c5c7d19d9a | 190 | |
kenjiArai | 0:f8c5c7d19d9a | 191 | while(true) { |
kenjiArai | 0:f8c5c7d19d9a | 192 | c = pc.getc(); |
kenjiArai | 0:f8c5c7d19d9a | 193 | if (c == '\r') { |
kenjiArai | 0:f8c5c7d19d9a | 194 | buff[idx++] = c; |
kenjiArai | 0:f8c5c7d19d9a | 195 | break; |
kenjiArai | 0:f8c5c7d19d9a | 196 | } |
kenjiArai | 0:f8c5c7d19d9a | 197 | if ((c == '\b') && idx) { |
kenjiArai | 0:f8c5c7d19d9a | 198 | idx--; |
kenjiArai | 0:f8c5c7d19d9a | 199 | pc.putc(c); |
kenjiArai | 0:f8c5c7d19d9a | 200 | pc.putc(' '); |
kenjiArai | 0:f8c5c7d19d9a | 201 | pc.putc(c); |
kenjiArai | 0:f8c5c7d19d9a | 202 | } |
kenjiArai | 0:f8c5c7d19d9a | 203 | if (((uint8_t)c >= ' ') && (idx < len - 1)) { |
kenjiArai | 0:f8c5c7d19d9a | 204 | buff[idx++] = c; |
kenjiArai | 0:f8c5c7d19d9a | 205 | pc.putc(c); |
kenjiArai | 0:f8c5c7d19d9a | 206 | } |
kenjiArai | 0:f8c5c7d19d9a | 207 | } |
kenjiArai | 0:f8c5c7d19d9a | 208 | buff[idx] = 0; |
kenjiArai | 0:f8c5c7d19d9a | 209 | pc.puts("\r\n"); |
kenjiArai | 0:f8c5c7d19d9a | 210 | } |
kenjiArai | 0:f8c5c7d19d9a | 211 | |
kenjiArai | 0:f8c5c7d19d9a | 212 | void chk_and_set_time(char *ptr) |
kenjiArai | 0:f8c5c7d19d9a | 213 | { |
kenjiArai | 0:f8c5c7d19d9a | 214 | int32_t p1; |
kenjiArai | 0:f8c5c7d19d9a | 215 | struct tm t; |
kenjiArai | 0:f8c5c7d19d9a | 216 | time_t seconds; |
kenjiArai | 0:f8c5c7d19d9a | 217 | |
kenjiArai | 0:f8c5c7d19d9a | 218 | if (xatoi(&ptr, &p1)) { |
kenjiArai | 0:f8c5c7d19d9a | 219 | t.tm_year = (uint8_t)p1 + 100; |
kenjiArai | 0:f8c5c7d19d9a | 220 | pc.printf("Year:%d ",p1); |
kenjiArai | 0:f8c5c7d19d9a | 221 | xatoi( &ptr, &p1 ); |
kenjiArai | 0:f8c5c7d19d9a | 222 | t.tm_mon = (uint8_t)p1 - 1; |
kenjiArai | 0:f8c5c7d19d9a | 223 | pc.printf("Month:%d ",p1); |
kenjiArai | 0:f8c5c7d19d9a | 224 | xatoi( &ptr, &p1 ); |
kenjiArai | 0:f8c5c7d19d9a | 225 | t.tm_mday = (uint8_t)p1; |
kenjiArai | 0:f8c5c7d19d9a | 226 | pc.printf("Day:%d ",p1); |
kenjiArai | 0:f8c5c7d19d9a | 227 | xatoi( &ptr, &p1 ); |
kenjiArai | 0:f8c5c7d19d9a | 228 | t.tm_hour = (uint8_t)p1; |
kenjiArai | 0:f8c5c7d19d9a | 229 | pc.printf("Hour:%d ",p1); |
kenjiArai | 0:f8c5c7d19d9a | 230 | xatoi( &ptr, &p1 ); |
kenjiArai | 0:f8c5c7d19d9a | 231 | t.tm_min = (uint8_t)p1; |
kenjiArai | 0:f8c5c7d19d9a | 232 | pc.printf("Min:%d ",p1); |
kenjiArai | 0:f8c5c7d19d9a | 233 | xatoi( &ptr, &p1 ); |
kenjiArai | 0:f8c5c7d19d9a | 234 | t.tm_sec = (uint8_t)p1; |
kenjiArai | 0:f8c5c7d19d9a | 235 | pc.printf("Sec: %d \r\n",p1); |
kenjiArai | 0:f8c5c7d19d9a | 236 | } else { |
kenjiArai | 0:f8c5c7d19d9a | 237 | return; |
kenjiArai | 0:f8c5c7d19d9a | 238 | } |
kenjiArai | 0:f8c5c7d19d9a | 239 | seconds = mktime(&t); |
kenjiArai | 0:f8c5c7d19d9a | 240 | set_time(seconds); |
kenjiArai | 0:f8c5c7d19d9a | 241 | pc.printf( |
kenjiArai | 0:f8c5c7d19d9a | 242 | "Date: %04d/%02d/%02d, %02d:%02d:%02d\r\n", |
kenjiArai | 0:f8c5c7d19d9a | 243 | t.tm_year + 1900, t.tm_mon + 1, t.tm_mday, t.tm_hour, t.tm_min, t.tm_sec |
kenjiArai | 0:f8c5c7d19d9a | 244 | ); |
kenjiArai | 0:f8c5c7d19d9a | 245 | } |
kenjiArai | 0:f8c5c7d19d9a | 246 | |
kenjiArai | 0:f8c5c7d19d9a | 247 | int32_t xatoi (char **str, int32_t *res) |
kenjiArai | 0:f8c5c7d19d9a | 248 | { |
kenjiArai | 0:f8c5c7d19d9a | 249 | int32_t val; |
kenjiArai | 0:f8c5c7d19d9a | 250 | uint8_t c, radix, s = 0; |
kenjiArai | 0:f8c5c7d19d9a | 251 | |
kenjiArai | 0:f8c5c7d19d9a | 252 | while ((c = **str) == ' ') { |
kenjiArai | 0:f8c5c7d19d9a | 253 | (*str)++; |
kenjiArai | 0:f8c5c7d19d9a | 254 | } |
kenjiArai | 0:f8c5c7d19d9a | 255 | if (c == '-') { |
kenjiArai | 0:f8c5c7d19d9a | 256 | s = 1; |
kenjiArai | 0:f8c5c7d19d9a | 257 | c = *(++(*str)); |
kenjiArai | 0:f8c5c7d19d9a | 258 | } |
kenjiArai | 0:f8c5c7d19d9a | 259 | if (c == '0') { |
kenjiArai | 0:f8c5c7d19d9a | 260 | c = *(++(*str)); |
kenjiArai | 0:f8c5c7d19d9a | 261 | if (c <= ' ') { |
kenjiArai | 0:f8c5c7d19d9a | 262 | *res = 0; |
kenjiArai | 0:f8c5c7d19d9a | 263 | return 1; |
kenjiArai | 0:f8c5c7d19d9a | 264 | } |
kenjiArai | 0:f8c5c7d19d9a | 265 | if (c == 'x') { |
kenjiArai | 0:f8c5c7d19d9a | 266 | radix = 16; |
kenjiArai | 0:f8c5c7d19d9a | 267 | c = *(++(*str)); |
kenjiArai | 0:f8c5c7d19d9a | 268 | } else { |
kenjiArai | 0:f8c5c7d19d9a | 269 | if (c == 'b') { |
kenjiArai | 0:f8c5c7d19d9a | 270 | radix = 2; |
kenjiArai | 0:f8c5c7d19d9a | 271 | c = *(++(*str)); |
kenjiArai | 0:f8c5c7d19d9a | 272 | } else { |
kenjiArai | 0:f8c5c7d19d9a | 273 | if ((c >= '0')&&(c <= '9')) { |
kenjiArai | 0:f8c5c7d19d9a | 274 | radix = 8; |
kenjiArai | 0:f8c5c7d19d9a | 275 | } else { |
kenjiArai | 0:f8c5c7d19d9a | 276 | return 0; |
kenjiArai | 0:f8c5c7d19d9a | 277 | } |
kenjiArai | 0:f8c5c7d19d9a | 278 | } |
kenjiArai | 0:f8c5c7d19d9a | 279 | } |
kenjiArai | 0:f8c5c7d19d9a | 280 | } else { |
kenjiArai | 0:f8c5c7d19d9a | 281 | if ((c < '1')||(c > '9')) { |
kenjiArai | 0:f8c5c7d19d9a | 282 | return 0; |
kenjiArai | 0:f8c5c7d19d9a | 283 | } |
kenjiArai | 0:f8c5c7d19d9a | 284 | radix = 10; |
kenjiArai | 0:f8c5c7d19d9a | 285 | } |
kenjiArai | 0:f8c5c7d19d9a | 286 | val = 0; |
kenjiArai | 0:f8c5c7d19d9a | 287 | while (c > ' ') { |
kenjiArai | 0:f8c5c7d19d9a | 288 | if (c >= 'a') { |
kenjiArai | 0:f8c5c7d19d9a | 289 | c -= 0x20; |
kenjiArai | 0:f8c5c7d19d9a | 290 | } |
kenjiArai | 0:f8c5c7d19d9a | 291 | c -= '0'; |
kenjiArai | 0:f8c5c7d19d9a | 292 | if (c >= 17) { |
kenjiArai | 0:f8c5c7d19d9a | 293 | c -= 7; |
kenjiArai | 0:f8c5c7d19d9a | 294 | if (c <= 9) { |
kenjiArai | 0:f8c5c7d19d9a | 295 | return 0; |
kenjiArai | 0:f8c5c7d19d9a | 296 | } |
kenjiArai | 0:f8c5c7d19d9a | 297 | } |
kenjiArai | 0:f8c5c7d19d9a | 298 | if (c >= radix) { |
kenjiArai | 0:f8c5c7d19d9a | 299 | return 0; |
kenjiArai | 0:f8c5c7d19d9a | 300 | } |
kenjiArai | 0:f8c5c7d19d9a | 301 | val = val * radix + c; |
kenjiArai | 0:f8c5c7d19d9a | 302 | c = *(++(*str)); |
kenjiArai | 0:f8c5c7d19d9a | 303 | } |
kenjiArai | 0:f8c5c7d19d9a | 304 | if (s) { |
kenjiArai | 0:f8c5c7d19d9a | 305 | val = -val; |
kenjiArai | 0:f8c5c7d19d9a | 306 | } |
kenjiArai | 0:f8c5c7d19d9a | 307 | *res = val; |
kenjiArai | 0:f8c5c7d19d9a | 308 | return 1; |
kenjiArai | 0:f8c5c7d19d9a | 309 | } |