mpsc.c revision d052d1beff706920e82c5d55006b08e256b5df09
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * drivers/serial/mpsc.c 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Generic driver for the MPSC (UART mode) on Marvell parts (e.g., GT64240, 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * GT64260, MV64340, MV64360, GT96100, ... ). 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Author: Mark A. Greer <mgreer@mvista.com> 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Based on an old MPSC driver that was in the linuxppc tree. It appears to 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * have been created by Chris Zankel (formerly of MontaVista) but there 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is no proper Copyright so I'm not sure. Apparently, parts were also 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * taken from PPCBoot (now U-Boot). Also based on drivers/serial/8250.c 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * by Russell King. 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2004 (c) MontaVista, Software, Inc. This file is licensed under 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the terms of the GNU General Public License version 2. This program 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is licensed "as is" without any warranty of any kind, whether express 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * or implied. 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The MPSC interface is much like a typical network controller's interface. 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * That is, you set up separate rings of descriptors for transmitting and 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * receiving data. There is also a pool of buffers with (one buffer per 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * descriptor) that incoming data are dma'd into or outgoing data are dma'd 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * out of. 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The MPSC requires two other controllers to be able to work. The Baud Rate 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Generator (BRG) provides a clock at programmable frequencies which determines 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the baud rate. The Serial DMA Controller (SDMA) takes incoming data from the 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MPSC and DMA's it into memory or DMA's outgoing data and passes it to the 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MPSC. It is actually the SDMA interrupt that the driver uses to keep the 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * transmit and receive "engines" going (i.e., indicate data has been 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * transmitted or received). 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * NOTES: 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1) Some chips have an erratum where several regs cannot be 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * read. To work around that, we keep a local copy of those regs in 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 'mpsc_port_info'. 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2) Some chips have an erratum where the ctlr will hang when the SDMA ctlr 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * accesses system mem with coherency enabled. For that reason, the driver 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * assumes that coherency for that ctlr has been disabled. This means 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * that when in a cache coherent system, the driver has to manually manage 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the data cache on the areas that it touches because the dma_* macro are 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * basically no-ops. 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 3) There is an erratum (on PPC) where you can't use the instruction to do 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * a DMA_TO_DEVICE/cache clean so DMA_BIDIRECTIONAL/flushes are used in places 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * where a DMA_TO_DEVICE/clean would have [otherwise] sufficed. 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4) AFAICT, hardware flow control isn't supported by the controller --MAG. 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 55d052d1beff706920e82c5d55006b08e256b5df09Russell King#include <linux/platform_device.h> 56d052d1beff706920e82c5d55006b08e256b5df09Russell King 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "mpsc.h" 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Define how this driver is known to the outside (we've been assigned a 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * range on the "Low-density serial ports" major). 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_MAJOR 204 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_MINOR_START 44 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_DRIVER_NAME "MPSC" 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_DEVFS_NAME "ttymm/" 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_DEV_NAME "ttyMM" 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_VERSION "1.00" 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct mpsc_port_info mpsc_ports[MPSC_NUM_CTLRS]; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct mpsc_shared_regs mpsc_shared_regs; 724d0145a7deab4027a0f0a7de74c2d103b8f029cfLee Nicksstatic struct uart_driver mpsc_reg; 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 744d0145a7deab4027a0f0a7de74c2d103b8f029cfLee Nicksstatic void mpsc_start_rx(struct mpsc_port_info *pi); 754d0145a7deab4027a0f0a7de74c2d103b8f029cfLee Nicksstatic void mpsc_free_ring_mem(struct mpsc_port_info *pi); 764d0145a7deab4027a0f0a7de74c2d103b8f029cfLee Nicksstatic void mpsc_release_port(struct uart_port *port); 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Baud Rate Generator Routines (BRG) 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_brg_init(struct mpsc_port_info *pi, u32 clk_src) 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->BRG_BCR_m : readl(pi->brg_base + BRG_BCR); 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~(0xf << 18)) | ((clk_src & 0xf) << 18); 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->brg_can_tune) 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~(1 << 25); 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->BRG_BCR_m = v; 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->brg_base + BRG_BCR); 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(readl(pi->brg_base + BRG_BTR) & 0xffff0000, 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->brg_base + BRG_BTR); 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_brg_enable(struct mpsc_port_info *pi) 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->BRG_BCR_m : readl(pi->brg_base + BRG_BCR); 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= (1 << 16); 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->BRG_BCR_m = v; 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->brg_base + BRG_BCR); 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_brg_disable(struct mpsc_port_info *pi) 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->BRG_BCR_m : readl(pi->brg_base + BRG_BCR); 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~(1 << 16); 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->BRG_BCR_m = v; 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->brg_base + BRG_BCR); 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_set_baudrate(struct mpsc_port_info *pi, u32 baud) 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * To set the baud, we adjust the CDV field in the BRG_BCR reg. 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * From manual: Baud = clk / ((CDV+1)*2) ==> CDV = (clk / (baud*2)) - 1. 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * However, the input clock is divided by 16 in the MPSC b/c of how 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 'MPSC_MMCRH' was set up so we have to divide the 'clk' used in our 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * calculation by 16 to account for that. So the real calculation 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * that accounts for the way the mpsc is set up is: 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * CDV = (clk / (baud*2*16)) - 1 ==> CDV = (clk / (baud << 5)) - 1. 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 cdv = (pi->port.uartclk / (baud << 5)) - 1; 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_brg_disable(pi); 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->BRG_BCR_m : readl(pi->brg_base + BRG_BCR); 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & 0xffff0000) | (cdv & 0xffff); 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->BRG_BCR_m = v; 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->brg_base + BRG_BCR); 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_brg_enable(pi); 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Serial DMA Routines (SDMA) 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_burstsize(struct mpsc_port_info *pi, u32 burst_size) 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_burstsize[%d]: burst_size: %d\n", 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.line, burst_size); 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds burst_size >>= 3; /* Divide by 8 b/c reg values are 8-byte chunks */ 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (burst_size < 2) 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = 0x0; /* 1 64-bit word */ 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (burst_size < 4) 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = 0x1; /* 2 64-bit words */ 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (burst_size < 8) 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = 0x2; /* 4 64-bit words */ 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = 0x3; /* 8 64-bit words */ 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel((readl(pi->sdma_base + SDMA_SDC) & (0x3 << 12)) | (v << 12), 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->sdma_base + SDMA_SDC); 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_init(struct mpsc_port_info *pi, u32 burst_size) 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_init[%d]: burst_size: %d\n", pi->port.line, 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds burst_size); 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel((readl(pi->sdma_base + SDMA_SDC) & 0x3ff) | 0x03f, 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->sdma_base + SDMA_SDC); 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_burstsize(pi, burst_size); 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline u32 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_intr_mask(struct mpsc_port_info *pi, u32 mask) 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 old, v; 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_intr_mask[%d]: mask: 0x%x\n", pi->port.line, mask); 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds old = v = (pi->mirror_regs) ? pi->shared_regs->SDMA_INTR_MASK_m : 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->shared_regs->sdma_intr_base + SDMA_INTR_MASK); 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask &= 0xf; 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->port.line) 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask <<= 8; 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~mask; 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->shared_regs->SDMA_INTR_MASK_m = v; 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->sdma_intr_base + SDMA_INTR_MASK); 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->port.line) 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds old >>= 8; 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return old & 0xf; 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_intr_unmask(struct mpsc_port_info *pi, u32 mask) 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_intr_unmask[%d]: mask: 0x%x\n", pi->port.line,mask); 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->shared_regs->SDMA_INTR_MASK_m : 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->shared_regs->sdma_intr_base + SDMA_INTR_MASK); 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask &= 0xf; 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->port.line) 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mask <<= 8; 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= mask; 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->shared_regs->SDMA_INTR_MASK_m = v; 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->sdma_intr_base + SDMA_INTR_MASK); 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_intr_ack(struct mpsc_port_info *pi) 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_intr_ack[%d]: Acknowledging IRQ\n", pi->port.line); 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->shared_regs->SDMA_INTR_CAUSE_m = 0; 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->shared_regs->sdma_intr_base + SDMA_INTR_CAUSE); 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_set_rx_ring(struct mpsc_port_info *pi, struct mpsc_rx_desc *rxre_p) 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_set_rx_ring[%d]: rxre_p: 0x%x\n", 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.line, (u32) rxre_p); 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel((u32)rxre_p, pi->sdma_base + SDMA_SCRDP); 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_set_tx_ring(struct mpsc_port_info *pi, struct mpsc_tx_desc *txre_p) 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel((u32)txre_p, pi->sdma_base + SDMA_SFTDP); 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel((u32)txre_p, pi->sdma_base + SDMA_SCTDP); 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_cmd(struct mpsc_port_info *pi, u32 val) 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readl(pi->sdma_base + SDMA_SDCM); 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (val) 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= val; 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = 0; 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->sdma_base + SDMA_SDCM); 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline uint 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_tx_active(struct mpsc_port_info *pi) 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return readl(pi->sdma_base + SDMA_SDCM) & SDMA_SDCM_TXD; 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_start_tx(struct mpsc_port_info *pi) 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_tx_desc *txre, *txre_p; 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If tx isn't running & there's a desc ready to go, start it */ 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!mpsc_sdma_tx_active(pi)) { 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre = (struct mpsc_tx_desc *)(pi->txr + 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pi->txr_tail * MPSC_TXRE_SIZE)); 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) txre, MPSC_TXRE_SIZE, DMA_FROM_DEVICE); 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds invalidate_dcache_range((ulong)txre, 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)txre + MPSC_TXRE_SIZE); 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (be32_to_cpu(txre->cmdstat) & SDMA_DESC_CMDSTAT_O) { 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre_p = (struct mpsc_tx_desc *)(pi->txr_p + 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pi->txr_tail * 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_TXRE_SIZE)); 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_set_tx_ring(pi, txre_p); 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_cmd(pi, SDMA_SDCM_STD | SDMA_SDCM_TXD); 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_stop(struct mpsc_port_info *pi) 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_stop[%d]: Stopping SDMA\n", pi->port.line); 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Abort any SDMA transfers */ 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_cmd(pi, 0); 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_cmd(pi, SDMA_SDCM_AR | SDMA_SDCM_AT); 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Clear the SDMA current and first TX and RX pointers */ 3382c6e75999000ebc942526466dbd0de37bfac73a4Al Viro mpsc_sdma_set_tx_ring(pi, NULL); 3392c6e75999000ebc942526466dbd0de37bfac73a4Al Viro mpsc_sdma_set_rx_ring(pi, NULL); 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Disable interrupts */ 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_intr_mask(pi, 0xf); 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_intr_ack(pi); 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Multi-Protocol Serial Controller Routines (MPSC) 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_hw_init(struct mpsc_port_info *pi) 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_hw_init[%d]: Initializing hardware\n", pi->port.line); 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set up clock routing */ 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) { 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = pi->shared_regs->MPSC_MRR_m; 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~0x1c7; 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->shared_regs->MPSC_MRR_m = v; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->mpsc_routing_base + MPSC_MRR); 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = pi->shared_regs->MPSC_RCRR_m; 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~0xf0f) | 0x100; 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->shared_regs->MPSC_RCRR_m = v; 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->mpsc_routing_base + MPSC_RCRR); 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = pi->shared_regs->MPSC_TCRR_m; 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~0xf0f) | 0x100; 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->shared_regs->MPSC_TCRR_m = v; 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->mpsc_routing_base + MPSC_TCRR); 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readl(pi->shared_regs->mpsc_routing_base + MPSC_MRR); 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~0x1c7; 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->mpsc_routing_base + MPSC_MRR); 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readl(pi->shared_regs->mpsc_routing_base + MPSC_RCRR); 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~0xf0f) | 0x100; 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->mpsc_routing_base + MPSC_RCRR); 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = readl(pi->shared_regs->mpsc_routing_base + MPSC_TCRR); 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~0xf0f) | 0x100; 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->shared_regs->mpsc_routing_base + MPSC_TCRR); 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Put MPSC in UART mode & enabel Tx/Rx egines */ 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0x000004c4, pi->mpsc_base + MPSC_MMCRL); 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* No preamble, 16x divider, low-latency, */ 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0x04400400, pi->mpsc_base + MPSC_MMCRH); 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) { 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_CHR_1_m = 0; 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_CHR_2_m = 0; 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_1); 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_2); 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(pi->mpsc_max_idle, pi->mpsc_base + MPSC_CHR_3); 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_4); 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_5); 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_6); 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_7); 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_8); 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_9); 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(0, pi->mpsc_base + MPSC_CHR_10); 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_enter_hunt(struct mpsc_port_info *pi) 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_enter_hunt[%d]: Hunting...\n", pi->port.line); 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) { 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(pi->MPSC_CHR_2_m | MPSC_CHR_2_EH, 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->mpsc_base + MPSC_CHR_2); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Erratum prevents reading CHR_2 so just delay for a while */ 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(100); 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(readl(pi->mpsc_base + MPSC_CHR_2) | MPSC_CHR_2_EH, 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->mpsc_base + MPSC_CHR_2); 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (readl(pi->mpsc_base + MPSC_CHR_2) & MPSC_CHR_2_EH) 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(10); 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_freeze(struct mpsc_port_info *pi) 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_freeze[%d]: Freezing\n", pi->port.line); 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->MPSC_MPCR_m : 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->mpsc_base + MPSC_MPCR); 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v |= MPSC_MPCR_FRZ; 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_MPCR_m = v; 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->mpsc_base + MPSC_MPCR); 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_unfreeze(struct mpsc_port_info *pi) 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->MPSC_MPCR_m : 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->mpsc_base + MPSC_MPCR); 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v &= ~MPSC_MPCR_FRZ; 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_MPCR_m = v; 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->mpsc_base + MPSC_MPCR); 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_unfreeze[%d]: Unfrozen\n", pi->port.line); 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_set_char_length(struct mpsc_port_info *pi, u32 len) 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_set_char_length[%d]: char len: %d\n", pi->port.line,len); 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->MPSC_MPCR_m : 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->mpsc_base + MPSC_MPCR); 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~(0x3 << 12)) | ((len & 0x3) << 12); 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_MPCR_m = v; 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->mpsc_base + MPSC_MPCR); 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_set_stop_bit_length(struct mpsc_port_info *pi, u32 len) 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_set_stop_bit_length[%d]: stop bits: %d\n", 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.line, len); 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->MPSC_MPCR_m : 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->mpsc_base + MPSC_MPCR); 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~(1 << 14)) | ((len & 0x1) << 14); 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_MPCR_m = v; 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->mpsc_base + MPSC_MPCR); 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_set_parity(struct mpsc_port_info *pi, u32 p) 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_set_parity[%d]: parity bits: 0x%x\n", pi->port.line, p); 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (pi->mirror_regs) ? pi->MPSC_CHR_2_m : 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->mpsc_base + MPSC_CHR_2); 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p &= 0x3; 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = (v & ~0xc000c) | (p << 18) | (p << 2); 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_CHR_2_m = v; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->mpsc_base + MPSC_CHR_2); 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Driver Init Routines 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_init_hw(struct mpsc_port_info *pi) 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_init_hw[%d]: Initializing\n", pi->port.line); 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_brg_init(pi, pi->brg_clk_src); 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_brg_enable(pi); 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_init(pi, dma_get_cache_alignment()); /* burst a cacheline */ 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_stop(pi); 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_hw_init(pi); 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_alloc_ring_mem(struct mpsc_port_info *pi) 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = 0; 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_alloc_ring_mem[%d]: Allocating ring mem\n", 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.line); 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pi->dma_region) { 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!dma_supported(pi->port.dev, 0xffffffff)) { 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "MPSC: Inadequate DMA support\n"); 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -ENXIO; 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if ((pi->dma_region = dma_alloc_noncoherent(pi->port.dev, 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_DMA_ALLOC_SIZE, &pi->dma_region_p, GFP_KERNEL)) 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds == NULL) { 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "MPSC: Can't alloc Desc region\n"); 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -ENOMEM; 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_free_ring_mem(struct mpsc_port_info *pi) 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_free_ring_mem[%d]: Freeing ring mem\n", pi->port.line); 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->dma_region) { 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_free_noncoherent(pi->port.dev, MPSC_DMA_ALLOC_SIZE, 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->dma_region, pi->dma_region_p); 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->dma_region = NULL; 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->dma_region_p = (dma_addr_t) NULL; 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_init_rings(struct mpsc_port_info *pi) 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_rx_desc *rxre; 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_tx_desc *txre; 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_addr_t dp, dp_p; 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u8 *bp, *bp_p; 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_init_rings[%d]: Initializing rings\n", pi->port.line); 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pi->dma_region == NULL); 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(pi->dma_region, 0, MPSC_DMA_ALLOC_SIZE); 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Descriptors & buffers are multiples of cacheline size and must be 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * cacheline aligned. 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp = ALIGN((u32) pi->dma_region, dma_get_cache_alignment()); 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p = ALIGN((u32) pi->dma_region_p, dma_get_cache_alignment()); 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Partition dma region into rx ring descriptor, rx buffers, 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * tx ring descriptors, and tx buffers. 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxr = dp; 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxr_p = dp_p; 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp += MPSC_RXR_SIZE; 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p += MPSC_RXR_SIZE; 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxb = (u8 *) dp; 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxb_p = (u8 *) dp_p; 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp += MPSC_RXB_SIZE; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p += MPSC_RXB_SIZE; 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxr_posn = 0; 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr = dp; 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_p = dp_p; 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp += MPSC_TXR_SIZE; 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p += MPSC_TXR_SIZE; 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txb = (u8 *) dp; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txb_p = (u8 *) dp_p; 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_head = 0; 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_tail = 0; 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Init rx ring descriptors */ 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp = pi->rxr; 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p = pi->rxr_p; 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp = pi->rxb; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp_p = pi->rxb_p; 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < MPSC_RXR_ENTRIES; i++) { 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre = (struct mpsc_rx_desc *)dp; 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->bufsize = cpu_to_be16(MPSC_RXBE_SIZE); 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->bytecnt = cpu_to_be16(0); 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->cmdstat = cpu_to_be32(SDMA_DESC_CMDSTAT_O | 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_EI | 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_F | 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_L); 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->link = cpu_to_be32(dp_p + MPSC_RXRE_SIZE); 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->buf_ptr = cpu_to_be32(bp_p); 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp += MPSC_RXRE_SIZE; 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p += MPSC_RXRE_SIZE; 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp += MPSC_RXBE_SIZE; 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp_p += MPSC_RXBE_SIZE; 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->link = cpu_to_be32(pi->rxr_p); /* Wrap last back to first */ 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Init tx ring descriptors */ 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp = pi->txr; 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p = pi->txr_p; 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp = pi->txb; 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp_p = pi->txb_p; 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < MPSC_TXR_ENTRIES; i++) { 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre = (struct mpsc_tx_desc *)dp; 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre->link = cpu_to_be32(dp_p + MPSC_TXRE_SIZE); 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre->buf_ptr = cpu_to_be32(bp_p); 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp += MPSC_TXRE_SIZE; 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dp_p += MPSC_TXRE_SIZE; 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp += MPSC_TXBE_SIZE; 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp_p += MPSC_TXBE_SIZE; 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre->link = cpu_to_be32(pi->txr_p); /* Wrap last back to first */ 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) pi->dma_region, MPSC_DMA_ALLOC_SIZE, 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DMA_BIDIRECTIONAL); 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flush_dcache_range((ulong)pi->dma_region, 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)pi->dma_region + MPSC_DMA_ALLOC_SIZE); 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_uninit_rings(struct mpsc_port_info *pi) 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_uninit_rings[%d]: Uninitializing rings\n",pi->port.line); 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pi->dma_region == NULL); 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxr = 0; 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxr_p = 0; 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxb = NULL; 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxb_p = NULL; 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxr_posn = 0; 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr = 0; 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_p = 0; 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txb = NULL; 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txb_p = NULL; 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_head = 0; 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_tail = 0; 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_make_ready(struct mpsc_port_info *pi) 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc; 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_make_ready[%d]: Making cltr ready\n", pi->port.line); 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pi->ready) { 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_init_hw(pi); 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((rc = mpsc_alloc_ring_mem(pi))) 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_init_rings(pi); 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->ready = 1; 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Interrupt Handling Routines 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_rx_intr(struct mpsc_port_info *pi, struct pt_regs *regs) 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_rx_desc *rxre; 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct tty_struct *tty = pi->port.info->tty; 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 cmdstat, bytes_in, i; 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = 0; 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u8 *bp; 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char flag = TTY_NORMAL; 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_rx_intr[%d]: Handling Rx intr\n", pi->port.line); 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre = (struct mpsc_rx_desc *)(pi->rxr + (pi->rxr_posn*MPSC_RXRE_SIZE)); 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *)rxre, MPSC_RXRE_SIZE, DMA_FROM_DEVICE); 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds invalidate_dcache_range((ulong)rxre, 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)rxre + MPSC_RXRE_SIZE); 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Loop through Rx descriptors handling ones that have been completed. 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (!((cmdstat = be32_to_cpu(rxre->cmdstat)) & SDMA_DESC_CMDSTAT_O)){ 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bytes_in = be16_to_cpu(rxre->bytecnt); 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Following use of tty struct directly is deprecated */ 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (unlikely((tty->flip.count + bytes_in) >= TTY_FLIPBUF_SIZE)){ 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (tty->low_latency) 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tty_flip_buffer_push(tty); 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If this failed then we will throw awa the bytes 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but mst do so to clear interrupts. 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp = pi->rxb + (pi->rxr_posn * MPSC_RXBE_SIZE); 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) bp, MPSC_RXBE_SIZE, DMA_FROM_DEVICE); 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds invalidate_dcache_range((ulong)bp, 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)bp + MPSC_RXBE_SIZE); 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Other than for parity error, the manual provides little 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * info on what data will be in a frame flagged by any of 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * these errors. For parity error, it is the last byte in 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the buffer that had the error. As for the rest, I guess 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we'll assume there is no data in the buffer. 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If there is...it gets lost. 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (unlikely(cmdstat & (SDMA_DESC_CMDSTAT_BR | 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_FR | SDMA_DESC_CMDSTAT_OR))) { 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.icount.rx++; 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmdstat & SDMA_DESC_CMDSTAT_BR) { /* Break */ 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.icount.brk++; 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (uart_handle_break(&pi->port)) 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto next_frame; 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (cmdstat & SDMA_DESC_CMDSTAT_FR)/* Framing */ 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.icount.frame++; 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (cmdstat & SDMA_DESC_CMDSTAT_OR) /* Overrun */ 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.icount.overrun++; 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmdstat &= pi->port.read_status_mask; 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmdstat & SDMA_DESC_CMDSTAT_BR) 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flag = TTY_BREAK; 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (cmdstat & SDMA_DESC_CMDSTAT_FR) 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flag = TTY_FRAME; 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (cmdstat & SDMA_DESC_CMDSTAT_OR) 8201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flag = TTY_OVERRUN; 8211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (cmdstat & SDMA_DESC_CMDSTAT_PE) 8221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flag = TTY_PARITY; 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (uart_handle_sysrq_char(&pi->port, *bp, regs)) { 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp++; 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bytes_in--; 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto next_frame; 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((unlikely(cmdstat & (SDMA_DESC_CMDSTAT_BR | 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_FR | SDMA_DESC_CMDSTAT_OR))) && 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds !(cmdstat & pi->port.ignore_status_mask)) 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tty_insert_flip_char(tty, *bp, flag); 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i=0; i<bytes_in; i++) 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tty_insert_flip_char(tty, *bp++, TTY_NORMAL); 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.icount.rx += bytes_in; 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsnext_frame: 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->bytecnt = cpu_to_be16(0); 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre->cmdstat = cpu_to_be32(SDMA_DESC_CMDSTAT_O | 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_EI | 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_F | 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_L); 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *)rxre, MPSC_RXRE_SIZE, DMA_BIDIRECTIONAL); 8521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flush_dcache_range((ulong)rxre, 8551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)rxre + MPSC_RXRE_SIZE); 8561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Advance to next descriptor */ 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rxr_posn = (pi->rxr_posn + 1) & (MPSC_RXR_ENTRIES - 1); 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rxre = (struct mpsc_rx_desc *)(pi->rxr + 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pi->rxr_posn * MPSC_RXRE_SIZE)); 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *)rxre, MPSC_RXRE_SIZE, DMA_FROM_DEVICE); 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 8641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 8651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds invalidate_dcache_range((ulong)rxre, 8661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)rxre + MPSC_RXRE_SIZE); 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = 1; 8701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Restart rx engine, if its stopped */ 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((readl(pi->sdma_base + SDMA_SDCM) & SDMA_SDCM_ERD) == 0) 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_start_rx(pi); 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tty_flip_buffer_push(tty); 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_setup_tx_desc(struct mpsc_port_info *pi, u32 count, u32 intr) 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_tx_desc *txre; 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre = (struct mpsc_tx_desc *)(pi->txr + 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pi->txr_head * MPSC_TXRE_SIZE)); 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre->bytecnt = cpu_to_be16(count); 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre->shadow = txre->bytecnt; 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); /* ensure cmdstat is last field updated */ 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre->cmdstat = cpu_to_be32(SDMA_DESC_CMDSTAT_O | SDMA_DESC_CMDSTAT_F | 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_L | ((intr) ? 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_EI 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds : 0)); 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) txre, MPSC_TXRE_SIZE, DMA_BIDIRECTIONAL); 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flush_dcache_range((ulong)txre, 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)txre + MPSC_TXRE_SIZE); 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 9021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void 9071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_copy_tx_data(struct mpsc_port_info *pi) 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct circ_buf *xmit = &pi->port.info->xmit; 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u8 *bp; 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 i; 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Make sure the desc ring isn't full */ 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (CIRC_CNT(pi->txr_head, pi->txr_tail, MPSC_TXR_ENTRIES) < 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (MPSC_TXR_ENTRIES - 1)) { 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->port.x_char) { 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Ideally, we should use the TCS field in 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * CHR_1 to put the x_char out immediately but 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * errata prevents us from being able to read 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * CHR_2 to know that its safe to write to 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * CHR_1. Instead, just put it in-band with 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * all the other Tx data. 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp = pi->txb + (pi->txr_head * MPSC_TXBE_SIZE); 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *bp = pi->port.x_char; 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.x_char = 0; 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i = 1; 9291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (!uart_circ_empty(xmit) && !uart_tx_stopped(&pi->port)){ 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i = min((u32) MPSC_TXBE_SIZE, 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (u32) uart_circ_chars_pending(xmit)); 9331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds i = min(i, (u32) CIRC_CNT_TO_END(xmit->head, xmit->tail, 9341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds UART_XMIT_SIZE)); 9351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp = pi->txb + (pi->txr_head * MPSC_TXBE_SIZE); 9361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(bp, &xmit->buf[xmit->tail], i); 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds xmit->tail = (xmit->tail + i) & (UART_XMIT_SIZE - 1); 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uart_write_wakeup(&pi->port); 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else /* All tx data copied into ring bufs */ 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) bp, MPSC_TXBE_SIZE, DMA_BIDIRECTIONAL); 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flush_dcache_range((ulong)bp, 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)bp + MPSC_TXBE_SIZE); 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 9511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_setup_tx_desc(pi, i, 1); 9521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Advance to next descriptor */ 9541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_head = (pi->txr_head + 1) & (MPSC_TXR_ENTRIES - 1); 9551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline int 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_tx_intr(struct mpsc_port_info *pi) 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_tx_desc *txre; 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = 0; 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!mpsc_sdma_tx_active(pi)) { 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre = (struct mpsc_tx_desc *)(pi->txr + 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pi->txr_tail * MPSC_TXRE_SIZE)); 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) txre, MPSC_TXRE_SIZE, DMA_FROM_DEVICE); 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds invalidate_dcache_range((ulong)txre, 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)txre + MPSC_TXRE_SIZE); 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (!(be32_to_cpu(txre->cmdstat) & SDMA_DESC_CMDSTAT_O)) { 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = 1; 9791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.icount.tx += be16_to_cpu(txre->bytecnt); 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_tail = (pi->txr_tail+1) & (MPSC_TXR_ENTRIES-1); 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If no more data to tx, fall out of loop */ 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->txr_head == pi->txr_tail) 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds txre = (struct mpsc_tx_desc *)(pi->txr + 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pi->txr_tail * MPSC_TXRE_SIZE)); 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) txre, MPSC_TXRE_SIZE, 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DMA_FROM_DEVICE); 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds invalidate_dcache_range((ulong)txre, 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)txre + MPSC_TXRE_SIZE); 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_copy_tx_data(pi); 9981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_start_tx(pi); /* start next desc if ready */ 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This is the driver's interrupt handler. To avoid a race, we first clear 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the interrupt, then handle any completed Rx/Tx descriptors. When done 10071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * handling those descriptors, we restart the Rx/Tx engines if they're stopped. 10081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic irqreturn_t 10101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_sdma_intr(int irq, void *dev_id, struct pt_regs *regs) 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = dev_id; 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulong iflags; 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = IRQ_NONE; 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_intr[%d]: SDMA Interrupt Received\n",pi->port.line); 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&pi->port.lock, iflags); 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_intr_ack(pi); 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (mpsc_rx_intr(pi, regs)) 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = IRQ_HANDLED; 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (mpsc_tx_intr(pi)) 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = IRQ_HANDLED; 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&pi->port.lock, iflags); 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_sdma_intr[%d]: SDMA Interrupt Handled\n", pi->port.line); 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * serial_core.c Interface routines 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic uint 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_tx_empty(struct uart_port *port) 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulong iflags; 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uint rc; 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&pi->port.lock, iflags); 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = mpsc_sdma_tx_active(pi) ? 0 : TIOCSER_TEMT; 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&pi->port.lock, iflags); 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 10491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_set_mctrl(struct uart_port *port, uint mctrl) 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Have no way to set modem control lines AFAICT */ 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic uint 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_get_mctrl(struct uart_port *port) 10601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 10621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 mflags, status; 10631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = (pi->mirror_regs) ? pi->MPSC_CHR_10_m : 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds readl(pi->mpsc_base + MPSC_CHR_10); 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mflags = 0; 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & 0x1) 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mflags |= TIOCM_CTS; 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & 0x2) 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mflags |= TIOCM_CAR; 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return mflags | TIOCM_DSR; /* No way to tell if DSR asserted */ 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 1077b129a8ccd53f74c43e4c83c8e0031a4990040830Russell Kingmpsc_stop_tx(struct uart_port *port) 10781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1081b129a8ccd53f74c43e4c83c8e0031a4990040830Russell King pr_debug("mpsc_stop_tx[%d]\n", port->line); 10821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_freeze(pi); 10841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 1088b129a8ccd53f74c43e4c83c8e0031a4990040830Russell Kingmpsc_start_tx(struct uart_port *port) 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 10911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_unfreeze(pi); 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_copy_tx_data(pi); 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_start_tx(pi); 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1096b129a8ccd53f74c43e4c83c8e0031a4990040830Russell King pr_debug("mpsc_start_tx[%d]\n", port->line); 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 11011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_start_rx(struct mpsc_port_info *pi) 11021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_start_rx[%d]: Starting...\n", pi->port.line); 11041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->rcv_data) { 11061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_enter_hunt(pi); 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_cmd(pi, SDMA_SDCM_ERD); 11081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 11101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 11131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_stop_rx(struct uart_port *port) 11141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 11161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_stop_rx[%d]: Stopping...\n", port->line); 11181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_cmd(pi, SDMA_SDCM_AR); 11201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 11241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_enable_ms(struct uart_port *port) 11251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; /* Not supported */ 11271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 11301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_break_ctl(struct uart_port *port, int ctl) 11311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 11331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulong flags; 11341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 v; 11351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds v = ctl ? 0x00ff0000 : 0; 11371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&pi->port.lock, flags); 11391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->mirror_regs) 11401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_CHR_1_m = v; 11411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writel(v, pi->mpsc_base + MPSC_CHR_1); 11421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&pi->port.lock, flags); 11431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 11451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 11481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_startup(struct uart_port *port) 11491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 11511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 flag = 0; 11521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc; 11531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_startup[%d]: Starting up MPSC, irq: %d\n", 11551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds port->line, pi->port.irq); 11561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((rc = mpsc_make_ready(pi)) == 0) { 11581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Setup IRQ handler */ 11591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_intr_ack(pi); 11601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If irq's are shared, need to set flag */ 11621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (mpsc_ports[0].port.irq == mpsc_ports[1].port.irq) 11631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flag = SA_SHIRQ; 11641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (request_irq(pi->port.irq, mpsc_sdma_intr, flag, 11661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "mpsc/sdma", pi)) 11671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "MPSC: Can't get SDMA IRQ %d\n", 11681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.irq); 11691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_intr_unmask(pi, 0xf); 11711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_set_rx_ring(pi, (struct mpsc_rx_desc *)(pi->rxr_p + 11721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pi->rxr_posn * MPSC_RXRE_SIZE))); 11731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 11761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 11791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_shutdown(struct uart_port *port) 11801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 11821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_shutdown[%d]: Shutting down MPSC\n", port->line); 11841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_stop(pi); 11861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_irq(pi->port.irq, pi); 11871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 11881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 11911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_set_termios(struct uart_port *port, struct termios *termios, 11921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct termios *old) 11931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 11951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 baud; 11961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulong flags; 11971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 chr_bits, stop_bits, par; 11981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->c_iflag = termios->c_iflag; 12001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->c_cflag = termios->c_cflag; 12011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (termios->c_cflag & CSIZE) { 12031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CS5: 12041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds chr_bits = MPSC_MPCR_CL_5; 12051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CS6: 12071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds chr_bits = MPSC_MPCR_CL_6; 12081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CS7: 12101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds chr_bits = MPSC_MPCR_CL_7; 12111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CS8: 12131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 12141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds chr_bits = MPSC_MPCR_CL_8; 12151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_cflag & CSTOPB) 12191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stop_bits = MPSC_MPCR_SBL_2; 12201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 12211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stop_bits = MPSC_MPCR_SBL_1; 12221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds par = MPSC_CHR_2_PAR_EVEN; 12241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_cflag & PARENB) 12251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_cflag & PARODD) 12261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds par = MPSC_CHR_2_PAR_ODD; 12271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CMSPAR 12281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_cflag & CMSPAR) { 12291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_cflag & PARODD) 12301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds par = MPSC_CHR_2_PAR_MARK; 12311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 12321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds par = MPSC_CHR_2_PAR_SPACE; 12331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 12351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk); 12371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&pi->port.lock, flags); 12391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uart_update_timeout(port, termios->c_cflag, baud); 12411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_set_char_length(pi, chr_bits); 12431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_set_stop_bit_length(pi, stop_bits); 12441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_set_parity(pi, par); 12451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_set_baudrate(pi, baud); 12461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Characters/events to read */ 12481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rcv_data = 1; 12491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.read_status_mask = SDMA_DESC_CMDSTAT_OR; 12501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_iflag & INPCK) 12521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.read_status_mask |= SDMA_DESC_CMDSTAT_PE | 12531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_FR; 12541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_iflag & (BRKINT | PARMRK)) 12561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.read_status_mask |= SDMA_DESC_CMDSTAT_BR; 12571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Characters/events to ignore */ 12591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.ignore_status_mask = 0; 12601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_iflag & IGNPAR) 12621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.ignore_status_mask |= SDMA_DESC_CMDSTAT_PE | 12631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SDMA_DESC_CMDSTAT_FR; 12641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_iflag & IGNBRK) { 12661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.ignore_status_mask |= SDMA_DESC_CMDSTAT_BR; 12671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (termios->c_iflag & IGNPAR) 12691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.ignore_status_mask |= SDMA_DESC_CMDSTAT_OR; 12701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Ignore all chars if CREAD not set */ 12731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(termios->c_cflag & CREAD)) 12741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->rcv_data = 0; 12751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 12761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_start_rx(pi); 12771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&pi->port.lock, flags); 12791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 12801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic const char * 12831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_type(struct uart_port *port) 12841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_type[%d]: port type: %s\n", port->line,MPSC_DRIVER_NAME); 12861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return MPSC_DRIVER_NAME; 12871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 12901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_request_port(struct uart_port *port) 12911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Should make chip/platform specific call */ 12931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 12971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_release_port(struct uart_port *port) 12981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 13001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->ready) { 13021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_uninit_rings(pi); 13031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_free_ring_mem(pi); 13041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->ready = 0; 13051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 13081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 13111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_config_port(struct uart_port *port, int flags) 13121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 13131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 13141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 13171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_verify_port(struct uart_port *port, struct serial_struct *ser) 13181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 13191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = (struct mpsc_port_info *)port; 13201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = 0; 13211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_verify_port[%d]: Verifying port data\n", pi->port.line); 13231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ser->type != PORT_UNKNOWN && ser->type != PORT_MPSC) 13251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -EINVAL; 13261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (pi->port.irq != ser->irq) 13271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -EINVAL; 13281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (ser->io_type != SERIAL_IO_MEM) 13291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -EINVAL; 13301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (pi->port.uartclk / 16 != ser->baud_base) /* Not sure */ 13311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -EINVAL; 13321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if ((void *)pi->port.mapbase != ser->iomem_base) 13331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -EINVAL; 13341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (pi->port.iobase != ser->port) 13351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -EINVAL; 13361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (ser->hub6 != 0) 13371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = -EINVAL; 13381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 13401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct uart_ops mpsc_pops = { 13431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .tx_empty = mpsc_tx_empty, 13441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .set_mctrl = mpsc_set_mctrl, 13451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .get_mctrl = mpsc_get_mctrl, 13461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .stop_tx = mpsc_stop_tx, 13471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .start_tx = mpsc_start_tx, 13481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .stop_rx = mpsc_stop_rx, 13491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .enable_ms = mpsc_enable_ms, 13501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .break_ctl = mpsc_break_ctl, 13511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .startup = mpsc_startup, 13521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .shutdown = mpsc_shutdown, 13531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .set_termios = mpsc_set_termios, 13541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .type = mpsc_type, 13551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release_port = mpsc_release_port, 13561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .request_port = mpsc_request_port, 13571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .config_port = mpsc_config_port, 13581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .verify_port = mpsc_verify_port, 13591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 13601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 13621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 13631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 13641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Console Interface Routines 13651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 13661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 13671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_SERIAL_MPSC_CONSOLE 13701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 13711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_console_write(struct console *co, const char *s, uint count) 13721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 13731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi = &mpsc_ports[co->index]; 13741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u8 *bp, *dp, add_cr = 0; 13751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 13761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (mpsc_sdma_tx_active(pi)) 13781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(100); 13791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (count > 0) { 13811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp = dp = pi->txb + (pi->txr_head * MPSC_TXBE_SIZE); 13821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < MPSC_TXBE_SIZE; i++) { 13841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (count == 0) 13851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (add_cr) { 13881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *(dp++) = '\r'; 13891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_cr = 0; 13901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 13921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *(dp++) = *s; 13931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*(s++) == '\n') { /* add '\r' after '\n' */ 13951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_cr = 1; 13961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds count++; 13971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds count--; 14011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dma_cache_sync((void *) bp, MPSC_TXBE_SIZE, DMA_BIDIRECTIONAL); 14041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) 14051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pi->cache_mgmt) /* GT642[46]0 Res #COMM-2 */ 14061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flush_dcache_range((ulong)bp, 14071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulong)bp + MPSC_TXBE_SIZE); 14081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 14091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_setup_tx_desc(pi, i, 0); 14101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_head = (pi->txr_head + 1) & (MPSC_TXR_ENTRIES - 1); 14111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_sdma_start_tx(pi); 14121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (mpsc_sdma_tx_active(pi)) 14141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(100); 14151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->txr_tail = (pi->txr_tail + 1) & (MPSC_TXR_ENTRIES - 1); 14171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init 14231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_console_setup(struct console *co, char *options) 14241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi; 14261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int baud, bits, parity, flow; 14271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_console_setup[%d]: options: %s\n", co->index, options); 14291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (co->index >= MPSC_NUM_CTLRS) 14311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds co->index = 0; 14321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi = &mpsc_ports[co->index]; 14341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds baud = pi->default_baud; 14361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bits = pi->default_bits; 14371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds parity = pi->default_parity; 14381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flow = pi->default_flow; 14391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pi->port.ops) 14411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 14421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pi->port.lock); /* Temporary fix--copied from 8250.c */ 14441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (options) 14461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uart_parse_options(options, &baud, &parity, &bits, &flow); 14471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return uart_set_options(&pi->port, co, baud, parity, bits, flow); 14491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct console mpsc_console = { 14521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = MPSC_DEV_NAME, 14531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .write = mpsc_console_write, 14541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .device = uart_console_device, 14551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .setup = mpsc_console_setup, 14561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .flags = CON_PRINTBUFFER, 14571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .index = -1, 14581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .data = &mpsc_reg, 14591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 14601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init 14621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_late_console_init(void) 14631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_late_console_init: Enter\n"); 14651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(mpsc_console.flags & CON_ENABLED)) 14671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds register_console(&mpsc_console); 14681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 14691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldslate_initcall(mpsc_late_console_init); 14721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_CONSOLE &mpsc_console 14741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 14751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MPSC_CONSOLE NULL 14761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 14771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 14781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 14791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 14801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Dummy Platform Driver to extract & map shared register regions 14811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 14821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 14831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 14851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_resource_err(char *s) 14861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "MPSC: Platform device resource error in %s\n", s); 14881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 14921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_shared_map_regs(struct platform_device *pd) 14931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct resource *r; 14951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((r = platform_get_resource(pd, IORESOURCE_MEM, 14971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_ROUTING_BASE_ORDER)) && request_mem_region(r->start, 14981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_ROUTING_REG_BLOCK_SIZE, "mpsc_routing_regs")) { 14991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.mpsc_routing_base = ioremap(r->start, 15011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_ROUTING_REG_BLOCK_SIZE); 15021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.mpsc_routing_base_p = r->start; 15031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 15051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_resource_err("MPSC routing base"); 15061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 15071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((r = platform_get_resource(pd, IORESOURCE_MEM, 15101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_SDMA_INTR_BASE_ORDER)) && request_mem_region(r->start, 15111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_SDMA_INTR_REG_BLOCK_SIZE, "sdma_intr_regs")) { 15121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.sdma_intr_base = ioremap(r->start, 15141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_SDMA_INTR_REG_BLOCK_SIZE); 15151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.sdma_intr_base_p = r->start; 15161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 15181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(mpsc_shared_regs.mpsc_routing_base); 15191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_mem_region(mpsc_shared_regs.mpsc_routing_base_p, 15201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_ROUTING_REG_BLOCK_SIZE); 15211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_resource_err("SDMA intr base"); 15221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 15231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 15261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 15291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_shared_unmap_regs(void) 15301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!mpsc_shared_regs.mpsc_routing_base) { 15321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(mpsc_shared_regs.mpsc_routing_base); 15331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_mem_region(mpsc_shared_regs.mpsc_routing_base_p, 15341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_ROUTING_REG_BLOCK_SIZE); 15351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!mpsc_shared_regs.sdma_intr_base) { 15371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(mpsc_shared_regs.sdma_intr_base); 15381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_mem_region(mpsc_shared_regs.sdma_intr_base_p, 15391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_SDMA_INTR_REG_BLOCK_SIZE); 15401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15422c6e75999000ebc942526466dbd0de37bfac73a4Al Viro mpsc_shared_regs.mpsc_routing_base = NULL; 15432c6e75999000ebc942526466dbd0de37bfac73a4Al Viro mpsc_shared_regs.sdma_intr_base = NULL; 15441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.mpsc_routing_base_p = 0; 15461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.sdma_intr_base_p = 0; 15471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 15491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 15521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_shared_drv_probe(struct device *dev) 15531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct platform_device *pd = to_platform_device(dev); 15551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_shared_pdata *pdata; 15561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = -ENODEV; 15571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->id == 0) { 15591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(rc = mpsc_shared_map_regs(pd))) { 15601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pdata = (struct mpsc_shared_pdata *)dev->platform_data; 15611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.MPSC_MRR_m = pdata->mrr_val; 15631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.MPSC_RCRR_m= pdata->rcrr_val; 15641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.MPSC_TCRR_m= pdata->tcrr_val; 15651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.SDMA_INTR_CAUSE_m = 15661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pdata->intr_cause_val; 15671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.SDMA_INTR_MASK_m = 15681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pdata->intr_mask_val; 15691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = 0; 15711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 15751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 15781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_shared_drv_remove(struct device *dev) 15791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct platform_device *pd = to_platform_device(dev); 15811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = -ENODEV; 15821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->id == 0) { 15841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_unmap_regs(); 15851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.MPSC_MRR_m = 0; 15861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.MPSC_RCRR_m = 0; 15871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.MPSC_TCRR_m = 0; 15881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.SDMA_INTR_CAUSE_m = 0; 15891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_shared_regs.SDMA_INTR_MASK_m = 0; 15901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = 0; 15911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 15941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct device_driver mpsc_shared_driver = { 15971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = MPSC_SHARED_NAME, 15981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .bus = &platform_bus_type, 15991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .probe = mpsc_shared_drv_probe, 16001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = mpsc_shared_drv_remove, 16011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 16021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 16041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 16051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 16061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Driver Interface Routines 16071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 16081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ****************************************************************************** 16091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct uart_driver mpsc_reg = { 16111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 16121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .driver_name = MPSC_DRIVER_NAME, 16131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .devfs_name = MPSC_DEVFS_NAME, 16141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .dev_name = MPSC_DEV_NAME, 16151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .major = MPSC_MAJOR, 16161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .minor = MPSC_MINOR_START, 16171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .nr = MPSC_NUM_CTLRS, 16181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .cons = MPSC_CONSOLE, 16191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 16201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 16221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_drv_map_regs(struct mpsc_port_info *pi, struct platform_device *pd) 16231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct resource *r; 16251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((r = platform_get_resource(pd, IORESOURCE_MEM, MPSC_BASE_ORDER)) && 16271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds request_mem_region(r->start, MPSC_REG_BLOCK_SIZE, "mpsc_regs")){ 16281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->mpsc_base = ioremap(r->start, MPSC_REG_BLOCK_SIZE); 16301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->mpsc_base_p = r->start; 16311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 16331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_resource_err("MPSC base"); 16341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 16351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((r = platform_get_resource(pd, IORESOURCE_MEM, 16381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_SDMA_BASE_ORDER)) && request_mem_region(r->start, 16391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MPSC_SDMA_REG_BLOCK_SIZE, "sdma_regs")) { 16401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->sdma_base = ioremap(r->start,MPSC_SDMA_REG_BLOCK_SIZE); 16421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->sdma_base_p = r->start; 16431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 16451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_resource_err("SDMA base"); 16461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 16471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((r = platform_get_resource(pd,IORESOURCE_MEM,MPSC_BRG_BASE_ORDER)) 16501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds && request_mem_region(r->start, MPSC_BRG_REG_BLOCK_SIZE, 16511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "brg_regs")) { 16521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->brg_base = ioremap(r->start, MPSC_BRG_REG_BLOCK_SIZE); 16541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->brg_base_p = r->start; 16551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 16571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_resource_err("BRG base"); 16581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 16591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 16621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 16651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_drv_unmap_regs(struct mpsc_port_info *pi) 16661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pi->mpsc_base) { 16681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(pi->mpsc_base); 16691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_mem_region(pi->mpsc_base_p, MPSC_REG_BLOCK_SIZE); 16701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pi->sdma_base) { 16721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(pi->sdma_base); 16731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_mem_region(pi->sdma_base_p, MPSC_SDMA_REG_BLOCK_SIZE); 16741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pi->brg_base) { 16761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds iounmap(pi->brg_base); 16771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_mem_region(pi->brg_base_p, MPSC_BRG_REG_BLOCK_SIZE); 16781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16802c6e75999000ebc942526466dbd0de37bfac73a4Al Viro pi->mpsc_base = NULL; 16812c6e75999000ebc942526466dbd0de37bfac73a4Al Viro pi->sdma_base = NULL; 16822c6e75999000ebc942526466dbd0de37bfac73a4Al Viro pi->brg_base = NULL; 16831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->mpsc_base_p = 0; 16851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->sdma_base_p = 0; 16861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->brg_base_p = 0; 16871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 16891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 16921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_drv_get_platform_data(struct mpsc_port_info *pi, 16931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct platform_device *pd, int num) 16941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_pdata *pdata; 16961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pdata = (struct mpsc_pdata *)pd->dev.platform_data; 16981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.uartclk = pdata->brg_clk_freq; 17001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.iotype = UPIO_MEM; 17011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.line = num; 17021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.type = PORT_MPSC; 17031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.fifosize = MPSC_TXBE_SIZE; 17041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.membase = pi->mpsc_base; 17051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.mapbase = (ulong)pi->mpsc_base; 17061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.ops = &mpsc_pops; 17071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->mirror_regs = pdata->mirror_regs; 17091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->cache_mgmt = pdata->cache_mgmt; 17101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->brg_can_tune = pdata->brg_can_tune; 17111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->brg_clk_src = pdata->brg_clk_src; 17121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->mpsc_max_idle = pdata->max_idle; 17131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->default_baud = pdata->default_baud; 17141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->default_bits = pdata->default_bits; 17151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->default_parity = pdata->default_parity; 17161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->default_flow = pdata->default_flow; 17171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Initial values of mirrored regs */ 17191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_CHR_1_m = pdata->chr_1_val; 17201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_CHR_2_m = pdata->chr_2_val; 17211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_CHR_10_m = pdata->chr_10_val; 17221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->MPSC_MPCR_m = pdata->mpcr_val; 17231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->BRG_BCR_m = pdata->bcr_val; 17241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->shared_regs = &mpsc_shared_regs; 17261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi->port.irq = platform_get_irq(pd, 0); 17281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 17301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 17331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_drv_probe(struct device *dev) 17341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct platform_device *pd = to_platform_device(dev); 17361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mpsc_port_info *pi; 17371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc = -ENODEV; 17381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_drv_probe: Adding MPSC %d\n", pd->id); 17401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->id < MPSC_NUM_CTLRS) { 17421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pi = &mpsc_ports[pd->id]; 17431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(rc = mpsc_drv_map_regs(pi, pd))) { 17451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_drv_get_platform_data(pi, pd, pd->id); 17461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(rc = mpsc_make_ready(pi))) 17481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(rc = uart_add_one_port(&mpsc_reg, 17491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pi->port))) 17501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rc = 0; 17511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 17521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_release_port( 17531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (struct uart_port *)pi); 17541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_drv_unmap_regs(pi); 17551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 17571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_drv_unmap_regs(pi); 17581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 17621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 17651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_drv_remove(struct device *dev) 17661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct platform_device *pd = to_platform_device(dev); 17681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pr_debug("mpsc_drv_exit: Removing MPSC %d\n", pd->id); 17701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->id < MPSC_NUM_CTLRS) { 17721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uart_remove_one_port(&mpsc_reg, &mpsc_ports[pd->id].port); 17731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_release_port((struct uart_port *)&mpsc_ports[pd->id].port); 17741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mpsc_drv_unmap_regs(&mpsc_ports[pd->id]); 17751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 17761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 17781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 17791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct device_driver mpsc_driver = { 17821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = MPSC_CTLR_NAME, 17831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .bus = &platform_bus_type, 17841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .probe = mpsc_drv_probe, 17851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = mpsc_drv_remove, 17861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 17871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init 17891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_drv_init(void) 17901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int rc; 17921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO "Serial: MPSC driver $Revision: 1.00 $\n"); 17941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(mpsc_ports, 0, sizeof(mpsc_ports)); 17961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&mpsc_shared_regs, 0, sizeof(mpsc_shared_regs)); 17971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(rc = uart_register_driver(&mpsc_reg))) { 17991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(rc = driver_register(&mpsc_shared_driver))) { 18001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((rc = driver_register(&mpsc_driver))) { 18011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds driver_unregister(&mpsc_shared_driver); 18021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uart_unregister_driver(&mpsc_reg); 18031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 18061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uart_unregister_driver(&mpsc_reg); 18071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rc; 18101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit 18141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmpsc_drv_exit(void) 18151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 18161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds driver_unregister(&mpsc_driver); 18171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds driver_unregister(&mpsc_shared_driver); 18181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uart_unregister_driver(&mpsc_reg); 18191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(mpsc_ports, 0, sizeof(mpsc_ports)); 18201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&mpsc_shared_regs, 0, sizeof(mpsc_shared_regs)); 18211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 18221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(mpsc_drv_init); 18251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(mpsc_drv_exit); 18261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Mark A. Greer <mgreer@mvista.com>"); 18281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("Generic Marvell MPSC serial/UART driver $Revision: 1.00 $"); 18291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_VERSION(MPSC_VERSION); 18301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 18311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_ALIAS_CHARDEV_MAJOR(MPSC_MAJOR); 1832