forked from luck/tmp_suning_uos_patched
3c7d9c81e1
There seems to be some problem with at-least the S3C2440 and bus traffic during an reset. It is unlikely, but still possible that the system will hang in such a way that the watchdog cannot get the system out of the state it is in. Change to making the code that calls the watchdog reset run from cached memory so that instruction fetches have quiesced before the watchdog fires. Signed-off-by: Ben Dooks <ben-linux@fluff.org> Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
358 lines
8.4 KiB
C
358 lines
8.4 KiB
C
/* linux/arch/arm/plat-s3c24xx/cpu.c
|
|
*
|
|
* Copyright (c) 2004-2005 Simtec Electronics
|
|
* http://www.simtec.co.uk/products/SWLINUX/
|
|
* Ben Dooks <ben@simtec.co.uk>
|
|
*
|
|
* S3C24XX CPU Support
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that 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
|
|
*/
|
|
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/serial_core.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include <asm/hardware.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/io.h>
|
|
#include <asm/delay.h>
|
|
#include <asm/cacheflush.h>
|
|
|
|
#include <asm/mach/arch.h>
|
|
#include <asm/mach/map.h>
|
|
|
|
#include <asm/arch/system-reset.h>
|
|
|
|
#include <asm/arch/regs-gpio.h>
|
|
#include <asm/plat-s3c/regs-serial.h>
|
|
|
|
#include <asm/plat-s3c24xx/cpu.h>
|
|
#include <asm/plat-s3c24xx/devs.h>
|
|
#include <asm/plat-s3c24xx/clock.h>
|
|
#include <asm/plat-s3c24xx/s3c2400.h>
|
|
#include <asm/plat-s3c24xx/s3c2410.h>
|
|
#include <asm/plat-s3c24xx/s3c2412.h>
|
|
#include "s3c244x.h"
|
|
#include <asm/plat-s3c24xx/s3c2440.h>
|
|
#include <asm/plat-s3c24xx/s3c2442.h>
|
|
#include <asm/plat-s3c24xx/s3c2443.h>
|
|
|
|
struct cpu_table {
|
|
unsigned long idcode;
|
|
unsigned long idmask;
|
|
void (*map_io)(struct map_desc *mach_desc, int size);
|
|
void (*init_uarts)(struct s3c2410_uartcfg *cfg, int no);
|
|
void (*init_clocks)(int xtal);
|
|
int (*init)(void);
|
|
const char *name;
|
|
};
|
|
|
|
/* table of supported CPUs */
|
|
|
|
static const char name_s3c2400[] = "S3C2400";
|
|
static const char name_s3c2410[] = "S3C2410";
|
|
static const char name_s3c2412[] = "S3C2412";
|
|
static const char name_s3c2440[] = "S3C2440";
|
|
static const char name_s3c2442[] = "S3C2442";
|
|
static const char name_s3c2443[] = "S3C2443";
|
|
static const char name_s3c2410a[] = "S3C2410A";
|
|
static const char name_s3c2440a[] = "S3C2440A";
|
|
|
|
static struct cpu_table cpu_ids[] __initdata = {
|
|
{
|
|
.idcode = 0x32410000,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c2410_map_io,
|
|
.init_clocks = s3c2410_init_clocks,
|
|
.init_uarts = s3c2410_init_uarts,
|
|
.init = s3c2410_init,
|
|
.name = name_s3c2410
|
|
},
|
|
{
|
|
.idcode = 0x32410002,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c2410_map_io,
|
|
.init_clocks = s3c2410_init_clocks,
|
|
.init_uarts = s3c2410_init_uarts,
|
|
.init = s3c2410_init,
|
|
.name = name_s3c2410a
|
|
},
|
|
{
|
|
.idcode = 0x32440000,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c244x_map_io,
|
|
.init_clocks = s3c244x_init_clocks,
|
|
.init_uarts = s3c244x_init_uarts,
|
|
.init = s3c2440_init,
|
|
.name = name_s3c2440
|
|
},
|
|
{
|
|
.idcode = 0x32440001,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c244x_map_io,
|
|
.init_clocks = s3c244x_init_clocks,
|
|
.init_uarts = s3c244x_init_uarts,
|
|
.init = s3c2440_init,
|
|
.name = name_s3c2440a
|
|
},
|
|
{
|
|
.idcode = 0x32440aaa,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c244x_map_io,
|
|
.init_clocks = s3c244x_init_clocks,
|
|
.init_uarts = s3c244x_init_uarts,
|
|
.init = s3c2442_init,
|
|
.name = name_s3c2442
|
|
},
|
|
{
|
|
.idcode = 0x32412001,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c2412_map_io,
|
|
.init_clocks = s3c2412_init_clocks,
|
|
.init_uarts = s3c2412_init_uarts,
|
|
.init = s3c2412_init,
|
|
.name = name_s3c2412,
|
|
},
|
|
{ /* a newer version of the s3c2412 */
|
|
.idcode = 0x32412003,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c2412_map_io,
|
|
.init_clocks = s3c2412_init_clocks,
|
|
.init_uarts = s3c2412_init_uarts,
|
|
.init = s3c2412_init,
|
|
.name = name_s3c2412,
|
|
},
|
|
{
|
|
.idcode = 0x32443001,
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c2443_map_io,
|
|
.init_clocks = s3c2443_init_clocks,
|
|
.init_uarts = s3c2443_init_uarts,
|
|
.init = s3c2443_init,
|
|
.name = name_s3c2443,
|
|
},
|
|
{
|
|
.idcode = 0x0, /* S3C2400 doesn't have an idcode */
|
|
.idmask = 0xffffffff,
|
|
.map_io = s3c2400_map_io,
|
|
.init_clocks = s3c2400_init_clocks,
|
|
.init_uarts = s3c2400_init_uarts,
|
|
.init = s3c2400_init,
|
|
.name = name_s3c2400
|
|
},
|
|
};
|
|
|
|
/* minimal IO mapping */
|
|
|
|
static struct map_desc s3c_iodesc[] __initdata = {
|
|
IODESC_ENT(GPIO),
|
|
IODESC_ENT(IRQ),
|
|
IODESC_ENT(MEMCTRL),
|
|
IODESC_ENT(UART)
|
|
};
|
|
|
|
|
|
static struct cpu_table *
|
|
s3c_lookup_cpu(unsigned long idcode)
|
|
{
|
|
struct cpu_table *tab;
|
|
int count;
|
|
|
|
tab = cpu_ids;
|
|
for (count = 0; count < ARRAY_SIZE(cpu_ids); count++, tab++) {
|
|
if ((idcode & tab->idmask) == tab->idcode)
|
|
return tab;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
/* cpu information */
|
|
|
|
static struct cpu_table *cpu;
|
|
|
|
static unsigned long s3c24xx_read_idcode_v5(void)
|
|
{
|
|
#if defined(CONFIG_CPU_S3C2412) || defined(CONFIG_CPU_S3C2413)
|
|
return __raw_readl(S3C2412_GSTATUS1);
|
|
#else
|
|
return 1UL; /* don't look like an 2400 */
|
|
#endif
|
|
}
|
|
|
|
static unsigned long s3c24xx_read_idcode_v4(void)
|
|
{
|
|
#ifndef CONFIG_CPU_S3C2400
|
|
return __raw_readl(S3C2410_GSTATUS1);
|
|
#else
|
|
return 0UL;
|
|
#endif
|
|
}
|
|
|
|
/* Hook for arm_pm_restart to ensure we execute the reset code
|
|
* with the caches enabled. It seems at least the S3C2440 has a problem
|
|
* resetting if there is bus activity interrupted by the reset.
|
|
*/
|
|
static void s3c24xx_pm_restart(char mode)
|
|
{
|
|
if (mode != 's') {
|
|
unsigned long flags;
|
|
|
|
local_irq_save(flags);
|
|
__cpuc_flush_kern_all();
|
|
__cpuc_flush_user_all();
|
|
|
|
arch_reset(mode);
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
/* fallback, or unhandled */
|
|
arm_machine_restart(mode);
|
|
}
|
|
|
|
void __init s3c24xx_init_io(struct map_desc *mach_desc, int size)
|
|
{
|
|
unsigned long idcode = 0x0;
|
|
|
|
/* initialise the io descriptors we need for initialisation */
|
|
iotable_init(s3c_iodesc, ARRAY_SIZE(s3c_iodesc));
|
|
|
|
if (cpu_architecture() >= CPU_ARCH_ARMv5) {
|
|
idcode = s3c24xx_read_idcode_v5();
|
|
} else {
|
|
idcode = s3c24xx_read_idcode_v4();
|
|
}
|
|
|
|
cpu = s3c_lookup_cpu(idcode);
|
|
|
|
if (cpu == NULL) {
|
|
printk(KERN_ERR "Unknown CPU type 0x%08lx\n", idcode);
|
|
panic("Unknown S3C24XX CPU");
|
|
}
|
|
|
|
printk("CPU %s (id 0x%08lx)\n", cpu->name, idcode);
|
|
|
|
if (cpu->map_io == NULL || cpu->init == NULL) {
|
|
printk(KERN_ERR "CPU %s support not enabled\n", cpu->name);
|
|
panic("Unsupported S3C24XX CPU");
|
|
}
|
|
|
|
arm_pm_restart = s3c24xx_pm_restart;
|
|
|
|
(cpu->map_io)(mach_desc, size);
|
|
}
|
|
|
|
/* s3c24xx_init_clocks
|
|
*
|
|
* Initialise the clock subsystem and associated information from the
|
|
* given master crystal value.
|
|
*
|
|
* xtal = 0 -> use default PLL crystal value (normally 12MHz)
|
|
* != 0 -> PLL crystal value in Hz
|
|
*/
|
|
|
|
void __init s3c24xx_init_clocks(int xtal)
|
|
{
|
|
if (xtal == 0)
|
|
xtal = 12*1000*1000;
|
|
|
|
if (cpu == NULL)
|
|
panic("s3c24xx_init_clocks: no cpu setup?\n");
|
|
|
|
if (cpu->init_clocks == NULL)
|
|
panic("s3c24xx_init_clocks: cpu has no clock init\n");
|
|
else
|
|
(cpu->init_clocks)(xtal);
|
|
}
|
|
|
|
/* uart management */
|
|
|
|
static int nr_uarts __initdata = 0;
|
|
|
|
static struct s3c2410_uartcfg uart_cfgs[3];
|
|
|
|
/* s3c24xx_init_uartdevs
|
|
*
|
|
* copy the specified platform data and configuration into our central
|
|
* set of devices, before the data is thrown away after the init process.
|
|
*
|
|
* This also fills in the array passed to the serial driver for the
|
|
* early initialisation of the console.
|
|
*/
|
|
|
|
void __init s3c24xx_init_uartdevs(char *name,
|
|
struct s3c24xx_uart_resources *res,
|
|
struct s3c2410_uartcfg *cfg, int no)
|
|
{
|
|
struct platform_device *platdev;
|
|
struct s3c2410_uartcfg *cfgptr = uart_cfgs;
|
|
struct s3c24xx_uart_resources *resp;
|
|
int uart;
|
|
|
|
memcpy(cfgptr, cfg, sizeof(struct s3c2410_uartcfg) * no);
|
|
|
|
for (uart = 0; uart < no; uart++, cfg++, cfgptr++) {
|
|
platdev = s3c24xx_uart_src[cfgptr->hwport];
|
|
|
|
resp = res + cfgptr->hwport;
|
|
|
|
s3c24xx_uart_devs[uart] = platdev;
|
|
|
|
platdev->name = name;
|
|
platdev->resource = resp->resources;
|
|
platdev->num_resources = resp->nr_resources;
|
|
|
|
platdev->dev.platform_data = cfgptr;
|
|
}
|
|
|
|
nr_uarts = no;
|
|
}
|
|
|
|
void __init s3c24xx_init_uarts(struct s3c2410_uartcfg *cfg, int no)
|
|
{
|
|
if (cpu == NULL)
|
|
return;
|
|
|
|
if (cpu->init_uarts == NULL) {
|
|
printk(KERN_ERR "s3c24xx_init_uarts: cpu has no uart init\n");
|
|
} else
|
|
(cpu->init_uarts)(cfg, no);
|
|
}
|
|
|
|
static int __init s3c_arch_init(void)
|
|
{
|
|
int ret;
|
|
|
|
// do the correct init for cpu
|
|
|
|
if (cpu == NULL)
|
|
panic("s3c_arch_init: NULL cpu\n");
|
|
|
|
ret = (cpu->init)();
|
|
if (ret != 0)
|
|
return ret;
|
|
|
|
ret = platform_add_devices(s3c24xx_uart_devs, nr_uarts);
|
|
return ret;
|
|
}
|
|
|
|
arch_initcall(s3c_arch_init);
|