16f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* 26f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * linux/drivers/net/irda/pxaficp_ir.c 36f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * 46f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Based on sa1100_ir.c by Russell King 56f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * 66f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Changes copyright (C) 2003-2005 MontaVista Software, Inc. 76f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * 86f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * This program is free software; you can redistribute it and/or modify 96f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * it under the terms of the GNU General Public License version 2 as 106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * published by the Free Software Foundation. 116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * 126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Infra-red driver (SIR/FIR) for the PXA2xx embedded microprocessor 136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * 146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 15b7f080cfe223b3b7424872639d153695615a9255Alexey Dobriyan#include <linux/dma-mapping.h> 16a6b7a407865aab9f849dd99a71072b7cd1175116Alexey Dobriyan#include <linux/interrupt.h> 176f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#include <linux/module.h> 186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#include <linux/netdevice.h> 19f6a2629353718e588820b731af43a445b6f35648Alexander Beregalov#include <linux/etherdevice.h> 20d052d1beff706920e82c5d55006b08e256b5df09Russell King#include <linux/platform_device.h> 2182d553c67deef92c6c84ecb70afc56e99863060cRussell King#include <linux/clk.h> 22c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut#include <linux/gpio.h> 235a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#include <net/irda/irda.h> 266f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#include <net/irda/irmod.h> 276f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#include <net/irda/wrapper.h> 286f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#include <net/irda/irda_device.h> 296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 30dcea83adc666061864b82c96e059dffe7268b512Russell King#include <mach/dma.h> 31293b2da1b61136813fc2764f43304c66ff8040e9Arnd Bergmann#include <linux/platform_data/irda-pxaficp.h> 325bf3df3f00f507119a26ba0780aa8799e741615cEric Miao#include <mach/regs-ost.h> 33121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring#include <mach/regs-uart.h> 346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 35b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define FICP __REG(0x40800000) /* Start of FICP area */ 36b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0 __REG(0x40800000) /* ICP Control Register 0 */ 37b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR1 __REG(0x40800004) /* ICP Control Register 1 */ 38b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR2 __REG(0x40800008) /* ICP Control Register 2 */ 39b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICDR __REG(0x4080000c) /* ICP Data Register */ 40b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0 __REG(0x40800014) /* ICP Status Register 0 */ 41b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1 __REG(0x40800018) /* ICP Status Register 1 */ 42b40ddf575883ceca303906556bcd0cff5c284fefEric Miao 43b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0_AME (1 << 7) /* Address match enable */ 44b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0_TIE (1 << 6) /* Transmit FIFO interrupt enable */ 4525985edcedea6396277003854657b5f3cb31a628Lucas De Marchi#define ICCR0_RIE (1 << 5) /* Receive FIFO interrupt enable */ 46b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0_RXE (1 << 4) /* Receive enable */ 47b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0_TXE (1 << 3) /* Transmit enable */ 48b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0_TUS (1 << 2) /* Transmit FIFO underrun select */ 49b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0_LBM (1 << 1) /* Loopback mode */ 50b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR0_ITR (1 << 0) /* IrDA transmission */ 51b40ddf575883ceca303906556bcd0cff5c284fefEric Miao 52b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR2_RXP (1 << 3) /* Receive Pin Polarity select */ 53b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR2_TXP (1 << 2) /* Transmit Pin Polarity select */ 54b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR2_TRIG (3 << 0) /* Receive FIFO Trigger threshold */ 55b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR2_TRIG_8 (0 << 0) /* >= 8 bytes */ 56b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR2_TRIG_16 (1 << 0) /* >= 16 bytes */ 57b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICCR2_TRIG_32 (2 << 0) /* >= 32 bytes */ 58b40ddf575883ceca303906556bcd0cff5c284fefEric Miao 59b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#ifdef CONFIG_PXA27x 60b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0_EOC (1 << 6) /* DMA End of Descriptor Chain */ 61b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#endif 62b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0_FRE (1 << 5) /* Framing error */ 63b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0_RFS (1 << 4) /* Receive FIFO service request */ 64b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0_TFS (1 << 3) /* Transnit FIFO service request */ 65b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0_RAB (1 << 2) /* Receiver abort */ 66b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0_TUR (1 << 1) /* Trunsmit FIFO underun */ 67b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR0_EIF (1 << 0) /* End/Error in FIFO */ 68b40ddf575883ceca303906556bcd0cff5c284fefEric Miao 69b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1_ROR (1 << 6) /* Receiver FIFO underrun */ 70b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1_CRE (1 << 5) /* CRC error */ 71b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1_EOF (1 << 4) /* End of frame */ 72b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1_TNF (1 << 3) /* Transmit FIFO not full */ 73b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1_RNE (1 << 2) /* Receive FIFO not empty */ 74b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1_TBY (1 << 1) /* Tramsmiter busy flag */ 75b40ddf575883ceca303906556bcd0cff5c284fefEric Miao#define ICSR1_RSY (1 << 0) /* Recevier synchronized flag */ 766f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_RXPL_NEG_IS_ZERO (1<<4) 786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_RXPL_POS_IS_ZERO 0x0 796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_TXPL_NEG_IS_ZERO (1<<3) 806f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_TXPL_POS_IS_ZERO 0x0 816f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_XMODE_PULSE_1_6 (1<<2) 826f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_XMODE_PULSE_3_16 0x0 836f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_RCVEIR_IR_MODE (1<<1) 846f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_RCVEIR_UART_MODE 0x0 856f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_XMITIR_IR_MODE (1<<0) 866f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_XMITIR_UART_MODE 0x0 876f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 886f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_IR_RECEIVE_ON (\ 896f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_RXPL_NEG_IS_ZERO | \ 906f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_TXPL_POS_IS_ZERO | \ 916f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_XMODE_PULSE_3_16 | \ 926f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_RCVEIR_IR_MODE | \ 936f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_XMITIR_UART_MODE) 946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 956f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IrSR_IR_TRANSMIT_ON (\ 966f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_RXPL_NEG_IS_ZERO | \ 976f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_TXPL_POS_IS_ZERO | \ 986f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_XMODE_PULSE_3_16 | \ 996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_RCVEIR_UART_MODE | \ 1006f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre IrSR_XMITIR_IR_MODE) 1016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestruct pxa_irda { 1036f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int speed; 1046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int newspeed; 1056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned long last_oscr; 1066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned char *dma_rx_buff; 1086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned char *dma_tx_buff; 1096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dma_addr_t dma_rx_buff_phy; 1106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dma_addr_t dma_tx_buff_phy; 1116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned int dma_tx_buff_len; 1126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int txdma; 1136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int rxdma; 1146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 115121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring int uart_irq; 116121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring int icp_irq; 117121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring 1186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct irlap_cb *irlap; 1196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct qos_info qos; 1206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre iobuff_t tx_buff; 1226f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre iobuff_t rx_buff; 1236f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct device *dev; 1256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxaficp_platform_data *pdata; 12682d553c67deef92c6c84ecb70afc56e99863060cRussell King struct clk *fir_clk; 12782d553c67deef92c6c84ecb70afc56e99863060cRussell King struct clk *sir_clk; 12882d553c67deef92c6c84ecb70afc56e99863060cRussell King struct clk *cur_clk; 1296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre}; 1306f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 13182d553c67deef92c6c84ecb70afc56e99863060cRussell Kingstatic inline void pxa_irda_disable_clk(struct pxa_irda *si) 13282d553c67deef92c6c84ecb70afc56e99863060cRussell King{ 13382d553c67deef92c6c84ecb70afc56e99863060cRussell King if (si->cur_clk) 1344823cd388dd68015e254d1449bd63ffe47d83fa7Philipp Zabel clk_disable_unprepare(si->cur_clk); 13582d553c67deef92c6c84ecb70afc56e99863060cRussell King si->cur_clk = NULL; 13682d553c67deef92c6c84ecb70afc56e99863060cRussell King} 13782d553c67deef92c6c84ecb70afc56e99863060cRussell King 13882d553c67deef92c6c84ecb70afc56e99863060cRussell Kingstatic inline void pxa_irda_enable_firclk(struct pxa_irda *si) 13982d553c67deef92c6c84ecb70afc56e99863060cRussell King{ 14082d553c67deef92c6c84ecb70afc56e99863060cRussell King si->cur_clk = si->fir_clk; 1414823cd388dd68015e254d1449bd63ffe47d83fa7Philipp Zabel clk_prepare_enable(si->fir_clk); 14282d553c67deef92c6c84ecb70afc56e99863060cRussell King} 14382d553c67deef92c6c84ecb70afc56e99863060cRussell King 14482d553c67deef92c6c84ecb70afc56e99863060cRussell Kingstatic inline void pxa_irda_enable_sirclk(struct pxa_irda *si) 14582d553c67deef92c6c84ecb70afc56e99863060cRussell King{ 14682d553c67deef92c6c84ecb70afc56e99863060cRussell King si->cur_clk = si->sir_clk; 1474823cd388dd68015e254d1449bd63ffe47d83fa7Philipp Zabel clk_prepare_enable(si->sir_clk); 14882d553c67deef92c6c84ecb70afc56e99863060cRussell King} 14982d553c67deef92c6c84ecb70afc56e99863060cRussell King 1506f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1516f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IS_FIR(si) ((si)->speed >= 4000000) 1526f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre#define IRDA_FRAME_SIZE_LIMIT 2047 1536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreinline static void pxa_irda_fir_dma_rx_start(struct pxa_irda *si) 1556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 1566f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->rxdma) = DCSR_NODESC; 1576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DSADR(si->rxdma) = __PREG(ICDR); 1586f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DTADR(si->rxdma) = si->dma_rx_buff_phy; 1596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCMD(si->rxdma) = DCMD_INCTRGADDR | DCMD_FLOWSRC | DCMD_WIDTH1 | DCMD_BURST32 | IRDA_FRAME_SIZE_LIMIT; 1606f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->rxdma) |= DCSR_RUN; 1616f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 1626f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1636f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreinline static void pxa_irda_fir_dma_tx_start(struct pxa_irda *si) 1646f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 1656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->txdma) = DCSR_NODESC; 1666f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DSADR(si->txdma) = si->dma_tx_buff_phy; 1676f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DTADR(si->txdma) = __PREG(ICDR); 1686f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCMD(si->txdma) = DCMD_INCSRCADDR | DCMD_FLOWTRG | DCMD_ENDIRQEN | DCMD_WIDTH1 | DCMD_BURST32 | si->dma_tx_buff_len; 1696f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->txdma) |= DCSR_RUN; 1706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 1716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* 173c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut * Set the IrDA communications mode. 174c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut */ 175c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasutstatic void pxa_irda_set_mode(struct pxa_irda *si, int mode) 176c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut{ 177c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (si->pdata->transceiver_mode) 178c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut si->pdata->transceiver_mode(si->dev, mode); 179c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut else { 180c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (gpio_is_valid(si->pdata->gpio_pwdown)) 181c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut gpio_set_value(si->pdata->gpio_pwdown, 182c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut !(mode & IR_OFF) ^ 183c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut !si->pdata->gpio_pwdown_inverted); 184c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut pxa2xx_transceiver_mode(si->dev, mode); 185c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut } 186c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut} 187c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut 188c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut/* 1896f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Set the IrDA communications speed. 1906f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 1916f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic int pxa_irda_set_speed(struct pxa_irda *si, int speed) 1926f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 1936f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned long flags; 1946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned int divisor; 1956f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 1966f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre switch (speed) { 1976f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case 9600: case 19200: case 38400: 1986f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case 57600: case 115200: 1996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2006f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* refer to PXA250/210 Developer's Manual 10-7 */ 2016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* BaudRate = 14.7456 MHz / (16*Divisor) */ 2026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre divisor = 14745600 / (16 * speed); 2036f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre local_irq_save(flags); 2056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (IS_FIR(si)) { 2076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* stop RX DMA */ 2086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->rxdma) &= ~DCSR_RUN; 2096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable FICP */ 2106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = 0; 21182d553c67deef92c6c84ecb70afc56e99863060cRussell King pxa_irda_disable_clk(si); 2126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* set board transceiver to SIR mode */ 214c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut pxa_irda_set_mode(si, IR_SIRMODE); 2156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2166f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* enable the STUART clock */ 21782d553c67deef92c6c84ecb70afc56e99863060cRussell King pxa_irda_enable_sirclk(si); 2186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 2196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable STUART first */ 2216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = 0; 2226f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2236f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* access DLL & DLH */ 2246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STLCR |= LCR_DLAB; 2256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STDLL = divisor & 0xff; 2266f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STDLH = divisor >> 8; 2276f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STLCR &= ~LCR_DLAB; 2286f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->speed = speed; 2306f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STISR = IrSR_IR_RECEIVE_ON | IrSR_XMODE_PULSE_1_6; 2316f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = IER_UUE | IER_RLSE | IER_RAVIE | IER_RTIOE; 2326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre local_irq_restore(flags); 2346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 2356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2366f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case 4000000: 2376f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre local_irq_save(flags); 2386f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2396f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable STUART */ 2406f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = 0; 2416f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STISR = 0; 24282d553c67deef92c6c84ecb70afc56e99863060cRussell King pxa_irda_disable_clk(si); 2436f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2446f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable FICP first */ 2456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = 0; 2466f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2476f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* set board transceiver to FIR mode */ 248c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut pxa_irda_set_mode(si, IR_FIRMODE); 2496f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2506f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* enable the FICP clock */ 25182d553c67deef92c6c84ecb70afc56e99863060cRussell King pxa_irda_enable_firclk(si); 2526f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->speed = speed; 2546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_fir_dma_rx_start(si); 2556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = ICCR0_ITR | ICCR0_RXE; 2566f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre local_irq_restore(flags); 2586f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 2596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2606f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre default: 2616f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return -EINVAL; 2626f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 2636f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2646f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return 0; 2656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 2666f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2676f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* SIR interrupt service routine. */ 2687d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t pxa_irda_sir_irq(int irq, void *dev_id) 2696f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 2706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct net_device *dev = dev_id; 2716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 2726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int iir, lsr, data; 2736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre iir = STIIR; 2756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2766f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre switch (iir & 0x0F) { 2776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case 0x06: /* Receiver Line Status */ 2786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre lsr = STLSR; 2796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre while (lsr & LSR_FIFOE) { 2806f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre data = STRBR; 2816f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (lsr & (LSR_OE | LSR_PE | LSR_FE | LSR_BI)) { 2826f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: sir receiving error\n"); 283af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_errors++; 2846f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (lsr & LSR_FE) 285af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_frame_errors++; 2866f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (lsr & LSR_OE) 287af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_fifo_errors++; 2886f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 289af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_bytes++; 290af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger async_unwrap_char(dev, &dev->stats, 291af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger &si->rx_buff, data); 2926f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 2936f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre lsr = STLSR; 2946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 295929678005ce947d521b0f8f3a76d48d7b394562bArnd Bergmann si->last_oscr = readl_relaxed(OSCR); 2966f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 2976f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 2986f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case 0x04: /* Received Data Available */ 2996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* forth through */ 3006f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case 0x0C: /* Character Timeout Indication */ 3026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre do { 303af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_bytes++; 304af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger async_unwrap_char(dev, &dev->stats, &si->rx_buff, STRBR); 3056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } while (STLSR & LSR_DR); 306929678005ce947d521b0f8f3a76d48d7b394562bArnd Bergmann si->last_oscr = readl_relaxed(OSCR); 3076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 3086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case 0x02: /* Transmit FIFO Data Request */ 3106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre while ((si->tx_buff.len) && (STLSR & LSR_TDRQ)) { 3116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STTHR = *si->tx_buff.data++; 3126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->tx_buff.len -= 1; 3136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 3146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->tx_buff.len == 0) { 316af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.tx_packets++; 317af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.tx_bytes += si->tx_buff.data - si->tx_buff.head; 3186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* We need to ensure that the transmitter has finished. */ 3206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre while ((STLSR & LSR_TEMT) == 0) 3216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre cpu_relax(); 322929678005ce947d521b0f8f3a76d48d7b394562bArnd Bergmann si->last_oscr = readl_relaxed(OSCR); 3236f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 3256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Ok, we've finished transmitting. Now enable 3266f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * the receiver. Sometimes we get a receive IRQ 3276f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * immediately after a transmit... 3286f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 3296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->newspeed) { 3306f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_set_speed(si, si->newspeed); 3316f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->newspeed = 0; 3326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 3336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* enable IR Receiver, disable IR Transmitter */ 3346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STISR = IrSR_IR_RECEIVE_ON | IrSR_XMODE_PULSE_1_6; 3356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* enable STUART and receive interrupts */ 3366f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = IER_UUE | IER_RLSE | IER_RAVIE | IER_RTIOE; 3376f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 3386f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* I'm hungry! */ 3396f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_wake_queue(dev); 3406f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 3416f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 3426f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 3436f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3446f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return IRQ_HANDLED; 3456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 3466f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3476f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* FIR Receive DMA interrupt handler */ 3487d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic void pxa_irda_fir_dma_rx_irq(int channel, void *data) 3496f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 3506f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int dcsr = DCSR(channel); 3516f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3526f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(channel) = dcsr & ~DCSR_RUN; 3536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: fir rx dma bus error %#x\n", dcsr); 3556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 3566f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* FIR Transmit DMA interrupt handler */ 3587d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic void pxa_irda_fir_dma_tx_irq(int channel, void *data) 3596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 3606f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct net_device *dev = data; 3616f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 3626f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int dcsr; 3636f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3646f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dcsr = DCSR(channel); 3656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(channel) = dcsr & ~DCSR_RUN; 3666f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3676f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (dcsr & DCSR_ENDINTR) { 368af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.tx_packets++; 369af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.tx_bytes += si->dma_tx_buff_len; 3706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 371af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.tx_errors++; 3726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 3736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre while (ICSR1 & ICSR1_TBY) 3756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre cpu_relax(); 376929678005ce947d521b0f8f3a76d48d7b394562bArnd Bergmann si->last_oscr = readl_relaxed(OSCR); 3776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 3796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * HACK: It looks like the TBY bit is dropped too soon. 3806f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Without this delay things break. 3816f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 3826f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre udelay(120); 3836f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 3846f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->newspeed) { 3856f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_set_speed(si, si->newspeed); 3866f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->newspeed = 0; 3876f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 3889a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski int i = 64; 3899a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski 3906f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = 0; 3916f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_fir_dma_rx_start(si); 3929a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski while ((ICSR1 & ICSR1_RNE) && i--) 3939a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski (void)ICDR; 3946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = ICCR0_ITR | ICCR0_RXE; 3959a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski 3969a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski if (i < 0) 3979a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski printk(KERN_ERR "pxa_ir: cannot clear Rx FIFO!\n"); 3986f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 3996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_wake_queue(dev); 4006f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 4016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* EIF(Error in FIFO/End in Frame) handler for FIR */ 4039a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetskistatic void pxa_irda_fir_irq_eif(struct pxa_irda *si, struct net_device *dev, int icsr0) 4046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 4056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned int len, stat, data; 4066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Get the current data position. */ 4086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre len = DTADR(si->rxdma) - si->dma_rx_buff_phy; 4096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre do { 4116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Read Status, and then Data. */ 4126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre stat = ICSR1; 4136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre rmb(); 4146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre data = ICDR; 4156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4166f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (stat & (ICSR1_CRE | ICSR1_ROR)) { 417af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_errors++; 4186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (stat & ICSR1_CRE) { 4196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: fir receive CRC error\n"); 420af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_crc_errors++; 4216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4226f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (stat & ICSR1_ROR) { 4236f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: fir receive overrun\n"); 424af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_over_errors++; 4256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4266f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 4276f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->dma_rx_buff[len++] = data; 4286f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* If we hit the end of frame, there's no point in continuing. */ 4306f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (stat & ICSR1_EOF) 4316f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 4326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } while (ICSR0 & ICSR0_EIF); 4336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (stat & ICSR1_EOF) { 4356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* end of frame. */ 4369a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski struct sk_buff *skb; 4379a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski 4389a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski if (icsr0 & ICSR0_FRE) { 4399a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski printk(KERN_ERR "pxa_ir: dropping erroneous frame\n"); 440af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_dropped++; 4419a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski return; 4429a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski } 4439a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski 4449a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski skb = alloc_skb(len+1,GFP_ATOMIC); 4456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (!skb) { 4466f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_ERR "pxa_ir: fir out of memory for receive skb\n"); 447af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_dropped++; 4486f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return; 4496f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4506f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4516f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Align IP header to 20 bytes */ 4526f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre skb_reserve(skb, 1); 45327d7ff46a3498d3debc6ba68fb8014c702b81170Arnaldo Carvalho de Melo skb_copy_to_linear_data(skb, si->dma_rx_buff, len); 4546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre skb_put(skb, len); 4556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4566f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Feed it to IrLAP */ 4576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre skb->dev = dev; 458459a98ed881802dee55897441bc7f77af614368eArnaldo Carvalho de Melo skb_reset_mac_header(skb); 4596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre skb->protocol = htons(ETH_P_IRDA); 4606f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_rx(skb); 4616f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 462af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_packets++; 463af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_bytes += len; 4646f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 4666f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4676f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* FIR interrupt handler */ 4687d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t pxa_irda_fir_irq(int irq, void *dev_id) 4696f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 4706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct net_device *dev = dev_id; 4716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 4729a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski int icsr0, i = 64; 4736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* stop RX DMA */ 4756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->rxdma) &= ~DCSR_RUN; 476929678005ce947d521b0f8f3a76d48d7b394562bArnd Bergmann si->last_oscr = readl_relaxed(OSCR); 4776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre icsr0 = ICSR0; 4786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (icsr0 & (ICSR0_FRE | ICSR0_RAB)) { 4806f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (icsr0 & ICSR0_FRE) { 4816f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: fir receive frame error\n"); 482af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_frame_errors++; 4836f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 4846f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: fir receive abort\n"); 485af0490810cfa159b4894ddecfc5eb2e4432fb976Stephen Hemminger dev->stats.rx_errors++; 4866f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4876f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICSR0 = icsr0 & (ICSR0_FRE | ICSR0_RAB); 4886f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4896f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4906f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (icsr0 & ICSR0_EIF) { 49125985edcedea6396277003854657b5f3cb31a628Lucas De Marchi /* An error in FIFO occurred, or there is a end of frame */ 4929a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski pxa_irda_fir_irq_eif(si, dev, icsr0); 4936f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 4946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 4956f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = 0; 4966f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_fir_dma_rx_start(si); 4979a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski while ((ICSR1 & ICSR1_RNE) && i--) 4989a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski (void)ICDR; 4996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = ICCR0_ITR | ICCR0_RXE; 5006f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5019a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski if (i < 0) 5029a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski printk(KERN_ERR "pxa_ir: cannot clear Rx FIFO!\n"); 5039a4d93d49d140c196020a1bae339efcf211cac03Guennadi Liakhovetski 5046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return IRQ_HANDLED; 5056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 5066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre/* hard_xmit interface of irda device */ 5086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic int pxa_irda_hard_xmit(struct sk_buff *skb, struct net_device *dev) 5096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 5106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 5116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int speed = irda_get_next_speed(skb); 5126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 5146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Does this packet contain a request to change the interface 5156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * speed? If so, remember it until we complete the transmission 5166f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * of this frame. 5176f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 5186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (speed != si->speed && speed != -1) 5196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->newspeed = speed; 5206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 5226f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * If this is an empty frame, we can bypass a lot. 5236f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 5246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (skb->len == 0) { 5256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->newspeed) { 5266f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->newspeed = 0; 5276f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_set_speed(si, speed); 5286f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 5296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dev_kfree_skb(skb); 5306ed106549d17474ca17a16057f4c0ed4eba5a7caPatrick McHardy return NETDEV_TX_OK; 5316f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 5326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_stop_queue(dev); 5346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (!IS_FIR(si)) { 5366f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->tx_buff.data = si->tx_buff.head; 5376f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->tx_buff.len = async_wrap_skb(skb, si->tx_buff.data, si->tx_buff.truesize); 5386f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5396f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Disable STUART interrupts and switch to transmit mode. */ 5406f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = 0; 5416f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STISR = IrSR_IR_TRANSMIT_ON | IrSR_XMODE_PULSE_1_6; 5426f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5436f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* enable STUART and transmit interrupts */ 5446f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = IER_UUE | IER_TIE; 5456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 5466f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned long mtt = irda_get_mtt(skb); 5476f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5486f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->dma_tx_buff_len = skb->len; 549d626f62b11e00c16e81e4308ab93d3f13551812aArnaldo Carvalho de Melo skb_copy_from_linear_data(skb, si->dma_tx_buff, skb->len); 5506f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5516f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (mtt) 552929678005ce947d521b0f8f3a76d48d7b394562bArnd Bergmann while ((unsigned)(readl_relaxed(OSCR) - si->last_oscr)/4 < mtt) 5536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre cpu_relax(); 5546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* stop RX DMA, disable FICP */ 5566f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->rxdma) &= ~DCSR_RUN; 5576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = 0; 5586f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_fir_dma_tx_start(si); 5606f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = ICCR0_ITR | ICCR0_TXE; 5616f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 5626f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5636f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dev_kfree_skb(skb); 5646ed106549d17474ca17a16057f4c0ed4eba5a7caPatrick McHardy return NETDEV_TX_OK; 5656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 5666f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5676f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic int pxa_irda_ioctl(struct net_device *dev, struct ifreq *ifreq, int cmd) 5686f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 5696f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct if_irda_req *rq = (struct if_irda_req *)ifreq; 5706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 5716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int ret; 5726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre switch (cmd) { 5746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case SIOCSBANDWIDTH: 5756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ret = -EPERM; 5766f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (capable(CAP_NET_ADMIN)) { 5776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 5786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * We are unable to set the speed if the 5796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * device is not running. 5806f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 5816f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (netif_running(dev)) { 5826f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ret = pxa_irda_set_speed(si, 5836f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre rq->ifr_baudrate); 5846f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } else { 5856f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_INFO "pxa_ir: SIOCSBANDWIDTH: !netif_running\n"); 5866f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ret = 0; 5876f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 5886f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 5896f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 5906f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5916f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case SIOCSMEDIABUSY: 5926f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ret = -EPERM; 5936f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (capable(CAP_NET_ADMIN)) { 5946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre irda_device_set_media_busy(dev, TRUE); 5956f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ret = 0; 5966f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 5976f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 5986f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 5996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre case SIOCGRECEIVING: 6006f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ret = 0; 6016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre rq->ifr_receiving = IS_FIR(si) ? 0 6026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre : si->rx_buff.state != OUTSIDE_FRAME; 6036f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 6046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre default: 6066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ret = -EOPNOTSUPP; 6076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre break; 6086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 6096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return ret; 6116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 6126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic void pxa_irda_startup(struct pxa_irda *si) 6146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 6156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Disable STUART interrupts */ 6166f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = 0; 6176f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* enable STUART interrupt to the processor */ 6186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STMCR = MCR_OUT2; 6196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* configure SIR frame format: StartBit - Data 7 ... Data 0 - Stop Bit */ 6206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STLCR = LCR_WLS0 | LCR_WLS1; 6216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* enable FIFO, we use FIFO to improve performance */ 6226f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STFCR = FCR_TRFIFOE | FCR_ITL_32; 6236f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable FICP */ 6256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = 0; 6266f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* configure FICP ICCR2 */ 6276f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR2 = ICCR2_TXP | ICCR2_TRIG_32; 6286f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* configure DMAC */ 63087f3dd77974cba1ba0798abd741ede50f56b3eb3Eric Miao DRCMR(17) = si->rxdma | DRCMR_MAPVLD; 63187f3dd77974cba1ba0798abd741ede50f56b3eb3Eric Miao DRCMR(18) = si->txdma | DRCMR_MAPVLD; 6326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* force SIR reinitialization */ 6346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->speed = 4000000; 6356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_set_speed(si, 9600); 6366f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6376f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: irda startup\n"); 6386f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 6396f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6406f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic void pxa_irda_shutdown(struct pxa_irda *si) 6416f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 6426f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned long flags; 6436f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6446f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre local_irq_save(flags); 6456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6466f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable STUART and interrupt */ 6476f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STIER = 0; 6486f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable STUART SIR mode */ 6496f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre STISR = 0; 6506f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6516f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable DMA */ 6526f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->txdma) &= ~DCSR_RUN; 6536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre DCSR(si->rxdma) &= ~DCSR_RUN; 6546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* disable FICP */ 6556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre ICCR0 = 0; 65682d553c67deef92c6c84ecb70afc56e99863060cRussell King 65782d553c67deef92c6c84ecb70afc56e99863060cRussell King /* disable the STUART or FICP clocks */ 65882d553c67deef92c6c84ecb70afc56e99863060cRussell King pxa_irda_disable_clk(si); 6596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 66087f3dd77974cba1ba0798abd741ede50f56b3eb3Eric Miao DRCMR(17) = 0; 66187f3dd77974cba1ba0798abd741ede50f56b3eb3Eric Miao DRCMR(18) = 0; 6626f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6636f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre local_irq_restore(flags); 6646f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* power off board transceiver */ 666c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut pxa_irda_set_mode(si, IR_OFF); 6676f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6686f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: irda shutdown\n"); 6696f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 6706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic int pxa_irda_start(struct net_device *dev) 6726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 6736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 6746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int err; 6756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6766f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->speed = 9600; 6776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 678121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring err = request_irq(si->uart_irq, pxa_irda_sir_irq, 0, dev->name, dev); 6796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err) 6806f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_irq1; 6816f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 682121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring err = request_irq(si->icp_irq, pxa_irda_fir_irq, 0, dev->name, dev); 6836f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err) 6846f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_irq2; 6856f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6866f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 6876f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * The interrupt must remain disabled for now. 6886f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 689121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring disable_irq(si->uart_irq); 690121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring disable_irq(si->icp_irq); 6916f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6926f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = -EBUSY; 6936f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->rxdma = pxa_request_dma("FICP_RX",DMA_PRIO_LOW, pxa_irda_fir_dma_rx_irq, dev); 6946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->rxdma < 0) 6956f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_rx_dma; 6966f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 6976f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->txdma = pxa_request_dma("FICP_TX",DMA_PRIO_LOW, pxa_irda_fir_dma_tx_irq, dev); 6986f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->txdma < 0) 6996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_tx_dma; 7006f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = -ENOMEM; 7026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->dma_rx_buff = dma_alloc_coherent(si->dev, IRDA_FRAME_SIZE_LIMIT, 7031f9061d27d3d2028805549c4a306324a48209057Joe Perches &si->dma_rx_buff_phy, GFP_KERNEL); 7046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (!si->dma_rx_buff) 7056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_dma_rx_buff; 7066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->dma_tx_buff = dma_alloc_coherent(si->dev, IRDA_FRAME_SIZE_LIMIT, 7081f9061d27d3d2028805549c4a306324a48209057Joe Perches &si->dma_tx_buff_phy, GFP_KERNEL); 7096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (!si->dma_tx_buff) 7106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_dma_tx_buff; 7116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Setup the serial port for the initial speed. */ 7136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_startup(si); 7146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 7166f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Open a new IrLAP layer instance. 7176f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 7186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->irlap = irlap_open(dev, &si->qos, "pxa"); 7196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = -ENOMEM; 7206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (!si->irlap) 7216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_irlap; 7226f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7236f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 7246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Now enable the interrupt and start the queue 7256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 726121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring enable_irq(si->uart_irq); 727121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring enable_irq(si->icp_irq); 7286f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_start_queue(dev); 7296f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7306f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: irda driver opened\n"); 7316f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return 0; 7336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_irlap: 7356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_shutdown(si); 7366f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dma_free_coherent(si->dev, IRDA_FRAME_SIZE_LIMIT, si->dma_tx_buff, si->dma_tx_buff_phy); 7376f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_dma_tx_buff: 7386f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dma_free_coherent(si->dev, IRDA_FRAME_SIZE_LIMIT, si->dma_rx_buff, si->dma_rx_buff_phy); 7396f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_dma_rx_buff: 7406f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_free_dma(si->txdma); 7416f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_tx_dma: 7426f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_free_dma(si->rxdma); 7436f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_rx_dma: 744121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring free_irq(si->icp_irq, dev); 7456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_irq2: 746121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring free_irq(si->uart_irq, dev); 7476f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_irq1: 7486f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7496f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return err; 7506f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 7516f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7526f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic int pxa_irda_stop(struct net_device *dev) 7536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 7546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 7556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7566f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_stop_queue(dev); 7576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7586f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_shutdown(si); 7596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7606f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* Stop IrLAP */ 7616f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->irlap) { 7626f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre irlap_close(si->irlap); 7636f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->irlap = NULL; 7646f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 7656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 766121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring free_irq(si->uart_irq, dev); 767121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring free_irq(si->icp_irq, dev); 7686f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7696f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_free_dma(si->rxdma); 7706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_free_dma(si->txdma); 7716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->dma_rx_buff) 7736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dma_free_coherent(si->dev, IRDA_FRAME_SIZE_LIMIT, si->dma_tx_buff, si->dma_tx_buff_phy); 7746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->dma_tx_buff) 7756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dma_free_coherent(si->dev, IRDA_FRAME_SIZE_LIMIT, si->dma_rx_buff, si->dma_rx_buff_phy); 7766f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre printk(KERN_DEBUG "pxa_ir: irda driver closed\n"); 7786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return 0; 7796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 7806f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 781b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovskystatic int pxa_irda_suspend(struct platform_device *_dev, pm_message_t state) 7826f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 783b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovsky struct net_device *dev = platform_get_drvdata(_dev); 7846f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si; 7856f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 78691e1a512291f258746611c18ec4970a81c9f311bRichard Purdie if (dev && netif_running(dev)) { 7876f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si = netdev_priv(dev); 7886f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_device_detach(dev); 7896f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_shutdown(si); 7906f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 7916f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 7926f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return 0; 7936f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 7946f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 795b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovskystatic int pxa_irda_resume(struct platform_device *_dev) 7966f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 797b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovsky struct net_device *dev = platform_get_drvdata(_dev); 7986f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si; 7996f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 80091e1a512291f258746611c18ec4970a81c9f311bRichard Purdie if (dev && netif_running(dev)) { 8016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si = netdev_priv(dev); 8026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre pxa_irda_startup(si); 8036f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_device_attach(dev); 8046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre netif_wake_queue(dev); 8056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 8066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 8076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return 0; 8086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 8096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 8106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 8116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitrestatic int pxa_irda_init_iobuf(iobuff_t *io, int size) 8126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 8136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre io->head = kmalloc(size, GFP_KERNEL | GFP_DMA); 8146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (io->head != NULL) { 8156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre io->truesize = size; 8166f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre io->in_frame = FALSE; 8176f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre io->state = OUTSIDE_FRAME; 8186f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre io->data = io->head; 8196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 8206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return io->head ? 0 : -ENOMEM; 8216f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 8226f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 823c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalovstatic const struct net_device_ops pxa_irda_netdev_ops = { 824c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalov .ndo_open = pxa_irda_start, 825c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalov .ndo_stop = pxa_irda_stop, 826c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalov .ndo_start_xmit = pxa_irda_hard_xmit, 827c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalov .ndo_do_ioctl = pxa_irda_ioctl, 828c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalov}; 829c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalov 830b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovskystatic int pxa_irda_probe(struct platform_device *pdev) 8316f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 8326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct net_device *dev; 8336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si; 8346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unsigned int baudrate_mask; 8356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre int err; 8366f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 8376f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (!pdev->dev.platform_data) 8386f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return -ENODEV; 8396f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 8406f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = request_mem_region(__PREG(STUART), 0x24, "IrDA") ? 0 : -EBUSY; 8416f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err) 8426f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_mem_1; 8436f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 8446f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = request_mem_region(__PREG(FICP), 0x1c, "IrDA") ? 0 : -EBUSY; 8456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err) 8466f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_mem_2; 8476f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 8486f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre dev = alloc_irdadev(sizeof(struct pxa_irda)); 849cbd841ca91b4f87d62263f8d86af1b14a745c413Peter Senna Tschudin if (!dev) { 850cbd841ca91b4f87d62263f8d86af1b14a745c413Peter Senna Tschudin err = -ENOMEM; 8516f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_mem_3; 852cbd841ca91b4f87d62263f8d86af1b14a745c413Peter Senna Tschudin } 8536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 854d2f3ad4cedc00c8ee848e7abe9b2bbc93b9a8c2dMarek Vasut SET_NETDEV_DEV(dev, &pdev->dev); 8556f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si = netdev_priv(dev); 8566f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->dev = &pdev->dev; 8576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->pdata = pdev->dev.platform_data; 8586f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 859121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring si->uart_irq = platform_get_irq(pdev, 0); 860121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring si->icp_irq = platform_get_irq(pdev, 1); 861121f3f9b42eb1e1e9edb6ab0f8672e92dd610a31Rob Herring 86282d553c67deef92c6c84ecb70afc56e99863060cRussell King si->sir_clk = clk_get(&pdev->dev, "UARTCLK"); 86382d553c67deef92c6c84ecb70afc56e99863060cRussell King si->fir_clk = clk_get(&pdev->dev, "FICPCLK"); 86482d553c67deef92c6c84ecb70afc56e99863060cRussell King if (IS_ERR(si->sir_clk) || IS_ERR(si->fir_clk)) { 86582d553c67deef92c6c84ecb70afc56e99863060cRussell King err = PTR_ERR(IS_ERR(si->sir_clk) ? si->sir_clk : si->fir_clk); 86682d553c67deef92c6c84ecb70afc56e99863060cRussell King goto err_mem_4; 86782d553c67deef92c6c84ecb70afc56e99863060cRussell King } 86882d553c67deef92c6c84ecb70afc56e99863060cRussell King 8696f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre /* 8706f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre * Initialise the SIR buffers 8716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre */ 8726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = pxa_irda_init_iobuf(&si->rx_buff, 14384); 8736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err) 8746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_mem_4; 8756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = pxa_irda_init_iobuf(&si->tx_buff, 4000); 8766f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err) 8776f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre goto err_mem_5; 8786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 879c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (gpio_is_valid(si->pdata->gpio_pwdown)) { 880c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut err = gpio_request(si->pdata->gpio_pwdown, "IrDA switch"); 881c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (err) 882c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut goto err_startup; 883c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut err = gpio_direction_output(si->pdata->gpio_pwdown, 884c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut !si->pdata->gpio_pwdown_inverted); 885c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (err) { 886c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut gpio_free(si->pdata->gpio_pwdown); 887c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut goto err_startup; 888c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut } 889c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut } 890c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut 891c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (si->pdata->startup) { 892baf1c5d2a08c828d6333e0a37bcdf5afb3d5d003Dmitry Eremin-Solenikov err = si->pdata->startup(si->dev); 893c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (err) 894c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut goto err_startup; 895c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut } 896c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut 897c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (gpio_is_valid(si->pdata->gpio_pwdown) && si->pdata->startup) 898c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut dev_warn(si->dev, "gpio_pwdown and startup() both defined!\n"); 899baf1c5d2a08c828d6333e0a37bcdf5afb3d5d003Dmitry Eremin-Solenikov 900c76ccd6a256004cca1127c9afb5474638fc78b74Alexander Beregalov dev->netdev_ops = &pxa_irda_netdev_ops; 9016f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9026f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre irda_init_max_qos_capabilies(&si->qos); 9036f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9046f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre baudrate_mask = 0; 9056f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->pdata->transceiver_cap & IR_SIRMODE) 9066f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre baudrate_mask |= IR_9600|IR_19200|IR_38400|IR_57600|IR_115200; 9076f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (si->pdata->transceiver_cap & IR_FIRMODE) 9086f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre baudrate_mask |= IR_4000000 << 8; 9096f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9106f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->qos.baud_rate.bits &= baudrate_mask; 9116f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre si->qos.min_turn_time.bits = 7; /* 1ms or more */ 9126f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9136f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre irda_qos_bits_to_value(&si->qos); 9146f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9156f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre err = register_netdev(dev); 9166f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9176f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err == 0) 9189bcadaef9189cce6b712a40ec2a359629e06795fLibo Chen platform_set_drvdata(pdev, dev); 9196f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9206f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (err) { 921baf1c5d2a08c828d6333e0a37bcdf5afb3d5d003Dmitry Eremin-Solenikov if (si->pdata->shutdown) 922baf1c5d2a08c828d6333e0a37bcdf5afb3d5d003Dmitry Eremin-Solenikov si->pdata->shutdown(si->dev); 923baf1c5d2a08c828d6333e0a37bcdf5afb3d5d003Dmitry Eremin-Solenikoverr_startup: 9246f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre kfree(si->tx_buff.head); 9256f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_mem_5: 9266f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre kfree(si->rx_buff.head); 9276f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_mem_4: 92882d553c67deef92c6c84ecb70afc56e99863060cRussell King if (si->sir_clk && !IS_ERR(si->sir_clk)) 92982d553c67deef92c6c84ecb70afc56e99863060cRussell King clk_put(si->sir_clk); 93082d553c67deef92c6c84ecb70afc56e99863060cRussell King if (si->fir_clk && !IS_ERR(si->fir_clk)) 93182d553c67deef92c6c84ecb70afc56e99863060cRussell King clk_put(si->fir_clk); 9326f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre free_netdev(dev); 9336f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_mem_3: 9346f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre release_mem_region(__PREG(FICP), 0x1c); 9356f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_mem_2: 9366f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre release_mem_region(__PREG(STUART), 0x24); 9376f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 9386f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitreerr_mem_1: 9396f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return err; 9406f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 9416f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 942b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovskystatic int pxa_irda_remove(struct platform_device *_dev) 9436f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre{ 944b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovsky struct net_device *dev = platform_get_drvdata(_dev); 9456f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9466f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre if (dev) { 9476f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre struct pxa_irda *si = netdev_priv(dev); 9486f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre unregister_netdev(dev); 949c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut if (gpio_is_valid(si->pdata->gpio_pwdown)) 950c4bd01727380ce666aba987b3d7c0e838cb99bbeMarek Vasut gpio_free(si->pdata->gpio_pwdown); 951baf1c5d2a08c828d6333e0a37bcdf5afb3d5d003Dmitry Eremin-Solenikov if (si->pdata->shutdown) 952baf1c5d2a08c828d6333e0a37bcdf5afb3d5d003Dmitry Eremin-Solenikov si->pdata->shutdown(si->dev); 9536f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre kfree(si->tx_buff.head); 9546f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre kfree(si->rx_buff.head); 95582d553c67deef92c6c84ecb70afc56e99863060cRussell King clk_put(si->fir_clk); 95682d553c67deef92c6c84ecb70afc56e99863060cRussell King clk_put(si->sir_clk); 9576f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre free_netdev(dev); 9586f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre } 9596f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9606f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre release_mem_region(__PREG(STUART), 0x24); 9616f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre release_mem_region(__PREG(FICP), 0x1c); 9626f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9636f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre return 0; 9646f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre} 9656f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 966b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovskystatic struct platform_driver pxa_ir_driver = { 967b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovsky .driver = { 968b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovsky .name = "pxa2xx-ir", 96972abb46101fb5c47a9592914adb221b430ff26bdKay Sievers .owner = THIS_MODULE, 970b259e7d250e15d45b3c8362917931aaff1c88d73Paul Sokolovsky }, 9716f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre .probe = pxa_irda_probe, 9726f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre .remove = pxa_irda_remove, 9736f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre .suspend = pxa_irda_suspend, 9746f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre .resume = pxa_irda_resume, 9756f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre}; 9766f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9778b7ff200010600ef7cd9d002f9f8f97edfc7578eAxel Linmodule_platform_driver(pxa_ir_driver); 9786f475c0133eb91c7df3b056843dc33d2824368a2Nicolas Pitre 9796f475c0133eb91c7df3b056843dc33d2824368a2Nicolas PitreMODULE_LICENSE("GPL"); 98072abb46101fb5c47a9592914adb221b430ff26bdKay SieversMODULE_ALIAS("platform:pxa2xx-ir"); 981