1 // SPDX-License-Identifier: GPL-2.0 2 // Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd. 3 4 #include <linux/console.h> 5 #include <linux/memblock.h> 6 #include <linux/initrd.h> 7 #include <linux/of.h> 8 #include <linux/of_fdt.h> 9 #include <linux/start_kernel.h> 10 #include <linux/dma-contiguous.h> 11 #include <linux/screen_info.h> 12 #include <asm/sections.h> 13 #include <asm/mmu_context.h> 14 #include <asm/pgalloc.h> 15 16 #ifdef CONFIG_DUMMY_CONSOLE 17 struct screen_info screen_info = { 18 .orig_video_lines = 30, 19 .orig_video_cols = 80, 20 .orig_video_mode = 0, 21 .orig_video_ega_bx = 0, 22 .orig_video_isVGA = 1, 23 .orig_video_points = 8 24 }; 25 #endif 26 27 phys_addr_t __init_memblock memblock_end_of_REG0(void) 28 { 29 return (memblock.memory.regions[0].base + 30 memblock.memory.regions[0].size); 31 } 32 33 phys_addr_t __init_memblock memblock_start_of_REG1(void) 34 { 35 return memblock.memory.regions[1].base; 36 } 37 38 size_t __init_memblock memblock_size_of_REG1(void) 39 { 40 return memblock.memory.regions[1].size; 41 } 42 43 static void __init csky_memblock_init(void) 44 { 45 unsigned long zone_size[MAX_NR_ZONES]; 46 unsigned long zhole_size[MAX_NR_ZONES]; 47 signed long size; 48 49 memblock_reserve(__pa(_stext), _end - _stext); 50 #ifdef CONFIG_BLK_DEV_INITRD 51 memblock_reserve(__pa(initrd_start), initrd_end - initrd_start); 52 #endif 53 54 early_init_fdt_reserve_self(); 55 early_init_fdt_scan_reserved_mem(); 56 57 memblock_dump_all(); 58 59 memset(zone_size, 0, sizeof(zone_size)); 60 memset(zhole_size, 0, sizeof(zhole_size)); 61 62 min_low_pfn = PFN_UP(memblock_start_of_DRAM()); 63 max_pfn = PFN_DOWN(memblock_end_of_DRAM()); 64 65 max_low_pfn = PFN_UP(memblock_end_of_REG0()); 66 if (max_low_pfn == 0) 67 max_low_pfn = max_pfn; 68 69 size = max_pfn - min_low_pfn; 70 71 if (memblock.memory.cnt > 1) { 72 zone_size[ZONE_NORMAL] = 73 PFN_DOWN(memblock_start_of_REG1()) - min_low_pfn; 74 zhole_size[ZONE_NORMAL] = 75 PFN_DOWN(memblock_start_of_REG1()) - max_low_pfn; 76 } else { 77 if (size <= PFN_DOWN(LOWMEM_LIMIT - PHYS_OFFSET_OFFSET)) 78 zone_size[ZONE_NORMAL] = max_pfn - min_low_pfn; 79 else { 80 zone_size[ZONE_NORMAL] = 81 PFN_DOWN(LOWMEM_LIMIT - PHYS_OFFSET_OFFSET); 82 max_low_pfn = min_low_pfn + zone_size[ZONE_NORMAL]; 83 } 84 } 85 86 #ifdef CONFIG_HIGHMEM 87 size = 0; 88 if (memblock.memory.cnt > 1) { 89 size = PFN_DOWN(memblock_size_of_REG1()); 90 highstart_pfn = PFN_DOWN(memblock_start_of_REG1()); 91 } else { 92 size = max_pfn - min_low_pfn - 93 PFN_DOWN(LOWMEM_LIMIT - PHYS_OFFSET_OFFSET); 94 highstart_pfn = min_low_pfn + 95 PFN_DOWN(LOWMEM_LIMIT - PHYS_OFFSET_OFFSET); 96 } 97 98 if (size > 0) 99 zone_size[ZONE_HIGHMEM] = size; 100 101 highend_pfn = max_pfn; 102 #endif 103 memblock_set_current_limit(PFN_PHYS(max_low_pfn)); 104 105 dma_contiguous_reserve(0); 106 107 free_area_init_node(0, zone_size, min_low_pfn, zhole_size); 108 } 109 110 void __init setup_arch(char **cmdline_p) 111 { 112 *cmdline_p = boot_command_line; 113 114 console_verbose(); 115 116 pr_info("Phys. mem: %ldMB\n", 117 (unsigned long) memblock_phys_mem_size()/1024/1024); 118 119 init_mm.start_code = (unsigned long) _stext; 120 init_mm.end_code = (unsigned long) _etext; 121 init_mm.end_data = (unsigned long) _edata; 122 init_mm.brk = (unsigned long) _end; 123 124 parse_early_param(); 125 126 csky_memblock_init(); 127 128 unflatten_and_copy_device_tree(); 129 130 #ifdef CONFIG_SMP 131 setup_smp(); 132 #endif 133 134 sparse_init(); 135 136 #ifdef CONFIG_HIGHMEM 137 kmap_init(); 138 #endif 139 140 #if defined(CONFIG_VT) && defined(CONFIG_DUMMY_CONSOLE) 141 conswitchp = &dummy_con; 142 #endif 143 } 144 145 unsigned long va_pa_offset; 146 EXPORT_SYMBOL(va_pa_offset); 147 148 asmlinkage __visible void __init csky_start(unsigned int unused, 149 void *dtb_start) 150 { 151 /* Clean up bss section */ 152 memset(__bss_start, 0, __bss_stop - __bss_start); 153 154 va_pa_offset = read_mmu_msa0() & ~(SSEG_SIZE - 1); 155 156 pre_trap_init(); 157 pre_mmu_init(); 158 159 if (dtb_start == NULL) 160 early_init_dt_scan(__dtb_start); 161 else 162 early_init_dt_scan(dtb_start); 163 164 start_kernel(); 165 166 asm volatile("br .\n"); 167 } 168