fsl_b4860_qds

/* sysLib.c - Freescale B4860QDS board system-dependent library */ /* * Copyright (c) 2014 Wind River Systems, Inc. * * The right to copy, distribute, modify or otherwise make use * of this software may be licensed only pursuant to the terms * of an applicable Wind River license agreement. */ /* modification history -------------------- 22aug13,wyt clear the boot space translation registers in sysToMonitor. (VXW6-83348) 16jul14,wyt add DSP space entry in sysPhysMemDesc[]. (VXW6-83325) 25apr14,wyt change FMAN ucode version.(VXW6-81828) 31mar14,wyt add DDR1 space entry in sysPhysMemDesc[]. 14jan14,wyt adapted from fsl_t4240_qds, version 02m. */ /* DESCRIPTION This library provides board-specific routines for b4860qds. INCLUDE FILES: sysLib.h SEE ALSO: \tb VxWorks Programmer's Guide: Configuration */ /* includes */ #include <vxWorks.h> #include <vsbConfig.h> #include <vme.h> #include <memLib.h> #include <cacheLib.h> #include <sysLib.h> #include "config.h" #include <string.h> #include <intLib.h> #include <logLib.h> #include <stdio.h> #include <taskLib.h> #include <vxLib.h> #include <tyLib.h> #include <arch/ppc/mmuE500Lib.h> #include <arch/ppc/vxPpcLib.h> #include <private/vmLibP.h> #include <miiLib.h> #include <cpuset.h> #ifdef INCLUDE_B4860_FMAN_UCODE # include <hwif/vxbus/hwConf.h> # include <h/vxbus/vxbAccess.h> #endif /* INCLUDE_B4860_FMAN_UCODE */ #ifdef INCLUDE_ALTIVEC # include <altivecLib.h> IMPORT STATUS (* _func_altivecProbeRtn) (void) ; #endif /* INCLUDE_ALTIVEC */ #ifdef DRV_I2C_VSC3316 #include <h/util/vxbVsc3316.h> #endif /* globals */ /* protect all TLB1 entries if in a Linux-VxWorks system. */ #define PROTECTED 0 #ifdef WRLOAD_IMAGE_BUILD_PHYS_BIAS # define PHYS_BIAS_HI_LO WRLOAD_IMAGE_BUILD_PHYS_BIAS # define PHYS_BIAS_LO (UINT32)(WRLOAD_IMAGE_BUILD_PHYS_BIAS) # define PHYS_BIAS_HI (UINT32)((UINT64)WRLOAD_IMAGE_BUILD_PHYS_BIAS >> 32) #else # define PHYS_BIAS_HI_LO 0 # define PHYS_BIAS_LO 0 # define PHYS_BIAS_HI 0 #endif /* WRLOAD_IMAGE_BUILD_PHYS_BIAS */ #ifdef INCLUDE_WRLOAD_IMAGE_BUILD /* * WARNING: The loaded image base address (LOCAL_MEM_LOCAL_ADRS + * WRLOAD_IMAGE_BUILD_PHYS_BIAS) must be modulo RAM_TLB_SZ size. */ #define RAM_TLB_SZ ( (LOCAL_MEM_SIZE <= 0x04000000) ? _MMU_TLB_SZ_64M \ : (LOCAL_MEM_SIZE <= 0x08000000) ? _MMU_TLB_SZ_128M \ : (LOCAL_MEM_SIZE <= 0x10000000) ? _MMU_TLB_SZ_256M \ : (LOCAL_MEM_SIZE <= 0x20000000) ? _MMU_TLB_SZ_512M \ : (LOCAL_MEM_SIZE <= 0x40000000) ? _MMU_TLB_SZ_1G : -1) #if (LOCAL_MEM_SIZE > 0x80000000) #error Additional TLB entries will need to be added to sysStaticTlbDesc[]. #endif #if ((LOCAL_MEM_LOCAL_ADRS + LOCAL_MEM_SIZE + (PHYS_BIAS_HI_LO & 0xffffffff)) \ > PHYS_MEM_SIZE) #error Your image footprint exceeds available memory. #endif #else #define RAM_TLB_SZ _MMU_TLB_SZ_1G #endif /* INCLUDE_WRLOAD_IMAGE_BUILD */ TLB_ENTRY_DESC sysStaticTlbDesc [] = { /* effAddr, Unused, realAddr, ts | size | attributes | permissions */ /* TLB #0. Flash */ /* needed be first entry here */ { FLASH_BASE_ADRS, 0x0, FLASH_BASE_ADRS, _MMU_TLB_TS_0 | _MMU_TLB_SZ_16M | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_I | _MMU_TLB_ATTR_G | _MMU_TLB_PERM_X }, /* * The RAM execution area must be the 2nd entry because romInit uses the 2nd * TLB for this area. When this TLB is written it replaces the romInit one. * You can't overlap TLBs. You must have a TLB to use an area. */ #ifdef INCLUDE_WRLOAD_IMAGE_BUILD { LOCAL_MEM_LOCAL_ADRS, PHYS_BIAS_HI, LOCAL_MEM_LOCAL_ADRS + PHYS_BIAS_LO, _MMU_TLB_TS_0 | RAM_TLB_SZ | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | CAM_DRAM_CACHE_MODE | _MMU_TLB_ATTR_M | _MMU_TLB_PERM_X }, #else { LOCAL_MEM_LOCAL_ADRS, _LOCAL_MEM_ERPN, LOCAL_MEM_LOCAL_ADRS, _MMU_TLB_TS_0 | RAM_TLB_SZ | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | CAM_DRAM_CACHE_MODE | _MMU_TLB_ATTR_M | _MMU_TLB_PERM_X }, #endif /* INCLUDE_WRLOAD_IMAGE_BUILD */ { CCSBAR, 0x0, CCSBAR, _MMU_TLB_TS_0 | _MMU_TLB_SZ_16M | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_I | _MMU_TLB_ATTR_G }, #if (LOCAL_MEM_SIZE > 0x40000000) { LOCAL_MEM_LOCAL_ADRS + 0x40000000, _LOCAL_MEM_ERPN, LOCAL_MEM_LOCAL_ADRS + 0x40000000, _MMU_TLB_TS_0 | _MMU_TLB_SZ_1G | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_M | _MMU_TLB_PERM_X }, #endif /* (LOCAL_MEM_SIZE > 0x40000000) */ #ifdef INCLUDE_VIRTUAL_SM { VIRTUAL_SM_BASE, 0, VIRTUAL_SM_BASE_PHYS, _MMU_TLB_TS_0 | _MMU_TLB_SZ_16M | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_M| _MMU_TLB_PERM_X }, #endif /* INCLUDE_VIRTUAL_SM */ { QIXIS_BASE, 0x0, QIXIS_BASE, _MMU_TLB_TS_0 | _MMU_TLB_SZ_4K | _MMU_TLB_ATTR_I | _MMU_TLB_ATTR_G | _MMU_TLB_PERM_W | _MMU_TLB_IPROT }, { CCSBAR, 0x0, CCSBAR, _MMU_TLB_TS_1 | _MMU_TLB_SZ_16M | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_I | _MMU_TLB_ATTR_G } /* All these are not protected */ #ifdef DRV_RESOURCE_QORIQBMAN , { BMAN_LAW_BASE, 0x0, BMAN_LAW_BASE, _MMU_TLB_TS_0 | _MMU_TLB_SZ_16M | PROTECTED | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_M }, { (BMAN_LAW_BASE + 0x01000000), 0x0, (BMAN_LAW_BASE + 0x01000000), _MMU_TLB_TS_0 | _MMU_TLB_SZ_16M | PROTECTED | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_I | _MMU_TLB_ATTR_G } #endif /* DRV_RESOURCE_QORIQBMAN */ #ifdef DRV_RESOURCE_QORIQQMAN , { QMAN_LAW_BASE, 0x0, QMAN_LAW_BASE, _MMU_TLB_TS_0 | _MMU_TLB_SZ_16M | PROTECTED | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_M }, { (QMAN_LAW_BASE + 0x01000000), 0x0, (QMAN_LAW_BASE + 0x01000000), _MMU_TLB_TS_0 | _MMU_TLB_SZ_16M | PROTECTED | _MMU_TLB_PERM_W | _MMU_TLB_ATTR_I | _MMU_TLB_ATTR_G } #endif /* DRV_RESOURCE_QORIQQMAN */ , { DCSR_LAW_BASE, 0x0, DCSR_LAW_BASE, _MMU_TLB_TS_0 | _MMU_TLB_SZ_4M | _MMU_TLB_ATTR_I | _MMU_TLB_ATTR_G | _MMU_TLB_PERM_W } #if (defined (_WRS_CONFIG_SMP) || defined (INCLUDE_AMP)) && \ (LOCAL_MEM_ERPN || \ ((RAM_TLB_SZ == _MMU_TLB_SZ_64M) && \ (CPUn_SPACE_START_ADDR < \ (LOCAL_MEM_LOCAL_ADRS & 0xFC000000))) || \ ((RAM_TLB_SZ == _MMU_TLB_SZ_128M) && \ (CPUn_SPACE_START_ADDR < \ (LOCAL_MEM_LOCAL_ADRS & 0xF8000000))) || \ ((RAM_TLB_SZ == _MMU_TLB_SZ_256M) && \ (CPUn_SPACE_START_ADDR < \ (LOCAL_MEM_LOCAL_ADRS & 0xF0000000))) || \ ((RAM_TLB_SZ == _MMU_TLB_SZ_512M) && \ (CPUn_SPACE_START_ADDR < \ (LOCAL_MEM_LOCAL_ADRS & 0xE0000000))) || \ ((RAM_TLB_SZ == _MMU_TLB_SZ_1G) && \ (CPUn_SPACE_START_ADDR < (LOCAL_MEM_LOCAL_ADRS & 0xC0000000)))) /* For CPUn_SPACE to allow ISR call to sysToMonitor(): */ , { ROUND_DOWN (CPUn_SPACE_START_ADDR, 0x10000), 0, ROUND_DOWN (CPUn_SPACE_START_ADDR, 0x10000), _MMU_TLB_TS_0 | _MMU_TLB_SZ_64K | _MMU_TLB_IPROT | _MMU_TLB_PERM_W | _MMU_TLB_PERM_X | CAM_DRAM_CACHE_MODE | _MMU_TLB_ATTR_M } #endif /* (_WRS_CONFIG_SMP || INCLUDE_AMP) && ...*/ }; /* * Warning, if sysStaticTlbDesc uses too many entries, mmuOptimize() may * fail to add a static entry for the sysPhysMemDesc table. */ int sysStaticTlbDescNumEnt = NELEMENTS (sysStaticTlbDesc); /* macro to compose 64-bit PHYS_ADDRs */ #define PHYS_64BIT_ADDR(h, l) (((PHYS_ADDR)(h) << 32) + (l)) /* * sysPhysMemDesc[] is used to initialize the Page Table Entry (PTE) array * used by the MMU to translate addresses with