第一版代码，为了在EEPROM保存参数的时候走STM32的CRC，让Codex修改了一下，现在的效果是无法存储，codex表示原因是CRC方法不同，修改到一半今天的额度使用完了，有待后续解决CRC的bug
This commit is contained in:
177
Middleware/CANopenNode/303/CO_LEDs.c
Normal file
177
Middleware/CANopenNode/303/CO_LEDs.c
Normal file
@@ -0,0 +1,177 @@
|
||||
/*
|
||||
* CANopen Indicator specification (CiA 303-3 v1.4.0)
|
||||
*
|
||||
* @file CO_LEDs.h
|
||||
* @ingroup CO_LEDs
|
||||
* @author Janez Paternoster
|
||||
* @copyright 2020 Janez Paternoster
|
||||
*
|
||||
* This file is part of <https://github.com/CANopenNode/CANopenNode>, a CANopen Stack.
|
||||
*
|
||||
* Licensed under the Apache License, Version 2.0 (the "License"); you may not use this
|
||||
* file except in compliance with the License. You may obtain a copy of the License at
|
||||
*
|
||||
* http://www.apache.org/licenses/LICENSE-2.0
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software distributed under the License is
|
||||
* distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and limitations under the License.
|
||||
*/
|
||||
|
||||
#include "303/CO_LEDs.h"
|
||||
|
||||
#if ((CO_CONFIG_LEDS)&CO_CONFIG_LEDS_ENABLE) != 0
|
||||
|
||||
CO_ReturnError_t
|
||||
CO_LEDs_init(CO_LEDs_t* LEDs) {
|
||||
CO_ReturnError_t ret = CO_ERROR_NO;
|
||||
|
||||
/* verify arguments */
|
||||
if (LEDs == NULL) {
|
||||
return CO_ERROR_ILLEGAL_ARGUMENT;
|
||||
}
|
||||
|
||||
/* clear the object */
|
||||
(void)memset(LEDs, 0, sizeof(CO_LEDs_t));
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
void
|
||||
CO_LEDs_process(CO_LEDs_t* LEDs, uint32_t timeDifference_us, CO_NMT_internalState_t NMTstate, bool_t LSSconfig,
|
||||
bool_t ErrCANbusOff, bool_t ErrCANbusWarn, bool_t ErrRpdo, bool_t ErrSync, bool_t ErrHbCons,
|
||||
bool_t ErrOther, bool_t firmwareDownload, uint32_t* timerNext_us) {
|
||||
(void)timerNext_us; /* may be unused */
|
||||
|
||||
uint8_t rd = 0;
|
||||
uint8_t gr = 0;
|
||||
bool_t tick = false;
|
||||
|
||||
LEDs->LEDtmr50ms += timeDifference_us;
|
||||
while (LEDs->LEDtmr50ms >= 50000U) {
|
||||
bool_t rdFlickerNext = (LEDs->LEDred & (uint8_t)CO_LED_flicker) == 0U;
|
||||
|
||||
tick = true;
|
||||
LEDs->LEDtmr50ms -= 50000U;
|
||||
|
||||
if (++LEDs->LEDtmr200ms > 3U) {
|
||||
/* calculate 2,5Hz blinking and flashing */
|
||||
LEDs->LEDtmr200ms = 0;
|
||||
rd = 0;
|
||||
gr = 0;
|
||||
|
||||
if ((LEDs->LEDred & CO_LED_blink) == 0U) {
|
||||
rd |= CO_LED_blink;
|
||||
} else {
|
||||
gr |= CO_LED_blink;
|
||||
}
|
||||
|
||||
switch (++LEDs->LEDtmrflash_1) {
|
||||
case 1: rd |= CO_LED_flash_1; break;
|
||||
case 2: gr |= CO_LED_flash_1; break;
|
||||
case 6: LEDs->LEDtmrflash_1 = 0; break;
|
||||
default: /* none */ break;
|
||||
}
|
||||
switch (++LEDs->LEDtmrflash_2) {
|
||||
case 1:
|
||||
case 3: rd |= CO_LED_flash_2; break;
|
||||
case 2:
|
||||
case 4: gr |= CO_LED_flash_2; break;
|
||||
case 8: LEDs->LEDtmrflash_2 = 0; break;
|
||||
default: /* none */ break;
|
||||
}
|
||||
switch (++LEDs->LEDtmrflash_3) {
|
||||
case 1:
|
||||
case 3:
|
||||
case 5: rd |= CO_LED_flash_3; break;
|
||||
case 2:
|
||||
case 4:
|
||||
case 6: gr |= CO_LED_flash_3; break;
|
||||
case 10: LEDs->LEDtmrflash_3 = 0; break;
|
||||
default: /* none */ break;
|
||||
}
|
||||
switch (++LEDs->LEDtmrflash_4) {
|
||||
case 1:
|
||||
case 3:
|
||||
case 5:
|
||||
case 7: rd |= CO_LED_flash_4; break;
|
||||
case 2:
|
||||
case 4:
|
||||
case 6:
|
||||
case 8: gr |= CO_LED_flash_4; break;
|
||||
case 12: LEDs->LEDtmrflash_4 = 0; break;
|
||||
default: /* none */ break;
|
||||
}
|
||||
} else {
|
||||
/* clear flicker and CANopen bits, keep others */
|
||||
rd = LEDs->LEDred & (0xFFU ^ (CO_LED_flicker | CO_LED_CANopen));
|
||||
gr = LEDs->LEDgreen & (0xFFU ^ (CO_LED_flicker | CO_LED_CANopen));
|
||||
}
|
||||
|
||||
/* calculate 10Hz flickering */
|
||||
if (rdFlickerNext) {
|
||||
rd |= CO_LED_flicker;
|
||||
} else {
|
||||
gr |= CO_LED_flicker;
|
||||
}
|
||||
|
||||
} /* while (LEDs->LEDtmr50ms >= 50000) */
|
||||
|
||||
if (tick) {
|
||||
uint8_t rd_co, gr_co;
|
||||
|
||||
/* CANopen red ERROR LED */
|
||||
if (ErrCANbusOff) {
|
||||
rd_co = 1;
|
||||
} else if (NMTstate == CO_NMT_INITIALIZING) {
|
||||
rd_co = rd & CO_LED_flicker;
|
||||
} else if (ErrRpdo) {
|
||||
rd_co = rd & CO_LED_flash_4;
|
||||
} else if (ErrSync) {
|
||||
rd_co = rd & CO_LED_flash_3;
|
||||
} else if (ErrHbCons) {
|
||||
rd_co = rd & CO_LED_flash_2;
|
||||
} else if (ErrCANbusWarn) {
|
||||
rd_co = rd & CO_LED_flash_1;
|
||||
} else if (ErrOther) {
|
||||
rd_co = rd & CO_LED_blink;
|
||||
} else {
|
||||
rd_co = 0;
|
||||
}
|
||||
|
||||
/* CANopen green RUN LED */
|
||||
if (LSSconfig) {
|
||||
gr_co = gr & CO_LED_flicker;
|
||||
} else if (firmwareDownload) {
|
||||
gr_co = gr & CO_LED_flash_3;
|
||||
} else if (NMTstate == CO_NMT_STOPPED) {
|
||||
gr_co = gr & CO_LED_flash_1;
|
||||
} else if (NMTstate == CO_NMT_PRE_OPERATIONAL) {
|
||||
gr_co = gr & CO_LED_blink;
|
||||
} else if (NMTstate == CO_NMT_OPERATIONAL) {
|
||||
gr_co = 1;
|
||||
} else {
|
||||
gr_co = 0;
|
||||
}
|
||||
|
||||
if (rd_co != 0U) {
|
||||
rd |= CO_LED_CANopen;
|
||||
}
|
||||
if (gr_co != 0U) {
|
||||
gr |= CO_LED_CANopen;
|
||||
}
|
||||
LEDs->LEDred = rd;
|
||||
LEDs->LEDgreen = gr;
|
||||
} /* if (tick) */
|
||||
|
||||
#if ((CO_CONFIG_LEDS)&CO_CONFIG_FLAG_TIMERNEXT) != 0
|
||||
if (timerNext_us != NULL) {
|
||||
uint32_t diff = 50000 - LEDs->LEDtmr50ms;
|
||||
if (*timerNext_us > diff) {
|
||||
*timerNext_us = diff;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
#endif /* (CO_CONFIG_LEDS) & CO_CONFIG_LEDS_ENABLE */
|
||||
Reference in New Issue
Block a user