From 9b240ce2e4b6d8956cc24b115f02a413758f5e76 Mon Sep 17 00:00:00 2001
From: moonglow <fxdteam@gmail.com>
Date: Mon, 11 Jan 2021 14:45:46 +0300
Subject: [PATCH] *fix led glitch

---
 Src/pcanpro_led.c | 10 +++++-----
 1 file changed, 5 insertions(+), 5 deletions(-)

diff --git a/Src/pcanpro_led.c b/Src/pcanpro_led.c
index 69b8f20..c5deba3 100644
--- a/Src/pcanpro_led.c
+++ b/Src/pcanpro_led.c
@@ -37,11 +37,11 @@ void pcan_led_set_mode( int led, int mode, uint32_t arg )
 {
   assert( led < LED_TOTAL );
 
-  if( led_mode_array[led].mode == mode )
-    return;
-
   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;
 
   /* set guard time */
@@ -51,7 +51,7 @@ void pcan_led_set_mode( int led, int mode, uint32_t arg )
     if( arg != 0xFFFFFFFF )
     {
       /* update to absolute */
-      arg += led_mode_array[led].timestamp;
+      arg = pcan_timestamp_millis() + arg;
     }
   }