This commit is contained in:
Mysteo
2023-08-01 19:45:40 +03:00
parent 6aa7f836d3
commit 222f758a2b
5 changed files with 96 additions and 105 deletions

View File

@@ -30,8 +30,8 @@
* Include files
****************************************************************************************/
extern "C" {
#include "header.h" /* generic header */
#include "vl6180_app.h"
#include "header.h" /* generic header */
#include "vl6180_app.h"
}
#include <cstring>
@@ -39,27 +39,31 @@ extern "C" {
#include "tim.h"
UartBridge bridge(true, USART1, USART2, 9600, 9600);
void zummerOff (void);
void zummerOn (void);
void lightingOn (void);
void lightingOff (void);
uint8_t timerCounter = 0;
void zummerOff(void);
void zummerOn(void);
void lightingOn(void);
void lightingOff(void);
/************************************************************************************//**
** \brief Initializes the user program application. Should be called once during
** software program initialization.
** \return none.
**
****************************************************************************************/
void AppInit(void)
{
/* Initialize the timer driver. */
TimerInit();
vl6180_init();
/* Initialize the led driver. */
LedInit();
/* initialize the bootloader interface */
bridge.init();
zummerOff();
lightingOff();
void AppInit(void) {
/* Initialize the timer driver. */
TimerInit();
vl6180_init();
/* Initialize the led driver. */
LedInit();
/* initialize the bootloader interface */
bridge.init();
zummerOff();
lightingOff();
/*
BootComInit();
@@ -80,31 +84,29 @@ uint32_t controlPinDetectedMs = 0;
uint8_t updateMode = 0;
void zummerOff (void)
{
void zummerOff(void) {
HAL_TIM_Base_Stop(&htimZummer);
HAL_TIM_PWM_Stop(&htimZummer, TIM_CHANNEL_2);
}
void zummerOn (void)
{
void zummerOn(void) {
HAL_TIM_Base_Start(&htimZummer);
HAL_TIM_PWM_Start(&htimZummer, TIM_CHANNEL_2);
}
void lightingOn (void)
{
void lightingOn(void) {
HAL_TIM_Base_Start(&htimLighitng);
HAL_TIM_PWM_Start(&htimLighitng, TIM_CHANNEL_1);
}
void lightingOff (void)
{
void lightingOff(void) {
HAL_TIM_Base_Stop(&htimLighitng);
HAL_TIM_PWM_Stop(&htimLighitng, TIM_CHANNEL_1);
}
uint8_t proximityCompleteMessure = 0;
void proximityMessureCompleted (void)
{
void proximityMessureCompleted(void) {
proximityCompleteMessure = 1;
}
@@ -117,98 +119,94 @@ uint32_t waitAnswerFromReaderMs = 0;
uint32_t lightStartMs = 0;
uint8_t uart1Buf[1024];
uint8_t uart2Buf[1024];
uint8_t uartTask (void) // return 0 if data received , otherwise return 1
uint8_t uartTask(void) // return 0 if data received , otherwise return 1
{
if (waitAnswerFromReaderMs != 0)
{
if (HAL_GetTick() - waitAnswerFromReaderMs >= MAX_WAIT_ANSWER_FROM_GM60 )
{
HAL_GPIO_WritePin(READER_EN_GPIO_Port, READER_EN_Pin, GPIO_PIN_SET );
if (waitAnswerFromReaderMs != 0) {
if (HAL_GetTick() - waitAnswerFromReaderMs >= MAX_WAIT_ANSWER_FROM_GM60) {
HAL_GPIO_WritePin(READER_EN_GPIO_Port, READER_EN_Pin, GPIO_PIN_SET);
HAL_Delay(500);
HAL_GPIO_WritePin(READER_EN_GPIO_Port, READER_EN_Pin, GPIO_PIN_RESET );
HAL_GPIO_WritePin(READER_EN_GPIO_Port, READER_EN_Pin, GPIO_PIN_RESET);
waitAnswerFromReaderMs = 0;
}
}
if (!bridge.uart1Buf->is_empty() && bridge.getHuart2()->gState == 0x20) {
HAL_UART_Abort(bridge.getHuart1());
HAL_UARTEx_ReceiveToIdle_IT(bridge.getHuart1(),(uint8_t*)bridge.dataFromUart1, BUF_SIZE );
HAL_UART_AbortReceive_IT(bridge.getHuart1());
HAL_UARTEx_ReceiveToIdle_IT(bridge.getHuart1(), (uint8_t *) bridge.dataFromUart1, BUF_SIZE);
waitAnswerFromReaderMs = HAL_GetTick();
std::string_view stringView{bridge.uart1Buf->dequeue()};
uint32_t size = stringView.size();
if (size > 4)
{
stringView.copy(reinterpret_cast<char *>(uart1Buf), size, 0);
if (stringView.find("FIRMWARE_UPDATE") != std::string::npos)
{
HAL_UART_DeInit(bridge.getHuart1());
BootComInit();
zummerOff();
lightingOff();
}
else if (stringView.find("ZOOMER_ON") != std::string::npos)
{
zummerOn();
}
else if (stringView.find("ZOOMER_OFF") != std::string::npos)
{
zummerOff();
}
else
{
HAL_UART_Transmit_IT(bridge.getHuart2(), (const uint8_t*) uart1Buf, size);
}
stringView.copy(reinterpret_cast<char *>(uart1Buf), size, 0);
if (stringView.find("FIRMWARE_UPDATE") != std::string::npos) {
HAL_UART_DeInit(bridge.getHuart1());
BootComInit();
zummerOff();
lightingOff();
} else if (stringView.find("ZOOMER_ON") != std::string::npos) {
zummerOn();
} else if (stringView.find("ZOOMER_OFF") != std::string::npos) {
zummerOff();
} else {
HAL_UART_Transmit_IT(bridge.getHuart2(), (const uint8_t *) uart1Buf, size);
}
return 0;
}
if (!bridge.uart2Buf->is_empty() && bridge.getHuart1()->gState == 0x20) {
HAL_TIM_Base_Stop(&htimSecTimer);
HAL_TIM_Base_Start_IT(&htimSecTimer);
timerCounter = 0;
waitAnswerFromReaderMs = 0;
HAL_UART_AbortReceive_IT(bridge.getHuart2());
HAL_UARTEx_ReceiveToIdle_IT(bridge.getHuart2(), (uint8_t *) bridge.dataFromUart2, BUF_SIZE);
std::string_view stringView{bridge.uart2Buf->dequeue()};
uint32_t size = stringView.size();
if (size > 4)
{
stringView.copy(reinterpret_cast<char *>(uart2Buf), size, 0);
HAL_UART_Transmit_IT(bridge.getHuart1(), (const uint8_t*) uart2Buf, size);
return 0;
}
stringView.copy(reinterpret_cast<char *>(uart2Buf), size, 0);
HAL_UART_Transmit_IT(bridge.getHuart1(), (const uint8_t *) uart2Buf, size);
return 0;
}
return 1;
}
void AppTask(void)
{
void AppTask(void) {
if (!updateMode) {
uartTask();
if (HAL_GetTick() - lightStartMs >= 10000 && lightStartMs > 0)
{
uartTask();
if (HAL_GetTick() - lightStartMs >= 10000 && lightStartMs > 0) {
lightStartMs = 0;
lightingOff();
}
if (bridge.uart1Buf->is_empty() && bridge.uart2Buf->is_empty())
{
if (proximityCompleteMessure == 1)
{
if (timerCounter == 1) {
timerCounter = 0;
if (vl6180_is_ready() >= 0)
vl6180_single_shot();
if (proximityCompleteMessure == 1) {
proximityCompleteMessure = 0;
if (getRange(&VL6180_Range) == 0)
{
if (VL6180_Range.range_mm > 0 && lightStartMs == 0)
{
if (getRange(&VL6180_Range) == 0) {
if (VL6180_Range.range_mm > 0 && lightStartMs == 0) {
lightStartMs = uwTick;
lightingOn();
}
}
}
}
}
else
{
} else {
BootComCheckActivationRequest();
}
}
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
{
if (htim->Instance == htimSecTimer.Instance)
{
HAL_TIM_Base_Stop_IT(htim);
timerCounter = 1;
}
}
/*** end of AppTask ***/
/*** end of AppTask ***/
/*********************************** end of app.c **************************************/