182 lines
4.0 KiB
C
182 lines
4.0 KiB
C
/*
|
|
* linux/arch/arm/mach-clps711x/p720t.c
|
|
*
|
|
* Copyright (C) 2000-2001 Deep Blue Solutions Ltd
|
|
*
|
|
* 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/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/types.h>
|
|
#include <linux/string.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/io.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/leds.h>
|
|
|
|
#include <mach/hardware.h>
|
|
#include <asm/pgtable.h>
|
|
#include <asm/page.h>
|
|
#include <asm/setup.h>
|
|
#include <asm/sizes.h>
|
|
#include <asm/mach-types.h>
|
|
#include <asm/mach/arch.h>
|
|
#include <asm/mach/map.h>
|
|
#include <mach/syspld.h>
|
|
|
|
#include <asm/hardware/clps7111.h>
|
|
|
|
#include "common.h"
|
|
|
|
/*
|
|
* Map the P720T system PLD. It occupies two address spaces:
|
|
* SYSPLD_PHYS_BASE and SYSPLD_PHYS_BASE + 0x00400000
|
|
* We map both here.
|
|
*/
|
|
static struct map_desc p720t_io_desc[] __initdata = {
|
|
{
|
|
.virtual = SYSPLD_VIRT_BASE,
|
|
.pfn = __phys_to_pfn(SYSPLD_PHYS_BASE),
|
|
.length = SZ_1M,
|
|
.type = MT_DEVICE
|
|
}, {
|
|
.virtual = 0xfe400000,
|
|
.pfn = __phys_to_pfn(0x10400000),
|
|
.length = SZ_1M,
|
|
.type = MT_DEVICE
|
|
}
|
|
};
|
|
|
|
static void __init
|
|
fixup_p720t(struct tag *tag, char **cmdline, struct meminfo *mi)
|
|
{
|
|
/*
|
|
* Our bootloader doesn't setup any tags (yet).
|
|
*/
|
|
if (tag->hdr.tag != ATAG_CORE) {
|
|
tag->hdr.tag = ATAG_CORE;
|
|
tag->hdr.size = tag_size(tag_core);
|
|
tag->u.core.flags = 0;
|
|
tag->u.core.pagesize = PAGE_SIZE;
|
|
tag->u.core.rootdev = 0x0100;
|
|
|
|
tag = tag_next(tag);
|
|
tag->hdr.tag = ATAG_MEM;
|
|
tag->hdr.size = tag_size(tag_mem32);
|
|
tag->u.mem.size = 4096;
|
|
tag->u.mem.start = PHYS_OFFSET;
|
|
|
|
tag = tag_next(tag);
|
|
tag->hdr.tag = ATAG_NONE;
|
|
tag->hdr.size = 0;
|
|
}
|
|
}
|
|
|
|
static void __init p720t_map_io(void)
|
|
{
|
|
clps711x_map_io();
|
|
iotable_init(p720t_io_desc, ARRAY_SIZE(p720t_io_desc));
|
|
}
|
|
|
|
static void __init p720t_init_early(void)
|
|
{
|
|
/*
|
|
* Power down as much as possible in case we don't
|
|
* have the drivers loaded.
|
|
*/
|
|
PLD_LCDEN = 0;
|
|
PLD_PWR &= ~(PLD_S4_ON|PLD_S3_ON|PLD_S2_ON|PLD_S1_ON);
|
|
|
|
PLD_KBD = 0;
|
|
PLD_IO = 0;
|
|
PLD_IRDA = 0;
|
|
PLD_CODEC = 0;
|
|
PLD_TCH = 0;
|
|
PLD_SPI = 0;
|
|
if (!IS_ENABLED(CONFIG_DEBUG_LL)) {
|
|
PLD_COM2 = 0;
|
|
PLD_COM1 = 0;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* LED controled by CPLD
|
|
*/
|
|
#if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS)
|
|
static void p720t_led_set(struct led_classdev *cdev,
|
|
enum led_brightness b)
|
|
{
|
|
u8 reg = clps_readb(PDDR);
|
|
|
|
if (b != LED_OFF)
|
|
reg |= 0x1;
|
|
else
|
|
reg &= ~0x1;
|
|
|
|
clps_writeb(reg, PDDR);
|
|
}
|
|
|
|
static enum led_brightness p720t_led_get(struct led_classdev *cdev)
|
|
{
|
|
u8 reg = clps_readb(PDDR);
|
|
|
|
return (reg & 0x1) ? LED_FULL : LED_OFF;
|
|
}
|
|
|
|
static int __init p720t_leds_init(void)
|
|
{
|
|
|
|
struct led_classdev *cdev;
|
|
int ret;
|
|
|
|
if (!machine_is_p720t())
|
|
return -ENODEV;
|
|
|
|
cdev = kzalloc(sizeof(*cdev), GFP_KERNEL);
|
|
if (!cdev)
|
|
return -ENOMEM;
|
|
|
|
cdev->name = "p720t:0";
|
|
cdev->brightness_set = p720t_led_set;
|
|
cdev->brightness_get = p720t_led_get;
|
|
cdev->default_trigger = "heartbeat";
|
|
|
|
ret = led_classdev_register(NULL, cdev);
|
|
if (ret < 0) {
|
|
kfree(cdev);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Since we may have triggers on any subsystem, defer registration
|
|
* until after subsystem_init.
|
|
*/
|
|
fs_initcall(p720t_leds_init);
|
|
#endif
|
|
|
|
MACHINE_START(P720T, "ARM-Prospector720T")
|
|
/* Maintainer: ARM Ltd/Deep Blue Solutions Ltd */
|
|
.atag_offset = 0x100,
|
|
.fixup = fixup_p720t,
|
|
.init_early = p720t_init_early,
|
|
.map_io = p720t_map_io,
|
|
.init_irq = clps711x_init_irq,
|
|
.timer = &clps711x_timer,
|
|
.restart = clps711x_restart,
|
|
MACHINE_END
|