/*
 * FreeRTOS Kernel V11.3.0
 * Copyright (C) 2021 Amazon.com, Inc. or its affiliates. All Rights Reserved.
 *
 * SPDX-License-Identifier: MIT
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy of
 * this software and associated documentation files (the "Software"), to deal in
 * the Software without restriction, including without limitation the rights to
 * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
 * the Software, and to permit persons to whom the Software is furnished to do so,
 * subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in all
 * copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
 * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
 * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
 * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 *
 * https://www.FreeRTOS.org
 * https://github.com/FreeRTOS
 *
 */

.file "portASM.S"
#include "FreeRTOSConfig.h"
#include "ISR_Support.h"

    .extern pxCurrentTCB
    .extern vTaskSwitchContext
    .extern vPortCentralInterruptHandler
    .extern xTaskIncrementTick
    .extern vPortAPICErrorHandler
    .extern pucPortTaskFPUContextBuffer
    .extern ulPortYieldPending

    .global vPortStartFirstTask
    .global vPortCentralInterruptWrapper
    .global vPortAPICErrorHandlerWrapper
    .global vPortTimerHandler
    .global vPortYieldCall
    .global vPortAPICSpuriousHandler

    .text

/*-----------------------------------------------------------*/

.align 4
.func vPortYieldCall
vPortYieldCall:
    /* Save general purpose registers. */
    pusha

    .if configSUPPORT_FPU == 1

        /* If the task has a buffer allocated to save the FPU context then save
        the FPU context now. */
        movl    pucPortTaskFPUContextBuffer, %eax
        test    %eax, %eax
        je      1f
        fnsave  ( %eax )
        fwait

        1:

        /* Save the address of the FPU context, if any. */
        push    pucPortTaskFPUContextBuffer

    .endif /* configSUPPORT_FPU */

    /* Find the TCB. */
    movl    pxCurrentTCB, %eax

    /* Stack location is first item in the TCB. */
    movl    %esp, (%eax)

    call vTaskSwitchContext

    /* Find the location of pxCurrentTCB again - a callee saved register could
    be used in place of eax to prevent this second load, but that then relies
    on the compiler and other asm code. */
    movl    pxCurrentTCB, %eax
    movl    (%eax), %esp

    .if configSUPPORT_FPU == 1

        /* Restore address of task's FPU context buffer. */
        pop     pucPortTaskFPUContextBuffer

        /* If the task has a buffer allocated in which its FPU context is saved,
        then restore it now. */
        movl    pucPortTaskFPUContextBuffer, %eax
        test    %eax, %eax
        je      1f
        frstor  ( %eax )
        1:
    .endif

    popa
    iret

.endfunc
/*-----------------------------------------------------------*/

.align 4
.func vPortStartFirstTask
vPortStartFirstTask:

    /* Find the TCB. */
    movl    pxCurrentTCB, %eax

    /* Stack location is first item in the TCB. */
    movl    (%eax), %esp

    /* Restore FPU context flag. */
    .if configSUPPORT_FPU == 1

        pop     pucPortTaskFPUContextBuffer

    .endif /* configSUPPORT_FPU */

    /* Restore general purpose registers. */
    popa
    iret
.endfunc
/*-----------------------------------------------------------*/

.align 4
.func vPortAPICErrorHandlerWrapper
vPortAPICErrorHandlerWrapper:
    pusha
    call    vPortAPICErrorHandler
    popa
    /* EOI. */
    movl    $0x00, (0xFEE000B0)
    iret
.endfunc
/*-----------------------------------------------------------*/

.align 4
.func vPortTimerHandler
vPortTimerHandler:

    /* Save general purpose registers. */
    pusha

    /* Interrupts are not nested, so save the rest of the task context. */
    .if configSUPPORT_FPU == 1

        /* If the task has a buffer allocated to save the FPU context then save the
        FPU context now. */
        movl    pucPortTaskFPUContextBuffer, %eax
        test    %eax, %eax
        je      1f
        fnsave  ( %eax ) /* Save FLOP context into ucTempFPUBuffer array. */
        fwait

        1:
        /* Save the address of the FPU context, if any. */
        push    pucPortTaskFPUContextBuffer

    .endif /* configSUPPORT_FPU */

    /* Find the TCB. */
    movl    pxCurrentTCB, %eax

    /* Stack location is first item in the TCB. */
    movl    %esp, (%eax)

    /* Switch stacks. */
    movl    ulTopOfSystemStack, %esp
    movl    %esp, %ebp

    /* Increment nesting count. */
    add     $1, ulInterruptNesting

    call    xTaskIncrementTick

    sti

    /* Is a switch to another task required? */
    test    %eax, %eax
    je      _skip_context_switch
    cli
    call    vTaskSwitchContext

_skip_context_switch:
    cli

    /* Decrement the variable used to determine if a switch to a system
    stack is necessary. */
    sub     $1, ulInterruptNesting

    /* Stack location is first item in the TCB. */
    movl    pxCurrentTCB, %eax
    movl    (%eax), %esp

    .if configSUPPORT_FPU == 1

        /* Restore address of task's FPU context buffer. */
        pop     pucPortTaskFPUContextBuffer

        /* If the task has a buffer allocated in which its FPU context is saved,
        then restore it now. */
        movl    pucPortTaskFPUContextBuffer, %eax
        test    %eax, %eax
        je      1f
        frstor  ( %eax )
        1:
    .endif

    popa

    /* EOI. */
    movl    $0x00, (0xFEE000B0)
    iret

.endfunc
/*-----------------------------------------------------------*/

.if configUSE_COMMON_INTERRUPT_ENTRY_POINT == 1

    .align 4
    .func vPortCentralInterruptWrapper
    vPortCentralInterruptWrapper:

        portFREERTOS_INTERRUPT_ENTRY

        movl $0xFEE00170, %eax          /* Highest In Service Register (ISR) long word. */
        movl $8, %ecx                   /* Loop counter. */

    next_isr_long_word:
        test %ecx, %ecx                 /* Loop counter reached 0? */
        je wrapper_epilogue             /* Looked at all ISR registers without finding a bit set. */
        sub $1, %ecx                    /* Sub 1 from loop counter. */
        movl (%eax), %ebx               /* Load next ISR long word. */
        sub $0x10, %eax                 /* Point to next ISR long word in case no bits are set in the current long word. */
        test %ebx, %ebx                 /* Are there any bits set? */
        je next_isr_long_word           /* Look at next ISR long word if no bits were set. */
        sti
        bsr %ebx, %ebx                  /* A bit was set, which one? */
        movl $32, %eax                  /* Destination operand for following multiplication. */
        mul %ecx                        /* Calculate base vector for current register, 32 vectors per register. */
        add %ebx, %eax                  /* Add bit offset into register to get final vector number. */
        push %eax                       /* Vector number is function parameter. */
        call vPortCentralInterruptHandler
        pop %eax                        /* Remove parameter. */

    wrapper_epilogue:
        portFREERTOS_INTERRUPT_EXIT

    .endfunc

.endif /* configUSE_COMMON_INTERRUPT_ENTRY_POINT */
/*-----------------------------------------------------------*/

.align 4
.func vPortAPISpuriousHandler
vPortAPICSpuriousHandler:
    iret

.endfunc

.end
