fix:修改UDP通讯中，取电变化上报机制
1、问题点：当RCU网络状态异常的情况下，网络还处于协商状态下，还未进入正常通讯环节时，取电变化不会进行判断。这会导致取电变化上报与实际产生取电状态时间点对不上。 2、将BLV_C1F_Module代码上传至Gitea,之前代码修改记录请查看 .\BasicCode\Readme.txt
This commit is contained in:
caocong
316
BasicCode/Drive/BLE/HAL/LED.c
Normal file
316
BasicCode/Drive/BLE/HAL/LED.c
Normal file
@@ -0,0 +1,316 @@
|
||||
/********************************** (C) COPYRIGHT *******************************
|
||||
* File Name : LED.c
|
||||
* Author : WCH
|
||||
* Version : V1.0
|
||||
* Date : 2014/05/12
|
||||
* Description :
|
||||
*******************************************************************************/
|
||||
|
||||
|
||||
|
||||
/******************************************************************************/
|
||||
/* ͷ<>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD><EFBFBD> */
|
||||
#include "CH57x_common.h"
|
||||
#include "HAL.h"
|
||||
|
||||
|
||||
|
||||
/* LED control structure */
|
||||
typedef struct {
|
||||
uint8 mode; /* Operation mode */
|
||||
uint8 todo; /* Blink cycles left */
|
||||
uint8 onPct; /* On cycle percentage */
|
||||
uint16 time; /* On/off cycle time (msec) */
|
||||
uint32 next; /* Time for next change */
|
||||
} HalLedControl_t;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
HalLedControl_t HalLedControlTable[HAL_LED_DEFAULT_MAX_LEDS];
|
||||
uint8 sleepActive;
|
||||
} HalLedStatus_t;
|
||||
|
||||
/***************************************************************************************************
|
||||
* GLOBAL VARIABLES
|
||||
***************************************************************************************************/
|
||||
static uint8 HalLedState; // LED state at last set/clr/blink update
|
||||
|
||||
static uint8 preBlinkState; // Original State before going to blink mode
|
||||
// bit 0, 1, 2, 3 represent led 0, 1, 2, 3
|
||||
static HalLedStatus_t HalLedStatusControl;
|
||||
|
||||
/***************************************************************************************************
|
||||
* LOCAL FUNCTION
|
||||
***************************************************************************************************/
|
||||
void HalLedOnOff (uint8 leds, uint8 mode);
|
||||
|
||||
/***************************************************************************************************
|
||||
* FUNCTIONS - API
|
||||
***************************************************************************************************/
|
||||
|
||||
/***************************************************************************************************
|
||||
* @fn : HAL_LedInit
|
||||
*
|
||||
* @brief : Initialize LED Service
|
||||
*
|
||||
* @param : None
|
||||
*
|
||||
* @return : None
|
||||
*/
|
||||
void HAL_LedInit (void)
|
||||
{
|
||||
/* Initialize all LEDs to OFF */
|
||||
LED1_DDR;
|
||||
HalLedSet(HAL_LED_ALL, HAL_LED_MODE_OFF);
|
||||
// just test
|
||||
HalLedBlink( HAL_LED_1, 10, 30 , 4000);
|
||||
/* Initialize sleepActive to FALSE */
|
||||
HalLedStatusControl.sleepActive = FALSE;
|
||||
}
|
||||
|
||||
/***************************************************************************************************
|
||||
* @fn <20><>HalLedSet
|
||||
*
|
||||
* @brief <20><>Tun ON/OFF/TOGGLE given LEDs
|
||||
*
|
||||
* @param <20><>led - bit mask value of leds to be turned ON/OFF/TOGGLE
|
||||
* mode - BLINK, FLASH, TOGGLE, ON, OFF
|
||||
*
|
||||
* @return <20><>None
|
||||
*/
|
||||
uint8 HalLedSet (uint8 leds, uint8 mode)
|
||||
{
|
||||
uint8 led;
|
||||
HalLedControl_t *sts;
|
||||
|
||||
switch (mode){
|
||||
case HAL_LED_MODE_BLINK:
|
||||
/* Default blink, 1 time, D% duty cycle */
|
||||
HalLedBlink (leds, 1, HAL_LED_DEFAULT_DUTY_CYCLE, HAL_LED_DEFAULT_FLASH_TIME);
|
||||
break;
|
||||
|
||||
case HAL_LED_MODE_FLASH:
|
||||
/* Default flash, N times, D% duty cycle */
|
||||
HalLedBlink (leds, HAL_LED_DEFAULT_FLASH_COUNT, HAL_LED_DEFAULT_DUTY_CYCLE, HAL_LED_DEFAULT_FLASH_TIME);
|
||||
break;
|
||||
|
||||
case HAL_LED_MODE_ON:
|
||||
case HAL_LED_MODE_OFF:
|
||||
case HAL_LED_MODE_TOGGLE:
|
||||
led = HAL_LED_1;
|
||||
leds &= HAL_LED_ALL;
|
||||
sts = HalLedStatusControl.HalLedControlTable;
|
||||
while (leds){
|
||||
if (leds & led){
|
||||
if (mode != HAL_LED_MODE_TOGGLE){
|
||||
sts->mode = mode; /* ON or OFF */
|
||||
}
|
||||
else{
|
||||
sts->mode ^= HAL_LED_MODE_ON; /* Toggle */
|
||||
}
|
||||
HalLedOnOff (led, sts->mode);
|
||||
leds ^= led;
|
||||
}
|
||||
led <<= 1;
|
||||
sts++;
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
return ( NULL );
|
||||
}
|
||||
|
||||
/***************************************************************************************************
|
||||
* @fn : HalLedBlink
|
||||
*
|
||||
* @brief : Blink the leds
|
||||
*
|
||||
* @param : leds - bit mask value of leds to be blinked
|
||||
* numBlinks - number of blinks
|
||||
* percent - the percentage in each period where the led will be on
|
||||
* period - length of each cycle in milliseconds
|
||||
*
|
||||
* @return : None
|
||||
*/
|
||||
void HalLedBlink (uint8 leds, uint8 numBlinks, uint8 percent, uint16 period)
|
||||
{
|
||||
uint8 led;
|
||||
HalLedControl_t *sts;
|
||||
|
||||
if (leds && percent && period){
|
||||
if (percent < 100){
|
||||
led = HAL_LED_1;
|
||||
leds &= HAL_LED_ALL;
|
||||
sts = HalLedStatusControl.HalLedControlTable;
|
||||
while (leds){
|
||||
if (leds & led){
|
||||
/* Store the current state of the led before going to blinking */
|
||||
preBlinkState |= (led & HalLedState);
|
||||
sts->mode = HAL_LED_MODE_OFF; /* Stop previous blink */
|
||||
sts->time = period; /* Time for one on/off cycle */
|
||||
sts->onPct = percent; /* % of cycle LED is on */
|
||||
sts->todo = numBlinks; /* Number of blink cycles */
|
||||
if (!numBlinks) sts->mode |= HAL_LED_MODE_FLASH; /* Continuous */
|
||||
sts->next = TMOS_GetSystemClock(); /* Start now */
|
||||
sts->mode |= HAL_LED_MODE_BLINK; /* Enable blinking */
|
||||
leds ^= led;
|
||||
}
|
||||
led <<= 1;
|
||||
sts++;
|
||||
}
|
||||
tmos_start_task( halTaskID, LED_BLINK_EVENT, NULL);
|
||||
}
|
||||
else{
|
||||
HalLedSet (leds, HAL_LED_MODE_ON); /* >= 100%, turn on */
|
||||
}
|
||||
}
|
||||
else{
|
||||
HalLedSet (leds, HAL_LED_MODE_OFF); /* No on time, turn off */
|
||||
}
|
||||
}
|
||||
|
||||
/***************************************************************************************************
|
||||
* @fn : HalLedUpdate
|
||||
*
|
||||
* @brief : Update leds to work with blink
|
||||
*
|
||||
* @param : none
|
||||
*
|
||||
* @return : none
|
||||
*/
|
||||
void HalLedUpdate (void)
|
||||
{
|
||||
uint8 led,pct,leds;
|
||||
uint16 next,wait;
|
||||
uint32 time;
|
||||
HalLedControl_t *sts;
|
||||
|
||||
next = 0;
|
||||
led = HAL_LED_1;
|
||||
leds = HAL_LED_ALL;
|
||||
sts = HalLedStatusControl.HalLedControlTable;
|
||||
|
||||
/* Check if sleep is active or not */
|
||||
if (!HalLedStatusControl.sleepActive){
|
||||
while (leds){
|
||||
if (leds & led){
|
||||
if(sts->mode & HAL_LED_MODE_BLINK){
|
||||
time = TMOS_GetSystemClock();
|
||||
if (time >= sts->next){
|
||||
if (sts->mode & HAL_LED_MODE_ON){
|
||||
pct = 100 - sts->onPct; /* Percentage of cycle for off */
|
||||
sts->mode &= ~HAL_LED_MODE_ON; /* Say it's not on */
|
||||
HalLedOnOff (led, HAL_LED_MODE_OFF); /* Turn it off */
|
||||
if (!(sts->mode & HAL_LED_MODE_FLASH)){
|
||||
if( sts->todo != 0xff ) sts->todo--; /* Not continuous, reduce count */
|
||||
if (!sts->todo){
|
||||
sts->mode ^= HAL_LED_MODE_BLINK; /* No more blinks */
|
||||
}
|
||||
}
|
||||
}
|
||||
else{
|
||||
pct = sts->onPct; /* Percentage of cycle for on */
|
||||
sts->mode |= HAL_LED_MODE_ON; /* Say it's on */
|
||||
HalLedOnOff(led, HAL_LED_MODE_ON); /* Turn it on */
|
||||
}
|
||||
if (sts->mode & HAL_LED_MODE_BLINK){
|
||||
wait = (((uint32)pct * (uint32)sts->time) / 100);
|
||||
sts->next = time + wait;
|
||||
}
|
||||
else{
|
||||
/* no more blink, no more wait */
|
||||
wait = 0;
|
||||
/* After blinking, set the LED back to the state before it blinks */
|
||||
HalLedSet (led, ((preBlinkState & led)!=0)?HAL_LED_MODE_ON:HAL_LED_MODE_OFF);
|
||||
/* Clear the saved bit */
|
||||
preBlinkState &= (led ^ 0xFF);
|
||||
}
|
||||
}
|
||||
else{
|
||||
wait = sts->next - time; /* Time left */
|
||||
}
|
||||
if (!next || ( wait && (wait < next) )){
|
||||
next = wait;
|
||||
}
|
||||
}
|
||||
leds ^= led;
|
||||
}
|
||||
led <<= 1;
|
||||
sts++;
|
||||
}
|
||||
if (next){
|
||||
tmos_start_task( halTaskID, LED_BLINK_EVENT, next); /* Schedule event */
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/***************************************************************************************************
|
||||
* @fn : HalLedOnOff
|
||||
*
|
||||
* @brief : Turns specified LED ON or OFF
|
||||
*
|
||||
* @param : leds - LED bit mask
|
||||
* mode - LED_ON,LED_OFF,
|
||||
*
|
||||
* @return : none
|
||||
*/
|
||||
void HalLedOnOff (uint8 leds, uint8 mode)
|
||||
{
|
||||
if (leds & HAL_LED_1){
|
||||
if (mode == HAL_LED_MODE_ON){
|
||||
HAL_TURN_ON_LED1();
|
||||
}
|
||||
else{
|
||||
HAL_TURN_OFF_LED1();
|
||||
}
|
||||
}
|
||||
if (leds & HAL_LED_2){
|
||||
if (mode == HAL_LED_MODE_ON){
|
||||
HAL_TURN_ON_LED2();
|
||||
}
|
||||
else{
|
||||
HAL_TURN_OFF_LED2();
|
||||
}
|
||||
}
|
||||
if (leds & HAL_LED_3){
|
||||
if (mode == HAL_LED_MODE_ON){
|
||||
HAL_TURN_ON_LED3();
|
||||
}
|
||||
else{
|
||||
HAL_TURN_OFF_LED3();
|
||||
}
|
||||
}
|
||||
if (leds & HAL_LED_4){
|
||||
if (mode == HAL_LED_MODE_ON){
|
||||
HAL_TURN_ON_LED4();
|
||||
}
|
||||
else{
|
||||
HAL_TURN_OFF_LED4();
|
||||
}
|
||||
}
|
||||
/* Remember current state */
|
||||
if (mode){
|
||||
HalLedState |= leds;
|
||||
}
|
||||
else{
|
||||
HalLedState &= (leds ^ 0xFF);
|
||||
}
|
||||
}
|
||||
|
||||
/***************************************************************************************************
|
||||
* @fn HalGetLedState
|
||||
*
|
||||
* @brief Dim LED2 - Dim (set level) of LED2
|
||||
*
|
||||
* @param none
|
||||
*
|
||||
* @return led state
|
||||
***************************************************************************************************/
|
||||
uint8 HalLedGetState ()
|
||||
{
|
||||
return HalLedState;
|
||||
}
|
||||
|
||||
/******************************** endfile @ led ******************************/
|
||||
Reference in New Issue
Block a user