@@ -229,24 +229,24 @@ static void LPTIM1_IRQHandler(void)
229
229
if (__HAL_LPTIM_GET_IT_SOURCE (& LptimHandle , LPTIM_IT_CMPOK ) != RESET ) {
230
230
__HAL_LPTIM_CLEAR_FLAG (& LptimHandle , LPTIM_FLAG_CMPOK );
231
231
lp_cmpok = true;
232
- if (sleep_manager_locked ) {
232
+ if (sleep_manager_locked ) {
233
233
sleep_manager_unlock_deep_sleep ();
234
234
sleep_manager_locked = false;
235
235
}
236
- if (lp_delayed_prog ) {
237
- if (roll_over_flag ) {
238
- /* If we were close to the roll over of the ticker counter
239
- * change current tick so it can be compared with buffer.
236
+ if (lp_delayed_prog ) {
237
+ if (roll_over_flag ) {
238
+ /* If we were close to the roll over of the ticker counter
239
+ * change current tick so it can be compared with buffer.
240
240
* If this event got outdated fire interrupt right now,
241
241
* else schedule it normally. */
242
- if (lp_delayed_counter <= ((lp_ticker_read () + LP_TIMER_SAFE_GUARD + 1 ) & 0xFFFF )){
242
+ if (lp_delayed_counter <= ((lp_ticker_read () + LP_TIMER_SAFE_GUARD + 1 ) & 0xFFFF )) {
243
243
lp_ticker_fire_interrupt ();
244
244
} else {
245
245
lp_ticker_set_interrupt ((lp_delayed_counter - LP_TIMER_SAFE_GUARD - 1 ) & 0xFFFF );
246
246
}
247
247
roll_over_flag = false;
248
248
} else {
249
- if (future_event_flag && (lp_delayed_counter <= lp_ticker_read ())) {
249
+ if (future_event_flag && (lp_delayed_counter <= lp_ticker_read ())) {
250
250
/* If this event got outdated fire interrupt right now,
251
251
* else schedule it normally. */
252
252
lp_ticker_fire_interrupt ();
@@ -255,7 +255,7 @@ static void LPTIM1_IRQHandler(void)
255
255
lp_ticker_set_interrupt (lp_delayed_counter );
256
256
}
257
257
}
258
-
258
+
259
259
lp_delayed_prog = false;
260
260
}
261
261
}
@@ -284,7 +284,7 @@ uint32_t lp_ticker_read(void)
284
284
void lp_ticker_set_interrupt (timestamp_t timestamp )
285
285
{
286
286
core_util_critical_section_enter ();
287
-
287
+
288
288
timestamp_t last_read_counter = lp_ticker_read ();
289
289
290
290
/* Always store the last requested timestamp */
@@ -298,11 +298,10 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
298
298
if (lp_cmpok == false) {
299
299
/* if this is not safe to write, then delay the programing to the
300
300
* time when CMPOK interrupt will trigger */
301
-
301
+
302
302
/* If this target timestamp is close to the roll over of the ticker counter
303
303
* and current tick is also close to the roll over, then we are in danger zone.*/
304
- if (((0xFFFF - LP_TIMER_SAFE_GUARD < timestamp ) || (timestamp < LP_TIMER_SAFE_GUARD )) && (0xFFFA < last_read_counter ))
305
- {
304
+ if (((0xFFFF - LP_TIMER_SAFE_GUARD < timestamp ) || (timestamp < LP_TIMER_SAFE_GUARD )) && (0xFFFA < last_read_counter )) {
306
305
roll_over_flag = true;
307
306
/* Change the lp_delayed_counter buffer in that way so the value of (0xFFFF - LP_TIMER_SAFE_GUARD) is equal to 0.
308
307
* By doing this it is easy to check if the value of timestamp get outdated by delaying its programming
@@ -315,7 +314,7 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
315
314
} else {
316
315
roll_over_flag = false;
317
316
/* Check if event was meant to be in the past. */
318
- if (lp_delayed_counter >= last_read_counter ) {
317
+ if (lp_delayed_counter >= last_read_counter ) {
319
318
future_event_flag = true;
320
319
} else {
321
320
future_event_flag = false;
@@ -324,18 +323,18 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
324
323
325
324
lp_delayed_prog = true;
326
325
} else {
327
-
326
+
328
327
lp_ticker_clear_interrupt ();
329
328
330
329
/* HW is not able to trig a very short term interrupt, that is
331
330
* not less than few ticks away (LP_TIMER_SAFE_GUARD). So let's make sure it'
332
331
* s at least current tick + LP_TIMER_SAFE_GUARD */
333
- for (uint8_t i = 0 ; i < LP_TIMER_SAFE_GUARD ; i ++ ) {
332
+ for (uint8_t i = 0 ; i < LP_TIMER_SAFE_GUARD ; i ++ ) {
334
333
if (LP_TIMER_WRAP ((last_read_counter + i )) == timestamp ) {
335
334
timestamp = LP_TIMER_WRAP ((timestamp + LP_TIMER_SAFE_GUARD ));
336
335
}
337
336
}
338
-
337
+
339
338
/* Then check if this target timestamp is not in the past, or close to wrap-around
340
339
* Let's assume last_read_counter = 0xFFFC, and we want to program timestamp = 0x100
341
340
* The interrupt will not fire before the CMPOK flag is OK, so there are 2 cases:
@@ -347,7 +346,7 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
347
346
* There might be crossing cases where it would also fire @ 0xFFFE, but by the time we read the counter,
348
347
* it may already have moved to the next one, so for now we've taken this as margin of error.
349
348
*/
350
- if ((timestamp < last_read_counter ) && (last_read_counter <= (0xFFFF - LP_TIMER_SAFE_GUARD ))) {
349
+ if ((timestamp < last_read_counter ) && (last_read_counter <= (0xFFFF - LP_TIMER_SAFE_GUARD ))) {
351
350
/* Workaround, because limitation */
352
351
__HAL_LPTIM_COMPARE_SET (& LptimHandle , ~0 );
353
352
} else {
@@ -360,7 +359,7 @@ void lp_ticker_set_interrupt(timestamp_t timestamp)
360
359
lp_cmpok = false;
361
360
/* Prevent from sleeping after compare register was set as we need CMPOK
362
361
* interrupt to fire (in ~3x30us cycles) before we can safely enter deep sleep mode */
363
- if (!sleep_manager_locked ) {
362
+ if (!sleep_manager_locked ) {
364
363
sleep_manager_lock_deep_sleep ();
365
364
sleep_manager_locked = true;
366
365
}
@@ -383,14 +382,14 @@ void lp_ticker_disable_interrupt(void)
383
382
{
384
383
core_util_critical_section_enter ();
385
384
386
- if (!lp_cmpok ) {
385
+ if (!lp_cmpok ) {
387
386
while (__HAL_LPTIM_GET_FLAG (& LptimHandle , LPTIM_FLAG_CMPOK ) == RESET ) {
388
387
}
389
388
__HAL_LPTIM_CLEAR_FLAG (& LptimHandle , LPTIM_FLAG_CMPOK );
390
389
lp_cmpok = true;
391
390
}
392
391
/* now that CMPOK is set, allow deep sleep again */
393
- if (sleep_manager_locked ) {
392
+ if (sleep_manager_locked ) {
394
393
sleep_manager_unlock_deep_sleep ();
395
394
sleep_manager_locked = false;
396
395
}
0 commit comments