80 lines
2.0 KiB
C
80 lines
2.0 KiB
C
|
/*!
|
|||
|
|
Copyright 2017 <EFBFBD><EFBFBD> "<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>" <EFBFBD> <EFBFBD><EFBFBD><EFBFBD> "<EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>"
|
|||
|
|
|
|||
|
|
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.
|
|||
|
|
|
|||
|
|
\file Vled.c
|
|||
|
|
\brief <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
\author <EFBFBD><EFBFBD><EFBFBD> "<EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>". http://motorcontrol.ru
|
|||
|
|
\version v 2.0 25/03/2016
|
|||
|
|
|
|||
|
|
\addtogroup led
|
|||
|
|
*/
|
|||
|
|
|
|||
|
|
#include "DSP.h"
|
|||
|
|
#include "main.h"
|
|||
|
|
|
|||
|
|
#define RUN_LED_TOGGLE GPIOK->DATAOUTTGL = 1 << 15
|
|||
|
|
#define RUN_LED_OFF GPIOK->DATAOUTSET = 1 << 15
|
|||
|
|
#define RUN_LED_ON GPIOK->DATAOUTCLR = 1 << 15
|
|||
|
|
|
|||
|
|
#define FAULT_LED_TOGGLE GPIOK->DATAOUTTGL = 1 << 14
|
|||
|
|
#define FAULT_LED_OFF GPIOK->DATAOUTSET = 1 << 14
|
|||
|
|
#define FAULT_LED_ON GPIOK->DATAOUTCLR = 1 << 14
|
|||
|
|
|
|||
|
|
void LED_init(Tled *p) {
|
|||
|
|
// <20> src/GpioPeripheralInit()
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
// <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20> <20><><EFBFBD><EFBFBD><EFBFBD> <20> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20> <20><><EFBFBD><EFBFBD>
|
|||
|
|
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20> <20><> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> <20><> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
void LED_msCalc(Tled *p) {
|
|||
|
|
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> <20> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
p->timerRunLed++;
|
|||
|
|
p->timerFaultLed++;
|
|||
|
|
|
|||
|
|
// <20> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
if (drv_status.bit.running == 0) p->prdRunLed = 1000;
|
|||
|
|
else p->prdRunLed = 200;
|
|||
|
|
|
|||
|
|
if (drv_status.bit.fault == 0) p->prdFaultLed = 0;
|
|||
|
|
else p->prdFaultLed = 200;
|
|||
|
|
|
|||
|
|
// <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> - <20><> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>, <20><><EFBFBD><EFBFBD><EFBFBD> - <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
if (p->prdFaultLed == 0) FAULT_LED_OFF;
|
|||
|
|
else if (p->timerFaultLed >= p->prdFaultLed) {
|
|||
|
|
p->timerFaultLed = 0;
|
|||
|
|
FAULT_LED_TOGGLE;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (p->prdRunLed == 0) RUN_LED_OFF;
|
|||
|
|
else if (p->timerRunLed >= p->prdRunLed) {
|
|||
|
|
p->timerRunLed = 0;
|
|||
|
|
RUN_LED_TOGGLE;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|