From 98e9e7d76851d226d5f4e10acca901d10ba681b5 Mon Sep 17 00:00:00 2001 From: Gregory Nutt Date: Tue, 9 Feb 2016 13:01:32 -0600 Subject: [PATCH] Add spinlock support for ARMv7-R architectures --- arch/arm/src/armv7-r/arm_testset.S | 121 +++++++++++++++++++++++++++++ arch/arm/src/tms570/Make.defs | 1 + 2 files changed, 122 insertions(+) create mode 100644 arch/arm/src/armv7-r/arm_testset.S diff --git a/arch/arm/src/armv7-r/arm_testset.S b/arch/arm/src/armv7-r/arm_testset.S new file mode 100644 index 00000000000..cd2a44c5bd0 --- /dev/null +++ b/arch/arm/src/armv7-r/arm_testset.S @@ -0,0 +1,121 @@ +/**************************************************************************** + * arch/arm/src/armv7-r/arm_testset.S + * + * Copyright (C) 2016 Gregory Nutt. All rights reserved. + * Author: Gregory Nutt + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in + * the documentation and/or other materials provided with the + * distribution. + * 3. Neither the name NuttX nor the names of its contributors may be + * used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS + * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE + * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS + * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN + * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + * + ****************************************************************************/ + +/**************************************************************************** + * Included Files + ****************************************************************************/ + +#include +#include + + .file "arm_testset.S" + +/**************************************************************************** + * Pre-processor Definitions + ****************************************************************************/ + +/**************************************************************************** + * Public Symbols + ****************************************************************************/ + + .globl up_testset + +/**************************************************************************** + * Assembly Macros + ****************************************************************************/ + +/**************************************************************************** + * Private Functions + ****************************************************************************/ + + .text + +/**************************************************************************** + * Public Functions + ****************************************************************************/ + +/**************************************************************************** + * Name: up_testset + * + * Description: + * Perform and atomic test and set operation on the provided spinlock. + * + * This function must be provided via the architecture-specific logoic. + * + * Input Parameters: + * lock - The address of spinlock object. + * + * Returned Value: + * The spinlock is always locked upon return. The value of previous value + * of the spinlock variable is returned, either SP_LOCKED if the spinlock + * as previously locked (meaning that the test-and-set operation failed to + * obtain the lock) or SP_UNLOCKED if the spinlock was previously unlocked + * (meaning that we successfully obtained the lock) + * + ****************************************************************************/ + + .globl up_testset + .type up_testset, %function + +up_testset: + + mov r1, #SP_LOCKED + + /* Test if the spinlock is locked or not */ + +1: + ldrexb r2, [r0] /* Test if spinlock is locked or not */ + cmp r2, r1 /* Locked state? */ + beq 2f /* If locked, return SP_LOCKED */ + + /* Not locked ... attempt to lock it */ + + strexbne r2, r1, [r0] /* Not locked, attempt to lock it */ + cmpne r2, #SP_LOCKED + beq 1b /* Failed to lock... try again */ + + /* Lock acquired -- return SP_UNLOCKED */ + + dmb /* Required before accessing protected resource */ + mov r0, #SP_UNLOCKED + bx lr + + /* Lock not acquired -- return SP_LOCKED */ + +2: + mov r0, #SP_LOCKED + bx lr + .size up_testset, . - up_testset + .end diff --git a/arch/arm/src/tms570/Make.defs b/arch/arm/src/tms570/Make.defs index e33fa43c60d..aaabbe4686c 100644 --- a/arch/arm/src/tms570/Make.defs +++ b/arch/arm/src/tms570/Make.defs @@ -42,6 +42,7 @@ HEAD_ASRC = arm_vectortab.S CMN_ASRCS += arm_vectors.S arm_head.S arm_fullcontextrestore.S CMN_ASRCS += arm_saveusercontext.S arm_vectoraddrexcptn.S arm_vfork.S +CMN_ASRCS += arm_testset.S CMN_ASRCS += cp15_coherent_dcache.S cp15_invalidate_dcache.S CMN_ASRCS += cp15_clean_dcache.S cp15_flush_dcache.S CMN_ASRCS += cp15_invalidate_dcache_all.S