Initial publish

Dependencies:   mbed

Fork of el17dg by Dmitrijs Griskovs

Committer:
Noximilien
Date:
Tue May 07 15:22:35 2019 +0000
Revision:
40:e3bbda7444fa
Parent:
1:5aa2312d3e94
The Final, Submission Version. I have read and agreed to the academic integrity. SID:201160286

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Noximilien 1:5aa2312d3e94 1 /*----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 2 * RL-ARM - RTX
Noximilien 1:5aa2312d3e94 3 *----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 4 * Name: RT_HAL_CM.H
Noximilien 1:5aa2312d3e94 5 * Purpose: Hardware Abstraction Layer for Cortex-M definitions
Noximilien 1:5aa2312d3e94 6 * Rev.: V4.60
Noximilien 1:5aa2312d3e94 7 *----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 8 *
Noximilien 1:5aa2312d3e94 9 * Copyright (c) 1999-2009 KEIL, 2009-2015 ARM Germany GmbH
Noximilien 1:5aa2312d3e94 10 * All rights reserved.
Noximilien 1:5aa2312d3e94 11 * Redistribution and use in source and binary forms, with or without
Noximilien 1:5aa2312d3e94 12 * modification, are permitted provided that the following conditions are met:
Noximilien 1:5aa2312d3e94 13 * - Redistributions of source code must retain the above copyright
Noximilien 1:5aa2312d3e94 14 * notice, this list of conditions and the following disclaimer.
Noximilien 1:5aa2312d3e94 15 * - Redistributions in binary form must reproduce the above copyright
Noximilien 1:5aa2312d3e94 16 * notice, this list of conditions and the following disclaimer in the
Noximilien 1:5aa2312d3e94 17 * documentation and/or other materials provided with the distribution.
Noximilien 1:5aa2312d3e94 18 * - Neither the name of ARM nor the names of its contributors may be used
Noximilien 1:5aa2312d3e94 19 * to endorse or promote products derived from this software without
Noximilien 1:5aa2312d3e94 20 * specific prior written permission.
Noximilien 1:5aa2312d3e94 21 *
Noximilien 1:5aa2312d3e94 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Noximilien 1:5aa2312d3e94 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Noximilien 1:5aa2312d3e94 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
Noximilien 1:5aa2312d3e94 25 * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
Noximilien 1:5aa2312d3e94 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
Noximilien 1:5aa2312d3e94 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
Noximilien 1:5aa2312d3e94 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
Noximilien 1:5aa2312d3e94 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
Noximilien 1:5aa2312d3e94 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
Noximilien 1:5aa2312d3e94 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Noximilien 1:5aa2312d3e94 32 * POSSIBILITY OF SUCH DAMAGE.
Noximilien 1:5aa2312d3e94 33 *---------------------------------------------------------------------------*/
Noximilien 1:5aa2312d3e94 34
Noximilien 1:5aa2312d3e94 35 #include "cmsis.h"
Noximilien 1:5aa2312d3e94 36 /* Definitions */
Noximilien 1:5aa2312d3e94 37 #define INITIAL_xPSR 0x10000000
Noximilien 1:5aa2312d3e94 38 #define DEMCR_TRCENA 0x01000000
Noximilien 1:5aa2312d3e94 39 #define ITM_ITMENA 0x00000001
Noximilien 1:5aa2312d3e94 40 #define MAGIC_WORD 0xE25A2EA5
Noximilien 1:5aa2312d3e94 41
Noximilien 1:5aa2312d3e94 42 #define SYS_TICK_IRQn TIMER0_IRQn
Noximilien 1:5aa2312d3e94 43
Noximilien 1:5aa2312d3e94 44 extern void rt_set_PSP (U32 stack);
Noximilien 1:5aa2312d3e94 45 extern U32 rt_get_PSP (void);
Noximilien 1:5aa2312d3e94 46 extern void os_set_env (void);
Noximilien 1:5aa2312d3e94 47 extern void SysTick_Handler (void);
Noximilien 1:5aa2312d3e94 48 extern void *_alloc_box (void *box_mem);
Noximilien 1:5aa2312d3e94 49 extern int _free_box (void *box_mem, void *box);
Noximilien 1:5aa2312d3e94 50
Noximilien 1:5aa2312d3e94 51 extern void rt_init_stack (P_TCB p_TCB, FUNCP task_body);
Noximilien 1:5aa2312d3e94 52 extern void rt_ret_val (P_TCB p_TCB, U32 v0);
Noximilien 1:5aa2312d3e94 53 extern void rt_ret_val2 (P_TCB p_TCB, U32 v0, U32 v1);
Noximilien 1:5aa2312d3e94 54
Noximilien 1:5aa2312d3e94 55 extern void dbg_init (void);
Noximilien 1:5aa2312d3e94 56 extern void dbg_task_notify (P_TCB p_tcb, BOOL create);
Noximilien 1:5aa2312d3e94 57 extern void dbg_task_switch (U32 task_id);
Noximilien 1:5aa2312d3e94 58
Noximilien 1:5aa2312d3e94 59
Noximilien 1:5aa2312d3e94 60 #if defined (__CC_ARM) /* ARM Compiler */
Noximilien 1:5aa2312d3e94 61
Noximilien 1:5aa2312d3e94 62 #if ((__TARGET_ARCH_7_M || __TARGET_ARCH_7E_M) && !NO_EXCLUSIVE_ACCESS)
Noximilien 1:5aa2312d3e94 63 #define __USE_EXCLUSIVE_ACCESS
Noximilien 1:5aa2312d3e94 64 #else
Noximilien 1:5aa2312d3e94 65 #undef __USE_EXCLUSIVE_ACCESS
Noximilien 1:5aa2312d3e94 66 #endif
Noximilien 1:5aa2312d3e94 67
Noximilien 1:5aa2312d3e94 68 #elif defined (__GNUC__) /* GNU Compiler */
Noximilien 1:5aa2312d3e94 69
Noximilien 1:5aa2312d3e94 70 #undef __USE_EXCLUSIVE_ACCESS
Noximilien 1:5aa2312d3e94 71
Noximilien 1:5aa2312d3e94 72 #if defined (__CORTEX_M0) || defined (__CORTEX_M0PLUS)
Noximilien 1:5aa2312d3e94 73 #define __TARGET_ARCH_6S_M 1
Noximilien 1:5aa2312d3e94 74 #else
Noximilien 1:5aa2312d3e94 75 #define __TARGET_ARCH_6S_M 0
Noximilien 1:5aa2312d3e94 76 #endif
Noximilien 1:5aa2312d3e94 77
Noximilien 1:5aa2312d3e94 78 #if defined (__VFP_FP__) && !defined(__SOFTFP__)
Noximilien 1:5aa2312d3e94 79 #define __TARGET_FPU_VFP 1
Noximilien 1:5aa2312d3e94 80 #else
Noximilien 1:5aa2312d3e94 81 #define __TARGET_FPU_VFP 0
Noximilien 1:5aa2312d3e94 82 #endif
Noximilien 1:5aa2312d3e94 83
Noximilien 1:5aa2312d3e94 84 #define __inline inline
Noximilien 1:5aa2312d3e94 85 #define __weak __attribute__((weak))
Noximilien 1:5aa2312d3e94 86
Noximilien 1:5aa2312d3e94 87
Noximilien 1:5aa2312d3e94 88 #elif defined (__ICCARM__) /* IAR Compiler */
Noximilien 1:5aa2312d3e94 89
Noximilien 1:5aa2312d3e94 90 #undef __USE_EXCLUSIVE_ACCESS
Noximilien 1:5aa2312d3e94 91
Noximilien 1:5aa2312d3e94 92 #if (__CORE__ == __ARM6M__)
Noximilien 1:5aa2312d3e94 93 #define __TARGET_ARCH_6S_M 1
Noximilien 1:5aa2312d3e94 94 #else
Noximilien 1:5aa2312d3e94 95 #define __TARGET_ARCH_6S_M 0
Noximilien 1:5aa2312d3e94 96 #endif
Noximilien 1:5aa2312d3e94 97
Noximilien 1:5aa2312d3e94 98 #if defined __ARMVFP__
Noximilien 1:5aa2312d3e94 99 #define __TARGET_FPU_VFP 1
Noximilien 1:5aa2312d3e94 100 #else
Noximilien 1:5aa2312d3e94 101 #define __TARGET_FPU_VFP 0
Noximilien 1:5aa2312d3e94 102 #endif
Noximilien 1:5aa2312d3e94 103
Noximilien 1:5aa2312d3e94 104 #define __inline inline
Noximilien 1:5aa2312d3e94 105
Noximilien 1:5aa2312d3e94 106 #endif
Noximilien 1:5aa2312d3e94 107
Noximilien 1:5aa2312d3e94 108
Noximilien 1:5aa2312d3e94 109 /* NVIC registers */
Noximilien 1:5aa2312d3e94 110
Noximilien 1:5aa2312d3e94 111 #define OS_PEND_IRQ() NVIC_PendIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 112 #define OS_PENDING NVIC_PendingIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 113 #define OS_UNPEND(fl) NVIC_UnpendIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 114 #define OS_PEND(fl,p) NVIC_PendIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 115 #define OS_LOCK() NVIC_DisableIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 116 #define OS_UNLOCK() NVIC_EnableIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 117
Noximilien 1:5aa2312d3e94 118 #define OS_X_PENDING NVIC_PendingIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 119 #define OS_X_UNPEND(fl) NVIC_UnpendIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 120 #define OS_X_PEND(fl,p) NVIC_PendIRQ(SYS_TICK_IRQn)
Noximilien 1:5aa2312d3e94 121
Noximilien 1:5aa2312d3e94 122 #define OS_X_INIT(n) NVIC_EnableIRQ(n)
Noximilien 1:5aa2312d3e94 123 #define OS_X_LOCK(n) NVIC_DisableIRQ(n)
Noximilien 1:5aa2312d3e94 124 #define OS_X_UNLOCK(n) NVIC_EnableIRQ(n)
Noximilien 1:5aa2312d3e94 125
Noximilien 1:5aa2312d3e94 126 /* Variables */
Noximilien 1:5aa2312d3e94 127 extern BIT dbg_msg;
Noximilien 1:5aa2312d3e94 128
Noximilien 1:5aa2312d3e94 129 /* Functions */
Noximilien 1:5aa2312d3e94 130 #ifdef __USE_EXCLUSIVE_ACCESS
Noximilien 1:5aa2312d3e94 131 #define rt_inc(p) while(__strex((__ldrex(p)+1),p))
Noximilien 1:5aa2312d3e94 132 #define rt_dec(p) while(__strex((__ldrex(p)-1),p))
Noximilien 1:5aa2312d3e94 133 #else
Noximilien 1:5aa2312d3e94 134 #define rt_inc(p) __disable_irq();(*p)++;__enable_irq();
Noximilien 1:5aa2312d3e94 135 #define rt_dec(p) __disable_irq();(*p)--;__enable_irq();
Noximilien 1:5aa2312d3e94 136 #endif
Noximilien 1:5aa2312d3e94 137
Noximilien 1:5aa2312d3e94 138 __inline static U32 rt_inc_qi (U32 size, U8 *count, U8 *first) {
Noximilien 1:5aa2312d3e94 139 U32 cnt,c2;
Noximilien 1:5aa2312d3e94 140 #ifdef __USE_EXCLUSIVE_ACCESS
Noximilien 1:5aa2312d3e94 141 do {
Noximilien 1:5aa2312d3e94 142 if ((cnt = __ldrex(count)) == size) {
Noximilien 1:5aa2312d3e94 143 __clrex();
Noximilien 1:5aa2312d3e94 144 return (cnt); }
Noximilien 1:5aa2312d3e94 145 } while (__strex(cnt+1, count));
Noximilien 1:5aa2312d3e94 146 do {
Noximilien 1:5aa2312d3e94 147 c2 = (cnt = __ldrex(first)) + 1;
Noximilien 1:5aa2312d3e94 148 if (c2 == size) c2 = 0;
Noximilien 1:5aa2312d3e94 149 } while (__strex(c2, first));
Noximilien 1:5aa2312d3e94 150 #else
Noximilien 1:5aa2312d3e94 151 __disable_irq();
Noximilien 1:5aa2312d3e94 152 if ((cnt = *count) < size) {
Noximilien 1:5aa2312d3e94 153 *count = cnt+1;
Noximilien 1:5aa2312d3e94 154 c2 = (cnt = *first) + 1;
Noximilien 1:5aa2312d3e94 155 if (c2 == size) c2 = 0;
Noximilien 1:5aa2312d3e94 156 *first = c2;
Noximilien 1:5aa2312d3e94 157 }
Noximilien 1:5aa2312d3e94 158 __enable_irq ();
Noximilien 1:5aa2312d3e94 159 #endif
Noximilien 1:5aa2312d3e94 160 return (cnt);
Noximilien 1:5aa2312d3e94 161 }
Noximilien 1:5aa2312d3e94 162
Noximilien 1:5aa2312d3e94 163 __inline static void rt_systick_init (void) {
Noximilien 1:5aa2312d3e94 164 #if SYS_TICK_IRQn == TIMER0_IRQn
Noximilien 1:5aa2312d3e94 165 #define SYS_TICK_TIMER LPC_TIM0
Noximilien 1:5aa2312d3e94 166 LPC_SC->PCONP |= (1 << PCTIM0);
Noximilien 1:5aa2312d3e94 167 LPC_SC->PCLKSEL0 = (LPC_SC->PCLKSEL0 & (~(1<<3))) | (1<<2); //PCLK == CPUCLK
Noximilien 1:5aa2312d3e94 168 #elif SYS_TICK_IRQn == TIMER1_IRQn
Noximilien 1:5aa2312d3e94 169 #define SYS_TICK_TIMER LPC_TIM1
Noximilien 1:5aa2312d3e94 170 LPC_SC->PCONP |= (1 << PCTIM1);
Noximilien 1:5aa2312d3e94 171 LPC_SC->PCLKSEL0 = (LPC_SC->PCLKSEL0 & (~(1<<5))) | (1<<4); //PCLK == CPUCLK
Noximilien 1:5aa2312d3e94 172 #elif SYS_TICK_IRQn == TIMER2_IRQn
Noximilien 1:5aa2312d3e94 173 #define SYS_TICK_TIMER LPC_TIM2
Noximilien 1:5aa2312d3e94 174 LPC_SC->PCONP |= (1 << PCTIM2);
Noximilien 1:5aa2312d3e94 175 LPC_SC->PCLKSEL1 = (LPC_SC->PCLKSEL1 & (~(1<<13))) | (1<<12); //PCLK == CPUCLK
Noximilien 1:5aa2312d3e94 176 #else
Noximilien 1:5aa2312d3e94 177 #define SYS_TICK_TIMER LPC_TIM3
Noximilien 1:5aa2312d3e94 178 LPC_SC->PCONP |= (1 << PCTIM3);
Noximilien 1:5aa2312d3e94 179 LPC_SC->PCLKSEL1 = (LPC_SC->PCLKSEL1 & (~(1<<15))) | (1<<14); //PCLK == CPUCLK
Noximilien 1:5aa2312d3e94 180 #endif
Noximilien 1:5aa2312d3e94 181
Noximilien 1:5aa2312d3e94 182 // setup Timer to count forever
Noximilien 1:5aa2312d3e94 183 //interrupt_reg
Noximilien 1:5aa2312d3e94 184 SYS_TICK_TIMER->TCR = 2; // reset & disable timer 0
Noximilien 1:5aa2312d3e94 185 SYS_TICK_TIMER->TC = os_trv;
Noximilien 1:5aa2312d3e94 186 SYS_TICK_TIMER->PR = 0; // set the prescale divider
Noximilien 1:5aa2312d3e94 187 //Reset of TC and Interrupt when MR3 MR2 matches TC
Noximilien 1:5aa2312d3e94 188 SYS_TICK_TIMER->MCR = (1 << 9) |(1 << 10); //TMCR_MR3_R_Msk | TMCR_MR3_I_Msk
Noximilien 1:5aa2312d3e94 189 SYS_TICK_TIMER->MR3 = os_trv; // match registers
Noximilien 1:5aa2312d3e94 190 SYS_TICK_TIMER->CCR = 0; // disable compare registers
Noximilien 1:5aa2312d3e94 191 SYS_TICK_TIMER->EMR = 0; // disable external match register
Noximilien 1:5aa2312d3e94 192 // initialize the interrupt vector
Noximilien 1:5aa2312d3e94 193 NVIC_SetVector(SYS_TICK_IRQn, (uint32_t)&SysTick_Handler);
Noximilien 1:5aa2312d3e94 194 SYS_TICK_TIMER->TCR = 1; // enable timer 0
Noximilien 1:5aa2312d3e94 195 }
Noximilien 1:5aa2312d3e94 196
Noximilien 1:5aa2312d3e94 197 __inline static void rt_svc_init (void) {
Noximilien 1:5aa2312d3e94 198 // TODO: add svcInit
Noximilien 1:5aa2312d3e94 199
Noximilien 1:5aa2312d3e94 200 }
Noximilien 1:5aa2312d3e94 201
Noximilien 1:5aa2312d3e94 202 #ifdef DBG_MSG
Noximilien 1:5aa2312d3e94 203 #define DBG_INIT() dbg_init()
Noximilien 1:5aa2312d3e94 204 #define DBG_TASK_NOTIFY(p_tcb,create) if (dbg_msg) dbg_task_notify(p_tcb,create)
Noximilien 1:5aa2312d3e94 205 #define DBG_TASK_SWITCH(task_id) if (dbg_msg && (os_tsk.new_tsk != os_tsk.run)) \
Noximilien 1:5aa2312d3e94 206 dbg_task_switch(task_id)
Noximilien 1:5aa2312d3e94 207 #else
Noximilien 1:5aa2312d3e94 208 #define DBG_INIT()
Noximilien 1:5aa2312d3e94 209 #define DBG_TASK_NOTIFY(p_tcb,create)
Noximilien 1:5aa2312d3e94 210 #define DBG_TASK_SWITCH(task_id)
Noximilien 1:5aa2312d3e94 211 #endif
Noximilien 1:5aa2312d3e94 212
Noximilien 1:5aa2312d3e94 213 /*----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 214 * end of file
Noximilien 1:5aa2312d3e94 215 *---------------------------------------------------------------------------*/
Noximilien 1:5aa2312d3e94 216