[libcpu][aarch64] 使用设备树对CPU进行初始化 (#8221)

bsp/qemu-virt64-aarch64/.config

@@ -42,6 +42,7 @@ CONFIG_RT_DEBUGING_COLOR=y
 CONFIG_RT_DEBUGING_CONTEXT=y
 # CONFIG_RT_DEBUGING_INIT is not set
 # CONFIG_RT_DEBUGING_PAGE_LEAK is not set
+# CONFIG_RT_DEBUGING_SPINLOCK is not set
 
 #
 # Inter-Thread communication
@@ -73,13 +74,8 @@ CONFIG_RT_USING_MEMHEAP_AUTO_BINDING=y
 CONFIG_RT_USING_MEMTRACE=y
 # CONFIG_RT_USING_HEAP_ISR is not set
 CONFIG_RT_USING_HEAP=y
-
-#
-# Kernel Device Object
-#
 CONFIG_RT_USING_DEVICE=y
 CONFIG_RT_USING_DEVICE_OPS=y
-# CONFIG_RT_USING_DM is not set
 CONFIG_RT_USING_INTERRUPT_INFO=y
 CONFIG_RT_USING_CONSOLE=y
 CONFIG_RT_CONSOLEBUF_SIZE=256
@@ -100,7 +96,7 @@ CONFIG_RT_USING_CACHE=y
 # CONFIG_RT_USING_HW_ATOMIC is not set
 # CONFIG_ARCH_ARM_BOOTWITH_FLUSH_CACHE is not set
 # CONFIG_ARCH_CPU_STACK_GROWS_UPWARD is not set
-# CONFIG_RT_USING_CPU_FFS is not set
+CONFIG_RT_USING_CPU_FFS=y
 CONFIG_ARCH_MM_MMU=y
 CONFIG_ARCH_ARM=y
 CONFIG_ARCH_ARM_MMU=y
@@ -166,6 +162,7 @@ CONFIG_RT_DFS_ELM_MAX_SECTOR_SIZE=512
 # CONFIG_RT_DFS_ELM_USE_ERASE is not set
 CONFIG_RT_DFS_ELM_REENTRANT=y
 CONFIG_RT_DFS_ELM_MUTEX_TIMEOUT=3000
+# CONFIG_RT_DFS_ELM_USE_EXFAT is not set
 CONFIG_RT_USING_DFS_DEVFS=y
 CONFIG_RT_USING_DFS_ROMFS=y
 # CONFIG_RT_USING_DFS_CROMFS is not set
@@ -177,6 +174,7 @@ CONFIG_RT_USING_DFS_ROMFS=y
 #
 # Device Drivers
 #
+CONFIG_RT_USING_DM=y
 CONFIG_RT_USING_DEVICE_IPC=y
 CONFIG_RT_UNAMED_PIPE_NUMBER=64
 CONFIG_RT_USING_SYSTEM_WORKQUEUE=y
@@ -201,10 +199,12 @@ CONFIG_RT_USING_RANDOM=y
 # CONFIG_RT_USING_PWM is not set
 # CONFIG_RT_USING_MTD_NOR is not set
 # CONFIG_RT_USING_MTD_NAND is not set
-# CONFIG_RT_USING_PM is not set
+CONFIG_RT_USING_PM=y
-CONFIG_RT_USING_FDT=y
+CONFIG_PM_TICKLESS_THRESHOLD_TIME=2
-CONFIG_RT_USING_FDTLIB=y
+# CONFIG_PM_USING_CUSTOM_CONFIG is not set
-# CONFIG_FDT_USING_DEBUG is not set
+# CONFIG_PM_ENABLE_DEBUG is not set
+# CONFIG_PM_ENABLE_SUSPEND_SLEEP_MODE is not set
+# CONFIG_PM_ENABLE_THRESHOLD_SLEEP_MODE is not set
 CONFIG_RT_USING_RTC=y
 # CONFIG_RT_USING_ALARM is not set
 CONFIG_RT_USING_SOFT_RTC=y
@@ -229,6 +229,10 @@ CONFIG_RT_USING_VIRTIO_CONSOLE=y
 CONFIG_RT_USING_VIRTIO_CONSOLE_PORT_MAX_NR=4
 CONFIG_RT_USING_VIRTIO_GPU=y
 CONFIG_RT_USING_VIRTIO_INPUT=y
+CONFIG_RT_USING_OFW=y
+# CONFIG_RT_USING_BUILTIN_FDT is not set
+CONFIG_RT_FDT_EARLYCON_MSG_SIZE=128
+# CONFIG_RT_USING_PIC is not set
 CONFIG_RT_USING_KTIME=y
 
 #
@@ -317,6 +321,12 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # CONFIG_RT_USING_MEMBLOCK is not set
 
+#
+# Memory protection
+#
+# CONFIG_RT_USING_MEM_PROTECTION is not set
+# CONFIG_RT_USING_HW_STACK_GUARD is not set
+
 #
 # RT-Thread Utestcases
 #
@@ -340,7 +350,6 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_KAWAII_MQTT is not set
 # CONFIG_PKG_USING_BC28_MQTT is not set
 # CONFIG_PKG_USING_WEBTERMINAL is not set
-# CONFIG_PKG_USING_LIBMODBUS is not set
 # CONFIG_PKG_USING_FREEMODBUS is not set
 # CONFIG_PKG_USING_NANOPB is not set
 
@@ -358,6 +367,11 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # CONFIG_PKG_USING_WLAN_WICED is not set
 # CONFIG_PKG_USING_RW007 is not set
+
+#
+# CYW43012 WiFi
+#
+# CONFIG_PKG_USING_WLAN_CYW43012 is not set
 # CONFIG_PKG_USING_COAP is not set
 # CONFIG_PKG_USING_NOPOLL is not set
 # CONFIG_PKG_USING_NETUTILS is not set
@@ -400,6 +414,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_NMEALIB is not set
 # CONFIG_PKG_USING_PDULIB is not set
 # CONFIG_PKG_USING_BTSTACK is not set
+# CONFIG_PKG_USING_BT_CYW43012 is not set
 # CONFIG_PKG_USING_LORAWAN_ED_STACK is not set
 # CONFIG_PKG_USING_WAYZ_IOTKIT is not set
 # CONFIG_PKG_USING_MAVLINK is not set
@@ -408,6 +423,8 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_AGILE_FTP is not set
 # CONFIG_PKG_USING_EMBEDDEDPROTO is not set
 # CONFIG_PKG_USING_RT_LINK_HW is not set
+# CONFIG_PKG_USING_RYANMQTT is not set
+# CONFIG_PKG_USING_RYANW5500 is not set
 # CONFIG_PKG_USING_LORA_PKT_FWD is not set
 # CONFIG_PKG_USING_LORA_GW_DRIVER_LIB is not set
 # CONFIG_PKG_USING_LORA_PKT_SNIFFER is not set
@@ -415,6 +432,9 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_SMALL_MODBUS is not set
 # CONFIG_PKG_USING_NET_SERVER is not set
 # CONFIG_PKG_USING_ZFTP is not set
+# CONFIG_PKG_USING_WOL is not set
+# CONFIG_PKG_USING_ZEPHYR_POLLING is not set
+# CONFIG_PKG_USING_MATTER_ADAPTATION_LAYER is not set
 
 #
 # security packages
@@ -461,7 +481,6 @@ CONFIG_RT_USING_ADT_REF=y
 # LVGL: powerful and easy-to-use embedded GUI library
 #
 # CONFIG_PKG_USING_LVGL is not set
-# CONFIG_PKG_USING_LITTLEVGL2RTT is not set
 # CONFIG_PKG_USING_LV_MUSIC_DEMO is not set
 # CONFIG_PKG_USING_GUI_GUIDER_DEMO is not set
 
@@ -483,17 +502,12 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_MP3PLAYER is not set
 # CONFIG_PKG_USING_TINYJPEG is not set
 # CONFIG_PKG_USING_UGUI is not set
-
-#
-# PainterEngine: A cross-platform graphics application framework written in C language
-#
-# CONFIG_PKG_USING_PAINTERENGINE is not set
-# CONFIG_PKG_USING_PAINTERENGINE_AUX is not set
 # CONFIG_PKG_USING_MCURSES is not set
 # CONFIG_PKG_USING_TERMBOX is not set
 # CONFIG_PKG_USING_VT100 is not set
 # CONFIG_PKG_USING_QRCODE is not set
 # CONFIG_PKG_USING_GUIENGINE is not set
+# CONFIG_PKG_USING_3GPP_AMRNB is not set
 
 #
 # tools packages
@@ -503,9 +517,9 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_EASYLOGGER is not set
 # CONFIG_PKG_USING_SYSTEMVIEW is not set
 # CONFIG_PKG_USING_SEGGER_RTT is not set
+# CONFIG_PKG_USING_RTT_AUTO_EXE_CMD is not set
 # CONFIG_PKG_USING_RDB is not set
 # CONFIG_PKG_USING_ULOG_EASYFLASH is not set
-# CONFIG_PKG_USING_ULOG_FILE is not set
 # CONFIG_PKG_USING_LOGMGR is not set
 # CONFIG_PKG_USING_ADBD is not set
 # CONFIG_PKG_USING_COREMARK is not set
@@ -539,9 +553,9 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_CBOX is not set
 # CONFIG_PKG_USING_SNOWFLAKE is not set
 # CONFIG_PKG_USING_HASH_MATCH is not set
-# CONFIG_PKG_USING_FIRE_PID_CURVE is not set
 # CONFIG_PKG_USING_ARMV7M_DWT_TOOL is not set
 # CONFIG_PKG_USING_VOFA_PLUS is not set
+# CONFIG_PKG_USING_ZDEBUG is not set
 
 #
 # system packages
@@ -578,6 +592,8 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_UC_COMMON is not set
 # CONFIG_PKG_USING_UC_MODBUS is not set
 # CONFIG_PKG_USING_FREERTOS_WRAPPER is not set
+# CONFIG_PKG_USING_LITEOS_SDK is not set
+# CONFIG_PKG_USING_TZ_DATABASE is not set
 # CONFIG_PKG_USING_CAIRO is not set
 # CONFIG_PKG_USING_PIXMAN is not set
 # CONFIG_PKG_USING_PARTITION is not set
@@ -601,6 +617,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_QBOOT is not set
 # CONFIG_PKG_USING_PPOOL is not set
 # CONFIG_PKG_USING_OPENAMP is not set
+# CONFIG_PKG_USING_RPMSG_LITE is not set
 # CONFIG_PKG_USING_LPM is not set
 # CONFIG_PKG_USING_TLSF is not set
 # CONFIG_PKG_USING_EVENT_RECORDER is not set
@@ -612,19 +629,99 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_TFDB is not set
 # CONFIG_PKG_USING_QPC is not set
 # CONFIG_PKG_USING_AGILE_UPGRADE is not set
+# CONFIG_PKG_USING_FLASH_BLOB is not set
+# CONFIG_PKG_USING_MLIBC is not set
+# CONFIG_PKG_USING_TASK_MSG_BUS is not set
+# CONFIG_PKG_USING_SFDB is not set
 
 #
 # peripheral libraries and drivers
 #
-# CONFIG_PKG_USING_SENSORS_DRIVERS is not set
+
-# CONFIG_PKG_USING_REALTEK_AMEBA is not set
+#
+# sensors drivers
+#
+# CONFIG_PKG_USING_LSM6DSM is not set
+# CONFIG_PKG_USING_LSM6DSL is not set
+# CONFIG_PKG_USING_LPS22HB is not set
+# CONFIG_PKG_USING_HTS221 is not set
+# CONFIG_PKG_USING_LSM303AGR is not set
+# CONFIG_PKG_USING_BME280 is not set
+# CONFIG_PKG_USING_BME680 is not set
+# CONFIG_PKG_USING_BMA400 is not set
+# CONFIG_PKG_USING_BMI160_BMX160 is not set
+# CONFIG_PKG_USING_SPL0601 is not set
+# CONFIG_PKG_USING_MS5805 is not set
+# CONFIG_PKG_USING_DA270 is not set
+# CONFIG_PKG_USING_DF220 is not set
+# CONFIG_PKG_USING_HSHCAL001 is not set
+# CONFIG_PKG_USING_BH1750 is not set
+# CONFIG_PKG_USING_MPU6XXX is not set
+# CONFIG_PKG_USING_AHT10 is not set
+# CONFIG_PKG_USING_AP3216C is not set
+# CONFIG_PKG_USING_TSL4531 is not set
+# CONFIG_PKG_USING_DS18B20 is not set
+# CONFIG_PKG_USING_DHT11 is not set
+# CONFIG_PKG_USING_DHTXX is not set
+# CONFIG_PKG_USING_GY271 is not set
+# CONFIG_PKG_USING_GP2Y10 is not set
+# CONFIG_PKG_USING_SGP30 is not set
+# CONFIG_PKG_USING_HDC1000 is not set
+# CONFIG_PKG_USING_BMP180 is not set
+# CONFIG_PKG_USING_BMP280 is not set
+# CONFIG_PKG_USING_SHTC1 is not set
+# CONFIG_PKG_USING_BMI088 is not set
+# CONFIG_PKG_USING_HMC5883 is not set
+# CONFIG_PKG_USING_MAX6675 is not set
+# CONFIG_PKG_USING_TMP1075 is not set
+# CONFIG_PKG_USING_SR04 is not set
+# CONFIG_PKG_USING_CCS811 is not set
+# CONFIG_PKG_USING_PMSXX is not set
+# CONFIG_PKG_USING_RT3020 is not set
+# CONFIG_PKG_USING_MLX90632 is not set
+# CONFIG_PKG_USING_MLX90393 is not set
+# CONFIG_PKG_USING_MLX90392 is not set
+# CONFIG_PKG_USING_MLX90397 is not set
+# CONFIG_PKG_USING_MS5611 is not set
+# CONFIG_PKG_USING_MAX31865 is not set
+# CONFIG_PKG_USING_VL53L0X is not set
+# CONFIG_PKG_USING_INA260 is not set
+# CONFIG_PKG_USING_MAX30102 is not set
+# CONFIG_PKG_USING_INA226 is not set
+# CONFIG_PKG_USING_LIS2DH12 is not set
+# CONFIG_PKG_USING_HS300X is not set
+# CONFIG_PKG_USING_ZMOD4410 is not set
+# CONFIG_PKG_USING_ISL29035 is not set
+# CONFIG_PKG_USING_MMC3680KJ is not set
+# CONFIG_PKG_USING_QMP6989 is not set
+# CONFIG_PKG_USING_BALANCE is not set
 # CONFIG_PKG_USING_SHT2X is not set
 # CONFIG_PKG_USING_SHT3X is not set
+# CONFIG_PKG_USING_SHT4X is not set
+# CONFIG_PKG_USING_AD7746 is not set
 # CONFIG_PKG_USING_ADT74XX is not set
+# CONFIG_PKG_USING_MAX17048 is not set
 # CONFIG_PKG_USING_AS7341 is not set
+# CONFIG_PKG_USING_CW2015 is not set
+# CONFIG_PKG_USING_ICM20608 is not set
+# CONFIG_PKG_USING_PAJ7620 is not set
+# CONFIG_PKG_USING_STHS34PF80 is not set
+
+#
+# touch drivers
+#
+# CONFIG_PKG_USING_GT9147 is not set
+# CONFIG_PKG_USING_GT1151 is not set
+# CONFIG_PKG_USING_GT917S is not set
+# CONFIG_PKG_USING_GT911 is not set
+# CONFIG_PKG_USING_FT6206 is not set
+# CONFIG_PKG_USING_FT5426 is not set
+# CONFIG_PKG_USING_FT6236 is not set
+# CONFIG_PKG_USING_XPT2046_TOUCH is not set
+# CONFIG_PKG_USING_CST816X is not set
+# CONFIG_PKG_USING_REALTEK_AMEBA is not set
 # CONFIG_PKG_USING_STM32_SDIO is not set
 # CONFIG_PKG_USING_ESP_IDF is not set
-# CONFIG_PKG_USING_ICM20608 is not set
 # CONFIG_PKG_USING_BUTTON is not set
 # CONFIG_PKG_USING_PCF8574 is not set
 # CONFIG_PKG_USING_SX12XX is not set
@@ -634,7 +731,6 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_LKDGUI is not set
 # CONFIG_PKG_USING_NRF5X_SDK is not set
 # CONFIG_PKG_USING_NRFX is not set
-# CONFIG_PKG_USING_WM_LIBRARIES is not set
 
 #
 # Kendryte SDK
@@ -647,12 +743,10 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_AGILE_LED is not set
 # CONFIG_PKG_USING_AT24CXX is not set
 # CONFIG_PKG_USING_MOTIONDRIVER2RTT is not set
-# CONFIG_PKG_USING_AD7746 is not set
 # CONFIG_PKG_USING_PCA9685 is not set
+# CONFIG_PKG_USING_ILI9341 is not set
 # CONFIG_PKG_USING_I2C_TOOLS is not set
 # CONFIG_PKG_USING_NRF24L01 is not set
-# CONFIG_PKG_USING_TOUCH_DRIVERS is not set
-# CONFIG_PKG_USING_MAX17048 is not set
 # CONFIG_PKG_USING_RPLIDAR is not set
 # CONFIG_PKG_USING_AS608 is not set
 # CONFIG_PKG_USING_RC522 is not set
@@ -667,7 +761,6 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_CAN_YMODEM is not set
 # CONFIG_PKG_USING_LORA_RADIO_DRIVER is not set
 # CONFIG_PKG_USING_QLED is not set
-# CONFIG_PKG_USING_PAJ7620 is not set
 # CONFIG_PKG_USING_AGILE_CONSOLE is not set
 # CONFIG_PKG_USING_LD3320 is not set
 # CONFIG_PKG_USING_WK2124 is not set
@@ -695,13 +788,18 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_MISAKA_AT24CXX is not set
 # CONFIG_PKG_USING_MISAKA_RGB_BLING is not set
 # CONFIG_PKG_USING_LORA_MODEM_DRIVER is not set
-# CONFIG_PKG_USING_BL_MCU_SDK is not set
 # CONFIG_PKG_USING_SOFT_SERIAL is not set
 # CONFIG_PKG_USING_MB85RS16 is not set
-# CONFIG_PKG_USING_CW2015 is not set
 # CONFIG_PKG_USING_RFM300 is not set
 # CONFIG_PKG_USING_IO_INPUT_FILTER is not set
 # CONFIG_PKG_USING_RASPBERRYPI_PICO_SDK is not set
+# CONFIG_PKG_USING_LRF_NV7LIDAR is not set
+# CONFIG_PKG_USING_AIP650 is not set
+# CONFIG_PKG_USING_FINGERPRINT is not set
+# CONFIG_PKG_USING_BT_ECB02C is not set
+# CONFIG_PKG_USING_UAT is not set
+# CONFIG_PKG_USING_ST7789 is not set
+# CONFIG_PKG_USING_SPI_TOOLS is not set
 
 #
 # AI packages
@@ -715,6 +813,17 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_ULAPACK is not set
 # CONFIG_PKG_USING_QUEST is not set
 # CONFIG_PKG_USING_NAXOS is not set
+# CONFIG_PKG_USING_NCNN is not set
+
+#
+# Signal Processing and Control Algorithm Packages
+#
+# CONFIG_PKG_USING_FIRE_PID_CURVE is not set
+# CONFIG_PKG_USING_QPID is not set
+# CONFIG_PKG_USING_UKAL is not set
+# CONFIG_PKG_USING_DIGITALCTRL is not set
+# CONFIG_PKG_USING_KISSFFT is not set
+# CONFIG_PKG_USING_CMSIS_DSP is not set
 
 #
 # miscellaneous packages
@@ -745,6 +854,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_TETRIS is not set
 # CONFIG_PKG_USING_DONUT is not set
 # CONFIG_PKG_USING_COWSAY is not set
+# CONFIG_PKG_USING_MORSE is not set
 # CONFIG_PKG_USING_LIBCSV is not set
 # CONFIG_PKG_USING_OPTPARSE is not set
 # CONFIG_PKG_USING_FASTLZ is not set
@@ -760,14 +870,12 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_DSTR is not set
 # CONFIG_PKG_USING_TINYFRAME is not set
 # CONFIG_PKG_USING_KENDRYTE_DEMO is not set
-# CONFIG_PKG_USING_DIGITALCTRL is not set
 # CONFIG_PKG_USING_UPACKER is not set
 # CONFIG_PKG_USING_UPARAM is not set
 # CONFIG_PKG_USING_HELLO is not set
 # CONFIG_PKG_USING_VI is not set
 # CONFIG_PKG_USING_KI is not set
 # CONFIG_PKG_USING_ARMv7M_DWT is not set
-# CONFIG_PKG_USING_UKAL is not set
 # CONFIG_PKG_USING_CRCLIB is not set
 # CONFIG_PKG_USING_LWGPS is not set
 # CONFIG_PKG_USING_STATE_MACHINE is not set
@@ -778,6 +886,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_SLCAN2RTT is not set
 # CONFIG_PKG_USING_SOEM is not set
 # CONFIG_PKG_USING_QPARAM is not set
+# CONFIG_PKG_USING_CorevMCU_CLI is not set
 
 #
 # Arduino libraries
@@ -785,8 +894,9 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_RTDUINO is not set
 
 #
-# Projects
+# Projects and Demos
 #
+# CONFIG_PKG_USING_ARDUINO_MSGQ_C_CPP_DEMO is not set
 # CONFIG_PKG_USING_ARDUINO_ULTRASOUND_RADAR is not set
 # CONFIG_PKG_USING_ARDUINO_SENSOR_KIT is not set
 # CONFIG_PKG_USING_ARDUINO_MATLAB_SUPPORT is not set
@@ -794,16 +904,17 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # Sensors
 #
-# CONFIG_PKG_USING_ARDUINO_SEEED_BMP280 is not set
+# CONFIG_PKG_USING_ARDUINO_SENSOR_DEVICE_DRIVERS is not set
+# CONFIG_PKG_USING_ARDUINO_CAPACITIVESENSOR is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_ADXL375 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_VL53L0X is not set
-# CONFIG_PKG_USING_ARDUINO_SEEED_LIS3DHTR is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_VL53L1X is not set
-# CONFIG_PKG_USING_ARDUINO_SEEED_DHT is not set
-# CONFIG_PKG_USING_ARDUINO_CAPACITIVESENSOR is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_SENSOR is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_VL6180X is not set
 # CONFIG_PKG_USING_ADAFRUIT_MAX31855 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_MAX31865 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_MAX31856 is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_MAX6675 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_MLX90614 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_LSM9DS1 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_AHTX0 is not set
@@ -884,6 +995,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_HTU21DF is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_AS7341 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_HTU31D is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_SENSORLAB is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_INA260 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_TMP007_LIBRARY is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_L3GD20 is not set
@@ -895,16 +1007,57 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_VEML6070 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_VEML6075 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_VEML7700 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_LIS3DHTR is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_DHT is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_ADXL335 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_ADXL345 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_BME280 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_BMP280 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_H3LIS331DL is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_MMA7660 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_TSL2561 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_PAJ7620 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_VL53L0X is not set
+# CONFIG_PKG_USING_SEEED_ITG3200 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_SHT31 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_HP20X is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_DRV2605L is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_BBM150 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_HMC5883L is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_LSM303DLH is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_TCS3414CS is not set
+# CONFIG_PKG_USING_SEEED_MP503 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_BMP085 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_HIGHTEMP is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_VEML6070 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_SI1145 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_SHT35 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_AT42QT1070 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_LSM6DS3 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_HDC1000 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_HM3301 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_MCP9600 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_LTC2941 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_LDC1612 is not set
 
 #
 # Display
 #
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_GFX_LIBRARY is not set
 # CONFIG_PKG_USING_ARDUINO_U8G2 is not set
+# CONFIG_PKG_USING_ARDUINO_TFT_ESPI is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_ST7735 is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_SSD1306 is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_ILI9341 is not set
+# CONFIG_PKG_USING_SEEED_TM1637 is not set
 
 #
 # Timing
 #
+# CONFIG_PKG_USING_ARDUINO_RTCLIB is not set
 # CONFIG_PKG_USING_ARDUINO_MSTIMER2 is not set
+# CONFIG_PKG_USING_ARDUINO_TICKER is not set
+# CONFIG_PKG_USING_ARDUINO_TASKSCHEDULER is not set
 
 #
 # Data Processing
@@ -927,10 +1080,17 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_PCF8574 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_PCA9685 is not set
+# CONFIG_PKG_USING_ARDUINO_SEEED_PCF85063TP is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_TPA2016 is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_DRV2605 is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_DS1841 is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_DS3502 is not set
 
 #
 # Other
 #
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_MFRC630 is not set
+# CONFIG_PKG_USING_ARDUINO_ADAFRUIT_SI5351 is not set
 
 #
 # Signal IO

bsp/qemu-virt64-aarch64/drivers/board.c

@@ -24,13 +24,7 @@
 #include <mm_aspace.h>
 #include <mm_page.h>
 #include <interrupt.h>
-
+#include <setup.h>
-#ifdef RT_USING_FDT
-#include "interrupt.h"
-#include "dtb_node.h"
-#include <psci_api.h>
-#include <cpu.h>
-#endif
 
 #ifdef RT_USING_SMART
 struct mem_desc platform_mem_desc[] = {
@@ -105,16 +99,8 @@ void rt_hw_board_init(void)
     rt_hw_uart_init();
     rt_console_set_device(RT_CONSOLE_DEVICE_NAME);
 
-#ifdef RT_USING_FDT
+#ifdef RT_USING_OFW
-    // TODO 0x44000000 should be replace by a variable
+    rt_hw_common_setup();
-    void * fdt_start = (void *)0x44000000 - PV_OFFSET;
-    device_tree_setup(fdt_start);
-
-#ifdef RT_USING_SMP
-    rt_hw_cpu_init();
-#else
-    psci_init();
-#endif /* RT_USING_SMP */
 #endif
 
     rt_components_board_init();

bsp/qemu-virt64-aarch64/rtconfig.h

@@ -51,9 +51,6 @@
 #define RT_USING_MEMHEAP_AUTO_BINDING
 #define RT_USING_MEMTRACE
 #define RT_USING_HEAP
-
-/* Kernel Device Object */
-
 #define RT_USING_DEVICE
 #define RT_USING_DEVICE_OPS
 #define RT_USING_INTERRUPT_INFO
@@ -72,6 +69,7 @@
 #define ARCH_HAVE_EFFICIENT_UNALIGNED_ACCESS
 #define ARCH_CPU_64BIT
 #define RT_USING_CACHE
+#define RT_USING_CPU_FFS
 #define ARCH_MM_MMU
 #define ARCH_ARM
 #define ARCH_ARM_MMU
@@ -127,6 +125,7 @@
 
 /* Device Drivers */
 
+#define RT_USING_DM
 #define RT_USING_DEVICE_IPC
 #define RT_UNAMED_PIPE_NUMBER 64
 #define RT_USING_SYSTEM_WORKQUEUE
@@ -140,8 +139,8 @@
 #define RT_USING_NULL
 #define RT_USING_ZERO
 #define RT_USING_RANDOM
-#define RT_USING_FDT
+#define RT_USING_PM
-#define RT_USING_FDTLIB
+#define PM_TICKLESS_THRESHOLD_TIME 2
 #define RT_USING_RTC
 #define RT_USING_SOFT_RTC
 #define RT_USING_DEV_BUS
@@ -153,6 +152,8 @@
 #define RT_USING_VIRTIO_CONSOLE_PORT_MAX_NR 4
 #define RT_USING_VIRTIO_GPU
 #define RT_USING_VIRTIO_INPUT
+#define RT_USING_OFW
+#define RT_FDT_EARLYCON_MSG_SIZE 128
 #define RT_USING_KTIME
 
 /* Using USB */
@@ -203,6 +204,9 @@
 /* Memory management */
 
 
+/* Memory protection */
+
+
 /* RT-Thread Utestcases */
 
 
@@ -219,6 +223,9 @@
 /* Wiced WiFi */
 
 
+/* CYW43012 WiFi */
+
+
 /* IoT Cloud */
 
 
@@ -241,9 +248,6 @@
 /* u8g2: a monochrome graphic library */
 
 
-/* PainterEngine: A cross-platform graphics application framework written in C language */
-
-
 /* tools packages */
 
 
@@ -263,6 +267,11 @@
 
 /* peripheral libraries and drivers */
 
+/* sensors drivers */
+
+
+/* touch drivers */
+
 
 /* Kendryte SDK */
 
@@ -270,6 +279,9 @@
 /* AI packages */
 
 
+/* Signal Processing and Control Algorithm Packages */
+
+
 /* miscellaneous packages */
 
 /* project laboratory */
@@ -283,7 +295,7 @@
 /* Arduino libraries */
 
 
-/* Projects */
+/* Projects and Demos */
 
 
 /* Sensors */
@@ -308,6 +320,7 @@
 
 /* Other */
 
+
 /* Signal IO */
 
 

bsp/raspberry-pi/raspi4-64/drivers/board.c

@@ -90,10 +90,6 @@ rt_region_t init_page_region = {
  */
 void rt_hw_board_init(void)
 {
-    extern void (*system_off)(void);
-    extern void reboot(void);
-    system_off = reboot;
-
     /* io device remap */
 #ifdef RT_USING_SMART
     rt_hw_mmu_map_init(&rt_kernel_space, (void*)0xfffffffff0000000, 0x10000000, MMUTable, PV_OFFSET);

bsp/rockchip/rk3568/.config

@@ -10,7 +10,8 @@ CONFIG_RT_NAME_MAX=8
 # CONFIG_RT_USING_ARCH_DATA_TYPE is not set
 # CONFIG_RT_USING_SMART is not set
 # CONFIG_RT_USING_AMP is not set
-# CONFIG_RT_USING_SMP is not set
+CONFIG_RT_USING_SMP=y
+CONFIG_RT_CPUS_NR=4
 CONFIG_RT_ALIGN_SIZE=8
 # CONFIG_RT_THREAD_PRIORITY_8 is not set
 CONFIG_RT_THREAD_PRIORITY_32=y
@@ -23,6 +24,7 @@ CONFIG_RT_HOOK_USING_FUNC_PTR=y
 CONFIG_RT_USING_IDLE_HOOK=y
 CONFIG_RT_IDLE_HOOK_LIST_SIZE=4
 CONFIG_IDLE_THREAD_STACK_SIZE=4096
+CONFIG_SYSTEM_THREAD_STACK_SIZE=4096
 CONFIG_RT_USING_TIMER_SOFT=y
 CONFIG_RT_TIMER_THREAD_PRIO=4
 CONFIG_RT_TIMER_THREAD_STACK_SIZE=4096
@@ -37,8 +39,9 @@ CONFIG_RT_KPRINTF_USING_LONGLONG=y
 CONFIG_RT_USING_DEBUG=y
 CONFIG_RT_DEBUGING_COLOR=y
 CONFIG_RT_DEBUGING_CONTEXT=y
-# CONFIG_RT_DEBUGING_INIT is not set
+# CONFIG_RT_DEBUGING_AUTO_INIT is not set
 # CONFIG_RT_DEBUGING_PAGE_LEAK is not set
+# CONFIG_RT_DEBUGING_SPINLOCK is not set
 
 #
 # Inter-Thread communication
@@ -69,19 +72,15 @@ CONFIG_RT_USING_SMALL_MEM_AS_HEAP=y
 CONFIG_RT_USING_MEMTRACE=y
 # CONFIG_RT_USING_HEAP_ISR is not set
 CONFIG_RT_USING_HEAP=y
-
-#
-# Kernel Device Object
-#
 CONFIG_RT_USING_DEVICE=y
 CONFIG_RT_USING_DEVICE_OPS=y
-# CONFIG_RT_USING_DM is not set
 # CONFIG_RT_USING_INTERRUPT_INFO is not set
 CONFIG_RT_USING_CONSOLE=y
 CONFIG_RT_CONSOLEBUF_SIZE=128
 CONFIG_RT_CONSOLE_DEVICE_NAME="uart2"
-CONFIG_RT_VER_NUM=0x50002
+CONFIG_RT_VER_NUM=0x50100
 # CONFIG_RT_USING_STDC_ATOMIC is not set
+CONFIG_RT_BACKTRACE_LEVEL_MAX_NR=32
 
 #
 # AArch64 Architecture Configuration
@@ -143,6 +142,7 @@ CONFIG_FINSH_USING_OPTION_COMPLETION=y
 #
 # Device Drivers
 #
+CONFIG_RT_USING_DM=y
 CONFIG_RT_USING_DEVICE_IPC=y
 CONFIG_RT_UNAMED_PIPE_NUMBER=64
 # CONFIG_RT_USING_SYSTEM_WORKQUEUE is not set
@@ -165,8 +165,12 @@ CONFIG_RT_USING_PIN=y
 # CONFIG_RT_USING_PWM is not set
 # CONFIG_RT_USING_MTD_NOR is not set
 # CONFIG_RT_USING_MTD_NAND is not set
-# CONFIG_RT_USING_PM is not set
+CONFIG_RT_USING_PM=y
-# CONFIG_RT_USING_FDT is not set
+CONFIG_PM_TICKLESS_THRESHOLD_TIME=2
+# CONFIG_PM_USING_CUSTOM_CONFIG is not set
+# CONFIG_PM_ENABLE_DEBUG is not set
+# CONFIG_PM_ENABLE_SUSPEND_SLEEP_MODE is not set
+# CONFIG_PM_ENABLE_THRESHOLD_SLEEP_MODE is not set
 # CONFIG_RT_USING_RTC is not set
 # CONFIG_RT_USING_SDIO is not set
 # CONFIG_RT_USING_SPI is not set
@@ -181,6 +185,10 @@ CONFIG_RT_USING_PIN=y
 # CONFIG_RT_USING_DEV_BUS is not set
 # CONFIG_RT_USING_WIFI is not set
 # CONFIG_RT_USING_VIRTIO is not set
+CONFIG_RT_USING_OFW=y
+# CONFIG_RT_USING_BUILTIN_FDT is not set
+CONFIG_RT_FDT_EARLYCON_MSG_SIZE=128
+# CONFIG_RT_USING_PIC is not set
 # CONFIG_RT_USING_KTIME is not set
 
 #
@@ -253,6 +261,17 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_RT_USING_RT_LINK is not set
 # CONFIG_RT_USING_VBUS is not set
 
+#
+# Memory management
+#
+# CONFIG_RT_USING_MEMBLOCK is not set
+
+#
+# Memory protection
+#
+# CONFIG_RT_USING_MEM_PROTECTION is not set
+# CONFIG_RT_USING_HW_STACK_GUARD is not set
+
 #
 # RT-Thread Utestcases
 #
@@ -293,6 +312,11 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # CONFIG_PKG_USING_WLAN_WICED is not set
 # CONFIG_PKG_USING_RW007 is not set
+
+#
+# CYW43012 WiFi
+#
+# CONFIG_PKG_USING_WLAN_CYW43012 is not set
 # CONFIG_PKG_USING_COAP is not set
 # CONFIG_PKG_USING_NOPOLL is not set
 # CONFIG_PKG_USING_NETUTILS is not set
@@ -335,6 +359,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_NMEALIB is not set
 # CONFIG_PKG_USING_PDULIB is not set
 # CONFIG_PKG_USING_BTSTACK is not set
+# CONFIG_PKG_USING_BT_CYW43012 is not set
 # CONFIG_PKG_USING_LORAWAN_ED_STACK is not set
 # CONFIG_PKG_USING_WAYZ_IOTKIT is not set
 # CONFIG_PKG_USING_MAVLINK is not set
@@ -354,6 +379,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_ZFTP is not set
 # CONFIG_PKG_USING_WOL is not set
 # CONFIG_PKG_USING_ZEPHYR_POLLING is not set
+# CONFIG_PKG_USING_MATTER_ADAPTATION_LAYER is not set
 
 #
 # security packages
@@ -400,7 +426,6 @@ CONFIG_RT_USING_ADT_REF=y
 # LVGL: powerful and easy-to-use embedded GUI library
 #
 # CONFIG_PKG_USING_LVGL is not set
-# CONFIG_PKG_USING_LITTLEVGL2RTT is not set
 # CONFIG_PKG_USING_LV_MUSIC_DEMO is not set
 # CONFIG_PKG_USING_GUI_GUIDER_DEMO is not set
 
@@ -476,6 +501,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_HASH_MATCH is not set
 # CONFIG_PKG_USING_ARMV7M_DWT_TOOL is not set
 # CONFIG_PKG_USING_VOFA_PLUS is not set
+# CONFIG_PKG_USING_ZDEBUG is not set
 
 #
 # system packages
@@ -512,6 +538,8 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_UC_COMMON is not set
 # CONFIG_PKG_USING_UC_MODBUS is not set
 # CONFIG_PKG_USING_FREERTOS_WRAPPER is not set
+# CONFIG_PKG_USING_LITEOS_SDK is not set
+# CONFIG_PKG_USING_TZ_DATABASE is not set
 # CONFIG_PKG_USING_CAIRO is not set
 # CONFIG_PKG_USING_PIXMAN is not set
 # CONFIG_PKG_USING_PARTITION is not set
@@ -535,6 +563,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_QBOOT is not set
 # CONFIG_PKG_USING_PPOOL is not set
 # CONFIG_PKG_USING_OPENAMP is not set
+# CONFIG_PKG_USING_RPMSG_LITE is not set
 # CONFIG_PKG_USING_LPM is not set
 # CONFIG_PKG_USING_TLSF is not set
 # CONFIG_PKG_USING_EVENT_RECORDER is not set
@@ -548,6 +577,8 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_AGILE_UPGRADE is not set
 # CONFIG_PKG_USING_FLASH_BLOB is not set
 # CONFIG_PKG_USING_MLIBC is not set
+# CONFIG_PKG_USING_TASK_MSG_BUS is not set
+# CONFIG_PKG_USING_SFDB is not set
 
 #
 # peripheral libraries and drivers
@@ -612,6 +643,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_BALANCE is not set
 # CONFIG_PKG_USING_SHT2X is not set
 # CONFIG_PKG_USING_SHT3X is not set
+# CONFIG_PKG_USING_SHT4X is not set
 # CONFIG_PKG_USING_AD7746 is not set
 # CONFIG_PKG_USING_ADT74XX is not set
 # CONFIG_PKG_USING_MAX17048 is not set
@@ -712,6 +744,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_FINGERPRINT is not set
 # CONFIG_PKG_USING_BT_ECB02C is not set
 # CONFIG_PKG_USING_UAT is not set
+# CONFIG_PKG_USING_ST7789 is not set
 # CONFIG_PKG_USING_SPI_TOOLS is not set
 
 #
@@ -736,6 +769,7 @@ CONFIG_RT_USING_ADT_REF=y
 # CONFIG_PKG_USING_UKAL is not set
 # CONFIG_PKG_USING_DIGITALCTRL is not set
 # CONFIG_PKG_USING_KISSFFT is not set
+# CONFIG_PKG_USING_CMSIS_DSP is not set
 
 #
 # miscellaneous packages
@@ -957,6 +991,7 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_GFX_LIBRARY is not set
 # CONFIG_PKG_USING_ARDUINO_U8G2 is not set
+# CONFIG_PKG_USING_ARDUINO_TFT_ESPI is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_ST7735 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_SSD1306 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_ILI9341 is not set
@@ -965,6 +1000,7 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # Timing
 #
+# CONFIG_PKG_USING_ARDUINO_RTCLIB is not set
 # CONFIG_PKG_USING_ARDUINO_MSTIMER2 is not set
 # CONFIG_PKG_USING_ARDUINO_TICKER is not set
 # CONFIG_PKG_USING_ARDUINO_TASKSCHEDULER is not set
@@ -1001,7 +1037,6 @@ CONFIG_RT_USING_ADT_REF=y
 #
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_MFRC630 is not set
 # CONFIG_PKG_USING_ARDUINO_ADAFRUIT_SI5351 is not set
-# CONFIG_PKG_USING_ARDUINO_RTCLIB is not set
 
 #
 # Signal IO

bsp/rockchip/rk3568/driver/board.c

@@ -12,14 +12,13 @@
 #include <rtthread.h>
 
 #include <mmu.h>
-#include <psci.h>
+#include <rtdevice.h>
 #include <gicv3.h>
 #include <gtimer.h>
 #include <cpuport.h>
 #include <interrupt.h>
 #include <ioremap.h>
-#include <psci_api.h>
+#include <psci.h>
-
 #include <board.h>
 #include <drv_uart.h>
 
@@ -77,9 +76,6 @@ void rt_hw_board_init(void)
 
     rt_thread_idle_sethook(idle_wfi);
 
-    // TODO porting to FDT-driven PSCI: arm_psci_init(PSCI_METHOD_SMC, RT_NULL, RT_NULL);
-    psci_init();
-
 #if defined(RT_USING_CONSOLE) && defined(RT_USING_DEVICE)
     /* set console device */
     rt_console_set_device(RT_CONSOLE_DEVICE_NAME);
@@ -103,17 +99,11 @@ void rt_hw_board_init(void)
 
 void reboot(void)
 {
-    // TODO poring to FDT to use new PSCI: arm_psci_system_reboot();
+    psci_system_reboot();
-    if (psci_ops.system_reset)
+
-    {
+    void *cur_base = rt_ioremap((void *) CRU_BASE, 0x100);
-        psci_ops.system_reset();
+    HWREG32(cur_base + 0x00D4) = 0xfdb9;
-    }
+    HWREG32(cur_base + 0x00D8) = 0xeca8;
-    else
-    {
-        void *cur_base = rt_ioremap((void *) CRU_BASE, 0x100);
-        HWREG32(cur_base + 0x00D4) = 0xfdb9;
-        HWREG32(cur_base + 0x00D8) = 0xeca8;
-    }
 }
 MSH_CMD_EXPORT(reboot, reboot...);
 
@@ -127,21 +117,15 @@ MSH_CMD_EXPORT_ALIAS(print_cpu_id, cpuid, print_cpu_id);
 void start_cpu(int argc, char *argv[])
 {
     rt_uint32_t status;
-    if (psci_ops.cpu_on)
+    status = rt_psci_cpu_on(0x3, (rt_uint64_t) 0x7A000000);
-    {
+    rt_kprintf("arm_psci_cpu_on 0x%X\n", status);
-        status = psci_ops.cpu_on(0x3, (rt_uint64_t) 0x7A000000);
-        rt_kprintf("arm_psci_cpu_on 0x%X\n", status);
-    }
 }
 MSH_CMD_EXPORT(start_cpu, start_cpu);
 
 #ifdef RT_AMP_SLAVE
 void rt_hw_cpu_shutdown(void)
 {
-    if (psci_ops.cpu_off)
+    rt_psci_cpu_off(0);
-    {
-        psci_ops.cpu_off(0);
-    }
 }
 #endif /* RT_AMP_SLAVE */
 #endif /* RT_USING_AMP */
@@ -161,17 +145,20 @@ rt_uint64_t rt_cpu_mpidr_early[] =
 void rt_hw_secondary_cpu_up(void)
 {
     int i;
-    extern void secondary_cpu_start(void);
+    extern void _secondary_cpu_entry(void);
+    rt_uint64_t entry = (rt_uint64_t)rt_kmem_v2p(_secondary_cpu_entry);
 
     for (i = 1; i < RT_CPUS_NR; ++i)
     {
-        arm_psci_cpu_on(rt_cpu_mpidr_early[i], (rt_uint64_t) secondary_cpu_start);
+        rt_psci_cpu_on(rt_cpu_mpidr_early[i], entry);
     }
 }
 
+extern unsigned long MMUTable[];
+
 void secondary_cpu_c_start(void)
 {
-    rt_hw_mmu_init();
+    rt_hw_mmu_ktbl_set((unsigned long)MMUTable);
     rt_hw_spin_lock(&_cpus_lock);
 
     arm_gic_cpu_init(0, platform_get_gic_cpu_base());
@@ -187,6 +174,6 @@ void secondary_cpu_c_start(void)
 
 void rt_hw_secondary_cpu_idle_exec(void)
 {
-    __WFE();
+    rt_hw_wfe();
 }
 #endif

bsp/rockchip/rk3568/link.lds

@@ -13,6 +13,8 @@ OUTPUT_ARCH(aarch64)
 
 SECTIONS
 {
+    _text_offset = 0x20000000;
+
     . = 0x20000000;
     . = ALIGN(4096);
     .text :

bsp/rockchip/rk3568/rtconfig.h

@@ -7,6 +7,8 @@
 /* RT-Thread Kernel */
 
 #define RT_NAME_MAX 8
+#define RT_USING_SMP
+#define RT_CPUS_NR 4
 #define RT_ALIGN_SIZE 8
 #define RT_THREAD_PRIORITY_32
 #define RT_THREAD_PRIORITY_MAX 32
@@ -17,6 +19,7 @@
 #define RT_USING_IDLE_HOOK
 #define RT_IDLE_HOOK_LIST_SIZE 4
 #define IDLE_THREAD_STACK_SIZE 4096
+#define SYSTEM_THREAD_STACK_SIZE 4096
 #define RT_USING_TIMER_SOFT
 #define RT_TIMER_THREAD_PRIO 4
 #define RT_TIMER_THREAD_STACK_SIZE 4096
@@ -46,15 +49,13 @@
 #define RT_USING_SMALL_MEM_AS_HEAP
 #define RT_USING_MEMTRACE
 #define RT_USING_HEAP
-
-/* Kernel Device Object */
-
 #define RT_USING_DEVICE
 #define RT_USING_DEVICE_OPS
 #define RT_USING_CONSOLE
 #define RT_CONSOLEBUF_SIZE 128
 #define RT_CONSOLE_DEVICE_NAME "uart2"
-#define RT_VER_NUM 0x50002
+#define RT_VER_NUM 0x50100
+#define RT_BACKTRACE_LEVEL_MAX_NR 32
 
 /* AArch64 Architecture Configuration */
 
@@ -101,12 +102,17 @@
 
 /* Device Drivers */
 
+#define RT_USING_DM
 #define RT_USING_DEVICE_IPC
 #define RT_UNAMED_PIPE_NUMBER 64
 #define RT_USING_SERIAL
 #define RT_USING_SERIAL_V1
 #define RT_SERIAL_RB_BUFSZ 64
 #define RT_USING_PIN
+#define RT_USING_PM
+#define PM_TICKLESS_THRESHOLD_TIME 2
+#define RT_USING_OFW
+#define RT_FDT_EARLYCON_MSG_SIZE 128
 
 /* Using USB */
 
@@ -142,6 +148,12 @@
 #define RT_USING_ADT_HASHMAP
 #define RT_USING_ADT_REF
 
+/* Memory management */
+
+
+/* Memory protection */
+
+
 /* RT-Thread Utestcases */
 
 
@@ -158,6 +170,9 @@
 /* Wiced WiFi */
 
 
+/* CYW43012 WiFi */
+
+
 /* IoT Cloud */
 
 

components/drivers/ofw/base.c

@@ -8,7 +8,6 @@
  * 2022-08-25     GuEe-GUI     first version
  */
 
-#define _GNU_SOURCE
 
 #include <rtthread.h>
 

components/drivers/ofw/fdt.c

@@ -8,8 +8,6 @@
  * 2022-08-25     GuEe-GUI     first version
  */
 
-#define _GNU_SOURCE
-
 #include <rthw.h>
 #include <rtthread.h>
 

components/drivers/ofw/ofw_internal.h

@@ -12,7 +12,7 @@
 #define __OFW_INTERNAL_H__
 
 #include <rtthread.h>
-
+#include <posix/string.h>
 #include <drivers/ofw.h>
 
 #define OFW_PHANDLE_MIN     1
@@ -23,7 +23,6 @@
 
 #define OFW_ROOT_NODE_ADDR_CELLS_DEFAULT    1
 #define OFW_ROOT_NODE_SIZE_CELLS_DEFAULT    1
-
 struct fdt_info
 {
     /* Always "/", because we save "ofw" information in root node. */

components/drivers/pm/pm.c

@@ -901,12 +901,12 @@ static rt_err_t _rt_pm_device_control(rt_device_t dev,
     switch (cmd)
     {
     case RT_PM_DEVICE_CTRL_REQUEST:
-        mode = (rt_uint32_t)args;
+        mode = (rt_uint32_t)(rt_ubase_t)args;
         rt_pm_request(mode);
         break;
 
     case RT_PM_DEVICE_CTRL_RELEASE:
-        mode = (rt_uint32_t)args;
+        mode = (rt_uint32_t)(rt_ubase_t)args;
         rt_pm_release(mode);
         break;
     }

libcpu/aarch64/common/SConscript

@@ -8,6 +8,9 @@ cwd     = GetCurrentDir()
 src     = Glob('*.c') + Glob('*.cpp') + Glob('*.S')
 CPPPATH = [cwd]
 
+if GetDepend('RT_USING_OFW') == False:
+    SrcRemove(src, ['setup.c', 'cpu_psci.c', 'psci.c'])
+    
 group = DefineGroup('common', src, depend = [''], CPPPATH = CPPPATH)
 
 # build for sub-directory

libcpu/aarch64/common/cpu.c

@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2006-2019, RT-Thread Development Team
+ * Copyright (c) 2006-2023, RT-Thread Development Team
  *
  * SPDX-License-Identifier: Apache-2.0
  *
@@ -7,37 +7,33 @@
  * Date           Author       Notes
  * 2011-09-15     Bernard      first version
  * 2019-07-28     zdzn         add smp support
+ * 2023-02-21     GuEe-GUI     mov cpu ofw init to setup
  */
 
 #include <rthw.h>
 #include <rtthread.h>
-#include <board.h>
+#include <rtdevice.h>
-#include "cp15.h"
+#include <cpu.h>
 
 #define DBG_TAG "libcpu.aarch64.cpu"
 #define DBG_LVL DBG_INFO
 #include <rtdbg.h>
-#include <string.h>
-#include "cpu.h"
-#include "psci_api.h"
 
-void (*system_off)(void);
 
 #ifdef RT_USING_SMP
 
-#ifdef RT_USING_FDT
-#include "dtb_node.h"
-struct dtb_node *_cpu_node[RT_CPUS_NR];
-#endif /* RT_USING_FDT */
-
-#define MPIDR_AFF_MASK 0x000000FF00FFFFFFul
 #define REPORT_ERR(retval) LOG_E("got error code %d in %s(), %s:%d", (retval), __func__, __FILE__, __LINE__)
 #define CHECK_RETVAL(retval) if (retval) {REPORT_ERR(retval);}
+#define cpuid_to_hwid(cpuid) \
+    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? rt_cpu_mpidr_early[cpuid] : ID_ERROR)
+#define set_hwid(cpuid, hwid) \
+    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? (rt_cpu_mpidr_early[cpuid] = (hwid)) : ID_ERROR)
+#define get_cpu_node(cpuid) \
+    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? _cpu_node[cpuid] : NULL)
+#define set_cpu_node(cpuid, node) \
+    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? (_cpu_node[cpuid] = node) : NULL)
 
-/**
+typedef rt_hw_spinlock_t arch_spinlock_t;
- * cpu_ops_tbl contains cpu_ops_t for each cpu kernel observed,
- * given cpu logical id 'i', its cpu_ops_t is 'cpu_ops_tbl[i]'
- */
 struct cpu_ops_t *cpu_ops_tbl[RT_CPUS_NR];
 
 #ifdef RT_USING_SMART
@@ -59,8 +55,6 @@ rt_weak rt_uint64_t rt_cpu_mpidr_early[] =
 };
 #endif /* RT_USING_SMART */
 
-typedef rt_hw_spinlock_t arch_spinlock_t;
-
 static inline void arch_spin_lock(arch_spinlock_t *lock)
 {
     unsigned int tmp;
@@ -138,115 +132,6 @@ static int _cpus_init_data_hardcoded(int num_cpus, rt_uint64_t *cpu_hw_ids, stru
     return 0;
 }
 
-#ifdef RT_USING_FDT
-
-/** read ('size' * 4) bytes number from start, big-endian format */
-static rt_uint64_t _read_be_number(void *start, int size)
-{
-    rt_uint64_t buf = 0;
-    for (; size > 0; size--)
-    {
-        buf = (buf << 32) | fdt32_to_cpu(*(uint32_t *)start);
-        start = (uint32_t *)start + 1;
-    }
-    return buf;
-}
-
-/** check device-type of the node, */
-static bool _node_is_cpu(struct dtb_node *node)
-{
-    char *device_type = dtb_node_get_dtb_node_property_value(node, "device_type", NULL);
-    if (device_type)
-    {
-        return !strcmp(device_type, "cpu");
-    }
-    return false;
-}
-
-static int _read_and_set_hwid(struct dtb_node *cpu, int *id_pool, int *pcpuid)
-{
-    // size/address_cells is number of elements in reg array
-    int size;
-    static int address_cells, size_cells;
-    if (!address_cells && !size_cells)
-        dtb_node_get_dtb_node_cells(cpu, &address_cells, &size_cells);
-
-    void *id_start = dtb_node_get_dtb_node_property_value(cpu, "reg", &size);
-    rt_uint64_t mpid = _read_be_number(id_start, address_cells);
-
-    *pcpuid = *id_pool;
-    *id_pool = *id_pool + 1;
-    set_hwid(*pcpuid, mpid);
-
-    LOG_I("Using MPID 0x%lx as cpu %d", mpid, *pcpuid);
-
-    // setting _cpu_node for cpu_init use
-    _cpu_node[*pcpuid] = cpu;
-
-    return 0;
-}
-
-static int _read_and_set_cpuops(struct dtb_node *cpu, int cpuid)
-{
-    char *method = dtb_node_get_dtb_node_property_value(cpu, "enable-method", NULL);
-    if (!method)
-    {
-        LOG_E("Cannot read method from cpu node");
-        return -1;
-    }
-
-    struct cpu_ops_t *cpu_ops;
-    if (!strcmp(method, cpu_ops_psci.method))
-    {
-        cpu_ops = &cpu_ops_psci;
-    }
-    else if (!strcmp(method, cpu_ops_spin_tbl.method))
-    {
-        cpu_ops = &cpu_ops_spin_tbl;
-    }
-    else
-    {
-        cpu_ops = RT_NULL;
-        LOG_E("Not supported cpu_ops: %s", method);
-    }
-    cpu_ops_tbl[cpuid] = cpu_ops;
-
-    LOG_D("Using boot method [%s] for cpu %d", cpu_ops->method, cpuid);
-    return 0;
-}
-
-static int _cpus_init_data_fdt()
-{
-    // cpuid_to_hwid and cpu_ops_tbl with fdt
-    void *root = get_dtb_node_head();
-    int id_pool = 0;
-    int cpuid;
-    struct dtb_node *cpus = dtb_node_get_dtb_node_by_path(root, "/cpus");
-
-    // for each cpu node (device-type is cpu), read its mpid and set its cpuid_to_hwid
-    for_each_node_child(cpus)
-    {
-        if (!_node_is_cpu(cpus))
-        {
-            continue;
-        }
-
-        if (id_pool > RT_CPUS_NR)
-        {
-            LOG_W("Reading more cpus from FDT than RT_CPUS_NR"
-                "\n  Parsing will not continue and only %d cpus will be used.", RT_CPUS_NR);
-            break;
-        }
-
-        _read_and_set_hwid(cpus, &id_pool, &cpuid);
-
-        _read_and_set_cpuops(cpus, cpuid);
-    }
-    return 0;
-}
-
-#endif /* RT_USING_FDT */
-
 /** init cpu with hardcoded infomation or parsing from FDT */
 static int _cpus_init(int num_cpus, rt_uint64_t *cpu_hw_ids, struct cpu_ops_t *cpu_ops[])
 {
@@ -258,9 +143,6 @@ static int _cpus_init(int num_cpus, rt_uint64_t *cpu_hw_ids, struct cpu_ops_t *c
     else
     {
         retval = -1;
-#ifdef RT_USING_FDT
-        retval = _cpus_init_data_fdt();
-#endif
     }
 
     if (retval)
@@ -278,7 +160,7 @@ static int _cpus_init(int num_cpus, rt_uint64_t *cpu_hw_ids, struct cpu_ops_t *c
 
         if (cpu_ops_tbl[i] && cpu_ops_tbl[i]->cpu_init)
         {
-            retval = cpu_ops_tbl[i]->cpu_init(i);
+            retval = cpu_ops_tbl[i]->cpu_init(i, RT_NULL);
             CHECK_RETVAL(retval);
         }
         else
@@ -290,30 +172,6 @@ static int _cpus_init(int num_cpus, rt_uint64_t *cpu_hw_ids, struct cpu_ops_t *c
     return 0;
 }
 
-static void _boot_secondary(void)
-{
-    for (int i = 1; i < RT_CPUS_NR; i++)
-    {
-        int retval = -0xbad0; // mark no support operation
-        if (cpu_ops_tbl[i] && cpu_ops_tbl[i]->cpu_boot)
-            retval = cpu_ops_tbl[i]->cpu_boot(i);
-        if (retval)
-        {
-            if (retval == -0xbad0)
-                LOG_E("No cpu_ops was probed for CPU %d. Try to configure it or use fdt", i);
-            else
-                LOG_E("Failed to boot secondary CPU %d, error code %d", i, retval);
-        } else {
-            LOG_I("Secondary CPU %d booted", i);
-        }
-    }
-}
-
-rt_weak void rt_hw_secondary_cpu_up(void)
-{
-    _boot_secondary();
-}
-
 /**
  * @brief boot cpu with hardcoded data
  *
@@ -334,29 +192,6 @@ int rt_hw_cpu_boot_secondary(int num_cpus, rt_uint64_t *cpu_hw_ids, struct cpu_o
     return retval;
 }
 
-#define CPU_INIT_USING_FDT 0,0,0
-
-/**
- * @brief Initialize cpu infomation from fdt
- *
- * @return int
- */
-int rt_hw_cpu_init()
-{
-#ifdef RT_USING_FDT
-    return _cpus_init(CPU_INIT_USING_FDT);
-#else
-    LOG_E("CPU init failed since RT_USING_FDT was not defined");
-    return -0xa; /* no fdt support */
-#endif /* RT_USING_FDT */
-}
-
-rt_weak void rt_hw_secondary_cpu_idle_exec(void)
-{
-    asm volatile("wfe" ::
-                     : "memory", "cc");
-}
-
 #endif /*RT_USING_SMP*/
 
 /**
@@ -369,24 +204,6 @@ const char *rt_hw_cpu_arch(void)
     return "aarch64";
 }
 
-/** shutdown CPU */
-void rt_hw_cpu_shutdown(void)
-{
-    rt_uint32_t level;
-    rt_kprintf("shutdown...\n");
-
-    if (system_off)
-        system_off();
-    LOG_E("system shutdown failed");
-
-    level = rt_hw_interrupt_disable();
-    while (level)
-    {
-        RT_ASSERT(0);
-    }
-}
-MSH_CMD_EXPORT_ALIAS(rt_hw_cpu_shutdown, shutdown, shutdown machine);
-
 #ifdef RT_USING_CPU_FFS
 /**
  * This function finds the first bit set (beginning with the least significant bit)

libcpu/aarch64/common/cpu.h

@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2006-2019, RT-Thread Development Team
+ * Copyright (c) 2006-2023, RT-Thread Development Team
  *
  * SPDX-License-Identifier: Apache-2.0
  *
@@ -9,49 +9,25 @@
 #ifndef __RT_HW_CPU_H__
 #define __RT_HW_CPU_H__
 
-#include <rthw.h>
+#include <rtdef.h>
-#include <rtthread.h>
+#include <cpuport.h>
-#include <stdbool.h>
+#include <mm_aspace.h>
+
+#ifdef RT_USING_OFW
+#include <drivers/ofw.h>
+#endif
+
+#define ID_ERROR __INT64_MAX__
+#define MPIDR_AFFINITY_MASK         0x000000ff00ffffffUL
 
-#ifdef RT_USING_SMP
 struct cpu_ops_t
 {
     const char *method;
-    int     (*cpu_init)(rt_uint32_t id);
+    int     (*cpu_init)(rt_uint32_t id, void *param);
-    int     (*cpu_boot)(rt_uint32_t id);
+    int     (*cpu_boot)(rt_uint32_t id, rt_uint64_t entry);
     void    (*cpu_shutdown)(void);
 };
 
-/**
+extern rt_uint64_t rt_cpu_mpidr_table[];
- * Identifier to mark a wrong CPU MPID.
- * All elements in rt_cpu_mpidr_early[] should be initialized with this value
- */
-#define ID_ERROR __INT64_MAX__
 
-extern rt_uint64_t rt_cpu_mpidr_early[];
+#endif /* __RT_HW_CPU_H__ */
-extern struct dtb_node *_cpu_node[];
-
-#define cpuid_to_hwid(cpuid) \
-    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? rt_cpu_mpidr_early[cpuid] : ID_ERROR)
-#define set_hwid(cpuid, hwid) \
-    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? (rt_cpu_mpidr_early[cpuid] = (hwid)) : ID_ERROR)
-#define get_cpu_node(cpuid) \
-    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? _cpu_node[cpuid] : NULL)
-#define set_cpu_node(cpuid, node) \
-    ((((cpuid) >= 0) && ((cpuid) < RT_CPUS_NR)) ? (_cpu_node[cpuid] = node) : NULL)
-
-extern int rt_hw_cpu_init();
-
-extern int rt_hw_cpu_boot_secondary(int num_cpus, rt_uint64_t *cpu_hw_ids, struct cpu_ops_t *cpu_ops[]);
-
-extern void rt_hw_secondary_cpu_idle_exec(void);
-
-extern struct cpu_ops_t cpu_ops_psci;
-
-extern struct cpu_ops_t cpu_ops_spin_tbl;
-
-#endif /* RT_USING_SMP */
-
-extern void (*system_off)(void);
-
-#endif /* __RT_HW_CPU_H__ */

libcpu/aarch64/common/cpu_psci.c

@@ -5,66 +5,36 @@
  *
  * Change Logs:
  * Date           Author       Notes
+ * 2023-02-21     GuEe-GUI     replace with drivers/psci
  */
 #include <rthw.h>
 #include <rtthread.h>
-#include <stdint.h>
 
-#ifdef RT_USING_SMP
+#define DBG_TAG "cpu.aa64"
-
-#define DBG_TAG "libcpu.aarch64.cpu_psci"
 #define DBG_LVL DBG_INFO
 #include <rtdbg.h>
-#include "cpu_ops_common.h"
 
-#include "cpu.h"
+#include <cpu.h>
-#include "errno.h"
+#include <cpuport.h>
-#include "psci.h"
+#include <psci.h>
-#include "psci_api.h"
 
-static int (*_psci_init)(void) = psci_init;
+static int psci_cpu_boot(rt_uint32_t cpuid, rt_uint64_t entry)
-
-static int __call_method_init()
 {
-    int (*init)(void) = _psci_init;
+    return rt_psci_cpu_on(cpuid, entry);
-    _psci_init = RT_NULL;
-
-    return init();
 }
 
-/** return 0 on success, otherwise failed */
+static void psci_cpu_shutdown(void)
-#define _call_method_init() ((_psci_init) ? __call_method_init() : 0);
-
-static int cpu_psci_cpu_init(rt_uint32_t cpuid)
 {
-    // init psci only once
+    rt_uint32_t state, state_id = PSCI_POWER_STATE_ID(0, 0, 0, PSCI_POWER_STATE_ID_POWERDOWN);
-    return _call_method_init();
+
+    state = PSCI_POWER_STATE(PSCI_POWER_STATE_LEVEL_CORES, PSCI_POWER_STATE_TYPE_STANDBY, state_id);
+
+    rt_psci_cpu_off(state);
 }
 
-static int cpu_psci_cpu_boot(rt_uint32_t cpuid)
+struct cpu_ops_t cpu_psci_ops =
 {
-    rt_uint64_t secondary_entry_pa = get_secondary_entry_pa();
-
-    if (!secondary_entry_pa)
-        return -1;
-
-    if (!psci_ops.cpu_on) {
-        LOG_E("Uninitialized psci operation");
-        return -1;
-    }
-    return psci_ops.cpu_on(cpuid_to_hwid(cpuid), secondary_entry_pa);
-}
-
-static void cpu_psci_cpu_shutdown()
-{
-    psci_ops.cpu_off(cpuid_to_hwid(rt_hw_cpu_id()));
-}
-
-struct cpu_ops_t cpu_ops_psci = {
     .method = "psci",
-    .cpu_boot = cpu_psci_cpu_boot,
+    .cpu_boot = psci_cpu_boot,
-    .cpu_init = cpu_psci_cpu_init,
+    .cpu_shutdown = psci_cpu_shutdown,
-    .cpu_shutdown = cpu_psci_cpu_shutdown,
 };
-
-#endif /* RT_USING_SMP */

libcpu/aarch64/common/cpu_spin_table.c

@@ -5,76 +5,61 @@
  *
  * Change Logs:
  * Date           Author       Notes
+ * 2023-02-21     GuEe-GUI     replace with ofw
  */
 #include <rthw.h>
 #include <rtthread.h>
 
-#include "cpu.h"
+#define DBG_TAG "cpu.aa64"
-
-#ifdef RT_USING_SMART
-#include <ioremap.h>
-#else
-#define rt_ioremap(x, ...) (x)
-#define rt_iounmap(x)
-#endif
-
-#define DBG_TAG "libcpu.aarch64.cpu_spin_table"
 #define DBG_LVL DBG_INFO
 #include <rtdbg.h>
-#include "cpu_ops_common.h"
 
-#ifdef RT_USING_SMP
+#include <cpu.h>
-#ifdef RT_USING_FDT
+#include <cpuport.h>
-#include <dtb_node.h>
+
+#include <ioremap.h>
+#include <drivers/core/dm.h>
+
+#ifdef RT_USING_OFW
 
 static rt_uint64_t cpu_release_addr[RT_CPUS_NR];
 
-static int spin_table_cpu_init(rt_uint32_t cpuid)
+static int spin_table_cpu_init(rt_uint32_t cpuid, void *param)
 {
-    struct dtb_node *cpu = get_cpu_node(cpuid);
+   struct rt_ofw_node *cpu_np = param;
-    if (!cpu)
-        return -1; /* uninitialized cpu node in fdt */
 
-    int size;
+   rt_ofw_prop_read_u64(cpu_np, "cpu-release-addr", &cpu_release_addr[cpuid]);
-    rt_uint64_t *phead = (rt_uint64_t*)dtb_node_get_dtb_node_property_value(cpu, "cpu-release-addr", &size);
-    cpu_release_addr[cpuid] = fdt64_to_cpu(*phead);
 
-    LOG_D("Using release address 0x%p for CPU %d", cpu_release_addr[cpuid], cpuid);
+   LOG_D("Using release address 0x%p for CPU %d", cpu_release_addr[cpuid], cpuid);
-    return 0;
+
+   return 0;
 }
 
-static int spin_table_cpu_boot(rt_uint32_t cpuid)
+static int spin_table_cpu_boot(rt_uint32_t cpuid, rt_uint64_t entry)
 {
-    rt_uint64_t secondary_entry_pa = get_secondary_entry_pa();
+    void *cpu_release_vaddr;
-    if (!secondary_entry_pa)
-        return -1;
 
-    // map release_addr to addressable place
+    cpu_release_vaddr = rt_ioremap((void *)cpu_release_addr[cpuid], sizeof(cpu_release_addr[0]));
-    void *rel_va = (void *)cpu_release_addr[cpuid];
 
-#ifdef RT_USING_SMART
+    if (!cpu_release_vaddr)
-    rel_va = rt_ioremap(rel_va, sizeof(cpu_release_addr[0]));
-#endif
-    if (!rel_va)
     {
         LOG_E("IO remap failing");
         return -1;
     }
 
-    __asm__ volatile("str %0, [%1]" ::"rZ"(secondary_entry_pa), "r"(rel_va));
+    __asm__ volatile ("str %0, [%1]" ::"rZ"(entry), "r"(cpu_release_vaddr));
-    __asm__ volatile("dsb sy");
+    rt_hw_barrier(dsb, sy);
-    __asm__ volatile("sev");
+    rt_hw_sev();
-    rt_iounmap(rel_va);
+
+    rt_iounmap(cpu_release_vaddr);
+
     return 0;
 }
-#endif /* RT_USING_FDT */
 
-struct cpu_ops_t cpu_ops_spin_tbl = {
+struct cpu_ops_t cpu_spin_table_ops =
+{
     .method = "spin-table",
-#ifdef RT_USING_FDT
     .cpu_init = spin_table_cpu_init,
     .cpu_boot = spin_table_cpu_boot,
-#endif
 };
-
+#endif
-#endif /* RT_USING_SMP */

libcpu/aarch64/common/psci.c

@@ -5,296 +5,414 @@
  *
  * Change Logs:
  * Date           Author       Notes
+ * 2021-09-09     GuEe-GUI     The first version
+ * 2022-09-24     GuEe-GUI     Add operations and fdt init support
  */
-#include <rthw.h>
-#include <rtthread.h>
-#include <stdint.h>
-#include <stdio.h>
-#include <string.h>
-#include "cpu.h"
-#include "psci.h"
-#include "psci_api.h"
-#include "smccc.h"
 
-#define DBG_TAG "libcpu.aarch64.psci"
+#include <rtthread.h>
+
+#define DBG_TAG "osi.psci"
 #define DBG_LVL DBG_INFO
 #include <rtdbg.h>
 
-/** template for creating 4 PSCI ops: SUSPEND, OFF, ON, MIGRATE */
+/* support cpu mpidr and smccc from libcpu */
-#define COMMON_PSCI_OPS_TEMPLATE(VER, SUSPEND, OFF, ON, MIGRATE)                   \
+#include <cpu.h>
-    static int psci_##VER##_cpu_suspend(uint32_t state, unsigned long entry_point) \
+#include <smccc.h>
-    {                                                                              \
+#include <psci.h>
-        return psci_call((SUSPEND), state, entry_point, 0);                        \
+#include <drivers/ofw.h>
-    }                                                                              \
+#include <drivers/platform.h>
-    static int psci_##VER##_cpu_off(uint32_t state)                                \
+#include <drivers/core/dm.h>
-    {                                                                              \
-        return psci_call((OFF), state, 0, 0);                                      \
-    }                                                                              \
-    static int psci_##VER##_cpu_on(unsigned long cpuid, unsigned long entry_point) \
-    {                                                                              \
-        return psci_call((ON), cpuid, entry_point, 0);                             \
-    }                                                                              \
-    static int psci_##VER##_migrate(unsigned long cpuid)                           \
-    {                                                                              \
-        return psci_call((MIGRATE), cpuid, 0, 0);                                  \
-    }
 
-struct psci_ops_t psci_ops;
+struct psci_ops
+{
+    rt_uint32_t (*get_version)(void);
+    rt_uint32_t (*cpu_on)(int cpuid, rt_ubase_t entry_point);
+    rt_uint32_t (*cpu_off)(rt_uint32_t state);
+    rt_uint32_t (*cpu_suspend)(rt_uint32_t power_state, rt_ubase_t entry_point);
+    rt_uint32_t (*migrate)(int cpuid);
+    rt_uint32_t (*get_affinity_info)(rt_ubase_t target_affinity, rt_ubase_t lowest_affinity_level);
+    rt_uint32_t (*migrate_info_type)(void);
+};
 
-#ifdef RT_USING_FDT
+struct psci_0_1_func_ids
-#include "dtb_node.h"
+{
-#endif /* RT_USING_FDT */
+    rt_uint32_t cpu_on;
+    rt_uint32_t cpu_off;
+    rt_uint32_t cpu_suspend;
+    rt_uint32_t migrate;
+};
 
-#if __SIZE_WIDTH__ == 64
+typedef rt_err_t (*psci_init_ofw_handle)(struct rt_ofw_node *np);
-#define PSCI_FN_NATIVE(version, name) PSCI_##version##_FN64_##name
+typedef rt_ubase_t (*psci_call_handle)(rt_uint32_t fn, rt_ubase_t arg0, rt_ubase_t arg1, rt_ubase_t arg2);
+
+/* [40:63] and [24:31] must be zero, other is aff3 (64bit), aff2, aff1, aff0 */
+#ifdef ARCH_CPU_64BIT
+#define PSCI_FNC_ID(version_major, version_min, name)   PSCI_##version_major##_##version_min##_FN64_##name
+#define MPIDR_MASK 0xff00ffffff
 #else
-#define PSCI_FN_NATIVE(version, name) PSCI_##version##_FN_##name
+#define PSCI_FNC_ID(version_major, version_min, name)   PSCI_##version_major##_##version_min##_FN_##name
+#define MPIDR_MASK 0x00ffffff
 #endif
 
-/**
+static struct psci_ops _psci_ops = {};
- * SMCCC can use either smc or hvc method
- * smccc_call will be init to proper interface when psci_init() was executed
- */
-static void (*smccc_call)(unsigned long a0, unsigned long a1, unsigned long a2,
-                          unsigned long a3, unsigned long a4, unsigned long a5,
-                          unsigned long a6, unsigned long a7, struct arm_smccc_res_t *res,
-                          struct arm_smccc_quirk_t *quirk);
 
-static rt_uint32_t psci_call(unsigned long a0, unsigned long a1, unsigned long a2, unsigned long a3)
+static struct psci_0_1_func_ids psci_0_1_func_ids = {};
+static psci_call_handle psci_call;
+
+/* PSCI SMCCC */
+static rt_ubase_t psci_smc_call(rt_uint32_t fn, rt_ubase_t arg0, rt_ubase_t arg1, rt_ubase_t arg2)
 {
     struct arm_smccc_res_t res;
-    smccc_call(a0, a1, a2, a3, 0, 0, 0, 0, &res, (void *)0);
+
+    arm_smccc_smc(fn, arg0, arg1, arg2, 0, 0, 0, 0, &res, RT_NULL);
+
     return res.a0;
 }
 
-static int _psci_init_with_version(int major, int minor);
+static rt_ubase_t psci_hvc_call(rt_uint32_t fn, rt_ubase_t arg0, rt_ubase_t arg1, rt_ubase_t arg2)
-
-#ifdef RT_USING_FDT
-static int _psci_probe_version(char *version, int *major, int *minor);
-
-static int psci_ver_major;
-static int psci_ver_minor;
-static struct dtb_node *psci_node;
-
-/**
- * @brief init psci operations.
- * using device tree to probe version and psci-method,
- * setup psci ops for future use
- *
- * @return int 0 on success
- */
-int psci_init(void)
 {
-    void *root = get_dtb_node_head();
+    struct arm_smccc_res_t res;
-    psci_node = dtb_node_get_dtb_node_by_path(root, "/psci");
-    if (!psci_node)
-    {
-        LOG_E("No PSCI node found");
-        return -1;
-    }
-    char *compatible = dtb_node_get_dtb_node_property_value(psci_node, "compatible", NULL);
-    char *method = dtb_node_get_dtb_node_property_value(psci_node, "method", NULL);
 
-    int retval = 0;
+    arm_smccc_hvc(fn, arg0, arg1, arg2, 0, 0, 0, 0, &res, RT_NULL);
 
-    // setup psci-method
+    return res.a0;
-    if (!strcmp("hvc", method))
-    {
-        smccc_call = arm_smccc_hvc;
-    }
-    else if (!strcmp("smc", method))
-    {
-        smccc_call = arm_smccc_smc;
-    }
-    else
-    {
-        LOG_E("Unknown PSCI method: %s", method);
-        return -1;
-    }
-    LOG_D("Using psci method %s", method);
-
-    retval = _psci_probe_version(compatible, &psci_ver_major, &psci_ver_minor);
-    if (retval != 0)
-        return retval;
-
-    // init psci_ops with specified psci version
-    retval = _psci_init_with_version(psci_ver_major, psci_ver_minor);
-
-    return retval;
 }
 
-/* function id of PSCI v0.1 should be probed in FDT, they are implementation defined value */
+/* PSCI VERSION */
-static rt_uint32_t cpu_suspend_0_1;
+static rt_uint32_t psci_0_1_get_version(void)
-static rt_uint32_t cpu_off_0_1;
-static rt_uint32_t cpu_on_0_1;
-static rt_uint32_t migrate_0_1;
-
-/* basic operations TEMPLATE for API since 0.1 version */
-COMMON_PSCI_OPS_TEMPLATE(0_1, cpu_suspend_0_1, cpu_off_0_1, cpu_on_0_1, migrate_0_1);
-
-/* used for v0.1 only, rely on FDT to probe function id */
-#define PROBE_AND_SET(FUNC_NAME)                                                       \
-    do                                                                                 \
-    {                                                                                  \
-        int num_of_elem;                                                               \
-        funcid =                                                                       \
-            dtb_node_get_dtb_node_property_value(psci_node, #FUNC_NAME, &num_of_elem); \
-        if (num_of_elem != 4 || funcid == 0 || *funcid == 0)                           \
-        {                                                                              \
-            LOG_E("Failed to probe " #FUNC_NAME " in FDT");                            \
-        }                                                                              \
-        else                                                                           \
-        {                                                                              \
-            FUNC_NAME##_0_1 = (rt_uint32_t)fdt32_to_cpu(*funcid);                      \
-            psci_ops.FUNC_NAME = psci_0_1_##FUNC_NAME;                                 \
-        }                                                                              \
-    } while (0)
-
-static int psci_0_1_init()
 {
-    // reading function id from fdt
+    return PSCI_VERSION(0, 1);
-    rt_uint32_t *funcid;
-    PROBE_AND_SET(cpu_suspend);
-    PROBE_AND_SET(cpu_off);
-    PROBE_AND_SET(cpu_on);
-    PROBE_AND_SET(migrate);
-    return 0;
 }
-#else
-int psci_init(void)
-{
-    smccc_call = arm_smccc_smc;
-    _psci_init_with_version(0, 2);
-    return 0;
-}
-#endif /* RT_USING_FDT */
-
-COMMON_PSCI_OPS_TEMPLATE(0_2, PSCI_FN_NATIVE(0_2, CPU_SUSPEND), PSCI_0_2_FN_CPU_OFF, PSCI_FN_NATIVE(0_2, CPU_ON), PSCI_FN_NATIVE(0_2, MIGRATE));
 
 static rt_uint32_t psci_0_2_get_version(void)
 {
-    return psci_call(PSCI_0_2_FN_PSCI_VERSION, 0, 0, 0);
+    return (rt_uint32_t)psci_call(PSCI_0_2_FN_PSCI_VERSION, 0, 0, 0);
 }
 
-static void psci_0_2_set_basic_ops()
+/* PSCI FEATURES */
+static rt_uint32_t psci_get_features(rt_uint32_t psci_func_id)
 {
-    psci_ops = (struct psci_ops_t){
+    return (rt_uint32_t)psci_call(PSCI_1_0_FN_PSCI_FEATURES, psci_func_id, 0, 0);
-        .get_version = psci_0_2_get_version,
-
-        // followings API are v0.1 compatible
-        .cpu_suspend = psci_0_2_cpu_suspend,
-        .cpu_off = psci_0_2_cpu_off,
-        .cpu_on = psci_0_2_cpu_on,
-        .migrate = psci_0_2_migrate,
-    };
 }
 
-static void psci_0_2_system_off(void)
+/* PSCI CPU_ON */
+static rt_uint32_t psci_cpu_on(rt_uint32_t func_id, int cpuid, rt_ubase_t entry_point)
+{
+    rt_uint32_t ret = -PSCI_RET_INVALID_PARAMETERS;
+
+    if (cpuid < RT_CPUS_NR)
+    {
+        rt_ubase_t mpid = rt_cpu_mpidr_table[cpuid] & MPIDR_MASK;
+
+        ret = (rt_uint32_t)psci_call(func_id, mpid, entry_point, 0);
+    }
+
+    return ret;
+}
+
+static rt_uint32_t psci_0_1_cpu_on(int cpuid, rt_ubase_t entry_point)
+{
+    return psci_cpu_on(psci_0_1_func_ids.cpu_on, cpuid, entry_point);
+}
+
+static rt_uint32_t psci_0_2_cpu_on(int cpuid, rt_ubase_t entry_point)
+{
+    return psci_cpu_on(PSCI_FNC_ID(0, 2, CPU_ON), cpuid, entry_point);
+}
+
+/* PSCI CPU_OFF */
+static rt_uint32_t psci_cpu_off(rt_uint32_t func_id, rt_uint32_t state)
+{
+    return (rt_uint32_t)psci_call(func_id, state, 0, 0);
+}
+
+static rt_uint32_t psci_0_1_cpu_off(rt_uint32_t state)
+{
+    return psci_cpu_off(psci_0_1_func_ids.cpu_off, state);
+}
+
+static rt_uint32_t psci_0_2_cpu_off(rt_uint32_t state)
+{
+    return psci_cpu_off(PSCI_0_2_FN_CPU_OFF, state);
+}
+
+/* PSCI CPU_SUSPEND */
+static rt_uint32_t psci_cpu_suspend(rt_uint32_t func_id, rt_uint32_t power_state, rt_ubase_t entry_point)
+{
+    return (rt_uint32_t)psci_call(func_id, power_state, entry_point, 0);
+}
+
+static rt_uint32_t psci_0_1_cpu_suspend(rt_uint32_t power_state, rt_ubase_t entry_point)
+{
+    return psci_cpu_suspend(psci_0_1_func_ids.cpu_suspend, power_state, entry_point);
+}
+
+static rt_uint32_t psci_0_2_cpu_suspend(rt_uint32_t power_state, rt_ubase_t entry_point)
+{
+    return psci_cpu_suspend(PSCI_FNC_ID(0, 2, CPU_SUSPEND), power_state, entry_point);
+}
+
+/* PSCI CPU_MIGRATE */
+static rt_uint32_t psci_migrate(rt_uint32_t func_id, int cpuid)
+{
+    rt_uint32_t ret = -PSCI_RET_INVALID_PARAMETERS;
+
+    if (cpuid < RT_CPUS_NR)
+    {
+        rt_ubase_t mpid = rt_cpu_mpidr_table[cpuid] & MPIDR_MASK;
+
+        ret = (rt_uint32_t)psci_call(func_id, mpid, 0, 0);
+    }
+
+    return ret;
+}
+
+static rt_uint32_t psci_0_1_migrate(int cpuid)
+{
+    return psci_migrate(psci_0_1_func_ids.migrate, cpuid);
+}
+
+static rt_uint32_t psci_0_2_migrate(int cpuid)
+{
+    return psci_migrate(PSCI_FNC_ID(0, 2, MIGRATE), cpuid);
+}
+
+/* PSCI AFFINITY_INFO */
+static rt_uint32_t psci_affinity_info(rt_ubase_t target_affinity, rt_ubase_t lowest_affinity_level)
+{
+    return (rt_uint32_t)psci_call(PSCI_FNC_ID(0, 2, AFFINITY_INFO), target_affinity, lowest_affinity_level, 0);
+}
+
+/* PSCI MIGRATE_INFO_TYPE */
+static rt_uint32_t psci_migrate_info_type(void)
+{
+    return (rt_uint32_t)psci_call(PSCI_0_2_FN_MIGRATE_INFO_TYPE, 0, 0, 0);
+}
+
+/* PSCI SYSTEM_OFF */
+void psci_system_off(void)
 {
     psci_call(PSCI_0_2_FN_SYSTEM_OFF, 0, 0, 0);
 }
 
-static void psci_0_2_system_reset(void)
+/* PSCI SYSTEM_RESET */
+void psci_system_reboot(void)
 {
-    psci_call(PSCI_0_2_FN_SYSTEM_RESET, 0, 0, 0);
+    if (psci_get_features(PSCI_FNC_ID(1, 1, SYSTEM_RESET2)) != PSCI_RET_NOT_SUPPORTED)
-}
-
-static int psci_0_2_init()
-{
-    psci_0_2_set_basic_ops();
-
-    // TODO init other version 0.2 features...
-    // psci system off and reset which controlling machine
-    psci_ops.system_off = psci_0_2_system_off;
-    psci_ops.system_reset = psci_0_2_system_reset;
-
-    system_off = psci_0_2_system_off;
-    return 0;
-}
-
-/* PSCI v1.0 & after */
-static int psci_1_0_features(uint32_t psci_func_id)
-{
-    return psci_call(PSCI_1_0_FN_PSCI_FEATURES,
-                     psci_func_id, 0, 0);
-}
-
-static int psci_1_0_init()
-{
-    psci_0_2_init();
-
-    // TODO init other version 1.0 features...
-    // remove unsupported features
-    if (psci_1_0_features(PSCI_0_2_FN_SYSTEM_OFF) == PSCI_RET_NOT_SUPPORTED)
     {
-        psci_ops.system_off = RT_NULL;
+        /*
-        system_off = RT_NULL;
+         * reset_type[31] = 0 (architectural)
+         * reset_type[30:0] = 0 (SYSTEM_WARM_RESET)
+         * cookie = 0 (ignored by the implementation)
+         */
+        psci_call(PSCI_FNC_ID(1, 1, SYSTEM_RESET2), 0, 0, 0);
     }
     else
-        LOG_D("Using SYSTEM OFF feature");
+    {
-    if (psci_1_0_features(PSCI_0_2_FN_SYSTEM_RESET) == PSCI_RET_NOT_SUPPORTED)
+        psci_call(PSCI_0_2_FN_SYSTEM_RESET, 0, 0, 0);
-        psci_ops.system_reset = RT_NULL;
+    }
+
+}
+
+#define PSCI_CALL_FN_RET(fn, ...)       \
+({                                      \
+    rt_uint32_t rc;                     \
+    rc = PSCI_RET_NOT_SUPPORTED;        \
+    if (_psci_ops.fn)                   \
+        rc = _psci_ops.fn(__VA_ARGS__); \
+    rc;                                 \
+})
+
+#define PSCI_CALL_FN(fn, ...)       \
+({                                  \
+    if (_psci_ops.fn)               \
+        _psci_ops.fn(__VA_ARGS__);  \
+})
+
+rt_uint32_t rt_psci_get_version(void)
+{
+    return PSCI_CALL_FN_RET(get_version);
+}
+
+rt_uint32_t rt_psci_cpu_on(int cpuid, rt_ubase_t entry_point)
+{
+    return PSCI_CALL_FN_RET(cpu_on, cpuid, entry_point);
+}
+
+rt_uint32_t rt_psci_cpu_off(rt_uint32_t state)
+{
+    return PSCI_CALL_FN_RET(cpu_off, state);
+}
+
+rt_uint32_t rt_psci_cpu_suspend(rt_uint32_t power_state, rt_ubase_t entry_point)
+{
+    return PSCI_CALL_FN_RET(cpu_suspend, power_state, entry_point);
+}
+
+rt_uint32_t rt_psci_migrate(int cpuid)
+{
+    return PSCI_CALL_FN_RET(migrate, cpuid);
+}
+
+rt_uint32_t rt_psci_get_affinity_info(rt_ubase_t target_affinity, rt_ubase_t lowest_affinity_level)
+{
+    return PSCI_CALL_FN_RET(get_affinity_info, target_affinity, lowest_affinity_level);
+}
+
+rt_uint32_t rt_psci_migrate_info_type(void)
+{
+    return PSCI_CALL_FN_RET(migrate_info_type);
+}
+
+#undef PSCI_CALL_FN_RET
+#undef PSCI_CALL_FN
+
+/* PSCI INIT */
+static rt_err_t psci_0_1_init(struct rt_ofw_node *np)
+{
+    rt_err_t err = RT_EOK;
+    rt_uint32_t func_id;
+
+    _psci_ops.get_version = psci_0_1_get_version;
+
+    if (!rt_ofw_prop_read_u32(np, "cpu_on", &func_id))
+    {
+        psci_0_1_func_ids.cpu_on = func_id;
+        _psci_ops.cpu_on = psci_0_1_cpu_on;
+    }
+
+    if (!rt_ofw_prop_read_u32(np, "cpu_off", &func_id))
+    {
+        psci_0_1_func_ids.cpu_off = func_id;
+        _psci_ops.cpu_off = psci_0_1_cpu_off;
+    }
+
+    if (!rt_ofw_prop_read_u32(np, "cpu_suspend", &func_id))
+    {
+        psci_0_1_func_ids.cpu_suspend = func_id;
+        _psci_ops.cpu_suspend = psci_0_1_cpu_suspend;
+    }
+
+    if (!rt_ofw_prop_read_u32(np, "migrate", &func_id))
+    {
+        psci_0_1_func_ids.migrate = func_id;
+        _psci_ops.migrate = psci_0_1_migrate;
+    }
+
+    return err;
+}
+
+static rt_err_t psci_0_2_init(struct rt_ofw_node *np)
+{
+    rt_err_t err = RT_EOK;
+    rt_uint32_t version = psci_0_2_get_version();
+
+    if (version >= PSCI_VERSION(0, 2))
+    {
+        _psci_ops.get_version       = psci_0_2_get_version;
+        _psci_ops.cpu_on            = psci_0_2_cpu_on;
+        _psci_ops.cpu_off           = psci_0_2_cpu_off;
+        _psci_ops.cpu_suspend       = psci_0_2_cpu_suspend;
+        _psci_ops.migrate           = psci_0_2_migrate;
+        _psci_ops.get_affinity_info = psci_affinity_info;
+        _psci_ops.migrate_info_type = psci_migrate_info_type;
+    }
     else
-        LOG_D("Using SYSTEM RESET feature");
+    {
+        LOG_E("PSCI version detected");
+        err = -RT_EINVAL;
+    }
+
+    return err;
+}
+
+static rt_err_t psci_1_0_init(struct rt_ofw_node *np)
+{
+    rt_err_t err;
+
+    err = psci_0_2_init(np);
+
+    return err;
+}
+
+static rt_err_t psci_ofw_init(struct rt_platform_device *pdev)
+{
+    rt_err_t err = RT_EOK;
+    const char *method;
+    const struct rt_ofw_node_id *id = pdev->id;
+    struct rt_ofw_node *np = pdev->parent.ofw_node;
+
+    if (!rt_ofw_prop_read_string(np, "method", &method))
+    {
+        if (!rt_strcmp(method, "smc"))
+        {
+            psci_call = psci_smc_call;
+        }
+        else if (!rt_strcmp(method, "hvc"))
+        {
+            psci_call = psci_hvc_call;
+        }
+        else
+        {
+            LOG_E("Invalid \"method\" property: %s", method);
+            err = -RT_EINVAL;
+        }
+
+        if (!err)
+        {
+            psci_init_ofw_handle psci_init = (psci_init_ofw_handle)id->data;
+
+            err = psci_init(np);
+
+            if (!err)
+            {
+                rt_uint32_t version = rt_psci_get_version();
+
+                rt_ofw_data(np) = &_psci_ops;
+
+                RT_UNUSED(version);
+
+                LOG_I("Using PSCI v%d.%d Function IDs", PSCI_VERSION_MAJOR(version), PSCI_VERSION_MINOR(version));
+            }
+        }
+    }
+    else
+    {
+        err = -RT_ENOSYS;
+    }
+
+    return err;
+}
+
+static rt_err_t psci_probe(struct rt_platform_device *pdev)
+{
+    rt_err_t err;
+
+    err = psci_ofw_init(pdev);
+
+    return err;
+}
+
+static const struct rt_ofw_node_id psci_ofw_ids[] =
+{
+    { .compatible = "arm,psci",     .data = psci_0_1_init },
+    { .compatible = "arm,psci-0.2", .data = psci_0_2_init },
+    { .compatible = "arm,psci-1.0", .data = psci_1_0_init },
+    { /* sentinel */ }
+};
+
+static struct rt_platform_driver psci_driver =
+{
+    .name = "arm-psci",
+    .ids = psci_ofw_ids,
+
+    .probe = psci_probe,
+};
+
+static int psci_drv_register(void)
+{
+    rt_platform_driver_register(&psci_driver);
 
     return 0;
 }
-
+INIT_FRAMEWORK_EXPORT(psci_drv_register);
-#ifdef RT_USING_FDT
-/* probe psci version from fdt or SMC call */
-static int _psci_probe_version(char *version, int *major, int *minor)
-{
-    int retval = 0;
-    // if strcmp compatible 'arm,psci-0.1'
-    if (!strcmp(version, "arm,psci"))
-    {
-        *major = 0;
-        *minor = 1;
-    }
-    else if (!strncmp(version, "arm,psci-", 8))
-    {
-        // since psci-0.2, using psci call to probe version
-        rt_uint32_t ret = psci_0_2_get_version();
-        *major = PSCI_VERSION_MAJOR(ret);
-        *minor = PSCI_VERSION_MINOR(ret);
-    }
-    else
-    {
-        LOG_E("[%s] was not a proper PSCI version", version);
-        retval = -1;
-    }
-    LOG_D("Using PSCI v%d.%d", *major, *minor);
-    return retval;
-}
-#endif /* RT_USING_FDT */
-
-/* init psci ops with version info */
-static int _psci_init_with_version(int major, int minor)
-{
-    int retval = -0xbeef; // mark unsupported
-    if (major == 0)
-    {
-        // for v0.1, psci function id was provided fdt
-        if (minor == 1)
-        {
-#ifdef RT_USING_FDT
-            retval = psci_0_1_init();
-#endif
-        }
-        else if (minor == 2)
-        {
-            retval = psci_0_2_init();
-        }
-    }
-    else if (major == 1)
-    {
-        // psci_1_0_init is a base setup for version after v1.0
-        retval = psci_1_0_init();
-    }
-
-    if (retval == -0xbeef)
-    {
-        LOG_E("PSCI init with incompatible version %d.%d", major, minor);
-    }
-    return retval;
-}

libcpu/aarch64/common/psci.h

@@ -5,21 +5,26 @@
  *
  * Change Logs:
  * Date           Author       Notes
+ * 2021-09-09     GuEe-GUI     The first version
  */
+
 #ifndef __PSCI_H__
 #define __PSCI_H__
 
-/**
+#include <rtdef.h>
- * PSCI protocol content
+
- * For PSCI v0.1, only return values below are protocol defined
+/*
+ * Non-Confidential PSCI 1.0 release (30 January 2015), and errata fix for PSCI 0.2, unsupport PSCI 0.1
  */
 
-/* PSCI v0.2 interface */
+/* PSCI 0.2 interface */
 #define PSCI_0_2_FN_BASE                    0x84000000
 #define PSCI_0_2_FN(n)                      (PSCI_0_2_FN_BASE + (n))
-#define PSCI_0_2_64BIT                      0x40000000
+#define PSCI_0_2_FN_END                     0x8400001F
-#define PSCI_0_2_FN64_BASE                  (PSCI_0_2_FN_BASE + PSCI_0_2_64BIT)
+
+#define PSCI_0_2_FN64_BASE                  0xC4000000
 #define PSCI_0_2_FN64(n)                    (PSCI_0_2_FN64_BASE + (n))
+#define PSCI_0_2_FN64_END                   0xC400001F
 
 #define PSCI_0_2_FN_PSCI_VERSION            PSCI_0_2_FN(0)
 #define PSCI_0_2_FN_CPU_SUSPEND             PSCI_0_2_FN(1)
@@ -35,69 +40,112 @@
 #define PSCI_0_2_FN64_CPU_SUSPEND           PSCI_0_2_FN64(1)
 #define PSCI_0_2_FN64_CPU_ON                PSCI_0_2_FN64(3)
 #define PSCI_0_2_FN64_AFFINITY_INFO         PSCI_0_2_FN64(4)
-#define PSCI_0_2_FN64_MIGRATE               (5)
+#define PSCI_0_2_FN64_MIGRATE               PSCI_0_2_FN64(5)
 #define PSCI_0_2_FN64_MIGRATE_INFO_UP_CPU   PSCI_0_2_FN64(7)
 
+/* PSCI 1.0 interface */
 #define PSCI_1_0_FN_PSCI_FEATURES           PSCI_0_2_FN(10)
+#define PSCI_1_0_FN_CPU_FREEZE              PSCI_0_2_FN(11)
+#define PSCI_1_0_FN_CPU_DEFAULT_SUSPEND     PSCI_0_2_FN(12)
+#define PSCI_1_0_FN_NODE_HW_STATE           PSCI_0_2_FN(13)
 #define PSCI_1_0_FN_SYSTEM_SUSPEND          PSCI_0_2_FN(14)
 #define PSCI_1_0_FN_SET_SUSPEND_MODE        PSCI_0_2_FN(15)
+#define PSCI_1_0_FN_STAT_RESIDENCY          PSCI_0_2_FN(16)
+#define PSCI_1_0_FN_STAT_COUNT              PSCI_0_2_FN(17)
 #define PSCI_1_1_FN_SYSTEM_RESET2           PSCI_0_2_FN(18)
 
+#define PSCI_1_0_FN64_CPU_DEFAULT_SUSPEND   PSCI_0_2_FN64(12)
+#define PSCI_1_0_FN64_NODE_HW_STATE         PSCI_0_2_FN64(13)
 #define PSCI_1_0_FN64_SYSTEM_SUSPEND        PSCI_0_2_FN64(14)
+#define PSCI_1_0_FN64_STAT_RESIDENCY        PSCI_0_2_FN64(16)
+#define PSCI_1_0_FN64_STAT_COUNT            PSCI_0_2_FN64(17)
 #define PSCI_1_1_FN64_SYSTEM_RESET2         PSCI_0_2_FN64(18)
 
-/* PSCI v0.2 power state encoding for CPU_SUSPEND function */
-#define PSCI_0_2_POWER_STATE_ID_MASK        0xffff
-#define PSCI_0_2_POWER_STATE_ID_SHIFT       0
-#define PSCI_0_2_POWER_STATE_TYPE_SHIFT     16
-#define PSCI_0_2_POWER_STATE_TYPE_MASK      (0x1 << PSCI_0_2_POWER_STATE_TYPE_SHIFT)
-#define PSCI_0_2_POWER_STATE_AFFL_SHIFT     24
-#define PSCI_0_2_POWER_STATE_AFFL_MASK      (0x3 << PSCI_0_2_POWER_STATE_AFFL_SHIFT)
-
-/* PSCI extended power state encoding for CPU_SUSPEND function */
-#define PSCI_1_0_EXT_POWER_STATE_ID_MASK    0xfffffff
-#define PSCI_1_0_EXT_POWER_STATE_ID_SHIFT   0
-#define PSCI_1_0_EXT_POWER_STATE_TYPE_SHIFT 30
-#define PSCI_1_0_EXT_POWER_STATE_TYPE_MASK  (0x1 << PSCI_1_0_EXT_POWER_STATE_TYPE_SHIFT)
-
-/* PSCI v0.2 affinity level state returned by AFFINITY_INFO */
-#define PSCI_0_2_AFFINITY_LEVEL_ON          0
-#define PSCI_0_2_AFFINITY_LEVEL_OFF         1
-#define PSCI_0_2_AFFINITY_LEVEL_ON_PENDING  2
-
-/* PSCI v0.2 multicore support in Trusted OS returned by MIGRATE_INFO_TYPE */
-#define PSCI_0_2_TOS_UP_MIGRATE             0
-#define PSCI_0_2_TOS_UP_NO_MIGRATE          1
-#define PSCI_0_2_TOS_MP                     2
-
 /* PSCI version decoding (independent of PSCI version) */
 #define PSCI_VERSION_MAJOR_SHIFT            16
 #define PSCI_VERSION_MINOR_MASK             ((1U << PSCI_VERSION_MAJOR_SHIFT) - 1)
 #define PSCI_VERSION_MAJOR_MASK             ~PSCI_VERSION_MINOR_MASK
-#define PSCI_VERSION_MAJOR(ver)             (((ver) & PSCI_VERSION_MAJOR_MASK) >> PSCI_VERSION_MAJOR_SHIFT)
+#define PSCI_VERSION_MAJOR(version)         (((version) & PSCI_VERSION_MAJOR_MASK) >> PSCI_VERSION_MAJOR_SHIFT)
-#define PSCI_VERSION_MINOR(ver)             ((ver) & PSCI_VERSION_MINOR_MASK)
+#define PSCI_VERSION_MINOR(version)         ((version) & PSCI_VERSION_MINOR_MASK)
-#define PSCI_VERSION(maj, min)              \
+#define PSCI_VERSION(major, min)            ((((major) << PSCI_VERSION_MAJOR_SHIFT) & PSCI_VERSION_MAJOR_MASK) | \
-            ((((maj) << PSCI_VERSION_MAJOR_SHIFT) & PSCI_VERSION_MAJOR_MASK) | \
+                                                    ((min) & PSCI_VERSION_MINOR_MASK))
-            ((min) & PSCI_VERSION_MINOR_MASK))
 
-/* PSCI features decoding (>=1.0) */
+/* PSCI affinity level state returned by AFFINITY_INFO */
-#define PSCI_1_0_FEATURES_CPU_SUSPEND_PF_SHIFT      1
+#define PSCI_AFFINITY_LEVEL_ON              0
-#define PSCI_1_0_FEATURES_CPU_SUSPEND_PF_MASK       (0x1 << PSCI_1_0_FEATURES_CPU_SUSPEND_PF_SHIFT)
+#define PSCI_AFFINITY_LEVEL_OFF             1
+#define PSCI_AFFINITY_LEVEL_ON_PENDING      2
 
-#define PSCI_1_0_OS_INITIATED           BIT(0)
+/*
-#define PSCI_1_0_SUSPEND_MODE_PC        0
+ * PSCI power state
-#define PSCI_1_0_SUSPEND_MODE_OSI       1
+ *  power_level:
+ *      Level 0: cores
+ *      Level 1: clusters
+ *      Level 2: system
+ *  state_type:
+ *      value 0: standby or retention state
+ *      value 1: powerdown state(entry and context_id is valid)
+ *  state_id:
+ *      StateID
+ */
+#define PSCI_POWER_STATE_LEVEL_CORES        0
+#define PSCI_POWER_STATE_LEVEL_CLUSTERS     1
+#define PSCI_POWER_STATE_LEVEL_SYSTEM       2
 
-/* PSCI return values (inclusive of all PSCI versions) */
+#define PSCI_POWER_STATE_TYPE_STANDBY       0
-#define PSCI_RET_SUCCESS                0
+#define PSCI_POWER_STATE_TYPE_POWER_DOWN    1
-#define PSCI_RET_NOT_SUPPORTED          -1
-#define PSCI_RET_INVALID_PARAMS         -2
-#define PSCI_RET_DENIED                 -3
-#define PSCI_RET_ALREADY_ON             -4
-#define PSCI_RET_ON_PENDING             -5
-#define PSCI_RET_INTERNAL_FAILURE       -6
-#define PSCI_RET_NOT_PRESENT            -7
-#define PSCI_RET_DISABLED               -8
-#define PSCI_RET_INVALID_ADDRESS        -9
 
-#endif  /*__PSCI_H__*/
+#define PSCI_POWER_LEVEL_SHIFT              24
+#define PSCI_POWER_STATE_TYPE_SHIFT         16
+#define PSCI_POWER_STATE_ID_SHIFT           0
+#define PSCI_POWER_STATE(power_level, state_type, state_id) \
+( \
+    ((power_level) << PSCI_POWER_LEVEL_SHIFT) | \
+    ((state_type) << PSCI_POWER_STATE_TYPE_SHIFT)  | \
+    ((state_id) << PSCI_POWER_STATE_ID_SHIFT) \
+)
+#define PSCI_POWER_LEVEL_VAL(state)         (((state) >> PSCI_POWER_LEVEL_SHIFT) & 0x3)
+#define PSCI_POWER_STATE_TYPE_VAL(state)    (((state) >> PSCI_POWER_STATE_TYPE_SHIFT) & 0x1)
+#define PSCI_POWER_STATE_ID_VAL(state)      (((state) >> PSCI_POWER_STATE_ID_SHIFT) & 0xffff)
+
+/*
+ * For system, cluster, core
+ *  0: run
+ *  1: standby(only core)
+ *  2: retention
+ *  3: powerdown
+ */
+#define PSCI_POWER_STATE_ID_RUN         0
+#define PSCI_POWER_STATE_ID_STANDBY     1
+#define PSCI_POWER_STATE_ID_RETENTION   2
+#define PSCI_POWER_STATE_ID_POWERDOWN   3
+
+#define PSCI_POWER_STATE_ID(state_id_power_level, system, cluster, core) \
+( \
+    ((state_id_power_level) << 12) | \
+    ((system) << 8)  | \
+    ((cluster) << 4) | \
+    (core) \
+)
+
+#define PSCI_RET_SUCCESS                    0
+#define PSCI_RET_NOT_SUPPORTED              (-1)
+#define PSCI_RET_INVALID_PARAMETERS         (-2)
+#define PSCI_RET_DENIED                     (-3)
+#define PSCI_RET_ALREADY_ON                 (-4)
+#define PSCI_RET_ON_PENDING                 (-5)
+#define PSCI_RET_INTERNAL_FAILURE           (-6)
+#define PSCI_RET_NOT_PRESENT                (-7)
+#define PSCI_RET_DISABLED                   (-8)
+#define PSCI_RET_INVALID_ADDRESS            (-9)
+
+void psci_system_off(void);
+void psci_system_reboot(void);
+rt_uint32_t rt_psci_get_version(void);
+rt_uint32_t rt_psci_cpu_on(int cpuid, rt_ubase_t entry_point);
+rt_uint32_t rt_psci_cpu_off(rt_uint32_t state);
+rt_uint32_t rt_psci_cpu_suspend(rt_uint32_t power_state, rt_ubase_t entry_point);
+rt_uint32_t rt_psci_migrate(int cpuid);
+rt_uint32_t rt_psci_get_affinity_info(rt_ubase_t target_affinity, rt_ubase_t lowest_affinity_level);
+rt_uint32_t rt_psci_migrate_info_type(void);
+
+#endif  /* __PSCI_H__ */

libcpu/aarch64/common/psci_api.h

@@ -1,34 +0,0 @@
-/*
- * Copyright (c) 2006-2022, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date           Author       Notes
- */
-#ifndef __PSCI_API_H__
-#define __PSCI_API_H__
-
-#include <rthw.h>
-#include <rtthread.h>
-#include <stdint.h>
-#include "psci_api.h"
-
-/** generic psci ops supported v0.1 v0.2 v1.0 v1.1 */
-struct psci_ops_t
-{
-    uint32_t (*get_version)(void);
-    int32_t (*cpu_suspend)(uint32_t state, unsigned long entry_point);
-    int32_t (*cpu_off)(uint32_t state);
-    int32_t (*cpu_on)(unsigned long cpuid, unsigned long entry_point);
-    int32_t (*migrate)(unsigned long cpuid);
-
-    void (*system_off)(void);
-    void (*system_reset)(void);
-};
-
-extern struct psci_ops_t psci_ops;
-
-extern int psci_init(void);
-
-#endif // __PSCI_API_H__

libcpu/aarch64/common/setup.c

@@ -0,0 +1,219 @@
+/*
+ * Copyright (c) 2006-2023, RT-Thread Development Team
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2023-02-21     GuEe-GUI     first version
+ */
+
+#include <rtthread.h>
+
+#define DBG_TAG "cpu.aa64"
+#define DBG_LVL DBG_INFO
+#include <rtdbg.h>
+
+#include <cpu.h>
+#include <mmu.h>
+#include <cpuport.h>
+#include <interrupt.h>
+
+#include <stdlib.h>
+#include <ioremap.h>
+#include <drivers/ofw.h>
+#include <drivers/ofw_fdt.h>
+#include <drivers/ofw_raw.h>
+#include <drivers/core/dm.h>
+
+#define rt_sysreg_write(sysreg, val) \
+    __asm__ volatile ("msr "RT_STRINGIFY(sysreg)", %0"::"r"((rt_uint64_t)(val)))
+
+#define rt_sysreg_read(sysreg, val) \
+    __asm__ volatile ("mrs %0, "RT_STRINGIFY(sysreg)"":"=r"((val)))
+
+extern void _secondary_cpu_entry(void);
+extern size_t MMUTable[];
+extern void *system_vectors;
+
+static void *fdt_ptr = RT_NULL;
+static rt_size_t fdt_size = 0;
+
+#ifdef RT_USING_SMP
+extern struct cpu_ops_t cpu_psci_ops;
+extern struct cpu_ops_t cpu_spin_table_ops;
+#else
+extern int rt_hw_cpu_id(void);
+#endif
+
+rt_uint64_t rt_cpu_mpidr_table[] =
+{
+    [RT_CPUS_NR] = 0,
+};
+
+static struct cpu_ops_t *cpu_ops[] =
+{
+#ifdef RT_USING_SMP
+    &cpu_psci_ops,
+    &cpu_spin_table_ops,
+#endif
+};
+
+static struct rt_ofw_node *cpu_np[RT_CPUS_NR] = { };
+
+void rt_hw_fdt_install_early(void *fdt)
+{
+    void *fdt_vaddr = fdt - PV_OFFSET;
+
+    if (fdt != RT_NULL && !fdt_check_header(fdt_vaddr))
+    {
+        fdt_ptr = fdt_vaddr;
+        fdt_size = fdt_totalsize(fdt_vaddr);
+    }
+}
+
+static void system_vectors_init(void)
+{
+    rt_hw_set_current_vbar((rt_ubase_t)&system_vectors);
+}
+
+rt_inline void cpu_info_init(void)
+{
+    int i = 0;
+    rt_uint64_t mpidr;
+    struct rt_ofw_node *np;
+
+    /* get boot cpu info */
+    rt_sysreg_read(mpidr_el1, mpidr);
+
+    rt_ofw_foreach_cpu_node(np)
+    {
+        rt_uint64_t hwid = rt_ofw_get_cpu_hwid(np, 0);
+
+        if ((mpidr & MPIDR_AFFINITY_MASK) != hwid)
+        {
+            /* Only save affinity and res make smp boot can check */
+            hwid |= 1ULL << 31;
+        }
+        else
+        {
+            hwid = mpidr;
+        }
+
+        cpu_np[i] = np;
+        rt_cpu_mpidr_table[i] = hwid;
+
+        rt_ofw_data(np) = (void *)hwid;
+
+        for (int idx = 0; idx < RT_ARRAY_SIZE(cpu_ops); ++idx)
+        {
+            struct cpu_ops_t *ops = cpu_ops[idx];
+
+            if (ops->cpu_init)
+            {
+                ops->cpu_init(i, np);
+            }
+        }
+
+        if (++i >= RT_CPUS_NR)
+        {
+            break;
+        }
+    }
+
+    rt_hw_cpu_dcache_ops(RT_HW_CACHE_FLUSH, rt_cpu_mpidr_table, sizeof(rt_cpu_mpidr_table));
+}
+
+void rt_hw_common_setup(void)
+{
+    if (rt_fdt_prefetch(fdt_ptr))
+    {
+        /* Platform cannot be initialized */
+        RT_ASSERT(0);
+    }
+
+    rt_fdt_unflatten();
+
+    cpu_info_init();
+}
+
+#ifdef RT_USING_SMP
+rt_weak void rt_hw_secondary_cpu_up(void)
+{
+    int cpu_id = rt_hw_cpu_id();
+    rt_uint64_t entry = (rt_uint64_t)rt_kmem_v2p(_secondary_cpu_entry);
+
+    if (!entry)
+    {
+        LOG_E("Failed to translate '_secondary_cpu_entry' to physical address");
+        RT_ASSERT(0);
+    }
+
+    /* Maybe we are no in the first cpu */
+    for (int i = 0; i < RT_ARRAY_SIZE(cpu_np); ++i)
+    {
+        int err;
+        const char *enable_method;
+
+        if (!cpu_np[i] || i == cpu_id)
+        {
+            continue;
+        }
+
+        err = rt_ofw_prop_read_string(cpu_np[i], "enable-method", &enable_method);
+
+        for (int idx = 0; !err && idx < RT_ARRAY_SIZE(cpu_ops); ++idx)
+        {
+            struct cpu_ops_t *ops = cpu_ops[idx];
+
+            if (ops->method && !rt_strcmp(ops->method, enable_method) && ops->cpu_boot)
+            {
+                err = ops->cpu_boot(i, entry);
+
+                break;
+            }
+        }
+
+        if (err)
+        {
+            LOG_W("Call cpu %d on %s", i, "failed");
+        }
+    }
+}
+
+rt_weak void rt_hw_secondary_cpu_bsp_start(void)
+{
+    int cpu_id = rt_hw_cpu_id();
+
+    system_vectors_init();
+
+    rt_hw_spin_lock(&_cpus_lock);
+
+    /* Save all mpidr */
+    rt_sysreg_read(mpidr_el1, rt_cpu_mpidr_table[cpu_id]);
+
+    rt_hw_mmu_ktbl_set((unsigned long)MMUTable);
+
+    rt_hw_interrupt_init();
+
+    rt_dm_secondary_cpu_init();
+    rt_hw_interrupt_umask(RT_SCHEDULE_IPI);
+    rt_hw_interrupt_umask(RT_STOP_IPI);
+
+    LOG_I("Call cpu %d on %s", cpu_id, "success");
+
+#ifdef RT_USING_HWTIMER
+    if (rt_device_hwtimer_us_delay == &cpu_us_delay)
+    {
+        cpu_loops_per_tick_init();
+    }
+#endif
+
+    rt_system_scheduler_start();
+}
+
+rt_weak void rt_hw_secondary_cpu_idle_exec(void)
+{
+    rt_hw_wfe();
+}
+#endif

libcpu/aarch64/common/setup.h

@@ -0,0 +1,22 @@
+/*
+ * Copyright (c) 2006-2023, RT-Thread Development Team
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2023-02-21     GuEe-GUI     first version
+ */
+
+#ifndef __SETUP_H__
+#define __SETUP_H__
+
+#include <rtdef.h>
+#include <mm_aspace.h>
+#ifdef RT_USING_OFW
+#include <drivers/ofw_fdt.h>
+#endif
+
+void rt_hw_common_setup(void);
+
+#endif /* __SETUP_H__ */

libcpu/aarch64/cortex-a/entry_point.S

@@ -209,6 +209,11 @@ after_mmu_enable:
     adr     x1, .el_stack_top
     mov     sp, x1           /* sp_el1 set to _start */
 
+#ifdef RT_USING_OFW
+    /* Save devicetree info */
+    mov     x0, dtb_paddr
+    bl      rt_hw_fdt_install_early
+#endif
     b  rtthread_startup
 
 #ifdef RT_USING_SMP