*fix led glitch

This commit is contained in:
moonglow 2021-01-11 14:45:46 +03:00
parent 95646306f1
commit 9b240ce2e4
1 changed files with 5 additions and 5 deletions

View File

@ -37,11 +37,11 @@ void pcan_led_set_mode( int led, int mode, uint32_t arg )
{ {
assert( led < LED_TOTAL ); assert( led < LED_TOTAL );
if( led_mode_array[led].mode == mode )
return;
led_mode_array[led].mode = mode; led_mode_array[led].mode = mode;
led_mode_array[led].timestamp = pcan_timestamp_millis(); if( !led_mode_array[led].timestamp )
{
led_mode_array[led].timestamp = pcan_timestamp_millis();
}
led_mode_array[led].delay = 0; led_mode_array[led].delay = 0;
/* set guard time */ /* set guard time */
@ -51,7 +51,7 @@ void pcan_led_set_mode( int led, int mode, uint32_t arg )
if( arg != 0xFFFFFFFF ) if( arg != 0xFFFFFFFF )
{ {
/* update to absolute */ /* update to absolute */
arg += led_mode_array[led].timestamp; arg = pcan_timestamp_millis() + arg;
} }
} }