/**
* @details Initiizes timers for timer based interrupts
*/
void Init_Timers(void) {
// ------------------------------------------------
// Timer 32_0 Init
Chip_TIMER_Init(LPC_TIMER32_0);
Chip_TIMER_Reset(LPC_TIMER32_0);
Chip_TIMER_MatchEnableInt(LPC_TIMER32_0, 0);
Chip_TIMER_SetMatch(LPC_TIMER32_0, 0, Hertz2Ticks(10));
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER32_0, 0);
// Chip_TIMER_Enable(LPC_TIMER32_0);
/* Enable timer interrupt */
NVIC_ClearPendingIRQ(TIMER_32_0_IRQn);
NVIC_EnableIRQ(TIMER_32_0_IRQn);
// ------------------------------------------------
// Timer 32_0 Init
Chip_TIMER_Init(LPC_TIMER32_1);
Chip_TIMER_Reset(LPC_TIMER32_1);
Chip_TIMER_MatchEnableInt(LPC_TIMER32_1, 0);
Chip_TIMER_SetMatch(LPC_TIMER32_1, 0, Hertz2Ticks(BCM_POLL_IDLE_FREQ));
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER32_1, 0);
/* Enable timer_32_1 interrupt */
NVIC_ClearPendingIRQ(TIMER_32_1_IRQn);
NVIC_EnableIRQ(TIMER_32_1_IRQn);
Chip_TIMER_Enable(LPC_TIMER32_1);
}
/**
* @brief main routine for timer example
* @return Function should not exit.
*/
int main(void)
{
uint32_t timerBaseClock;
SystemCoreClockUpdate();
Board_Init();
Board_LED_Set(0, false);
Board_LED_Set(1, false);
/* Initialize Timer 0 and Timer 1 */
Chip_TIMER_Init(LPC_TIMER0);
Chip_TIMER_Init(LPC_TIMER1);
/* Setup prescale value on Timer 0 to PCLK */
Chip_TIMER_PrescaleSet(LPC_TIMER0, 0);
/* Setup prescale value on Timer 1 for lower resolution */
Chip_TIMER_PrescaleSet(LPC_TIMER1, PRESCALE_HZ2);
/* Reset timers */
Chip_TIMER_Reset(LPC_TIMER0);
Chip_TIMER_Reset(LPC_TIMER1);
/* Enable both timers to generate interrupts when time matches */
Chip_TIMER_MatchEnableInt(LPC_TIMER0, 1);
Chip_TIMER_MatchEnableInt(LPC_TIMER1, 1);
/* Get rate of timer base clock */
timerBaseClock = Chip_Clock_GetAsyncSyscon_ClockRate();
/* Setup Timer 0 for a match every 1s */
Chip_TIMER_SetMatch(LPC_TIMER0, 1, (timerBaseClock / TICKRATE_HZ1));
/* Setup Timer 1 for a match twice in a second */
Chip_TIMER_SetMatch(LPC_TIMER1, 1, (timerBaseClock / ((PRESCALE_HZ2 + 1) * TICKRATE_HZ2)) );
/* Setup both timers to restart when match occurs */
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER0, 1);
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER1, 1);
/* Start both timers */
Chip_TIMER_Enable(LPC_TIMER0);
Chip_TIMER_Enable(LPC_TIMER1);
/* Clear both timers of any pending interrupts */
NVIC_ClearPendingIRQ(CT32B0_IRQn);
NVIC_ClearPendingIRQ(CT32B1_IRQn);
/* Enable both timer interrupts */
NVIC_EnableIRQ(CT32B0_IRQn);
NVIC_EnableIRQ(CT32B1_IRQn);
/* Wait for timers to generate interrupts (LEDs toggle in interrupt handlers) */
while (1) {
__WFI();
}
return 0;
}
/**
* @brief Initialization 32-bit Timer 0
* @return Nothing
*/
void Timer32_0_Init(uint32_t tickrate)
{
uint32_t timerFreq;
/* Initialize 32-bit timer 0 clock */
Chip_TIMER_Init(LPC_TIMER32_0);
/* Timer rate is system clock rate */
timerFreq = Chip_Clock_GetSystemClockRate();
/* Timer setup for match and interrupt at TICKRATE_HZ */
Chip_TIMER_Reset(LPC_TIMER32_0);
/* Enable timer to generate interrupts when time matches */
Chip_TIMER_MatchEnableInt(LPC_TIMER32_0, 1);
/* Setup 32-bit timer's duration (32-bit match time) */
Chip_TIMER_SetMatch(LPC_TIMER32_0, 1, (timerFreq / tickrate));
/* Setup timer to restart when match occurs */
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER32_0, 1);
/* Start timer */
Chip_TIMER_Enable(LPC_TIMER32_0);
/* Clear timer of any pending interrupts */
NVIC_ClearPendingIRQ(TIMER_32_0_IRQn);
/* Enable timer interrupt */
NVIC_EnableIRQ(TIMER_32_0_IRQn);
}
static void initHardware(void)
{
SystemCoreClockUpdate();
SysTick_Config(SystemCoreClock/1000);
Board_Init();
Board_LED_Set(0, false);
/* Timer */
Chip_TIMER_Init(LPC_TIMER1);
Chip_TIMER_PrescaleSet(LPC_TIMER1,
#ifdef lpc1769
Chip_Clock_GetPeripheralClockRate(SYSCTL_PCLK_TIMER1) / 1000000 - 1
#else
Chip_Clock_GetRate(CLK_MX_TIMER1) / 1000000 - 1
#endif
);
/* Match 0 (period) */
Chip_TIMER_MatchEnableInt(LPC_TIMER1, 0);
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER1, 0);
Chip_TIMER_StopOnMatchDisable(LPC_TIMER1, 0);
Chip_TIMER_SetMatch(LPC_TIMER1, 0, 1000);
/* Match 1 (duty) */
Chip_TIMER_MatchEnableInt(LPC_TIMER1, 1);
Chip_TIMER_ResetOnMatchDisable(LPC_TIMER1, 1);
Chip_TIMER_StopOnMatchDisable(LPC_TIMER1, 1);
Chip_TIMER_SetMatch(LPC_TIMER1, 1, 100);
Chip_TIMER_Reset(LPC_TIMER1);
Chip_TIMER_Enable(LPC_TIMER1);
NVIC_EnableIRQ(TIMER1_IRQn);
}
void App_Buzzer_off (void)
{
BUZZ_TIMER->TCR = 0x00;
Chip_TIMER_Reset(BUZZ_TIMER);
BUZZ_TIMER->IR = 0xFF;
return;
}
/*
* @Brief Initialize Timer peripheral
* @param timerNumber: Timer number, 0 to 3
* @param ticks: Number of ticks required to finish the cycle.
* @param voidFunctionPointer: function to be executed at the end of the timer cycle
* @return nothing
* @note For the 'ticks' parameter, see function Timer_microsecondsToTicks
*/
void Timer_Init( uint8_t timerNumber, uint32_t ticks,
voidFunctionPointer_t voidFunctionPointer){
/* Source:
http://docs.lpcware.com/lpcopen/v1.03/lpc18xx__43xx_2examples_2periph_2periph__blinky_2blinky_8c_source.html */
/*If timer period = CompareMatch0 Period = 0 => ERROR*/
if (ticks==0){
errorOcurred();
}
/* Enable timer clock and reset it */
Chip_TIMER_Init(timer_sd[timerNumber].name);
Chip_RGU_TriggerReset(timer_sd[timerNumber].RGU);
while (Chip_RGU_InReset(timer_sd[timerNumber].RGU)) {}
Chip_TIMER_Reset(timer_sd[timerNumber].name);
/* Update the defalut function pointer name of the Compare match 0*/
timer_dd[timerNumber].timerCompareMatchFunctionPointer[TIMERCOMPAREMATCH0] = voidFunctionPointer;
/* Initialize compare match with the specified ticks (number of counts needed to clear the match counter) */
Chip_TIMER_MatchEnableInt(timer_sd[timerNumber].name, TIMERCOMPAREMATCH0);
Chip_TIMER_SetMatch(timer_sd[timerNumber].name, TIMERCOMPAREMATCH0, ticks);
/* Makes Timer Match 0 period the timer period*/
Chip_TIMER_ResetOnMatchEnable(timer_sd[timerNumber].name, TIMERCOMPAREMATCH0);
/*Enable timer*/
Chip_TIMER_Enable(timer_sd[timerNumber].name);
/* Enable timer interrupt */
NVIC_SetPriority(timer_sd[timerNumber].IRQn, MAX_SYSCALL_INTERRUPT_PRIORITY+1);
NVIC_EnableIRQ(timer_sd[timerNumber].IRQn);
NVIC_ClearPendingIRQ(timer_sd[timerNumber].IRQn);
}
/**
* @brief main routine for blinky example
* @return Function should not exit.
*/
int main(void)
{
uint32_t timerFreq;
/* Generic Initialization */
SystemCoreClockUpdate();
Board_Init();
/* Enable timer 1 clock */
Chip_TIMER_Init(LPC_TIMER0);
/* Timer rate is system clock rate */
timerFreq = Chip_Clock_GetSystemClockRate();
/* Timer setup for match and interrupt at TICKRATE_HZ */
Chip_TIMER_Reset(LPC_TIMER0);
Chip_TIMER_MatchEnableInt(LPC_TIMER0, 1);
Chip_TIMER_SetMatch(LPC_TIMER0, 1, (timerFreq / TICKRATE_HZ1));
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER0, 1);
Chip_TIMER_Enable(LPC_TIMER0);
/* Enable timer interrupt */
NVIC_ClearPendingIRQ(TIMER0_IRQn);
NVIC_EnableIRQ(TIMER0_IRQn);
/* LEDs toggle in interrupt handlers */
while (1) {
__WFI();
}
return 0;
}
void InicTimers(void){
uint32_t timerFreq;
//inicializo los timers para la maquina de estado
Chip_TIMER_Init(LPC_TIMER2);
//tomo la frecuencia del clok
timerFreq = Chip_Clock_GetSystemClockRate();
//confinfiguro el timer 2 y el match 1
Chip_TIMER_Reset(LPC_TIMER2);
Chip_TIMER_MatchEnableInt(LPC_TIMER2, 1);
Chip_TIMER_SetMatch(LPC_TIMER2, 1, 250);
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER2, 1);
Chip_TIMER_Enable(LPC_TIMER2);
//habilito interrupciones
NVIC_ClearPendingIRQ(TIMER2_IRQn);
NVIC_EnableIRQ(TIMER2_IRQn);
}
void App_Button_Init(void)
{
ButtonWaiting = 0;
//Initialize the timer for the debouncing, but don't start it
Chip_TIMER_Init(DEBOUNCE_TIMER);
Chip_TIMER_Reset(DEBOUNCE_TIMER);
DEBOUNCE_TIMER->PR = 100;
DEBOUNCE_TIMER->MCR = (1<<1)|(1<<0); //Enable MR0 match interrupt, Reset TC on MR0 match
DEBOUNCE_TIMER->MR[0]= 0xFFFF; //MR0 match value
//Enable the IRQ for the timer
NVIC_EnableIRQ(DEBOUNCE_TIMER_NVIC_NAME);
//Set all button pins to GPIO input with pullup
Chip_IOCON_PinMuxSet(LPC_IOCON, BUTTON_1_PORT, BUTTON_1_PIN, (IOCON_FUNC0 | IOCON_MODE_PULLUP));
Chip_IOCON_PinMuxSet(LPC_IOCON, BUTTON_2_PORT, BUTTON_2_PIN, (IOCON_FUNC0 | IOCON_MODE_PULLUP));
Chip_IOCON_PinMuxSet(LPC_IOCON, BUTTON_3_PORT, BUTTON_3_PIN, (IOCON_FUNC0 | IOCON_MODE_PULLUP));
Chip_IOCON_PinMuxSet(LPC_IOCON, BUTTON_4_PORT, BUTTON_4_PIN, (IOCON_FUNC0 | IOCON_MODE_PULLUP));
Chip_IOCON_PinMuxSet(LPC_IOCON, BUTTON_5_PORT, BUTTON_5_PIN, (IOCON_FUNC0 | IOCON_MODE_PULLUP));
Chip_GPIO_SetPinDIRInput(LPC_GPIO, BUTTON_1_PORT, BUTTON_1_PIN);
Chip_GPIO_SetPinDIRInput(LPC_GPIO, BUTTON_2_PORT, BUTTON_2_PIN);
Chip_GPIO_SetPinDIRInput(LPC_GPIO, BUTTON_3_PORT, BUTTON_3_PIN);
Chip_GPIO_SetPinDIRInput(LPC_GPIO, BUTTON_4_PORT, BUTTON_4_PIN);
Chip_GPIO_SetPinDIRInput(LPC_GPIO, BUTTON_5_PORT, BUTTON_5_PIN);
//TODO: Probably put this in the main initalization...
Chip_Clock_EnablePeriphClock(SYSCTL_CLOCK_PINT);
//Setup GPIO interrupts for each button
/* Configure interrupt channel for the GPIO pin in SysCon block */
Chip_SYSCTL_SetPinInterrupt(BUTTON_1_PININT_INDEX, BUTTON_1_PORT, BUTTON_1_PIN);
Chip_SYSCTL_SetPinInterrupt(BUTTON_2_PININT_INDEX, BUTTON_2_PORT, BUTTON_2_PIN);
Chip_SYSCTL_SetPinInterrupt(BUTTON_3_PININT_INDEX, BUTTON_3_PORT, BUTTON_3_PIN);
Chip_SYSCTL_SetPinInterrupt(BUTTON_4_PININT_INDEX, BUTTON_4_PORT, BUTTON_4_PIN);
Chip_SYSCTL_SetPinInterrupt(BUTTON_5_PININT_INDEX, BUTTON_5_PORT, BUTTON_5_PIN);
/* Configure channel interrupt as edge sensitive and falling edge interrupt */
Chip_PININT_SetPinModeEdge(LPC_PININT, PININTCH(BUTTON_1_PININT_INDEX));
Chip_PININT_SetPinModeEdge(LPC_PININT, PININTCH(BUTTON_2_PININT_INDEX));
Chip_PININT_SetPinModeEdge(LPC_PININT, PININTCH(BUTTON_3_PININT_INDEX));
Chip_PININT_SetPinModeEdge(LPC_PININT, PININTCH(BUTTON_4_PININT_INDEX));
Chip_PININT_SetPinModeEdge(LPC_PININT, PININTCH(BUTTON_5_PININT_INDEX));
Chip_PININT_EnableIntLow(LPC_PININT, PININTCH(BUTTON_1_PININT_INDEX));
Chip_PININT_EnableIntLow(LPC_PININT, PININTCH(BUTTON_2_PININT_INDEX));
Chip_PININT_EnableIntLow(LPC_PININT, PININTCH(BUTTON_3_PININT_INDEX));
Chip_PININT_EnableIntLow(LPC_PININT, PININTCH(BUTTON_4_PININT_INDEX));
Chip_PININT_EnableIntLow(LPC_PININT, PININTCH(BUTTON_5_PININT_INDEX));
Chip_PININT_ClearIntStatus(LPC_PININT, ((1 << BUTTON_1_PININT_INDEX)|(1<<BUTTON_2_PININT_INDEX)|(1<<BUTTON_3_PININT_INDEX)|(1<<BUTTON_4_PININT_INDEX)|(1<<BUTTON_5_PININT_INDEX)) );
App_EnableButtons();
return;
}
void init_runtime_stats_timer( void )
{
Chip_TIMER_Init(LPC_TIMER3);
Chip_TIMER_Reset(LPC_TIMER3);
Chip_Clock_SetPCLKDiv(SYSCTL_PCLK_TIMER3, SYSCTL_CLKDIV_1);
Chip_TIMER_PrescaleSet(LPC_TIMER3, 3200);
Chip_TIMER_Enable(LPC_TIMER3);
}
uint32_t PWMSetPeriod(uint8_t channel, uint32_t period) {
if (channel > CHANNEL_C_TIMER_INDEX) {
return 1;
}
if (eDVSMode != EDVS_MODE_INTERNAL && channel == 0) {
return 1; // channel 0 taken for master/slave mode
}
LPC_TIMER_T * timer = halTimers[channel].timer;
halTimers[channel].period = period;
/**
* If the period equal 0, the timer is disable and its outputs are set as GPIO and driven low.
*/
if (period == 0) {
Chip_TIMER_DeInit(timer); //Stop the timer
Chip_TIMER_SetMatch(timer, 2, 0);
halTimers[channel].enabled[0] = DISABLE;
halTimers[channel].enabled[1] = DISABLE;
Chip_GPIO_SetPinDIRInput(LPC_GPIO_PORT, halTimers[channel].portGpio[0], halTimers[channel].pinGpio[0]);
Chip_GPIO_SetPinDIRInput(LPC_GPIO_PORT, halTimers[channel].portGpio[1], halTimers[channel].pinGpio[1]);
Chip_GPIO_SetPinOutLow(LPC_GPIO_PORT, halTimers[channel].portGpio[0], halTimers[channel].pinGpio[0]);
Chip_GPIO_SetPinOutLow(LPC_GPIO_PORT, halTimers[channel].portGpio[1], halTimers[channel].pinGpio[1]);
Chip_SCU_PinMuxSet(halTimers[channel].port[0], halTimers[channel].pin[0], halTimers[channel].gpioMode[0]);
Chip_SCU_PinMuxSet(halTimers[channel].port[1], halTimers[channel].pin[1], halTimers[channel].gpioMode[1]);
} else {
/**
* The channel match 2 is used as the controller of the base frequency.
* When there is a match on this channel, the timer is reset and the external match bit
* is set to 1.
* The M0 core is looking for this change and it sets the output of the channels to high.
*/
Chip_TIMER_Init(timer);
Chip_TIMER_Disable(timer);
Chip_TIMER_Reset(timer);
/**
* The Main clock is running at 192Mhz so set the Prescaler in order to have
* a 1 Mhz timer. Timer_CLK = Main_CLK/ (PR+1)
*/
Chip_TIMER_PrescaleSet(timer, 191);
Chip_TIMER_ResetOnMatchEnable(timer, 2);
Chip_TIMER_StopOnMatchDisable(timer, 2);
Chip_TIMER_MatchDisableInt(timer, 2);
Chip_TIMER_SetMatch(timer, 2, period);
//Reconfigure match channels!
if (halTimers[channel].enabled[0]) {
PWMSetWidth(channel, 0, halTimers[channel].witdh[0]);
}
if (halTimers[channel].enabled[1]) {
PWMSetWidth(channel, 1, halTimers[channel].witdh[1]);
}
Chip_TIMER_ExtMatchControlSet(timer, 0, TIMER_EXTMATCH_SET, 2);
// Clear interrupt pending
timer->IR = 0xFFFFFFFF;
Chip_TIMER_Enable(timer);
}
return 0;
}
void initialize_timer() {
Chip_TIMER_Init(LPC_TIMER1);
Chip_TIMER_Reset(LPC_TIMER1);
Chip_TIMER_MatchEnableInt(LPC_TIMER1, 1);
Chip_TIMER_SetMatch(LPC_TIMER1, 1, 240000);//1200000
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER1, 1);
Chip_TIMER_Enable(LPC_TIMER1);
NVIC_ClearPendingIRQ(TIMER1_IRQn);
NVIC_EnableIRQ(TIMER1_IRQn);
}
void Mb1240::init_capture_timer() {
Chip_TIMER_Init(this->timer);
Chip_TIMER_Reset(this->timer);
Chip_TIMER_CaptureRisingEdgeEnable(this->timer, this->timer_cap_ch);
Chip_TIMER_CaptureEnableInt(this->timer, this->timer_cap_ch);
Chip_TIMER_Enable(this->timer);
NVIC_ClearPendingIRQ(get_timer_nvic_irq(this->timer));
NVIC_EnableIRQ(get_timer_nvic_irq(this->timer));
}
void DEBOUNCE_TIMER_IRQ_HANDLER(void)
{
//Reenable buttons
App_HandleButtonPress();
ButtonWaiting = 0;
DEBOUNCE_TIMER->TCR = 0x00;
Chip_TIMER_Reset(DEBOUNCE_TIMER);
DEBOUNCE_TIMER->IR = 0xFF;
App_EnableButtons();
}
void setup() {
const uint32 system_clock_hz = Chip_Clock_GetSystemClockRate();
const uint32 prescale = system_clock_hz / 1000000;
Chip_TIMER_Init(SYS_CLOCK_TIMER32);
// Set prescaler for 1 usec/count.
Chip_TIMER_PrescaleSet(SYS_CLOCK_TIMER32, prescale - 1);
// Reset count
Chip_TIMER_Reset(SYS_CLOCK_TIMER32);
// Start counting.
Chip_TIMER_Enable(SYS_CLOCK_TIMER32);
}
void
call_transmit_delay (uint32_t seconds)
{
NVIC_DisableIRQ (TIMER_32_0_IRQn);
transmit_call = false;
Chip_TIMER_Reset (LPC_TIMER32_0);
Chip_TIMER_ClearMatch(LPC_TIMER32_0, 0);
Chip_TIMER_SetMatch (LPC_TIMER32_0, 0, seconds);
NVIC_ClearPendingIRQ (TIMER_32_0_IRQn);
NVIC_EnableIRQ (TIMER_32_0_IRQn);
}
void setupTimer(void)
{
Chip_IOCON_PinMux(LPC_IOCON, 1, 28, 2, 3);
Chip_GPIO_SetPinDIROutput(LPC_GPIO, 1, 28);
Chip_TIMER_Init(LPC_TIMER0);
Chip_TIMER_Reset(LPC_TIMER0);
Chip_TIMER_PrescaleSet(LPC_TIMER0, 500);
Chip_TIMER_SetMatch(LPC_TIMER0, 0, 16000);
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER0, 0);
// Chip_TIMER_MatchEnableInt(LPC_TIMER0, 0);
Chip_TIMER_ExtMatchControlSet(LPC_TIMER0, RESET, TIMER_EXTMATCH_TOGGLE, 0);
Chip_TIMER_Enable(LPC_TIMER0);
// NVIC_ClearPendingIRQ(TIMER0_IRQn);
// NVIC_EnableIRQ(TIMER0_IRQn);
}
void App_Buzzer_Init(void)
{
Chip_IOCON_PinMuxSet(LPC_IOCON, 0, 17, IOCON_FUNC0); //Set the buzz pin to GPIO
Chip_GPIO_SetPinDIROutput(LPC_GPIO, 0, 17); //Set the buzz pin to output
Chip_GPIO_SetPinState(LPC_GPIO, 0, 17, 0); //Set the buzz pin low
//Initialize the timer for the buzzer, but don't start it
Chip_TIMER_Init(BUZZ_TIMER);
Chip_TIMER_Reset(BUZZ_TIMER);
BUZZ_TIMER->MCR = (1<<1)|(1<<0); //Enable MR0 match interrupt, Reset TC on MR0 match
BUZZ_TIMER->MR[0]= 12000; //MR0 match value
//Enable the IRQ for the timer
NVIC_EnableIRQ(BUZZ_TIMER_NVIC_NAME);
return;
}
int main(void)
{
int duty = 100;
initHardware();
while(1) {
pausems(1000);
duty += 100;
if(duty == 1000) duty = 100;
Chip_TIMER_SetMatch(LPC_TIMER1, 1, duty);
Chip_TIMER_Reset(LPC_TIMER1);
Chip_TIMER_ClearMatch(LPC_TIMER1, 1);
Chip_TIMER_ClearMatch(LPC_TIMER1, 0);
}
}
void
call_init (void)
{
transmit_call = false;
Chip_TIMER_Init (LPC_TIMER32_0);
Chip_TIMER_Reset (LPC_TIMER32_0);
Chip_TIMER_MatchEnableInt (LPC_TIMER32_0, 0);
Chip_TIMER_PrescaleSet (LPC_TIMER32_0, Chip_Clock_GetSystemClockRate ());
Chip_TIMER_SetMatch (LPC_TIMER32_0, 0, CALL_INTERVAL_SEC);
Chip_TIMER_ResetOnMatchEnable (LPC_TIMER32_0, 0);
Chip_TIMER_Enable (LPC_TIMER32_0);
NVIC_ClearPendingIRQ (TIMER_32_0_IRQn);
NVIC_EnableIRQ (TIMER_32_0_IRQn);
}
void vConfigureTimerForRunTimeStats( void )
{
uint32_t timerFreq;
/* Enable timer 1 clock and reset it */
Chip_TIMER_Init(LPC_TIMER1);
Chip_RGU_TriggerReset(RGU_TIMER1_RST);
while (Chip_RGU_InReset(RGU_TIMER1_RST)) {}
/* Get timer 1 peripheral clock rate */
timerFreq = Chip_Clock_GetRate(CLK_MX_TIMER1);
/* Timer setup for match and interrupt at TICKRATE_HZ */
Chip_TIMER_Reset(LPC_TIMER1);
Chip_TIMER_SetMatch(LPC_TIMER1, 1, (timerFreq / TICKRATE_HZ));
Chip_TIMER_ResetOnMatchEnable(LPC_TIMER1, 1);
Chip_TIMER_Enable(LPC_TIMER1);
}
/*
* you want to use this!
*/
int calcwindspeed(){
int curtick = 0;
int speed = 0;
disable_gpio_irq(2,13);
curtick = cnttick;
cnttick = 0;
float div = Chip_TIMER_ReadCount(LPC_TIMER2)/ticksPerSecond;
Chip_TIMER_Reset(LPC_TIMER2);
enable_gpio_irq(2,13);
DBG("div:%f count:%d\n",div,curtick);
speed = curtick*(2.25/(div))*1.609344*100; //mph to km/h to 100m/h
return speed;
}
void
call_transmit_if_needed (void)
{
NVIC_DisableIRQ (TIMER_32_0_IRQn);
if (transmit_call) {
DBG (DBG_LEVEL_INFO, "Transmitting station ID (%s)", CALL_STRING);
tx_enable ();
while (!tx_is_ready ());
morse_send (CALL_STRING, strlen (CALL_STRING));
systick_delay (CALL_POST_DELAY_MS);
tx_disable ();
transmit_call = false;
Chip_TIMER_Reset (LPC_TIMER32_0);
Chip_TIMER_ClearMatch(LPC_TIMER32_0, 0);
Chip_TIMER_SetMatch (LPC_TIMER32_0, 0, CALL_INTERVAL_SEC);
NVIC_ClearPendingIRQ (TIMER_32_0_IRQn);
}
NVIC_EnableIRQ (TIMER_32_0_IRQn);
}
void
main (void)
{
SystemInit ();
Chip_IOCON_PinMuxSet (LPC_IOCON, LED_STATUS_PIO, IOCON_MODE_INACT | IOCON_FUNC0);
Chip_GPIO_SetPinDIROutput (LPC_GPIO, LED_STATUS_PORT, LED_STATUS_PIN);
Chip_GPIO_SetPinState (LPC_GPIO, LED_STATUS_PORT, LED_STATUS_PIN, false);
Chip_TIMER_Init (LPC_TIMER32_0);
Chip_TIMER_Reset (LPC_TIMER32_0);
Chip_TIMER_MatchEnableInt (LPC_TIMER32_0, 1);
Chip_TIMER_SetMatch (LPC_TIMER32_0, 1, (Chip_Clock_GetSystemClockRate () / (1 * 32)));
Chip_TIMER_ResetOnMatchEnable (LPC_TIMER32_0, 1);
Chip_TIMER_Enable (LPC_TIMER32_0);
/* Enable timer interrupt */
NVIC_ClearPendingIRQ (TIMER_32_0_IRQn);
NVIC_EnableIRQ (TIMER_32_0_IRQn);
while (1) {
__WFI ();
}
}
/**
* @details Where all the magic happens
* @return Shouldn't return
*/
int main(void) {
Init_Core();
Init_SM();
Init_Board();
Init_Globals();
Init_CAN();
Init_Timers();
// ------------------------------------------------
// Begin
DEBUG_Print("Started Up\r\n");
while(1) {
uint8_t count;
if ((count = Chip_UART_Read(LPC_USART, Rx_Buf, UART_RX_BUF_SIZE)) != 0) {
switch (Rx_Buf[0]) {
case 'a': // Print out Brusa Mains Info
DEBUG_Print("Actual Mains Voltage: ");
itoa(brusa_actual_1.mains_mVolts, str, 10);
DEBUG_Print(str);
DEBUG_Print("\r\n");
DEBUG_Print("Mains type: ");
itoa(brusa_actual_1.mains_cAmps, str, 10);
DEBUG_Print(str);
DEBUG_Print("\r\n");
DEBUG_Print("Temp: ");
itoa((brusa_temp.power_temp / 10) - 40 , str, 10);
DEBUG_Print(str);
DEBUG_Print("\r\n");
DEBUG_Print("Temp: 0x");
itoa(brusa_temp.power_temp , str, 16);
DEBUG_Print(str);
DEBUG_Print("\r\n");
break;
case 'b': // Print out Actual Brusa Output
DEBUG_Print("Actual Out Voltage: ");
itoa(brusa_actual_1.output_mVolts, str, 10);
DEBUG_Println(str);
DEBUG_Print("Actual Out Current: ");
itoa(brusa_actual_1.output_cAmps, str, 10);
DEBUG_Println(str);
break;
case 'f': // Print out Pack State
itoa(pack_state.pack_min_mVolts, str, 10);
DEBUG_Print("Pack Min Voltage: ");
DEBUG_Print(str);
DEBUG_Print("\r\n");
itoa(pack_state.pack_max_mVolts, str, 10);
DEBUG_Print("Pack Max Voltage: ");
DEBUG_Print(str);
DEBUG_Print("\r\n");
break;
case 'y': // Print out Module Balance State
itoa(PackManager_GetExtModId(0), str, 16);
DEBUG_Print("Mod 0x");
DEBUG_Print(str);
itoa(PackManager_GetExtBal(0), str, 2);
DEBUG_Print(": 0b");
DEBUG_Println(str);
itoa(PackManager_GetExtModId(1), str, 16);
DEBUG_Print("Mod 0x");
DEBUG_Print(str);
itoa(PackManager_GetExtBal(1), str, 2);
DEBUG_Print(": 0b");
DEBUG_Println(str);
break;
case 'e':
itoa(brusa_error,str, 2);
DEBUG_Println(str);
break;
case 'm': // Print out charge mode and brusa error
DEBUG_Print("Charge Mode: ");
itoa(Charge_GetMode(), str, 10);
DEBUG_Println(str);
DEBUG_Print("Error Messages: ");
itoa((uint64_t)brusa_error, str, 2);
DEBUG_Println(str);
break;
default:
DEBUG_Print("Unknown Command\r\n");
}
}
//-----------------------------
// Detect Input Changes (Default to IDLE)
MODE_INPUT_T inp = INP_IDLE;
if (!Board_Switch_Read()) {
inp = INP_CHRG;
} else {
inp = INP_IDLE;
}
//-----------------------------
// Update pack_state
pack_state.contactors_closed = Board_Contactors_Closed();
pack_state.msTicks = msTicks;
pack_state.brusa_error = brusa_error;
pack_state.pack_cAmps_in = brusa_actual_1.output_cAmps;
//-----------------------------
// SSM Step
ERROR_T result = SSM_Step(&pack_state, inp, &out_state);
if (result != ERROR_NONE) {
_error(result, true, false);
}
//-----------------------------
// Check if SSM has Changed State
// Currently only changes Poll Frequency
// [TODO] Set a status LED!!
if (SSM_GetMode() != mode) {
mode = SSM_GetMode();
switch (SSM_GetMode()) {
case IDLE:
Chip_TIMER_SetMatch(LPC_TIMER32_1, 0, Hertz2Ticks(BCM_POLL_IDLE_FREQ));
Chip_TIMER_Reset(LPC_TIMER32_1); // Otherwise shit gets F****D
break;
case CHARGING:
Chip_TIMER_SetMatch(LPC_TIMER32_1, 0, Hertz2Ticks(BCM_POLL_CHARGING_FREQ));
Chip_TIMER_Reset(LPC_TIMER32_1);
break;
case DRAINING:
Chip_TIMER_SetMatch(LPC_TIMER32_1, 0, Hertz2Ticks(BCM_POLL_DRAINING_FREQ));
Chip_TIMER_Reset(LPC_TIMER32_1);
break;
}
}
//-----------------------------
// Carry out out_state
if (out_state.close_contactors && !Board_Contactors_Closed()) {
Board_Close_Contactors(true);
} else if (!out_state.close_contactors && Board_Contactors_Closed()) {
Board_Close_Contactors(false);
}
if (out_state.brusa_output) {
brusa_control.clear_error = out_state.brusa_clear_latch;
brusa_control.output_mVolts = out_state.brusa_mVolts;
brusa_control.output_cAmps = out_state.brusa_cAmps;
Chip_TIMER_Enable(LPC_TIMER32_0);
} else {
brusa_control.output_mVolts = 0;
brusa_control.output_cAmps = 0;
Chip_TIMER_Disable(LPC_TIMER32_0);
}
//-----------------------------
// Retrieve available brusa messages
int8_t tmp = MCP2515_GetFullReceiveBuffer();
int8_t res = 0;
if (tmp == 2) {
MCP2515_ReadBuffer(&mcp_msg_obj, 0);
res = Brusa_Decode(&brusa_messages, &mcp_msg_obj);
if (res == -1) {
DEBUG_Println("Brusa Decode Error");
res = 0;
}
MCP2515_ReadBuffer(&mcp_msg_obj, 1);
res = Brusa_Decode(&brusa_messages, &mcp_msg_obj);
} else if (tmp == 0) { // Receive Buffer 0 Full
MCP2515_ReadBuffer(&mcp_msg_obj, tmp);
res = Brusa_Decode(&brusa_messages, &mcp_msg_obj);
} else if (tmp == 1) { //Receive buffer 1 full
MCP2515_ReadBuffer(&mcp_msg_obj, tmp);
res = Brusa_Decode(&brusa_messages, &mcp_msg_obj);
}
if (res == -1) {
DEBUG_Println("Brusa Decode Error");
res = 0;
}
//-----------------------------
// Send brusa message if its time
if (brusa_message_send) {
brusa_message_send = false;
Brusa_MakeCTL(&brusa_control, &mcp_msg_obj);
MCP2515_LoadBuffer(0, &mcp_msg_obj);
MCP2515_SendBuffer(0);
}
//-----------------------------
// Check for and decode A123 Messages
if (!RingBuffer_IsEmpty(&rx_buffer)) {
CCAN_MSG_OBJ_T temp_msg;
RingBuffer_Pop(&rx_buffer, &temp_msg);
res = PackManager_Update(&temp_msg);
if (new_std_msg_sent) {
PackManager_Commit(&pack_state);
new_std_msg_sent = false;
}
}
if (res == -1) {
DEBUG_Println("A123 Decode Error");
}
//-----------------------------
// Timed output
if (msTicks - last_debug_message > TIMED_MESSAGE_DELAY) {
message_count++;
last_debug_message = msTicks;
switch (message_count % 7) {
case 0:
if (out_state.balance) {
itoa(mbb_cmd.balance_target_mVolts, str, 10);
DEBUG_Print("Balancing to: ");
DEBUG_Println(str);
} else {
DEBUG_Println("Not balancing");
}
break;
case 1:
itoa(brusa_control.output_mVolts, str, 10);
DEBUG_Print("Brusa out V: ");
DEBUG_Println(str);
break;
case 2:
itoa(brusa_control.output_cAmps, str, 10);
DEBUG_Print("Brusa out C: ");
DEBUG_Println(str);
break;
case 3:
DEBUG_Print("Actual Out Voltage: ");
itoa(brusa_actual_1.output_mVolts, str, 10);
DEBUG_Println(str);
break;
case 4:
DEBUG_Print("Actual Out Current: ");
itoa(brusa_actual_1.output_cAmps, str, 10);
DEBUG_Println(str);
break;
case 5:
DEBUG_Print("Mode: ");
DEBUG_Println((SSM_GetMode() == CHARGING) ? "Chrg":"Idle");
break;
case 6:
DEBUG_Print("Brusa Output: ");
itoa(out_state.brusa_output, str, 2);
DEBUG_Println(str);
DEBUG_Print("\r\n");
break;
}
}
}
return 0;
}
void Timer_Reset(uint8_t timerNumber){
Chip_TIMER_Reset(timer_sd[timerNumber].name);
}