mirror of
https://github.com/FreeRTOS/FreeRTOS-Kernel.git
synced 2025-04-19 21:11:57 -04:00
Work in progress.
This commit is contained in:
Richard Barry
parent
bdea62587e
commit
0faf33fbca
|
|
@ -48,18 +48,34 @@
|
|||
* Implementation of functions defined in portable.h for the 16FX port.
|
||||
*----------------------------------------------------------*/
|
||||
|
||||
/* ------- Memory models --------- default address size */
|
||||
/* data code */
|
||||
#define SMALL 0 /* 16 Bit 16 Bit */
|
||||
#define MEDIUM 1 /* 16 Bit 24 Bit */
|
||||
#define COMPACT 2 /* 24 Bit 16 Bit */
|
||||
#define LARGE 3 /* 24 Bit 24 Bit */
|
||||
|
||||
/*
|
||||
* The below define should be same as the option selected by the Memory
|
||||
* Model (Project->Setup Project->C Compiler->Catagory->Target Depend )
|
||||
*/
|
||||
#define MEMMODEL MEDIUM
|
||||
#define configMEMMODEL portMEDIUM
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/*
|
||||
* Get current value of DPR and ADB registers
|
||||
*/
|
||||
portSTACK_TYPE xGet_DPR_ADB_bank( void );
|
||||
|
||||
/*
|
||||
* Get current value of DTB and PCB registers
|
||||
*/
|
||||
portSTACK_TYPE xGet_DTB_PCB_bank( void );
|
||||
|
||||
/*
|
||||
* Get current register pointer
|
||||
*/
|
||||
portCHAR xGet_RP( void );
|
||||
|
||||
/*
|
||||
* Sets up the periodic ISR used for the RTOS tick. This uses RLT0, but
|
||||
* can be done using any given RLT.
|
||||
*/
|
||||
static void prvSetupRLT0Interrupt( void );
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
|
|
@ -70,16 +86,9 @@
|
|||
typedef void tskTCB;
|
||||
extern volatile tskTCB * volatile pxCurrentTCB;
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Get current value of DPR and ADB registers */
|
||||
portSTACK_TYPE Get_DPR_ADB_bank(void);
|
||||
|
||||
/* Get current value of DTB and PCB registers */
|
||||
portSTACK_TYPE Get_DTB_PCB_bank(void);
|
||||
|
||||
/* Get current register pointer */
|
||||
portCHAR Get_RP(void);
|
||||
/* Constants required to handle critical sections. */
|
||||
#define portNO_CRITICAL_NESTING ( ( unsigned portBASE_TYPE ) 0x1234 )
|
||||
volatile unsigned portBASE_TYPE uxCriticalNesting = 9999UL;
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
|
|
@ -94,8 +103,9 @@ portCHAR Get_RP(void);
|
|||
* executes.
|
||||
*/
|
||||
|
||||
#if (MEMMODEL == SMALL || MEMMODEL == MEDIUM)
|
||||
#define portSAVE_CONTEXT() \
|
||||
#if( ( configMEMMODEL == portSMALL ) || ( configMEMMODEL == portMEDIUM ) )
|
||||
|
||||
#define portSAVE_CONTEXT() \
|
||||
{ __asm(" POPW A "); \
|
||||
__asm(" AND CCR,#H'DF "); \
|
||||
__asm(" PUSHW A "); \
|
||||
|
|
@ -127,9 +137,9 @@ portCHAR Get_RP(void);
|
|||
__asm(" OR CCR,#H'20 "); \
|
||||
}
|
||||
|
||||
/*
|
||||
/*
|
||||
* Macro to restore a task context from the task stack. This is effecti-
|
||||
* vely the reverse of portSAVE_CONTEXT(). First the stack pointer value
|
||||
* vely the reverse of SAVE_CONTEXT(). First the stack pointer value
|
||||
* (USP for SMALL and MEDIUM memory model amd USB:USP for COMPACT and
|
||||
* LARGE memory model ) is loaded from the task control block. Next the
|
||||
* value of all the general purpose registers RW0-RW7 is retrieved. Fina-
|
||||
|
|
@ -137,11 +147,18 @@ portCHAR Get_RP(void);
|
|||
* the task to be executed upon RETI from user stack to system stack.
|
||||
*/
|
||||
|
||||
#define portRESTORE_CONTEXT() \
|
||||
#define portRESTORE_CONTEXT() \
|
||||
{ __asm(" MOVW A, _pxCurrentTCB "); \
|
||||
__asm(" MOVW A, @A "); \
|
||||
__asm(" AND CCR,#H'DF "); \
|
||||
__asm(" MOVW SP, A "); \
|
||||
\
|
||||
/* Load the saves uxCriticalNesting value into RW0. */ \
|
||||
__asm(" POPW (RW0) "); \
|
||||
\
|
||||
/* Save the loaded value into the uxCriticalNesting variable. */ \
|
||||
__asm(" MOVW _uxCriticalNesting, RW0 "); \
|
||||
\
|
||||
__asm(" POPW (RW0,RW1,RW2,RW3,RW4,RW5,RW6,RW7) "); \
|
||||
__asm(" POPW A "); \
|
||||
__asm(" OR CCR,#H'20 "); \
|
||||
|
|
@ -168,8 +185,9 @@ portCHAR Get_RP(void);
|
|||
__asm(" PUSHW A "); \
|
||||
}
|
||||
|
||||
#elif (MEMMODEL == COMPACT || MEMMODEL == LARGE)
|
||||
#define portSAVE_CONTEXT() \
|
||||
#elif (configMEMMODEL == portCOMPACT || configMEMMODEL == portLARGE)
|
||||
|
||||
#define portSAVE_CONTEXT() \
|
||||
{ __asm(" POPW A "); \
|
||||
__asm(" AND CCR,#H'DF "); \
|
||||
__asm(" PUSHW A "); \
|
||||
|
|
@ -202,7 +220,7 @@ portCHAR Get_RP(void);
|
|||
__asm(" MOV @RL2+2, A "); \
|
||||
}
|
||||
|
||||
#define portRESTORE_CONTEXT() \
|
||||
#define portRESTORE_CONTEXT() \
|
||||
{ __asm(" MOVL A, _pxCurrentTCB "); \
|
||||
__asm(" MOVL RL2, A "); \
|
||||
__asm(" MOVW A, @RL2+0 "); \
|
||||
|
|
@ -245,50 +263,52 @@ portCHAR Get_RP(void);
|
|||
*/
|
||||
|
||||
#pragma asm
|
||||
.GLOBAL _Get_DPR_ADB_bank
|
||||
.GLOBAL _Get_DTB_PCB_bank
|
||||
.GLOBAL _Get_RP
|
||||
|
||||
.GLOBAL _xGet_DPR_ADB_bank
|
||||
.GLOBAL _xGet_DTB_PCB_bank
|
||||
.GLOBAL _xGet_RP
|
||||
.SECTION CODE, CODE, ALIGN=1
|
||||
_Get_DPR_ADB_bank:
|
||||
|
||||
_xGet_DPR_ADB_bank:
|
||||
|
||||
MOV A, DPR
|
||||
SWAP
|
||||
MOV A, ADB
|
||||
ORW A
|
||||
#if MEMMODEL == MEDIUM || MEMMODEL == LARGE
|
||||
#if configMEMMODEL == portMEDIUM || configMEMMODEL == portLARGE
|
||||
RETP
|
||||
#elif MEMMODEL == SMALL || MEMMODEL == COMPACT
|
||||
#elif configMEMMODEL == portSMALL || configMEMMODEL == portCOMPACT
|
||||
RET
|
||||
#endif
|
||||
#endif
|
||||
|
||||
|
||||
_xGet_DTB_PCB_bank:
|
||||
|
||||
_Get_DTB_PCB_bank:
|
||||
MOV A, DTB
|
||||
SWAP
|
||||
MOV A, PCB
|
||||
ORW A
|
||||
#if MEMMODEL == MEDIUM || MEMMODEL == LARGE
|
||||
#if configMEMMODEL == portMEDIUM || configMEMMODEL == portLARGE
|
||||
RETP
|
||||
#elif MEMMODEL == SMALL || MEMMODEL == COMPACT
|
||||
#elif configMEMMODEL == portSMALL || configMEMMODEL == portCOMPACT
|
||||
RET
|
||||
#endif
|
||||
#endif
|
||||
|
||||
|
||||
_xGet_RP:
|
||||
|
||||
_Get_RP:
|
||||
PUSHW PS
|
||||
POPW A
|
||||
SWAP
|
||||
ANDW A,#0x1f
|
||||
#if MEMMODEL == MEDIUM || MEMMODEL == LARGE
|
||||
#if configMEMMODEL == portMEDIUM || configMEMMODEL == portLARGE
|
||||
RETP
|
||||
#elif MEMMODEL == SMALL || MEMMODEL == COMPACT
|
||||
#elif configMEMMODEL == portSMALL || configMEMMODEL == portCOMPACT
|
||||
RET
|
||||
#endif
|
||||
#pragma endasm
|
||||
/*-----------------------------------------------------------*/
|
||||
#endif
|
||||
|
||||
/*
|
||||
* Sets up the periodic ISR used for the RTOS tick. This uses RLT0, but
|
||||
* can be done using any given RLT.
|
||||
*/
|
||||
static void prvSetupRLT0Interrupt( void );
|
||||
|
||||
#pragma endasm
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/*
|
||||
|
|
@ -301,7 +321,6 @@ portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE
|
|||
{
|
||||
/* Place a few bytes of known values on the bottom of the stack.
|
||||
This is just useful for debugging. */
|
||||
|
||||
*pxTopOfStack = 0x1111;
|
||||
pxTopOfStack--;
|
||||
*pxTopOfStack = 0x2222;
|
||||
|
|
@ -309,32 +328,35 @@ portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE
|
|||
*pxTopOfStack = 0x3333;
|
||||
pxTopOfStack--;
|
||||
|
||||
/* Once the task is called the called would push the pointer to the
|
||||
/* Once the task is called the task would push the pointer to the
|
||||
parameter on to the stack. Hence here the pointer would be copied first
|
||||
to the stack. In case of COMPACT or LARGE memory model such pointer
|
||||
would be 24 bit and in case of SMALL or MEDIUM memory model such pointer
|
||||
would be 16 bit */
|
||||
#if MEMMODEL == COMPACT || MEMMODEL == LARGE
|
||||
*pxTopOfStack = (portSTACK_TYPE)((portLONG)(pvParameters)>>16);
|
||||
#if( ( configMEMMODEL == portCOMPACT ) || ( configMEMMODEL == portLARGE ) )
|
||||
{
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) ( ( unsigned portLONG ) ( pvParameters ) >> 16 );
|
||||
pxTopOfStack--;
|
||||
#endif
|
||||
}
|
||||
#endif
|
||||
|
||||
*pxTopOfStack = (portSTACK_TYPE)(pvParameters);
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) ( pvParameters );
|
||||
pxTopOfStack--;
|
||||
|
||||
/* This is redundant push to the stack. This is required in order to introduce
|
||||
an offset so that the task accesses a parameter correctly that is passed on to
|
||||
the task stack. */
|
||||
#if MEMMODEL == MEDIUM || MEMMODEL == LARGE
|
||||
*pxTopOfStack = (Get_DTB_PCB_bank() & 0xff00) |
|
||||
(((portLONG)(pxCode) >>16) & 0xff);
|
||||
#if( ( configMEMMODEL == portMEDIUM ) || ( configMEMMODEL == portLARGE ) )
|
||||
{
|
||||
*pxTopOfStack = ( xGet_DTB_PCB_bank() & 0xff00 ) | ( ( ( portLONG ) ( pxCode ) >> 16 ) & 0xff );
|
||||
pxTopOfStack--;
|
||||
#endif
|
||||
}
|
||||
#endif
|
||||
|
||||
/* This is redundant push to the stack. This is required in order to introduce
|
||||
an offset so that the task accesses a parameter correctly that is passed on to
|
||||
the task stack. */
|
||||
*pxTopOfStack = ( portSTACK_TYPE )(pxCode);
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) ( pxCode );
|
||||
pxTopOfStack--;
|
||||
|
||||
/* PS - User Mode, ILM=7, RB=0, Interrupts enabled,USP */
|
||||
|
|
@ -342,25 +364,28 @@ portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE
|
|||
pxTopOfStack--;
|
||||
|
||||
/* PC */
|
||||
*pxTopOfStack = ( portSTACK_TYPE )(pxCode);
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) ( pxCode );
|
||||
pxTopOfStack--;
|
||||
|
||||
/* DTB | PCB */
|
||||
#if MEMMODEL == SMALL || MEMMODEL == COMPACT
|
||||
*pxTopOfStack = Get_DTB_PCB_bank();
|
||||
#if configMEMMODEL == portSMALL || configMEMMODEL == portCOMPACT
|
||||
{
|
||||
*pxTopOfStack = xGet_DTB_PCB_bank();
|
||||
pxTopOfStack--;
|
||||
#endif
|
||||
}
|
||||
#endif
|
||||
|
||||
/* DTB | PCB, in case of MEDIUM or LARGE memory model PCB would be used
|
||||
/* DTB | PCB, in case of portMEDIUM or portLARGE memory model PCB would be used
|
||||
along with PC to indicate the start address of the functiom */
|
||||
#if MEMMODEL == MEDIUM || MEMMODEL == LARGE
|
||||
*pxTopOfStack = (Get_DTB_PCB_bank() & 0xff00) |
|
||||
(((portLONG)(pxCode) >>16) & 0xff);
|
||||
#if( ( configMEMMODEL == portMEDIUM ) || ( configMEMMODEL == portLARGE ) )
|
||||
{
|
||||
*pxTopOfStack = ( xGet_DTB_PCB_bank() & 0xff00 ) | ( ( ( portLONG ) ( pxCode ) >> 16 ) & 0xff );
|
||||
pxTopOfStack--;
|
||||
#endif
|
||||
}
|
||||
#endif
|
||||
|
||||
/* DPR | ADB */
|
||||
*pxTopOfStack = Get_DPR_ADB_bank();
|
||||
*pxTopOfStack = xGet_DPR_ADB_bank();
|
||||
pxTopOfStack--;
|
||||
|
||||
/* AL */
|
||||
|
|
@ -387,13 +412,16 @@ portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE
|
|||
*pxTopOfStack = ( portSTACK_TYPE ) 0x1111; /* RW1 */
|
||||
pxTopOfStack--;
|
||||
*pxTopOfStack = ( portSTACK_TYPE ) 0x8888; /* RW0 */
|
||||
pxTopOfStack--;
|
||||
|
||||
/* The task starts with its uxCriticalNesting variable set to 0, interrupts
|
||||
being enabled. */
|
||||
*pxTopOfStack = portNO_CRITICAL_NESTING;
|
||||
|
||||
return pxTopOfStack;
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
/*
|
||||
* Setup RLT0 to generate a tick interrupt.
|
||||
*/
|
||||
|
||||
static void prvSetupRLT0Interrupt( void )
|
||||
{
|
||||
/* set reload value = 34999+1, TICK Interrupt after 10 ms @ 56MHz of CLKP1 */
|
||||
|
|
@ -403,9 +431,7 @@ static void prvSetupRLT0Interrupt( void )
|
|||
TMCSR0 = 0x041B;
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
/*
|
||||
* Start the scheduler.
|
||||
*/
|
||||
|
||||
portBASE_TYPE xPortStartScheduler( void )
|
||||
{
|
||||
/* Setup the hardware to generate the tick. */
|
||||
|
|
@ -427,8 +453,8 @@ portBASE_TYPE xPortStartScheduler( void )
|
|||
|
||||
void vPortEndScheduler( void )
|
||||
{
|
||||
/* It is unlikely that the AVR port will get stopped. If required simply
|
||||
disable the tick interrupt here. */
|
||||
/* Not implemented - unlikely to ever be required as there is nothing to
|
||||
return to. */
|
||||
}
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
|
@ -488,6 +514,7 @@ void vPortEndScheduler( void )
|
|||
|
||||
vTaskIncrementTick();
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
|
@ -508,6 +535,7 @@ __nosavereg __interrupt void vPortYield( void )
|
|||
/* Restore the context of the new task. */
|
||||
portRESTORE_CONTEXT();
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
__nosavereg __interrupt void vPortYieldDelayed( void )
|
||||
{
|
||||
|
|
@ -535,3 +563,30 @@ __nosavereg __interrupt void vPortYieldDelayed( void )
|
|||
/* Enable interrupts */
|
||||
__EI();
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
void vPortEnterCritical( void )
|
||||
{
|
||||
/* Disable interrupts */
|
||||
portDISABLE_INTERRUPTS();
|
||||
|
||||
/* Now interrupts are disabled uxCriticalNesting can be accessed
|
||||
directly. Increment uxCriticalNesting to keep a count of how many times
|
||||
portENTER_CRITICAL() has been called. */
|
||||
uxCriticalNesting++;
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
void vPortExitCritical( void )
|
||||
{
|
||||
if( uxCriticalNesting > portNO_CRITICAL_NESTING )
|
||||
{
|
||||
uxCriticalNesting--;
|
||||
if( uxCriticalNesting == portNO_CRITICAL_NESTING )
|
||||
{
|
||||
/* Enable all interrupt/exception. */
|
||||
portENABLE_INTERRUPTS();
|
||||
}
|
||||
}
|
||||
}
|
||||
/*-----------------------------------------------------------*/
|
||||
|
|
|
|||
|
|
@ -44,6 +44,10 @@
|
|||
#ifndef PORTMACRO_H
|
||||
#define PORTMACRO_H
|
||||
|
||||
#include "mb96348hs.h"
|
||||
#include <stddef.h>
|
||||
|
||||
|
||||
/*-----------------------------------------------------------
|
||||
* Port specific definitions.
|
||||
*
|
||||
|
|
@ -59,12 +63,9 @@
|
|||
#define portFLOAT float
|
||||
#define portDOUBLE double
|
||||
#define portLONG long
|
||||
#define portSHORT int
|
||||
#define portSHORT short
|
||||
#define portSTACK_TYPE unsigned portSHORT
|
||||
#define portBASE_TYPE char
|
||||
|
||||
/* This is required since SOFTUNE doesn't support inline directive as is. */
|
||||
#define inline
|
||||
#define portBASE_TYPE portSHORT
|
||||
|
||||
#if( configUSE_16_BIT_TICKS == 1 )
|
||||
typedef unsigned portSHORT portTickType;
|
||||
|
|
@ -75,21 +76,11 @@
|
|||
#endif
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Critical section handling. */
|
||||
#define portDISABLE_INTERRUPTS() __DI();
|
||||
|
||||
#define portENABLE_INTERRUPTS() __EI();
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
#define portENTER_CRITICAL() \
|
||||
{ __asm(" PUSHW PS "); \
|
||||
portDISABLE_INTERRUPTS(); \
|
||||
}
|
||||
|
||||
#define portEXIT_CRITICAL() \
|
||||
{ __asm(" POPW PS "); \
|
||||
}
|
||||
|
||||
#define portENTER_CRITICAL() vPortEnterCritical()
|
||||
#define portEXIT_CRITICAL() vPortExitCritical()
|
||||
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
|
|
@ -103,8 +94,8 @@
|
|||
/* portYIELD() uses SW interrupt */
|
||||
#define portYIELD() __asm( " INT #122 " );
|
||||
|
||||
/* portYIELD() uses delayed interrupt */
|
||||
#define portYIELDFromISR() __asm (" SETB 03A4H:0 ");
|
||||
/* portYIELD_FROM_ISR() uses delayed interrupt */
|
||||
#define portYIELD_FROM_ISR() __asm( " SETB 03A4H:0 " );
|
||||
/*-----------------------------------------------------------*/
|
||||
|
||||
/* Task function macros as described on the FreeRTOS.org WEB site. */
|
||||
|
|
@ -113,5 +104,8 @@
|
|||
|
||||
#define portMINIMAL_STACK_SIZE configMINIMAL_STACK_SIZE
|
||||
|
||||
/* Remove the inline declaration from within the kernel code. */
|
||||
#define inline
|
||||
|
||||
#endif /* PORTMACRO_H */
|
||||
|
||||
|
|
|
|||
Loading…
Reference in a new issue