brcm63xx cleanups; add a watchdog driver, indent serial console driver, add support for another sst flash
SVN-Revision: 6985
This commit is contained in:
parent
65d82bc293
commit
2bf49e010b
8 changed files with 943 additions and 652 deletions
|
@ -3,7 +3,7 @@
|
||||||
#
|
#
|
||||||
# Copyright (C) 2004 Broadcom Corporation
|
# Copyright (C) 2004 Broadcom Corporation
|
||||||
#
|
#
|
||||||
obj-y := irq.o prom.o setup.o time.o ser_init.o int-handler.o info.o
|
obj-y := irq.o prom.o setup.o time.o ser_init.o int-handler.o info.o wdt.o
|
||||||
|
|
||||||
SRCBASE := $(TOPDIR)
|
SRCBASE := $(TOPDIR)
|
||||||
EXTRA_CFLAGS += -I$(SRCBASE)/include
|
EXTRA_CFLAGS += -I$(SRCBASE)/include
|
||||||
|
|
|
@ -25,7 +25,8 @@
|
||||||
static char *boot_loader_names[BOOT_LOADER_LAST+1] = {
|
static char *boot_loader_names[BOOT_LOADER_LAST+1] = {
|
||||||
[BOOT_LOADER_UNKNOWN] = "Unknown",
|
[BOOT_LOADER_UNKNOWN] = "Unknown",
|
||||||
[BOOT_LOADER_CFE] = "CFE",
|
[BOOT_LOADER_CFE] = "CFE",
|
||||||
[BOOT_LOADER_REDBOOT] = "RedBoot"
|
[BOOT_LOADER_REDBOOT] = "RedBoot",
|
||||||
|
[BOOT_LOADER_CFE2] = "CFEv2"
|
||||||
};
|
};
|
||||||
|
|
||||||
/* boot loaders specific definitions */
|
/* boot loaders specific definitions */
|
||||||
|
@ -73,14 +74,29 @@ void __init detect_bootloader(void)
|
||||||
{
|
{
|
||||||
if (detect_cfe()) {
|
if (detect_cfe()) {
|
||||||
boot_loader_type = BOOT_LOADER_CFE;
|
boot_loader_type = BOOT_LOADER_CFE;
|
||||||
printk("Boot loader is : %s\n", boot_loader_names[boot_loader_type]);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if (detect_redboot()) {
|
if (detect_redboot()) {
|
||||||
boot_loader_type = BOOT_LOADER_REDBOOT;
|
boot_loader_type = BOOT_LOADER_REDBOOT;
|
||||||
}
|
}
|
||||||
else
|
else {
|
||||||
boot_loader_type = BOOT_LOADER_UNKNOWN;
|
/* Some devices are using CFE, but it is not detected as is */
|
||||||
|
boot_loader_type = BOOT_LOADER_CFE2;
|
||||||
|
}
|
||||||
|
printk("Boot loader is : %s\n", boot_loader_names[boot_loader_type]);
|
||||||
|
}
|
||||||
|
|
||||||
|
void __init detect_board(void)
|
||||||
|
{
|
||||||
|
switch (boot_loader_type)
|
||||||
|
{
|
||||||
|
case BOOT_LOADER_CFE:
|
||||||
|
break;
|
||||||
|
case BOOT_LOADER_REDBOOT:
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
EXPORT_SYMBOL(boot_loader_type);
|
EXPORT_SYMBOL(boot_loader_type);
|
||||||
|
|
|
@ -238,13 +238,13 @@ unsigned int BcmHalMapInterrupt(FN_HANDLER pfunc, unsigned int param,
|
||||||
|
|
||||||
if( interruptId >= INTERNAL_ISR_TABLE_OFFSET )
|
if( interruptId >= INTERNAL_ISR_TABLE_OFFSET )
|
||||||
{
|
{
|
||||||
nRet = request_irq( interruptId, pfunc, SA_SAMPLE_RANDOM | SA_INTERRUPT,
|
printk("BcmHalMapInterrupt : internal IRQ\n");
|
||||||
devname, (void *) param );
|
nRet = request_irq( interruptId, pfunc, SA_SAMPLE_RANDOM | SA_INTERRUPT, devname, (void *) param );
|
||||||
}
|
}
|
||||||
else if (interruptId >= INTERRUPT_ID_EXTERNAL_0 && interruptId <= INTERRUPT_ID_EXTERNAL_3)
|
else if (interruptId >= INTERRUPT_ID_EXTERNAL_0 && interruptId <= INTERRUPT_ID_EXTERNAL_3)
|
||||||
{
|
{
|
||||||
nRet = request_external_irq( interruptId, pfunc, SA_SAMPLE_RANDOM | SA_INTERRUPT,
|
printk("BcmHalMapInterrupt : external IRQ\n");
|
||||||
devname, (void *) param );
|
nRet = request_external_irq( interruptId, pfunc, SA_SAMPLE_RANDOM | SA_INTERRUPT, devname, (void *) param );
|
||||||
}
|
}
|
||||||
|
|
||||||
return( nRet );
|
return( nRet );
|
||||||
|
|
|
@ -1,6 +1,6 @@
|
||||||
/*
|
/*
|
||||||
<:copyright-gpl
|
|
||||||
Copyright 2004 Broadcom Corp. All Rights Reserved.
|
Copyright 2004 Broadcom Corp. All Rights Reserved.
|
||||||
|
Copyright 2007 OpenWrt,org, Florian Fainelli <florian@openwrt.org>
|
||||||
|
|
||||||
This program is free software; you can distribute it and/or modify it
|
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
|
under the terms of the GNU General Public License (Version 2) as
|
||||||
|
@ -14,7 +14,6 @@
|
||||||
You should have received a copy of the GNU General Public License along
|
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.,
|
with this program; if not, write to the Free Software Foundation, Inc.,
|
||||||
59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
|
59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
|
||||||
:>
|
|
||||||
*/
|
*/
|
||||||
/*
|
/*
|
||||||
* prom.c: PROM library initialization code.
|
* prom.c: PROM library initialization code.
|
||||||
|
@ -50,24 +49,26 @@ void __init prom_init(void)
|
||||||
{
|
{
|
||||||
serial_init();
|
serial_init();
|
||||||
|
|
||||||
printk( "%s prom init\n", get_system_type() );
|
printk("%s prom init\n", get_system_type() );
|
||||||
|
|
||||||
PERF->IrqMask = 0;
|
PERF->IrqMask = 0;
|
||||||
|
|
||||||
|
/* Detect the bootloader */
|
||||||
detect_bootloader();
|
detect_bootloader();
|
||||||
|
|
||||||
if (boot_loader_type == BOOT_LOADER_CFE) {
|
/* Do further initialisations depending on the bootloader */
|
||||||
|
if (boot_loader_type == BOOT_LOADER_CFE || boot_loader_type == BOOT_LOADER_CFE2) {
|
||||||
cfe_setup(fw_arg0, fw_arg1, fw_arg2, fw_arg3);
|
cfe_setup(fw_arg0, fw_arg1, fw_arg2, fw_arg3);
|
||||||
add_memory_region(0, (boot_mem_map.map[0].size - ADSL_SDRAM_IMAGE_SIZE), BOOT_MEM_RAM);
|
|
||||||
}
|
}
|
||||||
else
|
/* Register 16MB RAM minus the ADSL SDRAM by default */
|
||||||
add_memory_region(0, (0x01000000 - ADSL_SDRAM_IMAGE_SIZE), BOOT_MEM_RAM);
|
add_memory_region(0, (0x01000000 - ADSL_SDRAM_IMAGE_SIZE), BOOT_MEM_RAM);
|
||||||
|
|
||||||
mips_machgroup = MACH_GROUP_BRCM;
|
mips_machgroup = MACH_GROUP_BRCM;
|
||||||
mips_machtype = MACH_BCM;
|
mips_machtype = MACH_BCM;
|
||||||
}
|
}
|
||||||
|
|
||||||
void __init prom_free_prom_memory(void)
|
unsigned long __init prom_free_prom_memory(void)
|
||||||
{
|
{
|
||||||
/* We do not have any memory to free */
|
/* We do not have any memory to free */
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
246
target/linux/brcm63xx-2.6/files/arch/mips/bcm963xx/wdt.c
Normal file
246
target/linux/brcm63xx-2.6/files/arch/mips/bcm963xx/wdt.c
Normal file
|
@ -0,0 +1,246 @@
|
||||||
|
/*
|
||||||
|
* Watchdog driver for the BCM963xx devices
|
||||||
|
*
|
||||||
|
* Copyright (C) 2007 OpenWrt.org
|
||||||
|
* Florian Fainelli <florian@openwrt.org>
|
||||||
|
*
|
||||||
|
* 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.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <linux/module.h>
|
||||||
|
#include <linux/types.h>
|
||||||
|
#include <linux/errno.h>
|
||||||
|
#include <linux/miscdevice.h>
|
||||||
|
#include <linux/fs.h>
|
||||||
|
#include <linux/init.h>
|
||||||
|
#include <linux/notifier.h>
|
||||||
|
#include <linux/watchdog.h>
|
||||||
|
#include <linux/timer.h>
|
||||||
|
#include <linux/jiffies.h>
|
||||||
|
#include <linux/completion.h>
|
||||||
|
#include <linux/ioport.h>
|
||||||
|
|
||||||
|
typedef struct bcm963xx_timer {
|
||||||
|
unsigned short unused0;
|
||||||
|
unsigned char timer_mask;
|
||||||
|
#define TIMER0EN 0x01
|
||||||
|
#define TIMER1EN 0x02
|
||||||
|
#define TIMER2EN 0x04
|
||||||
|
unsigned char timer_ints;
|
||||||
|
#define TIMER0 0x01
|
||||||
|
#define TIMER1 0x02
|
||||||
|
#define TIMER2 0x04
|
||||||
|
#define WATCHDOG 0x08
|
||||||
|
unsigned long timer_ctl0;
|
||||||
|
unsigned long timer_ctl1;
|
||||||
|
unsigned long timer_ctl2;
|
||||||
|
#define TIMERENABLE 0x80000000
|
||||||
|
#define RSTCNTCLR 0x40000000
|
||||||
|
unsigned long timer_cnt0;
|
||||||
|
unsigned long timer_cnt1;
|
||||||
|
unsigned long timer_cnt2;
|
||||||
|
unsigned long wdt_def_count;
|
||||||
|
|
||||||
|
/* Write 0xff00 0x00ff to Start timer
|
||||||
|
* Write 0xee00 0x00ee to Stop and re-load default count
|
||||||
|
* Read from this register returns current watch dog count
|
||||||
|
*/
|
||||||
|
unsigned long wdt_ctl;
|
||||||
|
|
||||||
|
/* Number of 40-MHz ticks for WD Reset pulse to last */
|
||||||
|
unsigned long wdt_rst_count;
|
||||||
|
} bcm963xx_timer;
|
||||||
|
|
||||||
|
static struct bcm963xx_wdt_device {
|
||||||
|
struct completion stop;
|
||||||
|
volatile int running;
|
||||||
|
struct timer_list timer;
|
||||||
|
volatile int queue;
|
||||||
|
int default_ticks;
|
||||||
|
unsigned long inuse;
|
||||||
|
} bcm963xx_wdt_device;
|
||||||
|
|
||||||
|
static int ticks = 1000;
|
||||||
|
|
||||||
|
#define WDT_BASE 0xfffe0200
|
||||||
|
#define WDT ((volatile bcm963xx_timer * const) WDT_BASE)
|
||||||
|
|
||||||
|
#define BCM963XX_INTERVAL (HZ/10+1)
|
||||||
|
|
||||||
|
static void bcm963xx_wdt_trigger(unsigned long unused)
|
||||||
|
{
|
||||||
|
if (bcm963xx_wdt_device.running)
|
||||||
|
ticks--;
|
||||||
|
|
||||||
|
/* Load the default ticking value into the reset counter register */
|
||||||
|
WDT->wdt_rst_count = bcm963xx_wdt_device.default_ticks;
|
||||||
|
|
||||||
|
if (bcm963xx_wdt_device.queue && ticks) {
|
||||||
|
bcm963xx_wdt_device.timer.expires = jiffies + BCM963XX_INTERVAL;
|
||||||
|
add_timer(&bcm963xx_wdt_device.timer);
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
complete(&bcm963xx_wdt_device.stop);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void bcm963xx_wdt_reset(void)
|
||||||
|
{
|
||||||
|
ticks = bcm963xx_wdt_device.default_ticks;
|
||||||
|
/* Also reload default count */
|
||||||
|
WDT->wdt_def_count = ticks;
|
||||||
|
WDT->wdt_ctl = 0xee00;
|
||||||
|
WDT->wdt_ctl = 0x00ee;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void bcm963xx_wdt_start(void)
|
||||||
|
{
|
||||||
|
if (!bcm963xx_wdt_device.queue) {
|
||||||
|
bcm963xx_wdt_device.queue;
|
||||||
|
/* Enable the watchdog by writing 0xff00 ,then 0x00ff to the control register */
|
||||||
|
WDT->wdt_ctl = 0xff00;
|
||||||
|
WDT->wdt_ctl = 0x00ff;
|
||||||
|
bcm963xx_wdt_device.timer.expires = jiffies + BCM963XX_INTERVAL;
|
||||||
|
add_timer(&bcm963xx_wdt_device.timer);
|
||||||
|
}
|
||||||
|
bcm963xx_wdt_device.running++;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bcm963xx_wdt_stop(void)
|
||||||
|
{
|
||||||
|
if (bcm963xx_wdt_device.running)
|
||||||
|
bcm963xx_wdt_device.running = 0;
|
||||||
|
|
||||||
|
ticks = bcm963xx_wdt_device.default_ticks;
|
||||||
|
|
||||||
|
/* Stop the watchdog by writing 0xee00 then 0x00ee to the control register */
|
||||||
|
WDT->wdt_ctl = 0xee00;
|
||||||
|
WDT->wdt_ctl = 0x00ee;
|
||||||
|
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bcm963xx_wdt_open(struct inode *inode, struct file *file)
|
||||||
|
{
|
||||||
|
if (test_and_set_bit(0, &bcm963xx_wdt_device.inuse))
|
||||||
|
return -EBUSY;
|
||||||
|
return nonseekable_open(inode, file);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bcm963xx_wdt_release(struct inode *inode, struct file *file)
|
||||||
|
{
|
||||||
|
clear_bit(0, &bcm963xx_wdt_device.inuse);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bcm963xx_wdt_ioctl(struct inode *inode, struct file *file,
|
||||||
|
unsigned int cmd, unsigned long arg)
|
||||||
|
{
|
||||||
|
void __user *argp = (void __user *)arg;
|
||||||
|
unsigned int value;
|
||||||
|
|
||||||
|
static struct watchdog_info ident = {
|
||||||
|
.options = WDIOF_CARDRESET,
|
||||||
|
.identity = "BCM963xx WDT",
|
||||||
|
};
|
||||||
|
|
||||||
|
switch (cmd) {
|
||||||
|
case WDIOC_KEEPALIVE:
|
||||||
|
bcm963xx_wdt_reset();
|
||||||
|
break;
|
||||||
|
case WDIOC_GETSTATUS:
|
||||||
|
/* Reading from the control register will return the current value */
|
||||||
|
value = WDT->wdt_ctl;
|
||||||
|
if ( copy_to_user(argp, &value, sizeof(int)) )
|
||||||
|
return -EFAULT;
|
||||||
|
break;
|
||||||
|
case WDIOC_GETSUPPORT:
|
||||||
|
if ( copy_to_user(argp, &ident, sizeof(ident)) )
|
||||||
|
return -EFAULT;
|
||||||
|
break;
|
||||||
|
case WDIOC_SETOPTIONS:
|
||||||
|
if ( copy_from_user(&value, argp, sizeof(int)) )
|
||||||
|
return -EFAULT;
|
||||||
|
switch(value) {
|
||||||
|
case WDIOS_ENABLECARD:
|
||||||
|
bcm963xx_wdt_start();
|
||||||
|
break;
|
||||||
|
case WDIOS_DISABLECARD:
|
||||||
|
bcm963xx_wdt_stop();
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return -ENOTTY;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bcm963xx_wdt_write(struct file *file, const char __user *buf, size_t count, loff_t *ppos)
|
||||||
|
{
|
||||||
|
if (!count)
|
||||||
|
return -EIO;
|
||||||
|
bcm963xx_wdt_reset();
|
||||||
|
return count;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct file_operations bcm963xx_wdt_fops = {
|
||||||
|
.owner = THIS_MODULE,
|
||||||
|
.llseek = no_llseek,
|
||||||
|
.write = bcm963xx_wdt_write,
|
||||||
|
.ioctl = bcm963xx_wdt_ioctl,
|
||||||
|
.open = bcm963xx_wdt_open,
|
||||||
|
.release = bcm963xx_wdt_release,
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct miscdevice bcm963xx_wdt_miscdev = {
|
||||||
|
.minor = WATCHDOG_MINOR,
|
||||||
|
.name = "watchdog",
|
||||||
|
.fops = &bcm963xx_wdt_fops,
|
||||||
|
};
|
||||||
|
|
||||||
|
static void __exit bcm963xx_wdt_exit(void)
|
||||||
|
{
|
||||||
|
if (bcm963xx_wdt_device.queue ){
|
||||||
|
bcm963xx_wdt_device.queue = 0;
|
||||||
|
wait_for_completion(&bcm963xx_wdt_device.stop);
|
||||||
|
}
|
||||||
|
misc_deregister(&bcm963xx_wdt_miscdev);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int __init bcm963xx_wdt_init(void)
|
||||||
|
{
|
||||||
|
int ret = 0;
|
||||||
|
|
||||||
|
printk("Broadcom BCM963xx Watchdog timer\n");
|
||||||
|
|
||||||
|
ret = misc_register(&bcm963xx_wdt_miscdev);
|
||||||
|
if (ret) {
|
||||||
|
printk(KERN_CRIT "Cannot register miscdev on minor=%d (err=%d)\n", WATCHDOG_MINOR, ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
init_completion(&bcm963xx_wdt_device.stop);
|
||||||
|
bcm963xx_wdt_device.queue = 0;
|
||||||
|
|
||||||
|
clear_bit(0, &bcm963xx_wdt_device.inuse);
|
||||||
|
|
||||||
|
init_timer(&bcm963xx_wdt_device.timer);
|
||||||
|
bcm963xx_wdt_device.timer.function = bcm963xx_wdt_trigger;
|
||||||
|
bcm963xx_wdt_device.timer.data = 0;
|
||||||
|
|
||||||
|
bcm963xx_wdt_device.default_ticks = ticks;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
module_init(bcm963xx_wdt_init);
|
||||||
|
module_exit(bcm963xx_wdt_exit);
|
||||||
|
|
||||||
|
MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
|
||||||
|
MODULE_DESCRIPTION("Broadcom BCM963xx Watchdog driver");
|
||||||
|
MODULE_LICENSE("GPL");
|
|
@ -53,7 +53,7 @@ extern void _putc(char);
|
||||||
extern void _puts(const char *);
|
extern void _puts(const char *);
|
||||||
|
|
||||||
typedef struct bcm_serial {
|
typedef struct bcm_serial {
|
||||||
volatile Uart * port;
|
volatile Uart *port;
|
||||||
int type;
|
int type;
|
||||||
int flags;
|
int flags;
|
||||||
int irq;
|
int irq;
|
||||||
|
@ -111,32 +111,36 @@ static struct termios *serial_termios[BCM_NUM_UARTS];
|
||||||
static struct termios *serial_termios_locked[BCM_NUM_UARTS];
|
static struct termios *serial_termios_locked[BCM_NUM_UARTS];
|
||||||
|
|
||||||
|
|
||||||
static void bcm_stop (struct tty_struct *tty);
|
static void bcm_stop(struct tty_struct *tty);
|
||||||
static void bcm_start (struct tty_struct *tty);
|
static void bcm_start(struct tty_struct *tty);
|
||||||
static inline void receive_chars (struct bcm_serial * info);
|
static inline void receive_chars(struct bcm_serial *info);
|
||||||
static int startup (struct bcm_serial *info);
|
static int startup(struct bcm_serial *info);
|
||||||
static void shutdown (struct bcm_serial * info);
|
static void shutdown(struct bcm_serial *info);
|
||||||
static void change_speed( volatile Uart *pUart, tcflag_t cFlag );
|
static void change_speed(volatile Uart * pUart, tcflag_t cFlag);
|
||||||
static void bcm63xx_cons_flush_chars (struct tty_struct *tty);
|
static void bcm63xx_cons_flush_chars(struct tty_struct *tty);
|
||||||
static int bcm63xx_cons_write (struct tty_struct *tty,
|
static int bcm63xx_cons_write(struct tty_struct *tty,
|
||||||
const unsigned char *buf, int count);
|
const unsigned char *buf, int count);
|
||||||
static int bcm63xx_cons_write_room (struct tty_struct *tty);
|
static int bcm63xx_cons_write_room(struct tty_struct *tty);
|
||||||
static int bcm_chars_in_buffer (struct tty_struct *tty);
|
static int bcm_chars_in_buffer(struct tty_struct *tty);
|
||||||
static void bcm_flush_buffer (struct tty_struct *tty);
|
static void bcm_flush_buffer(struct tty_struct *tty);
|
||||||
static void bcm_throttle (struct tty_struct *tty);
|
static void bcm_throttle(struct tty_struct *tty);
|
||||||
static void bcm_unthrottle (struct tty_struct *tty);
|
static void bcm_unthrottle(struct tty_struct *tty);
|
||||||
static void bcm_send_xchar (struct tty_struct *tty, char ch);
|
static void bcm_send_xchar(struct tty_struct *tty, char ch);
|
||||||
static int get_serial_info(struct bcm_serial *info, struct serial_struct *retinfo);
|
static int get_serial_info(struct bcm_serial *info,
|
||||||
static int set_serial_info (struct bcm_serial *info, struct serial_struct *new_info);
|
struct serial_struct *retinfo);
|
||||||
static int get_lsr_info (struct bcm_serial *info, unsigned int *value);
|
static int set_serial_info(struct bcm_serial *info,
|
||||||
static void send_break (struct bcm_serial *info, int duration);
|
struct serial_struct *new_info);
|
||||||
static int bcm_ioctl (struct tty_struct * tty, struct file * file,
|
static int get_lsr_info(struct bcm_serial *info, unsigned int *value);
|
||||||
|
static void send_break(struct bcm_serial *info, int duration);
|
||||||
|
static int bcm_ioctl(struct tty_struct *tty, struct file *file,
|
||||||
unsigned int cmd, unsigned long arg);
|
unsigned int cmd, unsigned long arg);
|
||||||
static void bcm_set_termios (struct tty_struct *tty, struct termios *old_termios);
|
static void bcm_set_termios(struct tty_struct *tty,
|
||||||
static void bcm63xx_cons_close (struct tty_struct *tty, struct file *filp);
|
struct termios *old_termios);
|
||||||
static void bcm_hangup (struct tty_struct *tty);
|
static void bcm63xx_cons_close(struct tty_struct *tty, struct file *filp);
|
||||||
static int block_til_ready (struct tty_struct *tty, struct file *filp, struct bcm_serial *info);
|
static void bcm_hangup(struct tty_struct *tty);
|
||||||
static int bcm63xx_cons_open (struct tty_struct * tty, struct file * filp);
|
static int block_til_ready(struct tty_struct *tty, struct file *filp,
|
||||||
|
struct bcm_serial *info);
|
||||||
|
static int bcm63xx_cons_open(struct tty_struct *tty, struct file *filp);
|
||||||
static int __init bcm63xx_serialinit(void);
|
static int __init bcm63xx_serialinit(void);
|
||||||
|
|
||||||
|
|
||||||
|
@ -149,11 +153,11 @@ static int __init bcm63xx_serialinit(void);
|
||||||
* as necessary.
|
* as necessary.
|
||||||
* ------------------------------------------------------------
|
* ------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static void bcm_stop (struct tty_struct *tty)
|
static void bcm_stop(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
static void bcm_start (struct tty_struct *tty)
|
static void bcm_start(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
_puts(CARDNAME " Start\n");
|
_puts(CARDNAME " Start\n");
|
||||||
}
|
}
|
||||||
|
@ -165,66 +169,55 @@ static void bcm_start (struct tty_struct *tty)
|
||||||
* This routine deals with inputs from any lines.
|
* This routine deals with inputs from any lines.
|
||||||
* ------------------------------------------------------------
|
* ------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static inline void receive_chars (struct bcm_serial * info)
|
static inline void receive_chars(struct bcm_serial *info)
|
||||||
{
|
{
|
||||||
struct tty_struct *tty = 0;
|
struct tty_struct *tty = 0;
|
||||||
struct async_icount * icount;
|
struct async_icount *icount;
|
||||||
int ignore = 0;
|
int ignore = 0;
|
||||||
unsigned short status, tmp;
|
unsigned short status, tmp;
|
||||||
UCHAR ch = 0;
|
UCHAR ch = 0;
|
||||||
while ((status = info->port->intStatus) & RXINT)
|
while ((status = info->port->intStatus) & RXINT) {
|
||||||
{
|
|
||||||
char flag_char = TTY_NORMAL;
|
char flag_char = TTY_NORMAL;
|
||||||
|
|
||||||
if (status & RXFIFONE)
|
if (status & RXFIFONE)
|
||||||
ch = info->port->Data; // Read the character
|
ch = info->port->Data; // Read the character
|
||||||
tty = info->tty; /* now tty points to the proper dev */
|
tty = info->tty; /* now tty points to the proper dev */
|
||||||
icount = &info->icount;
|
icount = &info->icount;
|
||||||
if (! tty)
|
if (!tty)
|
||||||
break;
|
break;
|
||||||
if (!tty_buffer_request_room(tty, 1))
|
if (!tty_buffer_request_room(tty, 1))
|
||||||
break;
|
break;
|
||||||
icount->rx++;
|
icount->rx++;
|
||||||
if (status & RXBRK)
|
if (status & RXBRK) {
|
||||||
{
|
|
||||||
flag_char = TTY_BREAK;
|
flag_char = TTY_BREAK;
|
||||||
icount->brk++;
|
icount->brk++;
|
||||||
}
|
}
|
||||||
// keep track of the statistics
|
// keep track of the statistics
|
||||||
if (status & (RXFRAMERR | RXPARERR | RXOVFERR))
|
if (status & (RXFRAMERR | RXPARERR | RXOVFERR)) {
|
||||||
{
|
|
||||||
if (status & RXPARERR) /* parity error */
|
if (status & RXPARERR) /* parity error */
|
||||||
icount->parity++;
|
icount->parity++;
|
||||||
else
|
else if (status & RXFRAMERR) /* frame error */
|
||||||
if (status & RXFRAMERR) /* frame error */
|
|
||||||
icount->frame++;
|
icount->frame++;
|
||||||
if (status & RXOVFERR)
|
if (status & RXOVFERR) {
|
||||||
{
|
|
||||||
// Overflow. Reset the RX FIFO
|
// Overflow. Reset the RX FIFO
|
||||||
info->port->fifoctl |= RSTRXFIFOS;
|
info->port->fifoctl |= RSTRXFIFOS;
|
||||||
icount->overrun++;
|
icount->overrun++;
|
||||||
}
|
}
|
||||||
// check to see if we should ignore the character
|
// check to see if we should ignore the character
|
||||||
// and mask off conditions that should be ignored
|
// and mask off conditions that should be ignored
|
||||||
if (status & info->ignore_status_mask)
|
if (status & info->ignore_status_mask) {
|
||||||
{
|
if (++ignore > 100)
|
||||||
if (++ignore > 100 )
|
|
||||||
break;
|
break;
|
||||||
goto ignore_char;
|
goto ignore_char;
|
||||||
}
|
}
|
||||||
// Mask off the error conditions we want to ignore
|
// Mask off the error conditions we want to ignore
|
||||||
tmp = status & info->read_status_mask;
|
tmp = status & info->read_status_mask;
|
||||||
if (tmp & RXPARERR)
|
if (tmp & RXPARERR) {
|
||||||
{
|
|
||||||
flag_char = TTY_PARITY;
|
flag_char = TTY_PARITY;
|
||||||
}
|
} else if (tmp & RXFRAMERR) {
|
||||||
else
|
|
||||||
if (tmp & RXFRAMERR)
|
|
||||||
{
|
|
||||||
flag_char = TTY_FRAME;
|
flag_char = TTY_FRAME;
|
||||||
}
|
}
|
||||||
if (tmp & RXOVFERR)
|
if (tmp & RXOVFERR) {
|
||||||
{
|
|
||||||
tty_insert_flip_char(tty, ch, flag_char);
|
tty_insert_flip_char(tty, ch, flag_char);
|
||||||
ch = 0;
|
ch = 0;
|
||||||
flag_char = TTY_OVERRUN;
|
flag_char = TTY_OVERRUN;
|
||||||
|
@ -234,7 +227,7 @@ static inline void receive_chars (struct bcm_serial * info)
|
||||||
}
|
}
|
||||||
tty_insert_flip_char(tty, ch, flag_char);
|
tty_insert_flip_char(tty, ch, flag_char);
|
||||||
}
|
}
|
||||||
ignore_char:;
|
ignore_char:;
|
||||||
tty_flip_buffer_push(tty);
|
tty_flip_buffer_push(tty);
|
||||||
tty_schedule_flip(tty);
|
tty_schedule_flip(tty);
|
||||||
|
|
||||||
|
@ -250,24 +243,22 @@ ignore_char:;
|
||||||
* ------------------------------------------------------------
|
* ------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
|
||||||
static irqreturn_t bcm_interrupt (int irq, void * dev)
|
static irqreturn_t bcm_interrupt(int irq, void *dev)
|
||||||
#else
|
#else
|
||||||
static void bcm_interrupt (int irq, void * dev, struct pt_regs * regs)
|
static void bcm_interrupt(int irq, void *dev, struct pt_regs *regs)
|
||||||
#endif
|
#endif
|
||||||
{
|
{
|
||||||
struct bcm_serial * info = lines[0];
|
struct bcm_serial *info = lines[0];
|
||||||
UINT16 intStat;
|
UINT16 intStat;
|
||||||
|
|
||||||
/* get pending interrupt flags from UART */
|
/* get pending interrupt flags from UART */
|
||||||
|
|
||||||
/* Mask with only the serial interrupts that are enabled */
|
/* Mask with only the serial interrupts that are enabled */
|
||||||
intStat = info->port->intStatus & info->port->intMask;
|
intStat = info->port->intStatus & info->port->intMask;
|
||||||
while (intStat)
|
while (intStat) {
|
||||||
{
|
|
||||||
if (intStat & RXINT)
|
if (intStat & RXINT)
|
||||||
receive_chars (info);
|
receive_chars(info);
|
||||||
else
|
else if (intStat & TXINT)
|
||||||
if (intStat & TXINT)
|
|
||||||
info->port->intStatus = TXINT;
|
info->port->intStatus = TXINT;
|
||||||
else /* don't know what it was, so let's mask it */
|
else /* don't know what it was, so let's mask it */
|
||||||
info->port->intMask &= ~intStat;
|
info->port->intMask &= ~intStat;
|
||||||
|
@ -276,7 +267,7 @@ static void bcm_interrupt (int irq, void * dev, struct pt_regs * regs)
|
||||||
}
|
}
|
||||||
|
|
||||||
// Clear the interrupt
|
// Clear the interrupt
|
||||||
BcmHalInterruptEnable (INTERRUPT_ID_UART);
|
enable_brcm_irq(INTERRUPT_ID_UART);
|
||||||
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
|
||||||
return IRQ_HANDLED;
|
return IRQ_HANDLED;
|
||||||
#endif
|
#endif
|
||||||
|
@ -289,7 +280,7 @@ static void bcm_interrupt (int irq, void * dev, struct pt_regs * regs)
|
||||||
* various initialization tasks
|
* various initialization tasks
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static int startup (struct bcm_serial *info)
|
static int startup(struct bcm_serial *info)
|
||||||
{
|
{
|
||||||
// Port is already started...
|
// Port is already started...
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -303,7 +294,7 @@ static int startup (struct bcm_serial *info)
|
||||||
* DTR is dropped if the hangup on close termio flag is on.
|
* DTR is dropped if the hangup on close termio flag is on.
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static void shutdown (struct bcm_serial * info)
|
static void shutdown(struct bcm_serial *info)
|
||||||
{
|
{
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
if (!info->is_initialized)
|
if (!info->is_initialized)
|
||||||
|
@ -311,13 +302,14 @@ static void shutdown (struct bcm_serial * info)
|
||||||
|
|
||||||
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
||||||
|
|
||||||
info->port->control &= ~(BRGEN|TXEN|RXEN);
|
info->port->control &= ~(BRGEN | TXEN | RXEN);
|
||||||
if (info->tty)
|
if (info->tty)
|
||||||
set_bit (TTY_IO_ERROR, &info->tty->flags);
|
set_bit(TTY_IO_ERROR, &info->tty->flags);
|
||||||
info->is_initialized = 0;
|
info->is_initialized = 0;
|
||||||
|
|
||||||
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
* change_speed ()
|
* change_speed ()
|
||||||
|
@ -325,13 +317,12 @@ static void shutdown (struct bcm_serial * info)
|
||||||
* Set the baud rate, character size, parity and stop bits.
|
* Set the baud rate, character size, parity and stop bits.
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static void change_speed( volatile Uart *pUart, tcflag_t cFlag )
|
static void change_speed(volatile Uart * pUart, tcflag_t cFlag)
|
||||||
{
|
{
|
||||||
unsigned long ulFlags, ulBaud, ulClockFreqHz, ulTmp;
|
unsigned long ulFlags, ulBaud, ulClockFreqHz, ulTmp;
|
||||||
|
|
||||||
spin_lock_irqsave(&bcm963xx_serial_lock, ulFlags);
|
spin_lock_irqsave(&bcm963xx_serial_lock, ulFlags);
|
||||||
switch( cFlag & (CBAUD | CBAUDEX) )
|
switch (cFlag & (CBAUD | CBAUDEX)) {
|
||||||
{
|
|
||||||
case B115200:
|
case B115200:
|
||||||
ulBaud = 115200;
|
ulBaud = 115200;
|
||||||
break;
|
break;
|
||||||
|
@ -391,15 +382,14 @@ static void change_speed( volatile Uart *pUart, tcflag_t cFlag )
|
||||||
/* Calculate buad rate. */
|
/* Calculate buad rate. */
|
||||||
ulClockFreqHz = BD_BCM63XX_TIMER_CLOCK_INPUT;
|
ulClockFreqHz = BD_BCM63XX_TIMER_CLOCK_INPUT;
|
||||||
ulTmp = (ulClockFreqHz / ulBaud) / 16;
|
ulTmp = (ulClockFreqHz / ulBaud) / 16;
|
||||||
if( ulTmp & 0x01 )
|
if (ulTmp & 0x01)
|
||||||
ulTmp /= 2; /* Rounding up, so sub is already accounted for */
|
ulTmp /= 2; /* Rounding up, so sub is already accounted for */
|
||||||
else
|
else
|
||||||
ulTmp = (ulTmp / 2) - 1; /* Rounding down so we must sub 1 */
|
ulTmp = (ulTmp / 2) - 1; /* Rounding down so we must sub 1 */
|
||||||
pUart->baudword = ulTmp;
|
pUart->baudword = ulTmp;
|
||||||
|
|
||||||
/* Set character size, stop bits and parity. */
|
/* Set character size, stop bits and parity. */
|
||||||
switch( cFlag & CSIZE )
|
switch (cFlag & CSIZE) {
|
||||||
{
|
|
||||||
case CS5:
|
case CS5:
|
||||||
ulTmp = BITS5SYM; /* select transmit 5 bit data size */
|
ulTmp = BITS5SYM; /* select transmit 5 bit data size */
|
||||||
break;
|
break;
|
||||||
|
@ -413,21 +403,22 @@ static void change_speed( volatile Uart *pUart, tcflag_t cFlag )
|
||||||
ulTmp = BITS8SYM; /* select transmit 8 bit data size */
|
ulTmp = BITS8SYM; /* select transmit 8 bit data size */
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
if( cFlag & CSTOPB )
|
if (cFlag & CSTOPB)
|
||||||
ulTmp |= TWOSTOP; /* select 2 stop bits */
|
ulTmp |= TWOSTOP; /* select 2 stop bits */
|
||||||
else
|
else
|
||||||
ulTmp |= ONESTOP; /* select one stop bit */
|
ulTmp |= ONESTOP; /* select one stop bit */
|
||||||
|
|
||||||
/* Write these values into the config reg. */
|
/* Write these values into the config reg. */
|
||||||
pUart->config = ulTmp;
|
pUart->config = ulTmp;
|
||||||
pUart->control &= ~(RXPARITYEN | TXPARITYEN | RXPARITYEVEN | TXPARITYEVEN);
|
pUart->control &=
|
||||||
switch( cFlag & (PARENB | PARODD) )
|
~(RXPARITYEN | TXPARITYEN | RXPARITYEVEN | TXPARITYEVEN);
|
||||||
{
|
switch (cFlag & (PARENB | PARODD)) {
|
||||||
case PARENB|PARODD:
|
case PARENB | PARODD:
|
||||||
pUart->control |= RXPARITYEN | TXPARITYEN;
|
pUart->control |= RXPARITYEN | TXPARITYEN;
|
||||||
break;
|
break;
|
||||||
case PARENB:
|
case PARENB:
|
||||||
pUart->control |= RXPARITYEN | TXPARITYEN | RXPARITYEVEN | TXPARITYEVEN;
|
pUart->control |=
|
||||||
|
RXPARITYEN | TXPARITYEN | RXPARITYEVEN | TXPARITYEVEN;
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
pUart->control |= 0;
|
pUart->control |= 0;
|
||||||
|
@ -447,7 +438,7 @@ static void change_speed( volatile Uart *pUart, tcflag_t cFlag )
|
||||||
* Nothing to flush. Polled I/O is used.
|
* Nothing to flush. Polled I/O is used.
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static void bcm63xx_cons_flush_chars (struct tty_struct *tty)
|
static void bcm63xx_cons_flush_chars(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -459,7 +450,7 @@ static void bcm63xx_cons_flush_chars (struct tty_struct *tty)
|
||||||
* Main output routine using polled I/O.
|
* Main output routine using polled I/O.
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static int bcm63xx_cons_write (struct tty_struct *tty,
|
static int bcm63xx_cons_write(struct tty_struct *tty,
|
||||||
const unsigned char *buf, int count)
|
const unsigned char *buf, int count)
|
||||||
{
|
{
|
||||||
int c;
|
int c;
|
||||||
|
@ -476,7 +467,7 @@ static int bcm63xx_cons_write (struct tty_struct *tty,
|
||||||
* Compute the amount of space available for writing.
|
* Compute the amount of space available for writing.
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static int bcm63xx_cons_write_room (struct tty_struct *tty)
|
static int bcm63xx_cons_write_room(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
/* Pick a number. Any number. Polled I/O is used. */
|
/* Pick a number. Any number. Polled I/O is used. */
|
||||||
return 1024;
|
return 1024;
|
||||||
|
@ -489,7 +480,7 @@ static int bcm63xx_cons_write_room (struct tty_struct *tty)
|
||||||
* compute the amount of char left to be transmitted
|
* compute the amount of char left to be transmitted
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static int bcm_chars_in_buffer (struct tty_struct *tty)
|
static int bcm_chars_in_buffer(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -501,7 +492,7 @@ static int bcm_chars_in_buffer (struct tty_struct *tty)
|
||||||
* Empty the output buffer
|
* Empty the output buffer
|
||||||
* -------------------------------------------------------------------
|
* -------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static void bcm_flush_buffer (struct tty_struct *tty)
|
static void bcm_flush_buffer(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
tty_wakeup(tty);
|
tty_wakeup(tty);
|
||||||
}
|
}
|
||||||
|
@ -514,18 +505,17 @@ static void bcm_flush_buffer (struct tty_struct *tty)
|
||||||
* incoming characters should be throttled (or not).
|
* incoming characters should be throttled (or not).
|
||||||
* ------------------------------------------------------------
|
* ------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static void bcm_throttle (struct tty_struct *tty)
|
static void bcm_throttle(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
struct bcm_serial *info = (struct bcm_serial *)tty->driver_data;
|
struct bcm_serial *info = (struct bcm_serial *) tty->driver_data;
|
||||||
if (I_IXOFF(tty))
|
if (I_IXOFF(tty))
|
||||||
info->x_char = STOP_CHAR(tty);
|
info->x_char = STOP_CHAR(tty);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void bcm_unthrottle (struct tty_struct *tty)
|
static void bcm_unthrottle(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
struct bcm_serial *info = (struct bcm_serial *)tty->driver_data;
|
struct bcm_serial *info = (struct bcm_serial *) tty->driver_data;
|
||||||
if (I_IXOFF(tty))
|
if (I_IXOFF(tty)) {
|
||||||
{
|
|
||||||
if (info->x_char)
|
if (info->x_char)
|
||||||
info->x_char = 0;
|
info->x_char = 0;
|
||||||
else
|
else
|
||||||
|
@ -533,12 +523,12 @@ static void bcm_unthrottle (struct tty_struct *tty)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void bcm_send_xchar (struct tty_struct *tty, char ch)
|
static void bcm_send_xchar(struct tty_struct *tty, char ch)
|
||||||
{
|
{
|
||||||
struct bcm_serial *info = (struct bcm_serial *)tty->driver_data;
|
struct bcm_serial *info = (struct bcm_serial *) tty->driver_data;
|
||||||
info->x_char = ch;
|
info->x_char = ch;
|
||||||
if (ch)
|
if (ch)
|
||||||
bcm_start (info->tty);
|
bcm_start(info->tty);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -546,14 +536,15 @@ static void bcm_send_xchar (struct tty_struct *tty, char ch)
|
||||||
* rs_ioctl () and friends
|
* rs_ioctl () and friends
|
||||||
* ------------------------------------------------------------
|
* ------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static int get_serial_info(struct bcm_serial *info, struct serial_struct *retinfo)
|
static int get_serial_info(struct bcm_serial *info,
|
||||||
|
struct serial_struct *retinfo)
|
||||||
{
|
{
|
||||||
struct serial_struct tmp;
|
struct serial_struct tmp;
|
||||||
|
|
||||||
if (!retinfo)
|
if (!retinfo)
|
||||||
return -EFAULT;
|
return -EFAULT;
|
||||||
|
|
||||||
memset (&tmp, 0, sizeof(tmp));
|
memset(&tmp, 0, sizeof(tmp));
|
||||||
tmp.type = info->type;
|
tmp.type = info->type;
|
||||||
tmp.line = info->line;
|
tmp.line = info->line;
|
||||||
tmp.port = (int) info->port;
|
tmp.port = (int) info->port;
|
||||||
|
@ -563,10 +554,11 @@ static int get_serial_info(struct bcm_serial *info, struct serial_struct *retinf
|
||||||
tmp.close_delay = info->close_delay;
|
tmp.close_delay = info->close_delay;
|
||||||
tmp.closing_wait = info->closing_wait;
|
tmp.closing_wait = info->closing_wait;
|
||||||
|
|
||||||
return copy_to_user (retinfo, &tmp, sizeof(*retinfo));
|
return copy_to_user(retinfo, &tmp, sizeof(*retinfo));
|
||||||
}
|
}
|
||||||
|
|
||||||
static int set_serial_info (struct bcm_serial *info, struct serial_struct *new_info)
|
static int set_serial_info(struct bcm_serial *info,
|
||||||
|
struct serial_struct *new_info)
|
||||||
{
|
{
|
||||||
struct serial_struct new_serial;
|
struct serial_struct new_serial;
|
||||||
struct bcm_serial old_info;
|
struct bcm_serial old_info;
|
||||||
|
@ -575,7 +567,7 @@ static int set_serial_info (struct bcm_serial *info, struct serial_struct *new_i
|
||||||
if (!new_info)
|
if (!new_info)
|
||||||
return -EFAULT;
|
return -EFAULT;
|
||||||
|
|
||||||
copy_from_user (&new_serial, new_info, sizeof(new_serial));
|
copy_from_user(&new_serial, new_info, sizeof(new_serial));
|
||||||
old_info = *info;
|
old_info = *info;
|
||||||
|
|
||||||
if (!capable(CAP_SYS_ADMIN))
|
if (!capable(CAP_SYS_ADMIN))
|
||||||
|
@ -592,7 +584,7 @@ static int set_serial_info (struct bcm_serial *info, struct serial_struct *new_i
|
||||||
info->type = new_serial.type;
|
info->type = new_serial.type;
|
||||||
info->close_delay = new_serial.close_delay;
|
info->close_delay = new_serial.close_delay;
|
||||||
info->closing_wait = new_serial.closing_wait;
|
info->closing_wait = new_serial.closing_wait;
|
||||||
retval = startup (info);
|
retval = startup(info);
|
||||||
return retval;
|
return retval;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -606,15 +598,15 @@ static int set_serial_info (struct bcm_serial *info, struct serial_struct *new_i
|
||||||
* transmit holding register is empty. This functionality
|
* transmit holding register is empty. This functionality
|
||||||
* allows an RS485 driver to be written in user space.
|
* allows an RS485 driver to be written in user space.
|
||||||
*/
|
*/
|
||||||
static int get_lsr_info (struct bcm_serial *info, unsigned int *value)
|
static int get_lsr_info(struct bcm_serial *info, unsigned int *value)
|
||||||
{
|
{
|
||||||
return( 0 );
|
return (0);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* This routine sends a break character out the serial port.
|
* This routine sends a break character out the serial port.
|
||||||
*/
|
*/
|
||||||
static void send_break (struct bcm_serial *info, int duration)
|
static void send_break(struct bcm_serial *info, int duration)
|
||||||
{
|
{
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
|
|
||||||
|
@ -624,7 +616,7 @@ static void send_break (struct bcm_serial *info, int duration)
|
||||||
current->state = TASK_INTERRUPTIBLE;
|
current->state = TASK_INTERRUPTIBLE;
|
||||||
|
|
||||||
/*save_flags (flags);
|
/*save_flags (flags);
|
||||||
cli();*/
|
cli(); */
|
||||||
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
||||||
|
|
||||||
info->port->control |= XMITBREAK;
|
info->port->control |= XMITBREAK;
|
||||||
|
@ -635,81 +627,90 @@ static void send_break (struct bcm_serial *info, int duration)
|
||||||
//restore_flags (flags);
|
//restore_flags (flags);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int bcm_ioctl (struct tty_struct * tty, struct file * file,
|
static int bcm_ioctl(struct tty_struct *tty, struct file *file,
|
||||||
unsigned int cmd, unsigned long arg)
|
unsigned int cmd, unsigned long arg)
|
||||||
{
|
{
|
||||||
int error;
|
int error;
|
||||||
struct bcm_serial * info = (struct bcm_serial *)tty->driver_data;
|
struct bcm_serial *info = (struct bcm_serial *) tty->driver_data;
|
||||||
int retval;
|
int retval;
|
||||||
|
|
||||||
if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
|
if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
|
||||||
(cmd != TIOCSERCONFIG) && (cmd != TIOCSERGWILD) &&
|
(cmd != TIOCSERCONFIG) && (cmd != TIOCSERGWILD) &&
|
||||||
(cmd != TIOCSERSWILD) && (cmd != TIOCSERGSTRUCT))
|
(cmd != TIOCSERSWILD) && (cmd != TIOCSERGSTRUCT)) {
|
||||||
{
|
|
||||||
if (tty->flags & (1 << TTY_IO_ERROR))
|
if (tty->flags & (1 << TTY_IO_ERROR))
|
||||||
return -EIO;
|
return -EIO;
|
||||||
}
|
}
|
||||||
switch (cmd)
|
switch (cmd) {
|
||||||
{
|
|
||||||
|
|
||||||
case TCSBRK: /* SVID version: non-zero arg --> no break */
|
case TCSBRK: /* SVID version: non-zero arg --> no break */
|
||||||
retval = tty_check_change (tty);
|
retval = tty_check_change(tty);
|
||||||
if (retval)
|
if (retval)
|
||||||
return retval;
|
return retval;
|
||||||
tty_wait_until_sent (tty, 0);
|
tty_wait_until_sent(tty, 0);
|
||||||
if (!arg)
|
if (!arg)
|
||||||
send_break (info, HZ/4); /* 1/4 second */
|
send_break(info, HZ / 4); /* 1/4 second */
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
case TCSBRKP: /* support for POSIX tcsendbreak() */
|
case TCSBRKP: /* support for POSIX tcsendbreak() */
|
||||||
retval = tty_check_change (tty);
|
retval = tty_check_change(tty);
|
||||||
if (retval)
|
if (retval)
|
||||||
return retval;
|
return retval;
|
||||||
tty_wait_until_sent (tty, 0);
|
tty_wait_until_sent(tty, 0);
|
||||||
send_break (info, arg ? arg*(HZ/10) : HZ/4);
|
send_break(info, arg ? arg * (HZ / 10) : HZ / 4);
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
case TIOCGSOFTCAR:
|
case TIOCGSOFTCAR:
|
||||||
error = access_ok (VERIFY_WRITE, (void *)arg, sizeof(long));
|
error =
|
||||||
|
access_ok(VERIFY_WRITE, (void *) arg, sizeof(long));
|
||||||
if (!error)
|
if (!error)
|
||||||
return -EFAULT;
|
return -EFAULT;
|
||||||
else
|
else {
|
||||||
{
|
put_user(C_CLOCAL(tty) ? 1 : 0,
|
||||||
put_user (C_CLOCAL(tty) ? 1 : 0, (unsigned long *)arg);
|
(unsigned long *) arg);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
case TIOCSSOFTCAR:
|
case TIOCSSOFTCAR:
|
||||||
error = get_user (arg, (unsigned long *)arg);
|
error = get_user(arg, (unsigned long *) arg);
|
||||||
if (error)
|
if (error)
|
||||||
return error;
|
return error;
|
||||||
tty->termios->c_cflag = ((tty->termios->c_cflag & ~CLOCAL) | (arg ? CLOCAL : 0));
|
tty->termios->c_cflag =
|
||||||
|
((tty->termios->
|
||||||
|
c_cflag & ~CLOCAL) | (arg ? CLOCAL : 0));
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
case TIOCGSERIAL:
|
case TIOCGSERIAL:
|
||||||
error = access_ok (VERIFY_WRITE, (void *)arg, sizeof(struct serial_struct));
|
error =
|
||||||
|
access_ok(VERIFY_WRITE, (void *) arg,
|
||||||
|
sizeof(struct serial_struct));
|
||||||
if (!error)
|
if (!error)
|
||||||
return -EFAULT;
|
return -EFAULT;
|
||||||
else
|
else
|
||||||
return get_serial_info (info, (struct serial_struct *)arg);
|
return get_serial_info(info,
|
||||||
|
(struct serial_struct *)
|
||||||
|
arg);
|
||||||
|
|
||||||
case TIOCSSERIAL:
|
case TIOCSSERIAL:
|
||||||
return set_serial_info (info, (struct serial_struct *) arg);
|
return set_serial_info(info, (struct serial_struct *) arg);
|
||||||
|
|
||||||
case TIOCSERGETLSR: /* Get line status register */
|
case TIOCSERGETLSR: /* Get line status register */
|
||||||
error = access_ok (VERIFY_WRITE, (void *)arg, sizeof(unsigned int));
|
error =
|
||||||
|
access_ok(VERIFY_WRITE, (void *) arg,
|
||||||
|
sizeof(unsigned int));
|
||||||
if (!error)
|
if (!error)
|
||||||
return -EFAULT;
|
return -EFAULT;
|
||||||
else
|
else
|
||||||
return get_lsr_info (info, (unsigned int *)arg);
|
return get_lsr_info(info, (unsigned int *) arg);
|
||||||
|
|
||||||
case TIOCSERGSTRUCT:
|
case TIOCSERGSTRUCT:
|
||||||
error = access_ok (VERIFY_WRITE, (void *)arg, sizeof(struct bcm_serial));
|
error =
|
||||||
|
access_ok(VERIFY_WRITE, (void *) arg,
|
||||||
|
sizeof(struct bcm_serial));
|
||||||
if (!error)
|
if (!error)
|
||||||
return -EFAULT;
|
return -EFAULT;
|
||||||
else
|
else {
|
||||||
{
|
copy_to_user((struct bcm_serial *) arg, info,
|
||||||
copy_to_user((struct bcm_serial *)arg, info, sizeof(struct bcm_serial));
|
sizeof(struct bcm_serial));
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -719,12 +720,13 @@ static int bcm_ioctl (struct tty_struct * tty, struct file * file,
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void bcm_set_termios (struct tty_struct *tty, struct termios *old_termios)
|
static void bcm_set_termios(struct tty_struct *tty,
|
||||||
|
struct termios *old_termios)
|
||||||
{
|
{
|
||||||
struct bcm_serial *info = (struct bcm_serial *)tty->driver_data;
|
struct bcm_serial *info = (struct bcm_serial *) tty->driver_data;
|
||||||
|
|
||||||
if( tty->termios->c_cflag != old_termios->c_cflag )
|
if (tty->termios->c_cflag != old_termios->c_cflag)
|
||||||
change_speed (info->port, tty->termios->c_cflag);
|
change_speed(info->port, tty->termios->c_cflag);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -736,27 +738,25 @@ static void bcm_set_termios (struct tty_struct *tty, struct termios *old_termios
|
||||||
* the transmit enable and receive enable flags.
|
* the transmit enable and receive enable flags.
|
||||||
* ------------------------------------------------------------
|
* ------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static void bcm63xx_cons_close (struct tty_struct *tty, struct file *filp)
|
static void bcm63xx_cons_close(struct tty_struct *tty, struct file *filp)
|
||||||
{
|
{
|
||||||
struct bcm_serial * info = (struct bcm_serial *)tty->driver_data;
|
struct bcm_serial *info = (struct bcm_serial *) tty->driver_data;
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
|
|
||||||
if (!info)
|
if (!info)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
/*save_flags (flags);
|
/*save_flags (flags);
|
||||||
cli();*/
|
cli(); */
|
||||||
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
||||||
|
|
||||||
if (tty_hung_up_p (filp))
|
if (tty_hung_up_p(filp)) {
|
||||||
{
|
|
||||||
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
||||||
//restore_flags (flags);
|
//restore_flags (flags);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((tty->count == 1) && (info->count != 1))
|
if ((tty->count == 1) && (info->count != 1)) {
|
||||||
{
|
|
||||||
|
|
||||||
/* Uh, oh. tty->count is 1, which means that the tty
|
/* Uh, oh. tty->count is 1, which means that the tty
|
||||||
* structure will be freed. Info->count should always
|
* structure will be freed. Info->count should always
|
||||||
|
@ -764,20 +764,19 @@ static void bcm63xx_cons_close (struct tty_struct *tty, struct file *filp)
|
||||||
* one, we've got real problems, since it means the
|
* one, we've got real problems, since it means the
|
||||||
* serial port won't be shutdown.
|
* serial port won't be shutdown.
|
||||||
*/
|
*/
|
||||||
printk("bcm63xx_cons_close: bad serial port count; tty->count is 1, "
|
printk
|
||||||
|
("bcm63xx_cons_close: bad serial port count; tty->count is 1, "
|
||||||
"info->count is %d\n", info->count);
|
"info->count is %d\n", info->count);
|
||||||
info->count = 1;
|
info->count = 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (--info->count < 0)
|
if (--info->count < 0) {
|
||||||
{
|
|
||||||
printk("ds_close: bad serial port count for ttys%d: %d\n",
|
printk("ds_close: bad serial port count for ttys%d: %d\n",
|
||||||
info->line, info->count);
|
info->line, info->count);
|
||||||
info->count = 0;
|
info->count = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (info->count)
|
if (info->count) {
|
||||||
{
|
|
||||||
//restore_flags (flags);
|
//restore_flags (flags);
|
||||||
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
||||||
return;
|
return;
|
||||||
|
@ -791,39 +790,36 @@ static void bcm63xx_cons_close (struct tty_struct *tty, struct file *filp)
|
||||||
/* At this point we stop accepting input. To do this, we
|
/* At this point we stop accepting input. To do this, we
|
||||||
* disable the receive line status interrupts.
|
* disable the receive line status interrupts.
|
||||||
*/
|
*/
|
||||||
shutdown (info);
|
shutdown(info);
|
||||||
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
|
||||||
if (tty->driver->flush_buffer)
|
if (tty->driver->flush_buffer)
|
||||||
tty->driver->flush_buffer (tty);
|
tty->driver->flush_buffer(tty);
|
||||||
#else
|
#else
|
||||||
if (tty->driver.flush_buffer)
|
if (tty->driver.flush_buffer)
|
||||||
tty->driver.flush_buffer (tty);
|
tty->driver.flush_buffer(tty);
|
||||||
#endif
|
#endif
|
||||||
if (tty->ldisc.flush_buffer)
|
if (tty->ldisc.flush_buffer)
|
||||||
tty->ldisc.flush_buffer (tty);
|
tty->ldisc.flush_buffer(tty);
|
||||||
|
|
||||||
tty->closing = 0;
|
tty->closing = 0;
|
||||||
info->event = 0;
|
info->event = 0;
|
||||||
info->tty = 0;
|
info->tty = 0;
|
||||||
if (tty->ldisc.num != tty_ldisc_get(N_TTY)->num)
|
if (tty->ldisc.num != tty_ldisc_get(N_TTY)->num) {
|
||||||
{
|
|
||||||
if (tty->ldisc.close)
|
if (tty->ldisc.close)
|
||||||
(tty->ldisc.close)(tty);
|
(tty->ldisc.close) (tty);
|
||||||
tty->ldisc = *tty_ldisc_get(N_TTY);
|
tty->ldisc = *tty_ldisc_get(N_TTY);
|
||||||
tty->termios->c_line = N_TTY;
|
tty->termios->c_line = N_TTY;
|
||||||
if (tty->ldisc.open)
|
if (tty->ldisc.open)
|
||||||
(tty->ldisc.open)(tty);
|
(tty->ldisc.open) (tty);
|
||||||
}
|
}
|
||||||
if (info->blocked_open)
|
if (info->blocked_open) {
|
||||||
{
|
if (info->close_delay) {
|
||||||
if (info->close_delay)
|
|
||||||
{
|
|
||||||
current->state = TASK_INTERRUPTIBLE;
|
current->state = TASK_INTERRUPTIBLE;
|
||||||
schedule_timeout(info->close_delay);
|
schedule_timeout(info->close_delay);
|
||||||
}
|
}
|
||||||
wake_up_interruptible (&info->open_wait);
|
wake_up_interruptible(&info->open_wait);
|
||||||
}
|
}
|
||||||
wake_up_interruptible (&info->close_wait);
|
wake_up_interruptible(&info->close_wait);
|
||||||
|
|
||||||
//restore_flags (flags);
|
//restore_flags (flags);
|
||||||
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
spin_unlock_irqrestore(&bcm963xx_serial_lock, flags);
|
||||||
|
@ -832,16 +828,16 @@ static void bcm63xx_cons_close (struct tty_struct *tty, struct file *filp)
|
||||||
/*
|
/*
|
||||||
* bcm_hangup () --- called by tty_hangup() when a hangup is signaled.
|
* bcm_hangup () --- called by tty_hangup() when a hangup is signaled.
|
||||||
*/
|
*/
|
||||||
static void bcm_hangup (struct tty_struct *tty)
|
static void bcm_hangup(struct tty_struct *tty)
|
||||||
{
|
{
|
||||||
|
|
||||||
struct bcm_serial *info = (struct bcm_serial *)tty->driver_data;
|
struct bcm_serial *info = (struct bcm_serial *) tty->driver_data;
|
||||||
|
|
||||||
shutdown (info);
|
shutdown(info);
|
||||||
info->event = 0;
|
info->event = 0;
|
||||||
info->count = 0;
|
info->count = 0;
|
||||||
info->tty = 0;
|
info->tty = 0;
|
||||||
wake_up_interruptible (&info->open_wait);
|
wake_up_interruptible(&info->open_wait);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -849,7 +845,7 @@ static void bcm_hangup (struct tty_struct *tty)
|
||||||
* rs_open() and friends
|
* rs_open() and friends
|
||||||
* ------------------------------------------------------------
|
* ------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
static int block_til_ready (struct tty_struct *tty, struct file *filp,
|
static int block_til_ready(struct tty_struct *tty, struct file *filp,
|
||||||
struct bcm_serial *info)
|
struct bcm_serial *info)
|
||||||
{
|
{
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -860,7 +856,7 @@ static int block_til_ready (struct tty_struct *tty, struct file *filp,
|
||||||
* enables interrupts for a serial port. It also performs the
|
* enables interrupts for a serial port. It also performs the
|
||||||
* serial-specific initialization for the tty structure.
|
* serial-specific initialization for the tty structure.
|
||||||
*/
|
*/
|
||||||
static int bcm63xx_cons_open (struct tty_struct * tty, struct file * filp)
|
static int bcm63xx_cons_open(struct tty_struct *tty, struct file *filp)
|
||||||
{
|
{
|
||||||
struct bcm_serial *info;
|
struct bcm_serial *info;
|
||||||
int retval, line;
|
int retval, line;
|
||||||
|
@ -877,21 +873,21 @@ static int bcm63xx_cons_open (struct tty_struct * tty, struct file * filp)
|
||||||
|
|
||||||
info = lines[line];
|
info = lines[line];
|
||||||
|
|
||||||
tty->low_latency=1;
|
tty->low_latency = 1;
|
||||||
info->port->intMask = 0; /* Clear any pending interrupts */
|
info->port->intMask = 0; /* Clear any pending interrupts */
|
||||||
info->port->intMask = RXINT; /* Enable RX */
|
info->port->intMask = RXINT; /* Enable RX */
|
||||||
|
|
||||||
info->count++;
|
info->count++;
|
||||||
tty->driver_data = info;
|
tty->driver_data = info;
|
||||||
info->tty = tty;
|
info->tty = tty;
|
||||||
BcmHalInterruptEnable (INTERRUPT_ID_UART);
|
enable_brcm_irq(INTERRUPT_ID_UART);
|
||||||
|
|
||||||
// Start up serial port
|
// Start up serial port
|
||||||
retval = startup (info);
|
retval = startup(info);
|
||||||
if (retval)
|
if (retval)
|
||||||
return retval;
|
return retval;
|
||||||
|
|
||||||
retval = block_til_ready (tty, filp, info);
|
retval = block_til_ready(tty, filp, info);
|
||||||
if (retval)
|
if (retval)
|
||||||
return retval;
|
return retval;
|
||||||
|
|
||||||
|
@ -933,7 +929,7 @@ static struct tty_operations rs_ops = {
|
||||||
static int __init bcm63xx_serialinit(void)
|
static int __init bcm63xx_serialinit(void)
|
||||||
{
|
{
|
||||||
int i, flags;
|
int i, flags;
|
||||||
struct bcm_serial * info;
|
struct bcm_serial *info;
|
||||||
|
|
||||||
// Print the driver version information
|
// Print the driver version information
|
||||||
printk(VER_STR);
|
printk(VER_STR);
|
||||||
|
@ -942,12 +938,10 @@ static int __init bcm63xx_serialinit(void)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
serial_driver->owner = THIS_MODULE;
|
serial_driver->owner = THIS_MODULE;
|
||||||
// serial_driver->devfs_name = "tts/";
|
|
||||||
// serial_driver.magic = TTY_DRIVER_MAGIC;
|
|
||||||
serial_driver->name = "ttyS";
|
serial_driver->name = "ttyS";
|
||||||
serial_driver->major = TTY_MAJOR;
|
serial_driver->major = TTY_MAJOR;
|
||||||
serial_driver->minor_start = 64;
|
serial_driver->minor_start = 64;
|
||||||
// serial_driver.num = BCM_NUM_UARTS;
|
serial_driver->num = 1;
|
||||||
serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
|
serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
|
||||||
serial_driver->subtype = SERIAL_TYPE_NORMAL;
|
serial_driver->subtype = SERIAL_TYPE_NORMAL;
|
||||||
serial_driver->init_termios = tty_std_termios;
|
serial_driver->init_termios = tty_std_termios;
|
||||||
|
@ -959,18 +953,17 @@ static int __init bcm63xx_serialinit(void)
|
||||||
|
|
||||||
tty_set_operations(serial_driver, &rs_ops);
|
tty_set_operations(serial_driver, &rs_ops);
|
||||||
|
|
||||||
if (tty_register_driver (serial_driver))
|
if (tty_register_driver(serial_driver))
|
||||||
panic("Couldn't register serial driver\n");
|
panic("Couldn't register serial driver\n");
|
||||||
|
|
||||||
//save_flags(flags); cli();
|
//save_flags(flags); cli();
|
||||||
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
spin_lock_irqsave(&bcm963xx_serial_lock, flags);
|
||||||
|
|
||||||
for (i = 0; i < BCM_NUM_UARTS; i++)
|
for (i = 0; i < 1; i++) {
|
||||||
{
|
|
||||||
info = &multi[i];
|
info = &multi[i];
|
||||||
lines[i] = info;
|
lines[i] = info;
|
||||||
info->magic = SERIAL_MAGIC;
|
info->magic = SERIAL_MAGIC;
|
||||||
info->port = (Uart *) ((char *)UART_BASE + (i * 0x20));
|
info->port = (Uart *) ((char *) UART_BASE + (i * 0x20));
|
||||||
info->tty = 0;
|
info->tty = 0;
|
||||||
info->irq = (2 - i) + 8;
|
info->irq = (2 - i) + 8;
|
||||||
info->line = i;
|
info->line = i;
|
||||||
|
@ -987,7 +980,7 @@ static int __init bcm63xx_serialinit(void)
|
||||||
/* If we are pointing to address zero then punt - not correctly
|
/* If we are pointing to address zero then punt - not correctly
|
||||||
* set up in setup.c to handle this.
|
* set up in setup.c to handle this.
|
||||||
*/
|
*/
|
||||||
if (! info->port)
|
if (!info->port)
|
||||||
return 0;
|
return 0;
|
||||||
BcmHalMapInterrupt(bcm_interrupt, 0, INTERRUPT_ID_UART);
|
BcmHalMapInterrupt(bcm_interrupt, 0, INTERRUPT_ID_UART);
|
||||||
}
|
}
|
||||||
|
@ -1007,28 +1000,26 @@ module_init(bcm63xx_serialinit);
|
||||||
Purpose: bcm_console_print is registered for printk.
|
Purpose: bcm_console_print is registered for printk.
|
||||||
The console_lock must be held when we get here.
|
The console_lock must be held when we get here.
|
||||||
-------------------------------------------------------------------------- */
|
-------------------------------------------------------------------------- */
|
||||||
static void bcm_console_print (struct console * cons, const char * str,
|
static void bcm_console_print(struct console *cons, const char *str,
|
||||||
unsigned int count)
|
unsigned int count)
|
||||||
{
|
{
|
||||||
unsigned int i;
|
unsigned int i;
|
||||||
//_puts(str);
|
//_puts(str);
|
||||||
for(i=0; i<count; i++, str++)
|
for (i = 0; i < count; i++, str++) {
|
||||||
{
|
|
||||||
_putc(*str);
|
_putc(*str);
|
||||||
if (*str == 10)
|
if (*str == 10) {
|
||||||
{
|
|
||||||
_putc(13);
|
_putc(13);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct tty_driver * bcm_console_device(struct console * c, int *index)
|
static struct tty_driver *bcm_console_device(struct console *c, int *index)
|
||||||
{
|
{
|
||||||
*index = c->index;
|
*index = c->index;
|
||||||
return serial_driver;
|
return serial_driver;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int __init bcm_console_setup(struct console * co, char * options)
|
static int __init bcm_console_setup(struct console *co, char *options)
|
||||||
{
|
{
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
|
@ -3,4 +3,5 @@
|
||||||
#define BOOT_LOADER_UNKNOWN 0
|
#define BOOT_LOADER_UNKNOWN 0
|
||||||
#define BOOT_LOADER_CFE 1
|
#define BOOT_LOADER_CFE 1
|
||||||
#define BOOT_LOADER_REDBOOT 2
|
#define BOOT_LOADER_REDBOOT 2
|
||||||
#define BOOT_LOADER_LAST 2
|
#define BOOT_LOADER_CFE2 3
|
||||||
|
#define BOOT_LOADER_LAST 3
|
||||||
|
|
36
target/linux/brcm63xx-2.6/patches/150-sst_flash.patch
Normal file
36
target/linux/brcm63xx-2.6/patches/150-sst_flash.patch
Normal file
|
@ -0,0 +1,36 @@
|
||||||
|
diff -urN linux-2.6.19.2/drivers/mtd/chips/jedec_probe.c linux-2.6.19.2.new/drivers/mtd/chips/jedec_probe.c
|
||||||
|
--- linux-2.6.19.2/drivers/mtd/chips/jedec_probe.c 2007-01-10 20:10:37.000000000 +0100
|
||||||
|
+++ linux-2.6.19.2.new/drivers/mtd/chips/jedec_probe.c 2007-04-09 22:33:05.000000000 +0200
|
||||||
|
@@ -158,6 +158,7 @@
|
||||||
|
#define SST49LF030A 0x001C
|
||||||
|
#define SST49LF040A 0x0051
|
||||||
|
#define SST49LF080A 0x005B
|
||||||
|
+#define SST39VF6402B 0x236C
|
||||||
|
|
||||||
|
/* Toshiba */
|
||||||
|
#define TC58FVT160 0x00C2
|
||||||
|
@@ -1494,7 +1495,23 @@
|
||||||
|
ERASEINFO(0x1000,256),
|
||||||
|
ERASEINFO(0x1000,256)
|
||||||
|
}
|
||||||
|
-
|
||||||
|
+ }, {
|
||||||
|
+ .mfr_id = MANUFACTURER_SST,
|
||||||
|
+ .dev_id = SST39VF6402B,
|
||||||
|
+ .name = "SST 39VF6402B",
|
||||||
|
+ .uaddr = {
|
||||||
|
+ [0] = MTD_UADDR_0x5555_0x2AAA, /* x8 */
|
||||||
|
+ [1] = MTD_UADDR_0x5555_0x2AAA /* x16 */
|
||||||
|
+ },
|
||||||
|
+ .DevSize = SIZE_8MiB,
|
||||||
|
+ .CmdSet = P_ID_AMD_STD,
|
||||||
|
+ .NumEraseRegions= 4,
|
||||||
|
+ .regions = {
|
||||||
|
+ ERASEINFO(0x2000,256),
|
||||||
|
+ ERASEINFO(0x2000,256),
|
||||||
|
+ ERASEINFO(0x2000,256),
|
||||||
|
+ ERASEINFO(0x2000,256)
|
||||||
|
+ }
|
||||||
|
}, {
|
||||||
|
.mfr_id = MANUFACTURER_ST, /* FIXME - CFI device? */
|
||||||
|
.dev_id = M29W800DT,
|
Loading…
Reference in a new issue