arch/risc-v/rp23xx-rv: add smp support

Add SMP support to rp23xx risc-v port

Signed-off-by: Serg Podtynnyi <serg@podtynnyi.com>

Author: shtirlic

arch/risc-v/Kconfig

@@ -454,7 +454,6 @@ config ARCH_CHIP_RP23XX_RV
 	select ONESHOT_COUNT
 	select ONESHOT_FAST_DIVISION
 	select ALARM_ARCH
-	select ARCH_HAVE_I2CRESET
 	select ARCH_BOARD_COMMON
 	---help---
 		Raspberry Pi RP23XX architectures (RISC-V dual Hazard3).

arch/risc-v/src/rp23xx-rv/Make.defs

@@ -22,6 +22,10 @@
 
 include common/Make.defs
 
+ifeq ($(CONFIG_SMP),y)
+CMN_CSRCS := $(filter-out riscv_smpcall.c riscv_cpustart.c, $(CMN_CSRCS))
+endif
+
 # Specify our HEAD assembly file.  This will be linked as
 # the first object file, so it will appear at address 0
 HEAD_ASRC = rp23xx_head.S
@@ -44,7 +48,6 @@ CHIP_CSRCS += rp23xx_pll.c
 ifeq ($(CONFIG_SMP),y)
 CHIP_CSRCS += rp23xx_cpustart.c
 CHIP_CSRCS += rp23xx_smpcall.c
-CHIP_CSRCS += rp23xx_cpuidlestack.c
 endif
 
 ifeq ($(CONFIG_RP23XX_RV_DMAC),y)

arch/risc-v/src/rp23xx-rv/chip.h

@@ -37,11 +37,23 @@
 
 #include <arch/rp23xx-rv/chip.h>
 
+#include "riscv_internal.h"
+
 /****************************************************************************
  * Macro Definitions
  ****************************************************************************/
 
 #ifdef __ASSEMBLY__
 
+#if defined(CONFIG_SMP) && CONFIG_ARCH_INTERRUPTSTACK > 15
+.macro  setintstack tmp0, tmp1
+  up_cpu_index \tmp0
+  li    \tmp1, STACKFRAME_ALIGN_DOWN(CONFIG_ARCH_INTERRUPTSTACK)
+  mul   \tmp1, \tmp0, \tmp1
+  la    \tmp0, g_intstacktop
+  sub   sp, \tmp0, \tmp1
+.endm
+#endif /* CONFIG_SMP && CONFIG_ARCH_INTERRUPTSTACK > 15 */
+
 #endif /* __ASSEMBLY__  */
 #endif /* __ARCH_RISCV_SRC_RP23XX_RV_CHIP_H */

arch/risc-v/src/rp23xx-rv/hardware/rp23xx_hazard3.h

@@ -27,11 +27,13 @@
  * Included Files
  ****************************************************************************/
 
-#include "hardware/rp23xx_memorymap.h"
+#include "rp23xx_memorymap.h"
 
 /****************************************************************************
  * Pre-processor Definitions
  ****************************************************************************/
+#define hazard3_block()   __asm__ volatile ("slt x0, x0, x0" ::: "memory")
+#define hazard3_unblock() __asm__ volatile ("slt x0, x0, x1" ::: "memory")
 
 #define hazard3_irqarray_read(csr, index) (READ_AND_SET_CSR(csr, (index)) >> 16)
 #define hazard3_irqarray_write(csr, index, data) (WRITE_CSR(csr, (index) | ((uint32_t)(data) << 16)))

arch/risc-v/src/rp23xx-rv/hardware/rp23xx_memorymap.h

@@ -26,8 +26,6 @@
  * Included Files
  ****************************************************************************/
 
-#include "hardware/rp23xx_memorymap.h"
-
 /****************************************************************************
  * Pre-processor Definitions
  ****************************************************************************/

arch/risc-v/src/rp23xx-rv/hardware/rp23xx_psm.h

@@ -27,7 +27,7 @@
  * Included Files
  ****************************************************************************/
 
-#include "hardware/rp23xx_memorymap.h"
+#include "rp23xx_memorymap.h"
 
 /****************************************************************************
  * Pre-processor Definitions

arch/risc-v/src/rp23xx-rv/hardware/rp23xx_resets.h

@@ -27,7 +27,7 @@
  * Included Files
  ****************************************************************************/
 
-#include "hardware/rp23xx_memorymap.h"
+#include "rp23xx_memorymap.h"
 
 /****************************************************************************
  * Pre-processor Definitions

arch/risc-v/src/rp23xx-rv/hardware/rp23xx_sio.h

@@ -27,7 +27,7 @@
  * Included Files
  ****************************************************************************/
 
-#include "hardware/rp23xx_memorymap.h"
+#include "rp23xx_memorymap.h"
 
 /****************************************************************************
  * Pre-processor Definitions

arch/risc-v/src/rp23xx-rv/hardware/rp23xx_usbctrl_dpsram.h

@@ -27,7 +27,7 @@
  * Included Files
  ****************************************************************************/
 
-#include "hardware/rp23xx_memorymap.h"
+#include "rp23xx_memorymap.h"
 
 /****************************************************************************
  * Pre-processor Definitions

arch/risc-v/src/rp23xx-rv/hardware/rp23xx_usbctrl_regs.h

@@ -27,7 +27,7 @@
  * Included Files
  ****************************************************************************/
 
-#include "hardware/rp23xx_memorymap.h"
+#include "rp23xx_memorymap.h"
 
 /****************************************************************************
  * Pre-processor Definitions