//*****************************************************************************
//   +--+
//   | ++----+
//   +-++    |
//     |     |
//   +-+--+  |
//   | +--+--+
//   +----+    Copyright (c) 2012 Code Red Technologies Ltd.
//
// Microcontroller Startup code for use with Red Suite
//
// Version : 120126
//
// Software License Agreement
//
// The software is owned by Code Red Technologies and/or its suppliers, and is
// protected under applicable copyright laws.  All rights are reserved.  Any
// use in violation of the foregoing restrictions may subject the user to criminal
// sanctions under applicable laws, as well as to civil liability for the breach
// of the terms and conditions of this license.
//
// THIS SOFTWARE IS PROVIDED "AS IS".  NO WARRANTIES, WHETHER EXPRESS, IMPLIED
// OR STATUTORY, INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF
// MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE APPLY TO THIS SOFTWARE.
// USE OF THIS SOFTWARE FOR COMMERCIAL DEVELOPMENT AND/OR EDUCATION IS SUBJECT
// TO A CURRENT END USER LICENSE AGREEMENT (COMMERCIAL OR EDUCATIONAL) WITH
// CODE RED TECHNOLOGIES LTD.
//
//*****************************************************************************
#if defined (__cplusplus)
#ifdef __REDLIB__
#error Redlib does not support C++
#else
//*****************************************************************************
//
// The entry point for the C++ library startup
//
//*****************************************************************************
extern "C" {
	extern void __libc_init_array(void);
}
#endif
#endif

#define WEAK __attribute__ ((weak))
#define ALIAS(f) __attribute__ ((weak, alias (#f)))

// Code Red - if CMSIS is being used, then SystemInit() routine
// will be called by startup code rather than in application's main()
#if defined (__USE_CMSIS)
#include "stm32l1xx.h"
#endif

