mirror of https://github.com/rusefi/openblt.git
153 lines
5.5 KiB
C
153 lines
5.5 KiB
C
/************************************************************************************//**
|
|
* \file Demo/HCS12_Evbplus_Dragon12p_CodeWarrior/Prog/main.c
|
|
* \brief Demo program application source file.
|
|
* \ingroup Prog_HCS12_Evbplus_Dragon12p_CodeWarrior
|
|
* \internal
|
|
*----------------------------------------------------------------------------------------
|
|
* C O P Y R I G H T
|
|
*----------------------------------------------------------------------------------------
|
|
* Copyright (c) 2013 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
|
|
****************************************************************************************/
|
|
#include "header.h" /* generic header */
|
|
|
|
|
|
/****************************************************************************************
|
|
* Function prototypes
|
|
****************************************************************************************/
|
|
static void Init(void);
|
|
static void SysClockInit(void);
|
|
|
|
|
|
/************************************************************************************//**
|
|
** \brief This is the entry point for the bootloader application and is called
|
|
** by the reset interrupt vector after the C-startup routines executed.
|
|
** \return none.
|
|
**
|
|
****************************************************************************************/
|
|
void main(void)
|
|
{
|
|
/* initialize the microcontroller */
|
|
Init();
|
|
/* initialize the bootloader interface */
|
|
BootComInit();
|
|
|
|
/* start the infinite program loop */
|
|
while (1)
|
|
{
|
|
/* toggle LED with a fixed frequency */
|
|
LedToggle();
|
|
/* check for bootloader activation request */
|
|
BootComCheckActivationRequest();
|
|
}
|
|
} /*** end of main ***/
|
|
|
|
|
|
/************************************************************************************//**
|
|
** \brief Initializes the microcontroller.
|
|
** \return none.
|
|
**
|
|
****************************************************************************************/
|
|
static void Init(void)
|
|
{
|
|
/* initialize the system clock */
|
|
SysClockInit();
|
|
/* init the led driver */
|
|
LedInit();
|
|
/* init the timer driver */
|
|
TimerInit();
|
|
/* enable interrupts */
|
|
asm("cli");
|
|
} /*** end of Init ***/
|
|
|
|
|
|
/************************************************************************************//**
|
|
** \brief Initializes the microcontroller.
|
|
** \return none.
|
|
**
|
|
****************************************************************************************/
|
|
static void SysClockInit(void)
|
|
{
|
|
#if (BDM_DEBUGGING_ENABLED == 1)
|
|
/* normally, OpenBLT configures the system clock speed before starting the user
|
|
* program. when BDM programming/debugging is used instead of OpenBLT, the
|
|
* system clock speed configuration still needs to be done here.
|
|
*/
|
|
unsigned char synrCnt;
|
|
unsigned char refdvCnt;
|
|
unsigned long systemSpeed;
|
|
unsigned char found = 0;
|
|
|
|
/* initialize the system clock to BOOT_CPU_SYSTEM_SPEED_KHZ by configuring the PLL
|
|
* subsystem. first default to oscillator clock source.
|
|
*/
|
|
CLKSEL &= ~0x80;
|
|
/* search for the synthesizer and reference divider values. the equation to use is:
|
|
* PLLCLK = EXTCLK * ( (synrCnt + 1) / (refdvCnt + 1) ), with synrCnt can be from
|
|
* 0..63 and refdvCnt can be from 0..15
|
|
*/
|
|
for (refdvCnt = 0; refdvCnt <= 15; refdvCnt++)
|
|
{
|
|
for (synrCnt = 0; synrCnt <= 63; synrCnt++)
|
|
{
|
|
/* calculate the system speed with these SYNR and REFDV settings */
|
|
systemSpeed = ((unsigned long)BOOT_CPU_XTAL_SPEED_KHZ * (synrCnt+1)) / (refdvCnt+1);
|
|
/* was a match found? */
|
|
if (systemSpeed == BOOT_CPU_SYSTEM_SPEED_KHZ)
|
|
{
|
|
/* flag success */
|
|
found = 1;
|
|
/* break loop */
|
|
break;
|
|
}
|
|
}
|
|
if (found == 1)
|
|
{
|
|
/* break this loop as well if a match was already found */
|
|
break;
|
|
}
|
|
}
|
|
/* flag error if no match was found */
|
|
if (found == 0)
|
|
{
|
|
while (1==1)
|
|
{
|
|
;
|
|
}
|
|
}
|
|
/* set the synthesizer and reference divider values */
|
|
SYNR = synrCnt;
|
|
REFDV = refdvCnt;
|
|
/* wait for PLL to lock */
|
|
while((CRGFLG & 0x08) == 0)
|
|
{
|
|
;
|
|
}
|
|
/* select PLL as clock source */
|
|
CLKSEL |= 0x80;
|
|
#endif /* (BDM_DEBUGGING_ENABLED == 1) */
|
|
} /*** end of SysClockInit ***/
|
|
|
|
|
|
/*********************************** end of main.c *************************************/
|