281 lines
		
	
	
		
			7.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			281 lines
		
	
	
		
			7.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Thomas Horsten <thh@lasat.com>
 | |
|  * Copyright (C) 2000 LASAT Networks A/S.
 | |
|  *
 | |
|  *  This program is free software; you can distribute it and/or modify it
 | |
|  *  under the terms of the GNU General Public License (Version 2) as
 | |
|  *  published by the Free Software Foundation.
 | |
|  *
 | |
|  *  This program is distributed in the hope it will be useful, but WITHOUT
 | |
|  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 | |
|  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 | |
|  *  for more details.
 | |
|  *
 | |
|  *  You should have received a copy of the GNU General Public License along
 | |
|  *  with this program; if not, write to the Free Software Foundation, Inc.,
 | |
|  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
 | |
|  *
 | |
|  * Routines specific to the LASAT boards
 | |
|  */
 | |
| #include <linux/types.h>
 | |
| #include <linux/crc32.h>
 | |
| #include <asm/lasat/lasat.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/string.h>
 | |
| #include <linux/ctype.h>
 | |
| #include <linux/mutex.h>
 | |
| #include <asm/addrspace.h>
 | |
| #include "at93c.h"
 | |
| /* New model description table */
 | |
| #include "lasat_models.h"
 | |
| 
 | |
| static DEFINE_MUTEX(lasat_eeprom_mutex);
 | |
| 
 | |
| #define EEPROM_CRC(data, len) (~crc32(~0, data, len))
 | |
| 
 | |
| struct lasat_info lasat_board_info;
 | |
| 
 | |
| int EEPROMRead(unsigned int pos, unsigned char *data, int len)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < len; i++)
 | |
| 		*data++ = at93c_read(pos++);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int EEPROMWrite(unsigned int pos, unsigned char *data, int len)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < len; i++)
 | |
| 		at93c_write(pos++, *data++);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void init_flash_sizes(void)
 | |