//*****************************************************************************
#if defined (__cplusplus)
extern "C" {
#endif

//*****************************************************************************
//
// Forward declaration of the default handlers. These are aliased.
// When the application defines a handler (with the same name), this will
// automatically take precedence over these weak definitions
//
//*****************************************************************************
     void ResetISR(void);
WEAK void NMI_Handler(void);
WEAK void HardFault_Handler(void);
WEAK void MemManage_Handler(void);
WEAK void BusFault_Handler(void);
WEAK void UsageFault_Handler(void);
WEAK void SVC_Handler(void);
WEAK void DebugMon_Handler(void);
WEAK void PendSV_Handler(void);
WEAK void SysTick_Handler(void);
WEAK void IntDefaultHandler(void);

//*****************************************************************************
//
// Forward declaration of the specific IRQ handlers. These are aliased
// to the IntDefaultHandler, which is a 'forever' loop. When the application
// defines a handler (with the same name), this will automatically take
// precedence over these weak definitions
//
//*****************************************************************************
void WWDG_IRQHandler(void) ALIAS(IntDefaultHandler);
void PVD_IRQHandler(void) ALIAS(IntDefaultHandler);
void TAMPER_STAMP_IRQHandler(void) ALIAS(IntDefaultHandler);
void RTC_WKUP_IRQHandler(void) ALIAS(IntDefaultHandler);
void FLASH_IRQHandler(void) ALIAS(IntDefaultHandler);
void RCC_IRQHandler(void) ALIAS(IntDefaultHandler);
void EXTI0_IRQHandler(void) ALIAS(IntDefaultHandler);
void EXTI1_IRQHandler(void) ALIAS(IntDefaultHandler);
void EXTI2_IRQHandler(void) ALIAS(IntDefaultHandler);
void EXTI3_IRQHandler(void) ALIAS(IntDefaultHandler);
void EXTI4_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA1_Channel1_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA1_Channel2_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA1_Channel3_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA1_Channel4_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA1_Channel5_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA1_Channel6_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA1_Channel7_IRQHandler(void) ALIAS(IntDefaultHandler);
void ADC1_IRQHandler(void) ALIAS(IntDefaultHandler);
void USB_HP_IRQHandler(void) ALIAS(IntDefaultHandler);
void USB_LP_IRQHandler(void) ALIAS(IntDefaultHandler);
void DAC_IRQHandler(void) ALIAS(IntDefaultHandler);
void COMP_IRQHandler(void) ALIAS(IntDefaultHandler);
void EXTI9_5_IRQHandler(void) ALIAS(IntDefaultHandler);
void LCD_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM9_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM10_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM11_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM2_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM3_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM4_IRQHandler(void) ALIAS(IntDefaultHandler);
void I2C1_EV_IRQHandler(void) ALIAS(IntDefaultHandler);
void I2C1_ER_IRQHandler(void) ALIAS(IntDefaultHandler);
void I2C2_EV_IRQHandler(void) ALIAS(IntDefaultHandler);
void I2C2_ER_IRQHandler(void) ALIAS(IntDefaultHandler);
void SPI1_IRQHandler(void) ALIAS(IntDefaultHandler);
void SPI2_IRQHandler(void) ALIAS(IntDefaultHandler);
void USART1_IRQHandler(void) ALIAS(IntDefaultHandler);
void USART2_IRQHandler(void) ALIAS(IntDefaultHandler);
void USART3_IRQHandler(void) ALIAS(IntDefaultHandler);
void EXTI15_10_IRQHandler(void) ALIAS(IntDefaultHandler);
void RTC_Alarm_IRQHandler(void) ALIAS(IntDefaultHandler);
void USB_FS_WKUP_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM6_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM7_IRQHandler(void) ALIAS(IntDefaultHandler);
void SDIO_IRQHandler(void) ALIAS(IntDefaultHandler);
void TIM5_IRQHandler(void) ALIAS(IntDefaultHandler);
void SPI3_IRQHandler(void) ALIAS(IntDefaultHandler);
void UART4_IRQHandler(void) ALIAS(IntDefaultHandler);
void UART5_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA2_Channel1_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA2_Channel2_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA2_Channel3_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA2_Channel4_IRQHandler(void) ALIAS(IntDefaultHandler);
void DMA2_Channel5_IRQHandler(void) ALIAS(IntDefaultHandler);
void AES_IRQHandler(void) ALIAS(IntDefaultHandler);
void COMP_ACQ_IRQHandler(void) ALIAS(IntDefaultHandler);

//*****************************************************************************
//
// The entry point for the application.
// __main() is the entry point for Redlib based applications
// main() is the entry point for Newlib based applications
//
//*****************************************************************************
#if defined (__REDLIB__)
extern void __main(void);
#endif
extern int main(void);
//*****************************************************************************
//
// External declaration for the pointer to the stack top from the Linker Script
//
//*****************************************************************************
extern void _vStackTop(void);

//*****************************************************************************
#if defined (__cplusplus)
} // extern "C"
#endif
//*****************************************************************************
//
// The vector table.
// This relies on the linker script to place at correct location in memory.
//
//*****************************************************************************
extern void (* const g_pfnVectors[])(void);
__attribute__ ((section(".isr_vector")))
void (* const g_pfnVectors[])(void) = {
	// Core Level - CM3
	&_vStackTop, // The initial stack pointer
	ResetISR,				// The reset handler
	NMI_Handler,				// The NMI handler
	HardFault_Handler,			// The hard fault handler
	MemManage_Handler,			// The MPU fault handler
	BusFault_Handler,			// The bus fault handler
	UsageFault_Handler,			// The usage fault handler
	0,					// Reserved
	0,					// Reserved
	0,					// Reserved
	0,					// Reserved
	SVC_Handler,				// SVCall handler
	DebugMon_Handler,			// Debug monitor handler
	0,					// Reserved
	PendSV_Handler,				// The PendSV handler
	SysTick_Handler,			// The SysTick handler

	// Chip Level - STM32L1xx-MD
	WWDG_IRQHandler,                  	// Window WatchDog
	PVD_IRQHandler,                   	// PVD through EXTI Line detect
	TAMPER_STAMP_IRQHandler, 		// Tamper and Time Stamp
	RTC_WKUP_IRQHandler, 			// RTC
	FLASH_IRQHandler,                 	// FLASH
	RCC_IRQHandler,                   	// RCC
	EXTI0_IRQHandler,                 	// EXTI Line0
	EXTI1_IRQHandler,                 	// EXTI Line1
	EXTI2_IRQHandler,                 	// EXTI Line2
	EXTI3_IRQHandler,                 	// EXTI Line3
	EXTI4_IRQHandler,                 	// EXTI Line4
	DMA1_Channel1_IRQHandler,          	// DMA1 Channel 1
	DMA1_Channel2_IRQHandler,          	// DMA1 Channel 2
	DMA1_Channel3_IRQHandler,          	// DMA1 Channel 3
	DMA1_Channel4_IRQHandler,          	// DMA1 Channel 4
	DMA1_Channel5_IRQHandler,          	// DMA1 Channel 5
	DMA1_Channel6_IRQHandler,          	// DMA1 Channel 6
	DMA1_Channel7_IRQHandler,          	// DMA1 Channel 7
	ADC1_IRQHandler,                        // ADC1
	USB_HP_IRQHandler, 			// USB High Priority
	USB_LP_IRQHandler, 			// USB Low  Priority
	DAC_IRQHandler, 			// DAC
	COMP_IRQHandler, 			// COMP through EXTI Line
	EXTI9_5_IRQHandler,               	// ETTI Line 9..5
	LCD_IRQHandler,         		// LCD
	TIM9_IRQHandler,         		// TIM9
	TIM10_IRQHandler,               	// TIM10
	TIM11_IRQHandler,               	// TIM11
	TIM2_IRQHandler,                  	// TIM2
	TIM3_IRQHandler,                  	// TIM3
	TIM4_IRQHandler,                  	// TIM4
	I2C1_EV_IRQHandler,               	// I2C1 Event
	I2C1_ER_IRQHandler,               	// I2C1 Error
	I2C2_EV_IRQHandler,               	// I2C2 Event
	I2C2_ER_IRQHandler,               	// I2C2 Error
	SPI1_IRQHandler,                  	// SPI1
	SPI2_IRQHandler,                  	// SPI2
	USART1_IRQHandler,                	// USART1
	USART2_IRQHandler,                	// USART2
	USART3_IRQHandler,                	// USART3
	EXTI15_10_IRQHandler,             	// EXTI Line 15..10
	RTC_Alarm_IRQHandler,             	// RTC Alarm through EXTI Line
	USB_FS_WKUP_IRQHandler,           	// USB FS Wakeup from suspend
    TIM6_IRQHandler,                	// TIM6
    TIM7_IRQHandler,                	// TIM6
    SDIO_IRQHandler,                	// SDIO
    TIM5_IRQHandler,                	// TIM5
    SPI3_IRQHandler,                	// SPI3
    UART4_IRQHandler,                	// UART4
    UART5_IRQHandler,                	// UART5
    DMA2_Channel1_IRQHandler,           // DMA2 Channel 1
    DMA2_Channel2_IRQHandler,           // DMA2 Channel 2
    DMA2_Channel3_IRQHandler,           // DMA2 Channel 3
    DMA2_Channel4_IRQHandler,           // DMA2 Channel 4
    DMA2_Channel5_IRQHandler,           // DMA2 Channel 5
    AES_IRQHandler,                	    // AES
    COMP_ACQ_IRQHandler,                // Comparator Channel
};

