forked from Mirrors/opensbi
		
	lib: reset/fdt_reset_atcwdt200: Use defined macros and function in atcsmu.h
Reuse the smu related macros and function in atcsmu.h. Signed-off-by: Yu Chien Peter Lin <peterlin@andestech.com> Reviewed-by: Anup Patel <anup@brainfault.org>
This commit is contained in:
		
				
					committed by
					
						
						Anup Patel
					
				
			
			
				
	
			
			
			
						parent
						
							787296ae92
						
					
				
				
					commit
					7aaeeab9e7
				
			@@ -11,6 +11,7 @@ if FDT_RESET
 | 
			
		||||
 | 
			
		||||
config FDT_RESET_ATCWDT200
 | 
			
		||||
	bool "Andes WDT FDT reset driver"
 | 
			
		||||
	depends on SYS_ATCSMU
 | 
			
		||||
	default n
 | 
			
		||||
 | 
			
		||||
config FDT_RESET_GPIO
 | 
			
		||||
 
 | 
			
		||||
@@ -16,6 +16,7 @@
 | 
			
		||||
#include <sbi/sbi_system.h>
 | 
			
		||||
#include <sbi_utils/fdt/fdt_helper.h>
 | 
			
		||||
#include <sbi_utils/reset/fdt_reset.h>
 | 
			
		||||
#include <sbi_utils/sys/atcsmu.h>
 | 
			
		||||
 | 
			
		||||
#define ATCWDT200_WP_NUM 0x5aa5
 | 
			
		||||
#define WREN_REG 0x18
 | 
			
		||||
@@ -41,14 +42,8 @@
 | 
			
		||||
#define CLK_PCLK (1 << 1)
 | 
			
		||||
#define WDT_EN (1 << 0)
 | 
			
		||||
 | 
			
		||||
#define FLASH_BASE 0x80000000ULL
 | 
			
		||||
#define SMU_RESET_VEC_LO_OFF 0x50
 | 
			
		||||
#define SMU_RESET_VEC_HI_OFF 0x60
 | 
			
		||||
#define SMU_HARTn_RESET_VEC_LO(n) (SMU_RESET_VEC_LO_OFF + (n * 0x4))
 | 
			
		||||
#define SMU_HARTn_RESET_VEC_HI(n) (SMU_RESET_VEC_HI_OFF + (n * 0x4))
 | 
			
		||||
 | 
			
		||||
static volatile char *wdt_addr;
 | 
			
		||||
static volatile char *smu_addr;
 | 
			
		||||
static volatile char *wdt_addr = NULL;
 | 
			
		||||
static struct smu_data smu = { 0 };
 | 
			
		||||
 | 
			
		||||
static int ae350_system_reset_check(u32 type, u32 reason)
 | 
			
		||||
{
 | 
			
		||||
@@ -66,16 +61,16 @@ static void ae350_system_reset(u32 type, u32 reason)
 | 
			
		||||
{
 | 
			
		||||
	const struct sbi_platform *plat = sbi_platform_thishart_ptr();
 | 
			
		||||
 | 
			
		||||
	for (int i = 0; i < sbi_platform_hart_count(plat); i++) {
 | 
			
		||||
		writel(FLASH_BASE, smu_addr + SMU_HARTn_RESET_VEC_LO(i));
 | 
			
		||||
		writel(FLASH_BASE >> 32, smu_addr + SMU_HARTn_RESET_VEC_HI(i));
 | 
			
		||||
	}
 | 
			
		||||
	for (int i = 0; i < sbi_platform_hart_count(plat); i++)
 | 
			
		||||
		if (smu_set_reset_vector(&smu, FLASH_BASE, i))
 | 
			
		||||
			goto fail;
 | 
			
		||||
 | 
			
		||||
	/* Program WDT control register  */
 | 
			
		||||
	writew(ATCWDT200_WP_NUM, wdt_addr + WREN_REG);
 | 
			
		||||
	writel(INT_CLK_32768 | INT_EN | RST_CLK_128 | RST_EN | WDT_EN,
 | 
			
		||||
	       wdt_addr + CTRL_REG);
 | 
			
		||||
 | 
			
		||||
fail:
 | 
			
		||||
	sbi_hart_hang();
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
@@ -104,7 +99,7 @@ static int atcwdt200_reset_init(void *fdt, int nodeoff,
 | 
			
		||||
	if (fdt_parse_compat_addr(fdt, ®_addr, "andestech,atcsmu"))
 | 
			
		||||
		return SBI_ENODEV;
 | 
			
		||||
 | 
			
		||||
	smu_addr = (volatile char *)(unsigned long)reg_addr;
 | 
			
		||||
	smu.addr = (unsigned long)reg_addr;
 | 
			
		||||
 | 
			
		||||
	sbi_system_reset_add_device(&atcwdt200_reset);
 | 
			
		||||
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user