git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@7403 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
parent
46c3999c09
commit
05fbfd18f8
|
@ -0,0 +1,68 @@
|
||||||
|
/*
|
||||||
|
ChibiOS/HAL - Copyright (C) 2006-2014 Giovanni Di Sirio
|
||||||
|
|
||||||
|
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 LPC214x/st_lld.c
|
||||||
|
* @brief ST Driver subsystem low level driver code.
|
||||||
|
*
|
||||||
|
* @addtogroup ST
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "hal.h"
|
||||||
|
|
||||||
|
#if (OSAL_ST_MODE != OSAL_ST_MODE_NONE) || defined(__DOXYGEN__)
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver local definitions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver exported variables. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver local types. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver local variables and types. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver local functions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver interrupt handlers. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver exported functions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Low level ST driver initialization.
|
||||||
|
*
|
||||||
|
* @notapi
|
||||||
|
*/
|
||||||
|
void st_lld_init(void) {
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif /* OSAL_ST_MODE != OSAL_ST_MODE_NONE */
|
||||||
|
|
||||||
|
/** @} */
|
|
@ -0,0 +1,149 @@
|
||||||
|
/*
|
||||||
|
ChibiOS/HAL - Copyright (C) 2006-2014 Giovanni Di Sirio
|
||||||
|
|
||||||
|
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 LPC214x/st_lld.h
|
||||||
|
* @brief ST Driver subsystem low level driver header.
|
||||||
|
* @details This header is designed to be include-able without having to
|
||||||
|
* include other files from the HAL.
|
||||||
|
*
|
||||||
|
* @addtogroup ST
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _ST_LLD_H_
|
||||||
|
#define _ST_LLD_H_
|
||||||
|
|
||||||
|
#include "mcuconf.h"
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver constants. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver pre-compile time settings. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @name Configuration options
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
/** @} */
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Derived constants and error checks. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver data structures and types. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver macros. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* External declarations. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
void st_lld_init(void);
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Driver inline functions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Returns the time counter value.
|
||||||
|
*
|
||||||
|
* @return The counter value.
|
||||||
|
*
|
||||||
|
* @notapi
|
||||||
|
*/
|
||||||
|
static inline systime_t st_lld_get_counter(void) {
|
||||||
|
|
||||||
|
return (systime_t)0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Starts the alarm.
|
||||||
|
* @note Makes sure that no spurious alarms are triggered after
|
||||||
|
* this call.
|
||||||
|
*
|
||||||
|
* @param[in] time the time to be set for the first alarm
|
||||||
|
*
|
||||||
|
* @notapi
|
||||||
|
*/
|
||||||
|
static inline void st_lld_start_alarm(systime_t time) {
|
||||||
|
|
||||||
|
(void)time;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Stops the alarm interrupt.
|
||||||
|
*
|
||||||
|
* @notapi
|
||||||
|
*/
|
||||||
|
static inline void st_lld_stop_alarm(void) {
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Sets the alarm time.
|
||||||
|
*
|
||||||
|
* @param[in] time the time to be set for the next alarm
|
||||||
|
*
|
||||||
|
* @notapi
|
||||||
|
*/
|
||||||
|
static inline void st_lld_set_alarm(systime_t time) {
|
||||||
|
|
||||||
|
(void)time;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Returns the current alarm time.
|
||||||
|
*
|
||||||
|
* @return The currently set alarm time.
|
||||||
|
*
|
||||||
|
* @notapi
|
||||||
|
*/
|
||||||
|
static inline systime_t st_lld_get_alarm(void) {
|
||||||
|
|
||||||
|
return (systime_t)0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Determines if the alarm is active.
|
||||||
|
*
|
||||||
|
* @return The alarm status.
|
||||||
|
* @retval false if the alarm is not active.
|
||||||
|
* @retval true is the alarm is active
|
||||||
|
*
|
||||||
|
* @notapi
|
||||||
|
*/
|
||||||
|
static inline bool st_lld_is_alarm_active(void) {
|
||||||
|
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif /* _ST_LLD_H_ */
|
||||||
|
|
||||||
|
/** @} */
|
|
@ -147,21 +147,12 @@ _port_switch_arm:
|
||||||
* of a register holding the address of the ISR to be invoked, the ISR
|
* of a register holding the address of the ISR to be invoked, the ISR
|
||||||
* then returns in the common epilogue code where the context switch will
|
* then returns in the common epilogue code where the context switch will
|
||||||
* be performed, if required.
|
* be performed, if required.
|
||||||
* Note that registers are saved in the system stack in order to have the
|
|
||||||
* IRQ stack empty if a context switch has to be performed.
|
|
||||||
*/
|
*/
|
||||||
.code 32
|
.code 32
|
||||||
.func
|
.func
|
||||||
.global Irq_Handler
|
.global Irq_Handler
|
||||||
Irq_Handler:
|
Irq_Handler:
|
||||||
msr CPSR_c, #MODE_SYS | I_BIT
|
stmfd sp!, {r0-r3, r12, lr}
|
||||||
stmfd sp!, {r0-r3, r12, lr} // Registers on System Stack.
|
|
||||||
msr CPSR_c, #MODE_IRQ | I_BIT
|
|
||||||
mrs r0, SPSR
|
|
||||||
mov r1, lr
|
|
||||||
msr CPSR_c, #MODE_SYS | I_BIT
|
|
||||||
stmfd sp!, {r0, r1} // Push R0=SPSR, R1=LR_IRQ.
|
|
||||||
msr CPSR_c, #MODE_IRQ | I_BIT
|
|
||||||
#if defined(THUMB_NO_INTERWORKING)
|
#if defined(THUMB_NO_INTERWORKING)
|
||||||
add r0, pc, #1
|
add r0, pc, #1
|
||||||
bx r0
|
bx r0
|
||||||
|
@ -201,10 +192,89 @@ Irq_Handler:
|
||||||
* Low +------------+
|
* Low +------------+
|
||||||
*/
|
*/
|
||||||
.balign 16
|
.balign 16
|
||||||
|
#if defined(THUMB_NO_INTERWORKING)
|
||||||
|
.code 16
|
||||||
|
.thumb_func
|
||||||
|
.globl _port_irq_common
|
||||||
|
_port_irq_common:
|
||||||
|
bl chSchIsPreemptionRequired
|
||||||
|
mov lr, pc
|
||||||
|
bx lr
|
||||||
|
.code 32
|
||||||
|
#else /* !defined(THUMB_NO_INTERWORKING) */
|
||||||
.code 32
|
.code 32
|
||||||
.func
|
.func
|
||||||
.globl _port_irq_common
|
.globl _port_irq_common
|
||||||
_port_irq_common:
|
_port_irq_common:
|
||||||
|
bl chSchIsPreemptionRequired
|
||||||
|
#endif /* !defined(THUMB_NO_INTERWORKING) */
|
||||||
|
cmp r0, #0
|
||||||
|
ldmeq sp!, {r0-r3, r12, lr}
|
||||||
|
subeqs pc, lr, #4 // No reschedule, returns.
|
||||||
|
|
||||||
|
// Saves the IRQ mode registers in the system stack.
|
||||||
|
stmfd sp!, {r0-r3, r12, lr}
|
||||||
|
msr CPSR_c, #MODE_IRQ | I_BIT
|
||||||
|
mrs r0, SPSR
|
||||||
|
mov r1, lr
|
||||||
|
msr CPSR_c, #MODE_SYS | I_BIT
|
||||||
|
stmfd sp!, {r0, r1} // Push R0=SPSR, R1=LR_IRQ.
|
||||||
|
|
||||||
|
// Context switch.
|
||||||
|
#if defined(THUMB_NO_INTERWORKING)
|
||||||
|
add r0, pc, #1
|
||||||
|
bx r0
|
||||||
|
.code 16
|
||||||
|
#if CH_DBG_SYSTEM_STATE_CHECK
|
||||||
|
bl _dbg_check_lock
|
||||||
|
#endif
|
||||||
|
bl chSchDoReschedule
|
||||||
|
#if CH_DBG_SYSTEM_STATE_CHECK
|
||||||
|
bl _dbg_check_unlock
|
||||||
|
#endif
|
||||||
|
mov lr, pc
|
||||||
|
bx lr
|
||||||
|
.code 32
|
||||||
|
#else /* !defined(THUMB_NO_INTERWORKING) */
|
||||||
|
#if CH_DBG_SYSTEM_STATE_CHECK
|
||||||
|
bl _dbg_check_lock
|
||||||
|
#endif
|
||||||
|
bl chSchDoReschedule
|
||||||
|
#if CH_DBG_SYSTEM_STATE_CHECK
|
||||||
|
bl _dbg_check_unlock
|
||||||
|
#endif
|
||||||
|
#endif /* !defined(THUMB_NO_INTERWORKING) */
|
||||||
|
|
||||||
|
// Re-establish the IRQ conditions again.
|
||||||
|
ldmfd sp!, {r0, r1} // Pop R0=SPSR, R1=LR_IRQ.
|
||||||
|
msr CPSR_c, #MODE_IRQ | I_BIT
|
||||||
|
msr SPSR_fsxc, r0
|
||||||
|
mov lr, r1
|
||||||
|
msr CPSR_c, #MODE_SYS | I_BIT
|
||||||
|
ldmfd sp!, {r0-r3, r12, lr}
|
||||||
|
msr CPSR_c, #MODE_IRQ | I_BIT
|
||||||
|
subs pc, lr, #4
|
||||||
|
.endfunc
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
msr CPSR_c, #MODE_SYS | I_BIT
|
msr CPSR_c, #MODE_SYS | I_BIT
|
||||||
bl chSchIsPreemptionRequired
|
bl chSchIsPreemptionRequired
|
||||||
cmp r0, #0
|
cmp r0, #0
|
||||||
|
@ -225,7 +295,6 @@ noschd:
|
||||||
ldmfd sp!, {r0-r3, r12, lr}
|
ldmfd sp!, {r0-r3, r12, lr}
|
||||||
msr CPSR_c, #MODE_IRQ | I_BIT
|
msr CPSR_c, #MODE_IRQ | I_BIT
|
||||||
subs pc, lr, #4
|
subs pc, lr, #4
|
||||||
.endfunc
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Threads trampoline code.
|
* Threads trampoline code.
|
||||||
|
|
Loading…
Reference in New Issue