//*****************************************************************************
// Functions to carry out the initialization of RW and BSS data sections. These
// are written as separate functions rather than being inlined within the
// ResetISR() function in order to cope with MCUs with multiple banks of
// memory.
//*****************************************************************************
__attribute__ ((section(".after_vectors")))
void data_init(unsigned int romstart, unsigned int start, unsigned int len) {
	unsigned int *pulDest = (unsigned int*) start;
	unsigned int *pulSrc = (unsigned int*) romstart;
	unsigned int loop;
	for (loop = 0; loop < len; loop = loop + 4)
		*pulDest++ = *pulSrc++;
}

__attribute__ ((section(".after_vectors")))
void bss_init(unsigned int start, unsigned int len) {
	unsigned int *pulDest = (unsigned int*) start;
	unsigned int loop;
	for (loop = 0; loop < len; loop = loop + 4)
		*pulDest++ = 0;
}

//*****************************************************************************
// The following symbols are constructs generated by the linker, indicating
// the location of various points in the "Global Section Table". This table is
// created by the linker via the Code Red managed linker script mechanism. It
// contains the load address, execution address and length of each RW data
// section and the execution and length of each BSS (zero initialized) section.
//*****************************************************************************
extern unsigned int __data_section_table;
extern unsigned int __data_section_table_end;
extern unsigned int __bss_section_table;
extern unsigned int __bss_section_table_end;


//*****************************************************************************
// Reset entry point for your code.
// Sets up a simple runtime environment and initializes the C/C++
// library.
//*****************************************************************************
__attribute__ ((section(".after_vectors")))
void
ResetISR(void) {

    //
    // Copy the data sections from flash to SRAM.
    //
	unsigned int LoadAddr, ExeAddr, SectionLen;
	unsigned int *SectionTableAddr;

	// Load base address of Global Section Table
	SectionTableAddr = &__data_section_table;

    // Copy the data sections from flash to SRAM.
	while (SectionTableAddr < &__data_section_table_end) {
		LoadAddr = *SectionTableAddr++;
		ExeAddr = *SectionTableAddr++;
		SectionLen = *SectionTableAddr++;
		data_init(LoadAddr, ExeAddr, SectionLen);
	}
	// At this point, SectionTableAddr = &__bss_section_table;
	// Zero fill the bss segment
	while (SectionTableAddr < &__bss_section_table_end) {
		ExeAddr = *SectionTableAddr++;
		SectionLen = *SectionTableAddr++;
		bss_init(ExeAddr, SectionLen);
	}


#ifdef __USE_CMSIS
	SystemInit();
#endif

#if defined (__cplusplus)
	//
	// Call C++ library initialisation
	//
	__libc_init_array();
#endif

#if defined (__REDLIB__)
	// Call the Redlib library, which in turn calls main()
	__main() ;
#else
	main();
#endif

	//
	// main() shouldn't return, but if it does, we'll just enter an infinite loop
	//
	while (1) {
		;
	}
}

//*****************************************************************************
// Default exception handlers. Override the ones here by defining your own
// handler routines in your application code.
//*****************************************************************************
__attribute__ ((section(".after_vectors")))
void NMI_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void HardFault_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void MemManage_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void BusFault_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void UsageFault_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void SVC_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void DebugMon_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void PendSV_Handler(void)
{
    while(1)
    {
    }
}
__attribute__ ((section(".after_vectors")))
void SysTick_Handler(void)
{
    while(1)
    {
    }
}

//*****************************************************************************
//
// Processor ends up here if an unexpected interrupt occurs or a specific
// handler is not present in the application code.
//
//*****************************************************************************
__attribute__ ((section(".after_vectors")))
void IntDefaultHandler(void)
{
    while(1)
    {
    }
}