mirror of
				https://github.com/FreeRTOS/FreeRTOS-Kernel.git
				synced 2025-11-03 18:49:02 +01:00 
			
		
		
		
	Co-authored-by: Mathias Gredal <matg@universal-robots.com> Co-authored-by: Gaurav-Aggarwal-AWS <33462878+aggarg@users.noreply.github.com>
		
			
				
	
	
		
			289 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			289 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * FreeRTOS Kernel <DEVELOPMENT BRANCH>
 | 
						|
 * Copyright (C) 2020 Amazon.com, Inc. or its affiliates. All Rights Reserved.
 | 
						|
 * Copyright (c) 2021 Raspberry Pi (Trading) Ltd.
 | 
						|
 *
 | 
						|
 * SPDX-License-Identifier: MIT AND BSD-3-Clause
 | 
						|
 *
 | 
						|
 * 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
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
#ifndef PORTMACRO_H
 | 
						|
#define PORTMACRO_H
 | 
						|
 | 
						|
/* *INDENT-OFF* */
 | 
						|
#ifdef __cplusplus
 | 
						|
    extern "C" {
 | 
						|
#endif
 | 
						|
/* *INDENT-ON* */
 | 
						|
 | 
						|
#include "pico.h"
 | 
						|
#include "hardware/sync.h"
 | 
						|
 | 
						|
/*-----------------------------------------------------------
 | 
						|
 * Port specific definitions.
 | 
						|
 *
 | 
						|
 * The settings in this file configure FreeRTOS correctly for the
 | 
						|
 * given hardware and compiler.
 | 
						|
 *
 | 
						|
 * These settings should not be altered.
 | 
						|
 *-----------------------------------------------------------
 | 
						|
 */
 | 
						|
 | 
						|
/* Type definitions. */
 | 
						|
#define portCHAR          char
 | 
						|
#define portFLOAT         float
 | 
						|
#define portDOUBLE        double
 | 
						|
#define portLONG          long
 | 
						|
#define portSHORT         short
 | 
						|
#define portSTACK_TYPE    uint32_t
 | 
						|
#define portBASE_TYPE     long
 | 
						|
 | 
						|
typedef portSTACK_TYPE   StackType_t;
 | 
						|
typedef int32_t          BaseType_t;
 | 
						|
typedef uint32_t         UBaseType_t;
 | 
						|
 | 
						|
#if ( configTICK_TYPE_WIDTH_IN_BITS == TICK_TYPE_WIDTH_16_BITS )
 | 
						|
    typedef uint16_t     TickType_t;
 | 
						|
    #define portMAX_DELAY              ( TickType_t ) 0xffff
 | 
						|
#elif ( configTICK_TYPE_WIDTH_IN_BITS == TICK_TYPE_WIDTH_32_BITS )
 | 
						|
    typedef uint32_t     TickType_t;
 | 
						|
    #define portMAX_DELAY              ( TickType_t ) 0xffffffffUL
 | 
						|
 | 
						|
/* 32-bit tick type on a 32-bit architecture, so reads of the tick count do
 | 
						|
 * not need to be guarded with a critical section. */
 | 
						|
    #define portTICK_TYPE_IS_ATOMIC    1
 | 
						|
#else
 | 
						|
    #error configTICK_TYPE_WIDTH_IN_BITS set to unsupported tick type width.
 | 
						|
#endif
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
/* Architecture specifics. */
 | 
						|
#define portSTACK_GROWTH                ( -1 )
 | 
						|
#define portTICK_PERIOD_MS              ( ( TickType_t ) 1000 / configTICK_RATE_HZ )
 | 
						|
#define portBYTE_ALIGNMENT              8
 | 
						|
#define portDONT_DISCARD                __attribute__( ( used ) )
 | 
						|
 | 
						|
/* We have to use PICO_DIVIDER_DISABLE_INTERRUPTS as the source of truth rather than our config,
 | 
						|
 * as our FreeRTOSConfig.h header cannot be included by ASM code - which is what this affects in the SDK */
 | 
						|
#define portUSE_DIVIDER_SAVE_RESTORE    !PICO_DIVIDER_DISABLE_INTERRUPTS
 | 
						|
#if portUSE_DIVIDER_SAVE_RESTORE
 | 
						|
    #define portSTACK_LIMIT_PADDING     4
 | 
						|
#endif
 | 
						|
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
 | 
						|
/* Scheduler utilities. */
 | 
						|
extern void vPortYield( void );
 | 
						|
#define portNVIC_INT_CTRL_REG     ( *( ( volatile uint32_t * ) 0xe000ed04 ) )
 | 
						|
#define portNVIC_PENDSVSET_BIT    ( 1UL << 28UL )
 | 
						|
#define portYIELD()                vPortYield()
 | 
						|
#define portEND_SWITCHING_ISR( xSwitchRequired )            \
 | 
						|
    do                                                      \
 | 
						|
    {                                                       \
 | 
						|
        if( xSwitchRequired )                               \
 | 
						|
        {                                                   \
 | 
						|
            traceISR_EXIT_TO_SCHEDULER();                   \
 | 
						|
            portNVIC_INT_CTRL_REG = portNVIC_PENDSVSET_BIT; \
 | 
						|
        }                                                   \
 | 
						|
        else                                                \
 | 
						|
        {                                                   \
 | 
						|
            traceISR_EXIT();                                \
 | 
						|
        }                                                   \
 | 
						|
    } while( 0 )
 | 
						|
#define portYIELD_FROM_ISR( x )    portEND_SWITCHING_ISR( x )
 | 
						|
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
/* Exception handlers */
 | 
						|
#if ( configUSE_DYNAMIC_EXCEPTION_HANDLERS == 0 )
 | 
						|
    /* We only need to override the SDK's weak functions if we want to replace them at compile time */
 | 
						|
    #define vPortSVCHandler        isr_svcall
 | 
						|
    #define xPortPendSVHandler     isr_pendsv
 | 
						|
    #define xPortSysTickHandler    isr_systick
 | 
						|
#endif
 | 
						|
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
/* Multi-core */
 | 
						|
#define portMAX_CORE_COUNT    2
 | 
						|
 | 
						|
/* Check validity of number of cores specified in config */
 | 
						|
#if ( configNUMBER_OF_CORES < 1 || portMAX_CORE_COUNT < configNUMBER_OF_CORES )
 | 
						|
    #error "Invalid number of cores specified in config!"
 | 
						|
#endif
 | 
						|
 | 
						|
#if ( configTICK_CORE < 0 || configTICK_CORE > configNUMBER_OF_CORES )
 | 
						|
    #error "Invalid tick core specified in config!"
 | 
						|
#endif
 | 
						|
/* FreeRTOS core id is always zero based, so always 0 if we're running on only one core */
 | 
						|
#if configNUMBER_OF_CORES == portMAX_CORE_COUNT
 | 
						|
    #define portGET_CORE_ID()    get_core_num()
 | 
						|
#else
 | 
						|
    #define portGET_CORE_ID()    0
 | 
						|
#endif
 | 
						|
 | 
						|
#define portCHECK_IF_IN_ISR()                                 \
 | 
						|
    ( {                                                       \
 | 
						|
        uint32_t ulIPSR;                                      \
 | 
						|
        __asm volatile ( "mrs %0, IPSR" : "=r" ( ulIPSR )::); \
 | 
						|
        ( ( uint8_t ) ulIPSR ) > 0; } )
 | 
						|
 | 
						|
void vYieldCore( int xCoreID );
 | 
						|
#define portYIELD_CORE( a )                  vYieldCore( a )
 | 
						|
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
/* Critical nesting count management. */
 | 
						|
#define portCRITICAL_NESTING_IN_TCB    0
 | 
						|
 | 
						|
extern UBaseType_t uxCriticalNestings[ configNUMBER_OF_CORES ];
 | 
						|
#define portGET_CRITICAL_NESTING_COUNT( xCoreID )          ( uxCriticalNestings[ ( xCoreID ) ] )
 | 
						|
#define portSET_CRITICAL_NESTING_COUNT( xCoreID, x )       ( uxCriticalNestings[ ( xCoreID ) ] = ( x ) )
 | 
						|
#define portINCREMENT_CRITICAL_NESTING_COUNT( xCoreID )    ( uxCriticalNestings[ ( xCoreID ) ]++ )
 | 
						|
#define portDECREMENT_CRITICAL_NESTING_COUNT( xCoreID )    ( uxCriticalNestings[ ( xCoreID ) ]-- )
 | 
						|
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
/* Critical section management. */
 | 
						|
 | 
						|
#define portSET_INTERRUPT_MASK()                                  \
 | 
						|
    ( {                                                           \
 | 
						|
        uint32_t ulState;                                         \
 | 
						|
        __asm volatile ( "mrs %0, PRIMASK" : "=r" ( ulState )::); \
 | 
						|
        __asm volatile ( " cpsid i " ::: "memory" );              \
 | 
						|
        ulState; } )
 | 
						|
 | 
						|
#define portCLEAR_INTERRUPT_MASK( ulState )    __asm volatile ( "msr PRIMASK,%0" ::"r" ( ulState ) : )
 | 
						|
 | 
						|
extern uint32_t ulSetInterruptMaskFromISR( void ) __attribute__( ( naked ) );
 | 
						|
extern void vClearInterruptMaskFromISR( uint32_t ulMask )  __attribute__( ( naked ) );
 | 
						|
#define portSET_INTERRUPT_MASK_FROM_ISR()         ulSetInterruptMaskFromISR()
 | 
						|
#define portCLEAR_INTERRUPT_MASK_FROM_ISR( x )    vClearInterruptMaskFromISR( x )
 | 
						|
 | 
						|
#define portDISABLE_INTERRUPTS()                  __asm volatile ( " cpsid i " ::: "memory" )
 | 
						|
#define portENABLE_INTERRUPTS()                   __asm volatile ( " cpsie i " ::: "memory" )
 | 
						|
 | 
						|
#if ( configNUMBER_OF_CORES == 1 )
 | 
						|
    extern void vPortEnterCritical( void );
 | 
						|
    extern void vPortExitCritical( void );
 | 
						|
    #define portENTER_CRITICAL()    vPortEnterCritical()
 | 
						|
    #define portEXIT_CRITICAL()     vPortExitCritical()
 | 
						|
#else
 | 
						|
    extern void vTaskEnterCritical( void );
 | 
						|
    extern void vTaskExitCritical( void );
 | 
						|
    extern UBaseType_t vTaskEnterCriticalFromISR( void );
 | 
						|
    extern void vTaskExitCriticalFromISR( UBaseType_t uxSavedInterruptStatus );
 | 
						|
    #define portENTER_CRITICAL()               vTaskEnterCritical()
 | 
						|
    #define portEXIT_CRITICAL()                vTaskExitCritical()
 | 
						|
    #define portENTER_CRITICAL_FROM_ISR()      vTaskEnterCriticalFromISR()
 | 
						|
    #define portEXIT_CRITICAL_FROM_ISR( x )    vTaskExitCriticalFromISR( x )
 | 
						|
#endif /* if ( configNUMBER_OF_CORES == 1 ) */
 | 
						|
 | 
						|
#define portRTOS_SPINLOCK_COUNT    2
 | 
						|
 | 
						|
#if PICO_SDK_VERSION_MAJOR < 2
 | 
						|
__force_inline static bool spin_try_lock_unsafe(spin_lock_t *lock) {
 | 
						|
   return *lock;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/* Note this is a single method with uxAcquire parameter since we have
 | 
						|
 * static vars, the method is always called with a compile time constant for
 | 
						|
 * uxAcquire, and the compiler should do the right thing! */
 | 
						|
static inline void vPortRecursiveLock( BaseType_t xCoreID,
 | 
						|
                                       uint32_t ulLockNum,
 | 
						|
                                       spin_lock_t * pxSpinLock,
 | 
						|
                                       BaseType_t uxAcquire )
 | 
						|
{
 | 
						|
    static volatile uint8_t ucOwnedByCore[ portMAX_CORE_COUNT ][portRTOS_SPINLOCK_COUNT];
 | 
						|
    static volatile uint8_t ucRecursionCountByLock[ portRTOS_SPINLOCK_COUNT ];
 | 
						|
 | 
						|
    configASSERT( ulLockNum < portRTOS_SPINLOCK_COUNT );
 | 
						|
 | 
						|
    if( uxAcquire )
 | 
						|
    {
 | 
						|
        if (!spin_try_lock_unsafe(pxSpinLock)) {
 | 
						|
            if( ucOwnedByCore[ xCoreID ][ ulLockNum ] )
 | 
						|
            {
 | 
						|
                configASSERT( ucRecursionCountByLock[ ulLockNum ] != 255u );
 | 
						|
                ucRecursionCountByLock[ ulLockNum ] = ucRecursionCountByLock[ ulLockNum ] + 1;
 | 
						|
                return;
 | 
						|
            }
 | 
						|
            spin_lock_unsafe_blocking(pxSpinLock);
 | 
						|
        }
 | 
						|
        configASSERT( ucRecursionCountByLock[ ulLockNum ] == 0 );
 | 
						|
        ucRecursionCountByLock[ ulLockNum ] = 1;
 | 
						|
        ucOwnedByCore[ xCoreID ][ ulLockNum ] = 1;
 | 
						|
    }
 | 
						|
    else
 | 
						|
    {
 | 
						|
        configASSERT( ( ucOwnedByCore[ xCoreID ] [ulLockNum ] ) != 0 );
 | 
						|
        configASSERT( ucRecursionCountByLock[ ulLockNum ] != 0 );
 | 
						|
 | 
						|
        ucRecursionCountByLock[ ulLockNum ] = ucRecursionCountByLock[ ulLockNum ] - 1;
 | 
						|
        if ( ucRecursionCountByLock[ ulLockNum ] == 0U )
 | 
						|
        {
 | 
						|
            ucOwnedByCore[ xCoreID ] [ ulLockNum ] = 0;
 | 
						|
            spin_unlock_unsafe(pxSpinLock);
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
#if ( configNUMBER_OF_CORES == 1 )
 | 
						|
    #define portGET_ISR_LOCK( xCoreID )
 | 
						|
    #define portRELEASE_ISR_LOCK( xCoreID )
 | 
						|
    #define portGET_TASK_LOCK( xCoreID )
 | 
						|
    #define portRELEASE_TASK_LOCK( xCoreID )
 | 
						|
#else
 | 
						|
    #define portGET_ISR_LOCK( xCoreID )         vPortRecursiveLock( ( xCoreID ), 0, spin_lock_instance( configSMP_SPINLOCK_0 ), pdTRUE )
 | 
						|
    #define portRELEASE_ISR_LOCK( xCoreID )     vPortRecursiveLock( ( xCoreID ), 0, spin_lock_instance( configSMP_SPINLOCK_0 ), pdFALSE )
 | 
						|
    #define portGET_TASK_LOCK( xCoreID )        vPortRecursiveLock( ( xCoreID ), 1, spin_lock_instance( configSMP_SPINLOCK_1 ), pdTRUE )
 | 
						|
    #define portRELEASE_TASK_LOCK( xCoreID )    vPortRecursiveLock( ( xCoreID ), 1, spin_lock_instance( configSMP_SPINLOCK_1 ), pdFALSE )
 | 
						|
#endif
 | 
						|
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
/* Tickless idle/low power functionality. */
 | 
						|
#ifndef portSUPPRESS_TICKS_AND_SLEEP
 | 
						|
    extern void vPortSuppressTicksAndSleep( TickType_t xExpectedIdleTime );
 | 
						|
    #define portSUPPRESS_TICKS_AND_SLEEP( xExpectedIdleTime )    vPortSuppressTicksAndSleep( xExpectedIdleTime )
 | 
						|
#endif
 | 
						|
/*-----------------------------------------------------------*/
 | 
						|
 | 
						|
/* Task function macros as described on the FreeRTOS.org WEB site. */
 | 
						|
#define portTASK_FUNCTION_PROTO( vFunction, pvParameters )    void vFunction( void * pvParameters )
 | 
						|
#define portTASK_FUNCTION( vFunction, pvParameters )          void vFunction( void * pvParameters )
 | 
						|
 | 
						|
#define portNOP()               __asm volatile ( "nop" )
 | 
						|
 | 
						|
#define portMEMORY_BARRIER()    __asm volatile ( "" ::: "memory" )
 | 
						|
 | 
						|
/* *INDENT-OFF* */
 | 
						|
#ifdef __cplusplus
 | 
						|
    }
 | 
						|
#endif
 | 
						|
/* *INDENT-ON* */
 | 
						|
 | 
						|
#endif /* PORTMACRO_H */
 |