FreeRTOS 启动第一个任务 prvStartFirstTask vPortSVCHandler

__asm void prvStartFirstTask( void )

__asm void prvStartFirstTask( void )
{
    PRESERVE8

    /* Use the NVIC offset register to locate the stack. */
    ldr r0, =0xE000ED08   //  0xE000ED08 地址处为VTOR(向量表偏移量)寄存器,存储向量表起始地址

    ldr r0, [r0]   //  启动文件中, 最初地址放置的__initial_sp 
    ldr r0, [r0]  //  根据向量表实际存储地址,取出向量表中的第一项,向量表第一项存储主堆栈指针 MSP 的初始值
    /* Set the msp back to the start of the stack. */
    msr msp, r0   //  将 __initial_sp的初始值写入 MSP 中 
    /* Globally enable interrupts. */
    cpsie i
    cpsie f
    dsb
    isb
    /* Call SVC to start the first task. */
    svc 0   //    调用SVC中断   
    nop
    nop
}

取 MSP 的初始值的思路是先根据向量表的位置寄存器 VTOR (0xE000ED08) 来获取向量表存储的地址;
再根据向量表存储的地址,取出第一个元素__initial_sp,写入 MSP;

Cortex-M3 处理器,上电默认进入线程的特权模式,使用 MSP 作为堆栈指针;
从上电跑到这里,经过一系列的函数调用,出栈,入栈,MSP 自然已经不是最开始的初始化的位置;
这里通过 MSR 重新初始化 MSP,丢弃主堆栈中的数据;  这是一条不归路,代码跑到这里,不会再返回之前的调用路径。

调用 svc 并传入系统调用号为 0 启动 SVC 中断

-------------------------------------------------------------------------------------------------------

-------------------------------------------------------------------------------------------------------

__asm void vPortSVCHandler( void )

__asm void vPortSVCHandler( void )
{
	PRESERVE8

	/* Get the location of the current TCB. */
	ldr	r3, =pxCurrentTCB
	ldr r1, [r3]   //  根据 tskTCB结构体定义, 首地址存的是 pxTopOfStack   
	ldr r0, [r1]   //  r0得到TopOfStack的值
	/* Pop the core registers. */
	ldmia r0!, {r4-r11, r14}
	msr psp, r0
	isb
	mov r0, #0
	msr	basepri, r0
	bx r14
}

pxCurrentTCB 指向的是最高优先级的 Ready 状态的任务指针;根据 pxCurrentTCB 获取到对应 tskTCB的地址;
然后获取第一个成员变量pxTopOfStack;,也就是当前任务的栈顶地址;
在任务创建xTaskCreate的时候,需要模拟的 Cortex 的异常入栈顺序,做好数据放置;

使用 LDMIA 指令,以 pxTopOfStack 开始顺序出栈,先出 R4~R11(在创建任务的时候,最后入栈的就是这些个),同时 R0 递增;

将此刻的 R0 赋值给 PSP(因为出栈的时候,处理器会按照入栈的顺序去取 R4-R11、R14,而这些寄存器在我们创建任务的时候已经手动压栈)

将 BASEPRI 寄存器赋值为 0,也就是允许任何中断

最后执行 bx R14,告诉处理器 ISR 完成,需要返回,此刻处理器便会进行出栈操作,PC 被我们赋值成为了执行任务的函数的入口,也即正式跑起来;

StackType_t *pxPortInitialiseStack( StackType_t *pxTopOfStack, TaskFunction_t pxCode, void *pvParameters )
{
	/* Simulate the stack frame as it would be created by a context switch
	interrupt. */

	/* Offset added to account for the way the MCU uses the stack on entry/exit
	of interrupts, and to ensure alignment. */
	pxTopOfStack--;

	*pxTopOfStack = portINITIAL_XPSR;	/* xPSR */
	pxTopOfStack--;
	*pxTopOfStack = ( ( StackType_t ) pxCode ) & portSTART_ADDRESS_MASK;	/* PC */
	pxTopOfStack--;
	*pxTopOfStack = ( StackType_t ) prvTaskExitError;	/* LR */

	/* Save code space by skipping register initialisation. */
	pxTopOfStack -= 5;	/* R12, R3, R2 and R1. */
	*pxTopOfStack = ( StackType_t ) pvParameters;	/* R0 */

	/* A save method is being used that requires each task to maintain its
	own exec return value. */
	pxTopOfStack--;
	*pxTopOfStack = portINITIAL_EXEC_RETURN;

	pxTopOfStack -= 8;	/* R11, R10, R9, R8, R7, R6, R5 and R4. */

	return pxTopOfStack;
}

其中 #define portINITIAL_EXEC_RETURN        ( 0xfffffffd )

来自:《STM32F3 and STM32F4 Series Cortex®-M4 programming manual》(ST的PM0214文档)

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值