| {
 | |
| 	unsigned long *lb = lasat_board_info.li_flashpart_base;
 | |
| 	unsigned long *ls = lasat_board_info.li_flashpart_size;
 | |
| 	int i;
 | |
| 
 | |
| 	ls[LASAT_MTD_BOOTLOADER] = 0x40000;
 | |
| 	ls[LASAT_MTD_SERVICE] = 0xC0000;
 | |
| 	ls[LASAT_MTD_NORMAL] = 0x100000;
 | |
| 
 | |
| 	if (!IS_LASAT_200()) {
 | |
| 		lasat_board_info.li_flash_base = 0x1e000000;
 | |
| 
 | |
| 		lb[LASAT_MTD_BOOTLOADER] = 0x1e400000;
 | |
| 
 | |
| 		if (lasat_board_info.li_flash_size > 0x200000) {
 | |
| 			ls[LASAT_MTD_CONFIG] = 0x100000;
 | |
| 			ls[LASAT_MTD_FS] = 0x500000;
 | |
| 		}
 | |
| 	} else {
 | |
| 		lasat_board_info.li_flash_base = 0x10000000;
 | |
| 
 | |
| 		if (lasat_board_info.li_flash_size < 0x1000000) {
 | |
| 			lb[LASAT_MTD_BOOTLOADER] = 0x10000000;
 | |
| 			ls[LASAT_MTD_CONFIG] = 0x100000;
 | |
| 			if (lasat_board_info.li_flash_size >= 0x400000)
 | |
| 				ls[LASAT_MTD_FS] =
 | |
| 				     lasat_board_info.li_flash_size - 0x300000;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	for (i = 1; i < LASAT_MTD_LAST; i++)
 | |
| 		lb[i] = lb[i-1] + ls[i-1];
 | |
| }
 | |
| 
 | |
| int lasat_init_board_info(void)
 | |
| {
 | |
| 	int c;
 | |
| 	unsigned long crc;
 | |
| 	unsigned long cfg0, cfg1;
 | |
| 	const struct product_info   *ppi;
 | |
| 	int i_n_base_models = N_BASE_MODELS;
 | |
| 	const char * const * i_txt_base_models = txt_base_models;
 | |
| 	int i_n_prids = N_PRIDS;
 | |
| 
 | |
| 	memset(&lasat_board_info, 0, sizeof(lasat_board_info));
 | |
| 
 | |
| 	/* First read the EEPROM info */
 | |
| 	EEPROMRead(0, (unsigned char *)&lasat_board_info.li_eeprom_info,
 | |
| 		   sizeof(struct lasat_eeprom_struct));
 | |
| 
 | |
| 	/* Check the CRC */
 | |
| 	crc = EEPROM_CRC((unsigned char *)(&lasat_board_info.li_eeprom_info),
 | |
| 		    sizeof(struct lasat_eeprom_struct) - 4);
 | |
| 
 | |
| 	if (crc != lasat_board_info.li_eeprom_info.crc32) {
 | |
| 		printk(KERN_WARNING "WARNING...\nWARNING...\nEEPROM CRC does "
 | |
| 		       "not match calculated, attempting to soldier on...\n");
 | |
| 	}
 | |
| 
 | |
| 	if (lasat_board_info.li_eeprom_info.version != LASAT_EEPROM_VERSION) {
 | |
| 		printk(KERN_WARNING "WARNING...\nWARNING...\nEEPROM version "
 | |
| 		       "%d, wanted version %d, attempting to soldier on...\n",
 | |
| 		       (unsigned int)lasat_board_info.li_eeprom_info.version,
 | |
| 		       LASAT_EEPROM_VERSION);
 | |
| 	}
 | |
| 
 | |
| 	cfg0 = lasat_board_info.li_eeprom_info.cfg[0];
 | |
| 	cfg1 = lasat_board_info.li_eeprom_info.cfg[1];
 | |
| 
 | |
| 	if (LASAT_W0_DSCTYPE(cfg0) != 1) {
 | |
| 		printk(KERN_WARNING "WARNING...\nWARNING...\n"
 | |
| 		       "Invalid configuration read from EEPROM, attempting to "
 | |
| 		       "soldier on...");
 | |
| 	}
 | |
| 	/* We have a valid configuration */
 | |
| 
 | |
| 	switch (LASAT_W0_SDRAMBANKSZ(cfg0)) {
 | |
| 	case 0:
 | |
| 		lasat_board_info.li_memsize = 0x0800000;
 | |
| 		break;
 | |
| 	case 1:
 | |
| 		lasat_board_info.li_memsize = 0x1000000;
 | |
| 		break;
 | |
| 	case 2:
 | |
| 		lasat_board_info.li_memsize = 0x2000000;
 | |
| 		break;
 | |
| 	case 3:
 | |
| 		lasat_board_info.li_memsize = 0x4000000;
 | |
| 		break;
 | |
| 	case 4:
 | |
| 		lasat_board_info.li_memsize = 0x8000000;
 | |
| 		break;
 | |
| 	default:
 | |
| 		lasat_board_info.li_memsize = 0;
 | |
| 	}
 | |
| 
 | |
| 	switch (LASAT_W0_SDRAMBANKS(cfg0)) {
 | |
| 	case 0:
 | |
| 		break;
 | |
| 	case 1:
 | |
| 		lasat_board_info.li_memsize *= 2;
 | |
| 		break;
 | |
| 	default:
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	switch (LASAT_W0_BUSSPEED(cfg0)) {
 | |
| 	case 0x0:
 | |
| 		lasat_board_info.li_bus_hz = 60000000;
 | |
| 		break;
 | |
| 	case 0x1:
 | |
| 		lasat_board_info.li_bus_hz = 66000000;
 | |
| 		break;
 | |
| 	case 0x2:
 | |
| 		lasat_board_info.li_bus_hz = 66666667;
 | |
| 		break;
 | |
| 	case 0x3:
 | |
| 		lasat_board_info.li_bus_hz = 80000000;
 | |
| 		break;
 | |
| 	case 0x4:
 | |
| 		lasat_board_info.li_bus_hz = 83333333;
 | |
| 		break;
 | |
| 	case 0x5:
 | |
| 		lasat_board_info.li_bus_hz = 100000000;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	switch (LASAT_W0_CPUCLK(cfg0)) {
 | |
| 	case 0x0:
 | |
| 		lasat_board_info.li_cpu_hz =
 | |
| 			lasat_board_info.li_bus_hz;
 | |
| 		break;
 | |
| 	case 0x1:
 | |
| 		lasat_board_info.li_cpu_hz =
 | |
| 			lasat_board_info.li_bus_hz +
 | |
| 			(lasat_board_info.li_bus_hz >> 1);
 | |
| 		break;
 | |
| 	case 0x2:
 | |
| 		lasat_board_info.li_cpu_hz =
 | |
| 			lasat_board_info.li_bus_hz +
 | |
| 			lasat_board_info.li_bus_hz;
 | |
| 		break;
 | |
| 	case 0x3:
 | |
| 		lasat_board_info.li_cpu_hz =
 | |
| 			lasat_board_info.li_bus_hz +
 | |
| 			lasat_board_info.li_bus_hz +
 | |
| 			(lasat_board_info.li_bus_hz >> 1);
 | |
| 		break;
 | |
| 	case 0x4:
 | |
| 		lasat_board_info.li_cpu_hz =
 | |
| 			lasat_board_info.li_bus_hz +
 | |
| 			lasat_board_info.li_bus_hz +
 | |
| 			lasat_board_info.li_bus_hz;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	/* Flash size */
 | |
| 	switch (LASAT_W1_FLASHSIZE(cfg1)) {
 | |
| 	case 0:
 | |
| 		lasat_board_info.li_flash_size = 0x200000;
 | |
| 		break;
 | |
| 	case 1:
 | |
| 		lasat_board_info.li_flash_size = 0x400000;
 | |
| 		break;
 | |
| 	case 2:
 | |
| 		lasat_board_info.li_flash_size = 0x800000;
 | |
| 		break;
 | |
| 	case 3:
 | |
| 		lasat_board_info.li_flash_size = 0x1000000;
 | |
| 		break;
 | |
| 	case 4:
 | |
| 		lasat_board_info.li_flash_size = 0x2000000;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	init_flash_sizes();
 | |
| 
 | |
| 	lasat_board_info.li_bmid = LASAT_W0_BMID(cfg0);
 | |
| 	lasat_board_info.li_prid = lasat_board_info.li_eeprom_info.prid;
 | |
| 	if (lasat_board_info.li_prid == 0xffff || lasat_board_info.li_prid == 0)
 | |
| 		lasat_board_info.li_prid = lasat_board_info.li_bmid;
 | |
| 
 | |
| 	/* Base model stuff */
 | |
| 	if (lasat_board_info.li_bmid > i_n_base_models)
 | |
| 		lasat_board_info.li_bmid = i_n_base_models;
 | |
| 	strcpy(lasat_board_info.li_bmstr,
 | |
| 	       i_txt_base_models[lasat_board_info.li_bmid]);
 | |
| 
 | |
| 	/* Product ID dependent values */
 | |
| 	c = lasat_board_info.li_prid;
 | |
| 	if (c >= i_n_prids) {
 | |
| 		strcpy(lasat_board_info.li_namestr, "Unknown Model");
 | |
| 		strcpy(lasat_board_info.li_typestr, "Unknown Type");
 | |
| 	} else {
 | |
| 		ppi = &vendor_info_table[0].vi_product_info[c];
 | |
| 		strcpy(lasat_board_info.li_namestr, ppi->pi_name);
 | |
| 		if (ppi->pi_type)
 | |
| 			strcpy(lasat_board_info.li_typestr, ppi->pi_type);
 | |
| 		else
 | |
| 			sprintf(lasat_board_info.li_typestr, "%d", 10 * c);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| void lasat_write_eeprom_info(void)
 | |
| {
 | |
| 	unsigned long crc;
 | |
| 
 | |
| 	mutex_lock(&lasat_eeprom_mutex);
 | |
| 
 | |
| 	/* Generate the CRC */
 | |
| 	crc = EEPROM_CRC((unsigned char *)(&lasat_board_info.li_eeprom_info),
 | |
| 		    sizeof(struct lasat_eeprom_struct) - 4);
 | |
| 	lasat_board_info.li_eeprom_info.crc32 = crc;
 | |
| 
 | |
| 	/* Write the EEPROM info */
 | |
| 	EEPROMWrite(0, (unsigned char *)&lasat_board_info.li_eeprom_info,
 | |
| 		    sizeof(struct lasat_eeprom_struct));
 | |
| 
 | |
| 	mutex_unlock(&lasat_eeprom_mutex);
 | |
| }
 | 
