1/* 2 * Copyright (C) ST-Ericsson SA 2010 3 * 4 * Author: Rabin Vincent <rabin.vincent@stericsson.com> for ST-Ericsson 5 * License terms: GNU General Public License (GPL) version 2 6 */ 7 8#include <linux/kernel.h> 9#include <linux/init.h> 10#include <linux/io.h> 11 12#include <asm/cputype.h> 13#include <asm/tlbflush.h> 14#include <asm/cacheflush.h> 15#include <asm/mach/map.h> 16 17#include <mach/hardware.h> 18#include <mach/setup.h> 19 20struct dbx500_asic_id dbx500_id; 21 22static unsigned int ux500_read_asicid(phys_addr_t addr) 23{ 24 phys_addr_t base = addr & ~0xfff; 25 struct map_desc desc = { 26 .virtual = IO_ADDRESS(base), 27 .pfn = __phys_to_pfn(base), 28 .length = SZ_16K, 29 .type = MT_DEVICE, 30 }; 31 32 iotable_init(&desc, 1); 33 34 /* As in devicemaps_init() */ 35 local_flush_tlb_all(); 36 flush_cache_all(); 37 38 return readl(__io_address(addr)); 39} 40 41static void ux500_print_soc_info(unsigned int asicid) 42{ 43 unsigned int rev = dbx500_revision(); 44 45 pr_info("DB%4x ", dbx500_partnumber()); 46 47 if (rev == 0x01) 48 pr_cont("Early Drop"); 49 else if (rev >= 0xA0) 50 pr_cont("v%d.%d" , (rev >> 4) - 0xA + 1, rev & 0xf); 51 else 52 pr_cont("Unknown"); 53 54 pr_cont(" [%#010x]\n", asicid); 55} 56 57static unsigned int partnumber(unsigned int asicid) 58{ 59 return (asicid >> 8) & 0xffff; 60} 61 62/* 63 * SOC MIDR ASICID ADDRESS ASICID VALUE 64 * DB8500ed 0x410fc090 0x9001FFF4 0x00850001 65 * DB8500v1 0x411fc091 0x9001FFF4 0x008500A0 66 * DB8500v1.1 0x411fc091 0x9001FFF4 0x008500A1 67 * DB8500v2 0x412fc091 0x9001DBF4 0x008500B0 68 * DB8520v2.2 0x412fc091 0x9001DBF4 0x008500B2 69 * DB5500v1 0x412fc091 0x9001FFF4 0x005500A0 70 */ 71 72void __init ux500_map_io(void) 73{ 74 unsigned int cpuid = read_cpuid_id(); 75 unsigned int asicid = 0; 76 phys_addr_t addr = 0; 77 78 switch (cpuid) { 79 case 0x410fc090: /* DB8500ed */ 80 case 0x411fc091: /* DB8500v1 */ 81 addr = 0x9001FFF4; 82 break; 83 84 case 0x412fc091: /* DB8520 / DB8500v2 / DB5500v1 */ 85 asicid = ux500_read_asicid(0x9001DBF4); 86 if (partnumber(asicid) == 0x8500 || 87 partnumber(asicid) == 0x8520) 88 /* DB8500v2 */ 89 break; 90 91 /* DB5500v1 */ 92 addr = 0x9001FFF4; 93 break; 94 } 95 96 if (addr) 97 asicid = ux500_read_asicid(addr); 98 99 if (!asicid) { 100 pr_err("Unable to identify SoC\n"); 101 ux500_unknown_soc(); 102 } 103 104 dbx500_id.process = asicid >> 24; 105 dbx500_id.partnumber = partnumber(asicid); 106 dbx500_id.revision = asicid & 0xff; 107 108 ux500_print_soc_info(asicid); 109} 110