| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * Code commons to all DaVinci SoCs. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Author: Mark A. Greer <mgreer@mvista.com> | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * 2009 (c) MontaVista Software, Inc. This file is licensed under | 
					
						
							|  |  |  |  * the terms of the GNU General Public License version 2. This program | 
					
						
							|  |  |  |  * is licensed "as is" without any warranty of any kind, whether express | 
					
						
							|  |  |  |  * or implied. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | #include <linux/module.h>
 | 
					
						
							|  |  |  | #include <linux/io.h>
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:41:27 -07:00
										 |  |  | #include <linux/etherdevice.h>
 | 
					
						
							| 
									
										
										
										
											2009-11-19 15:58:25 +05:30
										 |  |  | #include <linux/davinci_emac.h>
 | 
					
						
							| 
									
										
										
										
											2011-08-04 14:51:45 +01:00
										 |  |  | #include <linux/dma-mapping.h>
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | #include <asm/tlb.h>
 | 
					
						
							|  |  |  | #include <asm/mach/map.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <mach/common.h>
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:09 -07:00
										 |  |  | #include <mach/cputype.h>
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:23 -07:00
										 |  |  | #include "clock.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | struct davinci_soc_info davinci_soc_info; | 
					
						
							|  |  |  | EXPORT_SYMBOL(davinci_soc_info); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:40:00 -07:00
										 |  |  | void __iomem *davinci_intc_base; | 
					
						
							| 
									
										
										
										
											2009-04-15 12:41:40 -07:00
										 |  |  | int davinci_intc_type; | 
					
						
							| 
									
										
										
										
											2009-04-15 12:40:00 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:41:27 -07:00
										 |  |  | void davinci_get_mac_addr(struct memory_accessor *mem_acc, void *context) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	char *mac_addr = davinci_soc_info.emac_pdata->mac_addr; | 
					
						
							|  |  |  | 	off_t offset = (off_t)context; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Read MAC addr from EEPROM */ | 
					
						
							|  |  |  | 	if (mem_acc->read(mem_acc, mac_addr, offset, ETH_ALEN) == ETH_ALEN) | 
					
						
							|  |  |  | 		pr_info("Read MAC addr from EEPROM: %pM\n", mac_addr); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-05-07 17:06:34 -04:00
										 |  |  | static int __init davinci_init_id(struct davinci_soc_info *soc_info) | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:09 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2010-05-07 17:06:34 -04:00
										 |  |  | 	int			i; | 
					
						
							|  |  |  | 	struct davinci_id	*dip; | 
					
						
							|  |  |  | 	u8			variant; | 
					
						
							|  |  |  | 	u16			part_no; | 
					
						
							|  |  |  | 	void __iomem		*base; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	base = ioremap(soc_info->jtag_id_reg, SZ_4K); | 
					
						
							|  |  |  | 	if (!base) { | 
					
						
							|  |  |  | 		pr_err("Unable to map JTAG ID register\n"); | 
					
						
							|  |  |  | 		return -ENOMEM; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	soc_info->jtag_id = __raw_readl(base); | 
					
						
							|  |  |  | 	iounmap(base); | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:09 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-05-07 17:06:34 -04:00
										 |  |  | 	variant = (soc_info->jtag_id & 0xf0000000) >> 28; | 
					
						
							|  |  |  | 	part_no = (soc_info->jtag_id & 0x0ffff000) >> 12; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	for (i = 0, dip = soc_info->ids; i < soc_info->ids_num; | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:09 -07:00
										 |  |  | 			i++, dip++) | 
					
						
							|  |  |  | 		/* Don't care about the manufacturer right now */ | 
					
						
							| 
									
										
										
										
											2010-05-07 17:06:34 -04:00
										 |  |  | 		if ((dip->part_no == part_no) && (dip->variant == variant)) { | 
					
						
							|  |  |  | 			soc_info->cpu_id = dip->cpu_id; | 
					
						
							|  |  |  | 			pr_info("DaVinci %s variant 0x%x\n", dip->name, | 
					
						
							|  |  |  | 					dip->variant); | 
					
						
							|  |  |  | 			return 0; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pr_err("Unknown DaVinci JTAG ID 0x%x\n", soc_info->jtag_id); | 
					
						
							|  |  |  | 	return -EINVAL; | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:09 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | void __init davinci_common_init(struct davinci_soc_info *soc_info) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int ret; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!soc_info) { | 
					
						
							|  |  |  | 		ret = -EINVAL; | 
					
						
							|  |  |  | 		goto err; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	memcpy(&davinci_soc_info, soc_info, sizeof(struct davinci_soc_info)); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (davinci_soc_info.io_desc && (davinci_soc_info.io_desc_num > 0)) | 
					
						
							|  |  |  | 		iotable_init(davinci_soc_info.io_desc, | 
					
						
							|  |  |  | 				davinci_soc_info.io_desc_num); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * Normally devicemaps_init() would flush caches and tlb after | 
					
						
							|  |  |  | 	 * mdesc->map_io(), but we must also do it here because of the CPU | 
					
						
							|  |  |  | 	 * revision check below. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	local_flush_tlb_all(); | 
					
						
							|  |  |  | 	flush_cache_all(); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * We want to check CPU revision early for cpu_is_xxxx() macros. | 
					
						
							|  |  |  | 	 * IO space mapping must be initialized before we can do that. | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2010-05-07 17:06:34 -04:00
										 |  |  | 	ret = davinci_init_id(&davinci_soc_info); | 
					
						
							|  |  |  | 	if (ret < 0) | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:09 -07:00
										 |  |  | 		goto err; | 
					
						
							| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:39:23 -07:00
										 |  |  | 	if (davinci_soc_info.cpu_clks) { | 
					
						
							|  |  |  | 		ret = davinci_clk_init(davinci_soc_info.cpu_clks); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (ret != 0) | 
					
						
							|  |  |  | 			goto err; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | 	return; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | err: | 
					
						
							| 
									
										
										
										
											2009-10-01 12:41:06 +05:30
										 |  |  | 	panic("davinci_common_init: SoC Initialization failed\n"); | 
					
						
							| 
									
										
										
										
											2009-04-15 12:38:58 -07:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2012-04-26 09:45:39 +08:00
										 |  |  | 
 | 
					
						
							|  |  |  | void __init davinci_init_late(void) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	davinci_cpufreq_init(); | 
					
						
							|  |  |  | 	davinci_pm_init(); | 
					
						
							|  |  |  | 	davinci_clk_disable_unused(); | 
					
						
							|  |  |  | } |