205 lines
6.6 KiB
C++
205 lines
6.6 KiB
C++
/************************************************************************************//**
|
|
* \file Demo/ARMCM0_STM32G0_Nucleo_G071RB_CubeIDE/Prog/App/app.c
|
|
* \brief User program application source file.
|
|
* \ingroup Prog_ARMCM0_STM32G0_Nucleo_G071RB_CubeIDE
|
|
* \internal
|
|
*----------------------------------------------------------------------------------------
|
|
* C O P Y R I G H T
|
|
*----------------------------------------------------------------------------------------
|
|
* Copyright (c) 2020 by Feaser http://www.feaser.com All rights reserved
|
|
*
|
|
*----------------------------------------------------------------------------------------
|
|
* L I C E N S E
|
|
*----------------------------------------------------------------------------------------
|
|
* This file is part of OpenBLT. OpenBLT is free software: you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as published by the Free
|
|
* Software Foundation, either version 3 of the License, or (at your option) any later
|
|
* version.
|
|
*
|
|
* OpenBLT is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY;
|
|
* without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
|
|
* PURPOSE. See the GNU General Public License for more details.
|
|
*
|
|
* You have received a copy of the GNU General Public License along with OpenBLT. It
|
|
* should be located in ".\Doc\license.html". If not, contact Feaser to obtain a copy.
|
|
*
|
|
* \endinternal
|
|
****************************************************************************************/
|
|
|
|
/****************************************************************************************
|
|
* Include files
|
|
****************************************************************************************/
|
|
extern "C" {
|
|
#include "header.h" /* generic header */
|
|
#include "vl6180_app.h"
|
|
}
|
|
|
|
#include "uart_bridge.hpp"
|
|
#include "tim.h"
|
|
|
|
UartBridge bridge(true, USART1, USART2, 9600, 9600);
|
|
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();
|
|
/*
|
|
BootComInit();
|
|
|
|
*/
|
|
} /*** end of AppInit ***/
|
|
|
|
|
|
/************************************************************************************//**
|
|
** \brief Task function of the user program application. Should be called
|
|
** continuously in the program loop.
|
|
** \return none.
|
|
**
|
|
****************************************************************************************/
|
|
uint8_t temp[2];
|
|
uint32_t controlPinMs = 0;
|
|
uint8_t controlPinFlag = 0;
|
|
uint8_t controlPinHighStart = 0;
|
|
uint8_t updateMode = 0;
|
|
|
|
void zummerOff (void)
|
|
{
|
|
HAL_TIM_Base_Stop(&htim3);
|
|
HAL_TIM_PWM_Stop(&htim3, TIM_CHANNEL_2);
|
|
}
|
|
void zummerOn (void)
|
|
{
|
|
HAL_TIM_Base_Start(&htim3);
|
|
HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_2);
|
|
}
|
|
void lightingOn (void)
|
|
{
|
|
HAL_GPIO_WritePin(LIGHTING_EN_GPIO_Port, LIGHTING_EN_Pin, GPIO_PIN_SET);
|
|
}
|
|
void lightingOff (void)
|
|
{
|
|
HAL_GPIO_WritePin(LIGHTING_EN_GPIO_Port, LIGHTING_EN_Pin, GPIO_PIN_RESET);
|
|
}
|
|
|
|
uint8_t proximityCompleteMessure = 0;
|
|
void proximityMessureCompleted (void)
|
|
{
|
|
proximityCompleteMessure = 1;
|
|
}
|
|
|
|
|
|
VL6180_RangeData_t VL6180_Range;
|
|
uint32_t waitAnsweredMs = 0;
|
|
#define MAX_WAIT_ANSWER_FROM_GM60 10000
|
|
#define DATA_TIMEOUT 500
|
|
|
|
uint32_t lightStartMs = 0;
|
|
|
|
|
|
uint8_t uartTask (void) // return 0 if data received , otherwise return 1
|
|
{
|
|
if (waitAnsweredMs != 0)
|
|
{
|
|
if (HAL_GetTick() - waitAnsweredMs >= 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 );
|
|
waitAnsweredMs = 0;
|
|
}
|
|
}
|
|
|
|
if (!bridge.uart1Buf->is_empty() && (__HAL_UART_GET_FLAG(bridge.getHuart2(), UART_FLAG_TC))) {
|
|
waitAnsweredMs = HAL_GetTick();
|
|
temp[1] = bridge.uart1Buf->dequeue();
|
|
HAL_UART_Transmit_IT(bridge.getHuart2(), &temp[1], 1);
|
|
return 0;
|
|
}
|
|
|
|
if (!bridge.uart2Buf->is_empty() && (__HAL_UART_GET_FLAG(bridge.getHuart1(), UART_FLAG_TC))) {
|
|
temp[2] = bridge.uart2Buf->dequeue();
|
|
HAL_UART_Transmit_IT(bridge.getHuart1(), &temp[2], 1);
|
|
return 0;
|
|
}
|
|
|
|
}
|
|
void AppTask(void)
|
|
{
|
|
if (!updateMode) {
|
|
if (uartTask() == 0)
|
|
{
|
|
|
|
}
|
|
if (HAL_GetTick() - lightStartMs >= 10000)
|
|
{
|
|
lightStartMs = 0;
|
|
lightingOff();
|
|
}
|
|
if (HAL_GPIO_ReadPin(CONTROL_PIN_GPIO_Port, CONTROL_PIN_Pin) == GPIO_PIN_SET) {
|
|
if (controlPinFlag == 0)
|
|
{
|
|
controlPinHighStart = HAL_GetTick();
|
|
controlPinFlag = 1;
|
|
}
|
|
} else if (controlPinFlag == 1) {
|
|
controlPinFlag = 0;
|
|
uint32_t ms = HAL_GetTick() - controlPinHighStart;
|
|
if (ms >= 5000 && ms < 5200) {
|
|
////////Update mode
|
|
HAL_UART_DeInit(&huart1);
|
|
BootComInit();
|
|
zummerOff();
|
|
lightingOff();
|
|
} else if (ms >= 100 && ms < 150) {
|
|
zummerOn();
|
|
//////ZUMMER ON
|
|
} else if (ms >= 200 && ms < 250) {
|
|
zummerOff();
|
|
//////ZUMMER OFF
|
|
}
|
|
}
|
|
if (bridge.uart1Buf->is_empty() && bridge.uart2Buf->is_empty())
|
|
{
|
|
if (proximityCompleteMessure == 1)
|
|
{
|
|
proximityCompleteMessure = 0;
|
|
if (getRange(&VL6180_Range) == 0)
|
|
{
|
|
if (VL6180_Range.range_mm > 0 && lightStartMs == 0)
|
|
{
|
|
lightStartMs = uwTick;
|
|
lightingOn();
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
BootComCheckActivationRequest();
|
|
}
|
|
}
|
|
|
|
|
|
/*** end of AppTask ***/
|
|
|
|
|
|
/*********************************** end of app.c **************************************/
|
|
|
|
//////////// FINALLY NEED TO UNCOMMENT BootComCheckActivationRequest and BootComInit for success firmwaare update from HOST
|