brcm63xx cleanups; add a watchdog driver, indent serial console driver, add support for another sst flash

SVN-Revision: 6985
This commit is contained in:
Florian Fainelli 2007-04-17 16:00:23 +00:00
parent 65d82bc293
commit 2bf49e010b
8 changed files with 943 additions and 652 deletions

View file

@ -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

View file

@ -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);

View file

@ -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 );

View file

@ -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;
} }

View 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");

View file

@ -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;
} }

View file

@ -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

View 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,