1ca632f55SGrant Likely /* 2ca632f55SGrant Likely * A driver for the ARM PL022 PrimeCell SSP/SPI bus master. 3ca632f55SGrant Likely * 4ca632f55SGrant Likely * Copyright (C) 2008-2009 ST-Ericsson AB 5ca632f55SGrant Likely * Copyright (C) 2006 STMicroelectronics Pvt. Ltd. 6ca632f55SGrant Likely * 7ca632f55SGrant Likely * Author: Linus Walleij <linus.walleij@stericsson.com> 8ca632f55SGrant Likely * 9ca632f55SGrant Likely * Initial version inspired by: 10ca632f55SGrant Likely * linux-2.6.17-rc3-mm1/drivers/spi/pxa2xx_spi.c 11ca632f55SGrant Likely * Initial adoption to PL022 by: 12ca632f55SGrant Likely * Sachin Verma <sachin.verma@st.com> 13ca632f55SGrant Likely * 14ca632f55SGrant Likely * This program is free software; you can redistribute it and/or modify 15ca632f55SGrant Likely * it under the terms of the GNU General Public License as published by 16ca632f55SGrant Likely * the Free Software Foundation; either version 2 of the License, or 17ca632f55SGrant Likely * (at your option) any later version. 18ca632f55SGrant Likely * 19ca632f55SGrant Likely * This program is distributed in the hope that it will be useful, 20ca632f55SGrant Likely * but WITHOUT ANY WARRANTY; without even the implied warranty of 21ca632f55SGrant Likely * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 22ca632f55SGrant Likely * GNU General Public License for more details. 23ca632f55SGrant Likely */ 24ca632f55SGrant Likely 25ca632f55SGrant Likely #include <linux/init.h> 26ca632f55SGrant Likely #include <linux/module.h> 27ca632f55SGrant Likely #include <linux/device.h> 28ca632f55SGrant Likely #include <linux/ioport.h> 29ca632f55SGrant Likely #include <linux/errno.h> 30ca632f55SGrant Likely #include <linux/interrupt.h> 31ca632f55SGrant Likely #include <linux/spi/spi.h> 32*14af60b6SChris Blair #include <linux/kthread.h> 33ca632f55SGrant Likely #include <linux/delay.h> 34ca632f55SGrant Likely #include <linux/clk.h> 35ca632f55SGrant Likely #include <linux/err.h> 36ca632f55SGrant Likely #include <linux/amba/bus.h> 37ca632f55SGrant Likely #include <linux/amba/pl022.h> 38ca632f55SGrant Likely #include <linux/io.h> 39ca632f55SGrant Likely #include <linux/slab.h> 40ca632f55SGrant Likely #include <linux/dmaengine.h> 41ca632f55SGrant Likely #include <linux/dma-mapping.h> 42ca632f55SGrant Likely #include <linux/scatterlist.h> 43bcda6ff8SRabin Vincent #include <linux/pm_runtime.h> 44*14af60b6SChris Blair #include <linux/sched.h> 45ca632f55SGrant Likely 46ca632f55SGrant Likely /* 47ca632f55SGrant Likely * This macro is used to define some register default values. 48ca632f55SGrant Likely * reg is masked with mask, the OR:ed with an (again masked) 49ca632f55SGrant Likely * val shifted sb steps to the left. 50ca632f55SGrant Likely */ 51ca632f55SGrant Likely #define SSP_WRITE_BITS(reg, val, mask, sb) \ 52ca632f55SGrant Likely ((reg) = (((reg) & ~(mask)) | (((val)<<(sb)) & (mask)))) 53ca632f55SGrant Likely 54ca632f55SGrant Likely /* 55ca632f55SGrant Likely * This macro is also used to define some default values. 56ca632f55SGrant Likely * It will just shift val by sb steps to the left and mask 57ca632f55SGrant Likely * the result with mask. 58ca632f55SGrant Likely */ 59ca632f55SGrant Likely #define GEN_MASK_BITS(val, mask, sb) \ 60ca632f55SGrant Likely (((val)<<(sb)) & (mask)) 61ca632f55SGrant Likely 62ca632f55SGrant Likely #define DRIVE_TX 0 63ca632f55SGrant Likely #define DO_NOT_DRIVE_TX 1 64ca632f55SGrant Likely 65ca632f55SGrant Likely #define DO_NOT_QUEUE_DMA 0 66ca632f55SGrant Likely #define QUEUE_DMA 1 67ca632f55SGrant Likely 68ca632f55SGrant Likely #define RX_TRANSFER 1 69ca632f55SGrant Likely #define TX_TRANSFER 2 70ca632f55SGrant Likely 71ca632f55SGrant Likely /* 72ca632f55SGrant Likely * Macros to access SSP Registers with their offsets 73ca632f55SGrant Likely */ 74ca632f55SGrant Likely #define SSP_CR0(r) (r + 0x000) 75ca632f55SGrant Likely #define SSP_CR1(r) (r + 0x004) 76ca632f55SGrant Likely #define SSP_DR(r) (r + 0x008) 77ca632f55SGrant Likely #define SSP_SR(r) (r + 0x00C) 78ca632f55SGrant Likely #define SSP_CPSR(r) (r + 0x010) 79ca632f55SGrant Likely #define SSP_IMSC(r) (r + 0x014) 80ca632f55SGrant Likely #define SSP_RIS(r) (r + 0x018) 81ca632f55SGrant Likely #define SSP_MIS(r) (r + 0x01C) 82ca632f55SGrant Likely #define SSP_ICR(r) (r + 0x020) 83ca632f55SGrant Likely #define SSP_DMACR(r) (r + 0x024) 84ca632f55SGrant Likely #define SSP_ITCR(r) (r + 0x080) 85ca632f55SGrant Likely #define SSP_ITIP(r) (r + 0x084) 86ca632f55SGrant Likely #define SSP_ITOP(r) (r + 0x088) 87ca632f55SGrant Likely #define SSP_TDR(r) (r + 0x08C) 88ca632f55SGrant Likely 89ca632f55SGrant Likely #define SSP_PID0(r) (r + 0xFE0) 90ca632f55SGrant Likely #define SSP_PID1(r) (r + 0xFE4) 91ca632f55SGrant Likely #define SSP_PID2(r) (r + 0xFE8) 92ca632f55SGrant Likely #define SSP_PID3(r) (r + 0xFEC) 93ca632f55SGrant Likely 94ca632f55SGrant Likely #define SSP_CID0(r) (r + 0xFF0) 95ca632f55SGrant Likely #define SSP_CID1(r) (r + 0xFF4) 96ca632f55SGrant Likely #define SSP_CID2(r) (r + 0xFF8) 97ca632f55SGrant Likely #define SSP_CID3(r) (r + 0xFFC) 98ca632f55SGrant Likely 99ca632f55SGrant Likely /* 100ca632f55SGrant Likely * SSP Control Register 0 - SSP_CR0 101ca632f55SGrant Likely */ 102ca632f55SGrant Likely #define SSP_CR0_MASK_DSS (0x0FUL << 0) 103ca632f55SGrant Likely #define SSP_CR0_MASK_FRF (0x3UL << 4) 104ca632f55SGrant Likely #define SSP_CR0_MASK_SPO (0x1UL << 6) 105ca632f55SGrant Likely #define SSP_CR0_MASK_SPH (0x1UL << 7) 106ca632f55SGrant Likely #define SSP_CR0_MASK_SCR (0xFFUL << 8) 107ca632f55SGrant Likely 108ca632f55SGrant Likely /* 109ca632f55SGrant Likely * The ST version of this block moves som bits 110ca632f55SGrant Likely * in SSP_CR0 and extends it to 32 bits 111ca632f55SGrant Likely */ 112ca632f55SGrant Likely #define SSP_CR0_MASK_DSS_ST (0x1FUL << 0) 113ca632f55SGrant Likely #define SSP_CR0_MASK_HALFDUP_ST (0x1UL << 5) 114ca632f55SGrant Likely #define SSP_CR0_MASK_CSS_ST (0x1FUL << 16) 115ca632f55SGrant Likely #define SSP_CR0_MASK_FRF_ST (0x3UL << 21) 116ca632f55SGrant Likely 117ca632f55SGrant Likely /* 118ca632f55SGrant Likely * SSP Control Register 0 - SSP_CR1 119ca632f55SGrant Likely */ 120ca632f55SGrant Likely #define SSP_CR1_MASK_LBM (0x1UL << 0) 121ca632f55SGrant Likely #define SSP_CR1_MASK_SSE (0x1UL << 1) 122ca632f55SGrant Likely #define SSP_CR1_MASK_MS (0x1UL << 2) 123ca632f55SGrant Likely #define SSP_CR1_MASK_SOD (0x1UL << 3) 124ca632f55SGrant Likely 125ca632f55SGrant Likely /* 126ca632f55SGrant Likely * The ST version of this block adds some bits 127ca632f55SGrant Likely * in SSP_CR1 128ca632f55SGrant Likely */ 129ca632f55SGrant Likely #define SSP_CR1_MASK_RENDN_ST (0x1UL << 4) 130ca632f55SGrant Likely #define SSP_CR1_MASK_TENDN_ST (0x1UL << 5) 131ca632f55SGrant Likely #define SSP_CR1_MASK_MWAIT_ST (0x1UL << 6) 132ca632f55SGrant Likely #define SSP_CR1_MASK_RXIFLSEL_ST (0x7UL << 7) 133ca632f55SGrant Likely #define SSP_CR1_MASK_TXIFLSEL_ST (0x7UL << 10) 134ca632f55SGrant Likely /* This one is only in the PL023 variant */ 135ca632f55SGrant Likely #define SSP_CR1_MASK_FBCLKDEL_ST (0x7UL << 13) 136ca632f55SGrant Likely 137ca632f55SGrant Likely /* 138ca632f55SGrant Likely * SSP Status Register - SSP_SR 139ca632f55SGrant Likely */ 140ca632f55SGrant Likely #define SSP_SR_MASK_TFE (0x1UL << 0) /* Transmit FIFO empty */ 141ca632f55SGrant Likely #define SSP_SR_MASK_TNF (0x1UL << 1) /* Transmit FIFO not full */ 142ca632f55SGrant Likely #define SSP_SR_MASK_RNE (0x1UL << 2) /* Receive FIFO not empty */ 143ca632f55SGrant Likely #define SSP_SR_MASK_RFF (0x1UL << 3) /* Receive FIFO full */ 144ca632f55SGrant Likely #define SSP_SR_MASK_BSY (0x1UL << 4) /* Busy Flag */ 145ca632f55SGrant Likely 146ca632f55SGrant Likely /* 147ca632f55SGrant Likely * SSP Clock Prescale Register - SSP_CPSR 148ca632f55SGrant Likely */ 149ca632f55SGrant Likely #define SSP_CPSR_MASK_CPSDVSR (0xFFUL << 0) 150ca632f55SGrant Likely 151ca632f55SGrant Likely /* 152ca632f55SGrant Likely * SSP Interrupt Mask Set/Clear Register - SSP_IMSC 153ca632f55SGrant Likely */ 154ca632f55SGrant Likely #define SSP_IMSC_MASK_RORIM (0x1UL << 0) /* Receive Overrun Interrupt mask */ 155ca632f55SGrant Likely #define SSP_IMSC_MASK_RTIM (0x1UL << 1) /* Receive timeout Interrupt mask */ 156ca632f55SGrant Likely #define SSP_IMSC_MASK_RXIM (0x1UL << 2) /* Receive FIFO Interrupt mask */ 157ca632f55SGrant Likely #define SSP_IMSC_MASK_TXIM (0x1UL << 3) /* Transmit FIFO Interrupt mask */ 158ca632f55SGrant Likely 159ca632f55SGrant Likely /* 160ca632f55SGrant Likely * SSP Raw Interrupt Status Register - SSP_RIS 161ca632f55SGrant Likely */ 162ca632f55SGrant Likely /* Receive Overrun Raw Interrupt status */ 163ca632f55SGrant Likely #define SSP_RIS_MASK_RORRIS (0x1UL << 0) 164ca632f55SGrant Likely /* Receive Timeout Raw Interrupt status */ 165ca632f55SGrant Likely #define SSP_RIS_MASK_RTRIS (0x1UL << 1) 166ca632f55SGrant Likely /* Receive FIFO Raw Interrupt status */ 167ca632f55SGrant Likely #define SSP_RIS_MASK_RXRIS (0x1UL << 2) 168ca632f55SGrant Likely /* Transmit FIFO Raw Interrupt status */ 169ca632f55SGrant Likely #define SSP_RIS_MASK_TXRIS (0x1UL << 3) 170ca632f55SGrant Likely 171ca632f55SGrant Likely /* 172ca632f55SGrant Likely * SSP Masked Interrupt Status Register - SSP_MIS 173ca632f55SGrant Likely */ 174ca632f55SGrant Likely /* Receive Overrun Masked Interrupt status */ 175ca632f55SGrant Likely #define SSP_MIS_MASK_RORMIS (0x1UL << 0) 176ca632f55SGrant Likely /* Receive Timeout Masked Interrupt status */ 177ca632f55SGrant Likely #define SSP_MIS_MASK_RTMIS (0x1UL << 1) 178ca632f55SGrant Likely /* Receive FIFO Masked Interrupt status */ 179ca632f55SGrant Likely #define SSP_MIS_MASK_RXMIS (0x1UL << 2) 180ca632f55SGrant Likely /* Transmit FIFO Masked Interrupt status */ 181ca632f55SGrant Likely #define SSP_MIS_MASK_TXMIS (0x1UL << 3) 182ca632f55SGrant Likely 183ca632f55SGrant Likely /* 184ca632f55SGrant Likely * SSP Interrupt Clear Register - SSP_ICR 185ca632f55SGrant Likely */ 186ca632f55SGrant Likely /* Receive Overrun Raw Clear Interrupt bit */ 187ca632f55SGrant Likely #define SSP_ICR_MASK_RORIC (0x1UL << 0) 188ca632f55SGrant Likely /* Receive Timeout Clear Interrupt bit */ 189ca632f55SGrant Likely #define SSP_ICR_MASK_RTIC (0x1UL << 1) 190ca632f55SGrant Likely 191ca632f55SGrant Likely /* 192ca632f55SGrant Likely * SSP DMA Control Register - SSP_DMACR 193ca632f55SGrant Likely */ 194ca632f55SGrant Likely /* Receive DMA Enable bit */ 195ca632f55SGrant Likely #define SSP_DMACR_MASK_RXDMAE (0x1UL << 0) 196ca632f55SGrant Likely /* Transmit DMA Enable bit */ 197ca632f55SGrant Likely #define SSP_DMACR_MASK_TXDMAE (0x1UL << 1) 198ca632f55SGrant Likely 199ca632f55SGrant Likely /* 200ca632f55SGrant Likely * SSP Integration Test control Register - SSP_ITCR 201ca632f55SGrant Likely */ 202ca632f55SGrant Likely #define SSP_ITCR_MASK_ITEN (0x1UL << 0) 203ca632f55SGrant Likely #define SSP_ITCR_MASK_TESTFIFO (0x1UL << 1) 204ca632f55SGrant Likely 205ca632f55SGrant Likely /* 206ca632f55SGrant Likely * SSP Integration Test Input Register - SSP_ITIP 207ca632f55SGrant Likely */ 208ca632f55SGrant Likely #define ITIP_MASK_SSPRXD (0x1UL << 0) 209ca632f55SGrant Likely #define ITIP_MASK_SSPFSSIN (0x1UL << 1) 210ca632f55SGrant Likely #define ITIP_MASK_SSPCLKIN (0x1UL << 2) 211ca632f55SGrant Likely #define ITIP_MASK_RXDMAC (0x1UL << 3) 212ca632f55SGrant Likely #define ITIP_MASK_TXDMAC (0x1UL << 4) 213ca632f55SGrant Likely #define ITIP_MASK_SSPTXDIN (0x1UL << 5) 214ca632f55SGrant Likely 215ca632f55SGrant Likely /* 216ca632f55SGrant Likely * SSP Integration Test output Register - SSP_ITOP 217ca632f55SGrant Likely */ 218ca632f55SGrant Likely #define ITOP_MASK_SSPTXD (0x1UL << 0) 219ca632f55SGrant Likely #define ITOP_MASK_SSPFSSOUT (0x1UL << 1) 220ca632f55SGrant Likely #define ITOP_MASK_SSPCLKOUT (0x1UL << 2) 221ca632f55SGrant Likely #define ITOP_MASK_SSPOEn (0x1UL << 3) 222ca632f55SGrant Likely #define ITOP_MASK_SSPCTLOEn (0x1UL << 4) 223ca632f55SGrant Likely #define ITOP_MASK_RORINTR (0x1UL << 5) 224ca632f55SGrant Likely #define ITOP_MASK_RTINTR (0x1UL << 6) 225ca632f55SGrant Likely #define ITOP_MASK_RXINTR (0x1UL << 7) 226ca632f55SGrant Likely #define ITOP_MASK_TXINTR (0x1UL << 8) 227ca632f55SGrant Likely #define ITOP_MASK_INTR (0x1UL << 9) 228ca632f55SGrant Likely #define ITOP_MASK_RXDMABREQ (0x1UL << 10) 229ca632f55SGrant Likely #define ITOP_MASK_RXDMASREQ (0x1UL << 11) 230ca632f55SGrant Likely #define ITOP_MASK_TXDMABREQ (0x1UL << 12) 231ca632f55SGrant Likely #define ITOP_MASK_TXDMASREQ (0x1UL << 13) 232ca632f55SGrant Likely 233ca632f55SGrant Likely /* 234ca632f55SGrant Likely * SSP Test Data Register - SSP_TDR 235ca632f55SGrant Likely */ 236ca632f55SGrant Likely #define TDR_MASK_TESTDATA (0xFFFFFFFF) 237ca632f55SGrant Likely 238ca632f55SGrant Likely /* 239ca632f55SGrant Likely * Message State 240ca632f55SGrant Likely * we use the spi_message.state (void *) pointer to 241ca632f55SGrant Likely * hold a single state value, that's why all this 242ca632f55SGrant Likely * (void *) casting is done here. 243ca632f55SGrant Likely */ 244ca632f55SGrant Likely #define STATE_START ((void *) 0) 245ca632f55SGrant Likely #define STATE_RUNNING ((void *) 1) 246ca632f55SGrant Likely #define STATE_DONE ((void *) 2) 247ca632f55SGrant Likely #define STATE_ERROR ((void *) -1) 248ca632f55SGrant Likely 249ca632f55SGrant Likely /* 250ca632f55SGrant Likely * SSP State - Whether Enabled or Disabled 251ca632f55SGrant Likely */ 252ca632f55SGrant Likely #define SSP_DISABLED (0) 253ca632f55SGrant Likely #define SSP_ENABLED (1) 254ca632f55SGrant Likely 255ca632f55SGrant Likely /* 256ca632f55SGrant Likely * SSP DMA State - Whether DMA Enabled or Disabled 257ca632f55SGrant Likely */ 258ca632f55SGrant Likely #define SSP_DMA_DISABLED (0) 259ca632f55SGrant Likely #define SSP_DMA_ENABLED (1) 260ca632f55SGrant Likely 261ca632f55SGrant Likely /* 262ca632f55SGrant Likely * SSP Clock Defaults 263ca632f55SGrant Likely */ 264ca632f55SGrant Likely #define SSP_DEFAULT_CLKRATE 0x2 265ca632f55SGrant Likely #define SSP_DEFAULT_PRESCALE 0x40 266ca632f55SGrant Likely 267ca632f55SGrant Likely /* 268ca632f55SGrant Likely * SSP Clock Parameter ranges 269ca632f55SGrant Likely */ 270ca632f55SGrant Likely #define CPSDVR_MIN 0x02 271ca632f55SGrant Likely #define CPSDVR_MAX 0xFE 272ca632f55SGrant Likely #define SCR_MIN 0x00 273ca632f55SGrant Likely #define SCR_MAX 0xFF 274ca632f55SGrant Likely 275ca632f55SGrant Likely /* 276ca632f55SGrant Likely * SSP Interrupt related Macros 277ca632f55SGrant Likely */ 278ca632f55SGrant Likely #define DEFAULT_SSP_REG_IMSC 0x0UL 279ca632f55SGrant Likely #define DISABLE_ALL_INTERRUPTS DEFAULT_SSP_REG_IMSC 280ca632f55SGrant Likely #define ENABLE_ALL_INTERRUPTS (~DEFAULT_SSP_REG_IMSC) 281ca632f55SGrant Likely 282ca632f55SGrant Likely #define CLEAR_ALL_INTERRUPTS 0x3 283ca632f55SGrant Likely 284ca632f55SGrant Likely #define SPI_POLLING_TIMEOUT 1000 285ca632f55SGrant Likely 286ca632f55SGrant Likely /* 287ca632f55SGrant Likely * The type of reading going on on this chip 288ca632f55SGrant Likely */ 289ca632f55SGrant Likely enum ssp_reading { 290ca632f55SGrant Likely READING_NULL, 291ca632f55SGrant Likely READING_U8, 292ca632f55SGrant Likely READING_U16, 293ca632f55SGrant Likely READING_U32 294ca632f55SGrant Likely }; 295ca632f55SGrant Likely 296ca632f55SGrant Likely /** 297ca632f55SGrant Likely * The type of writing going on on this chip 298ca632f55SGrant Likely */ 299ca632f55SGrant Likely enum ssp_writing { 300ca632f55SGrant Likely WRITING_NULL, 301ca632f55SGrant Likely WRITING_U8, 302ca632f55SGrant Likely WRITING_U16, 303ca632f55SGrant Likely WRITING_U32 304ca632f55SGrant Likely }; 305ca632f55SGrant Likely 306ca632f55SGrant Likely /** 307ca632f55SGrant Likely * struct vendor_data - vendor-specific config parameters 308ca632f55SGrant Likely * for PL022 derivates 309ca632f55SGrant Likely * @fifodepth: depth of FIFOs (both) 310ca632f55SGrant Likely * @max_bpw: maximum number of bits per word 311ca632f55SGrant Likely * @unidir: supports unidirection transfers 312ca632f55SGrant Likely * @extended_cr: 32 bit wide control register 0 with extra 313ca632f55SGrant Likely * features and extra features in CR1 as found in the ST variants 314ca632f55SGrant Likely * @pl023: supports a subset of the ST extensions called "PL023" 315ca632f55SGrant Likely */ 316ca632f55SGrant Likely struct vendor_data { 317ca632f55SGrant Likely int fifodepth; 318ca632f55SGrant Likely int max_bpw; 319ca632f55SGrant Likely bool unidir; 320ca632f55SGrant Likely bool extended_cr; 321ca632f55SGrant Likely bool pl023; 322ca632f55SGrant Likely bool loopback; 323ca632f55SGrant Likely }; 324ca632f55SGrant Likely 325ca632f55SGrant Likely /** 326ca632f55SGrant Likely * struct pl022 - This is the private SSP driver data structure 327ca632f55SGrant Likely * @adev: AMBA device model hookup 328ca632f55SGrant Likely * @vendor: vendor data for the IP block 329ca632f55SGrant Likely * @phybase: the physical memory where the SSP device resides 330ca632f55SGrant Likely * @virtbase: the virtual memory where the SSP is mapped 331ca632f55SGrant Likely * @clk: outgoing clock "SPICLK" for the SPI bus 332ca632f55SGrant Likely * @master: SPI framework hookup 333ca632f55SGrant Likely * @master_info: controller-specific data from machine setup 334*14af60b6SChris Blair * @kworker: thread struct for message pump 335*14af60b6SChris Blair * @kworker_task: pointer to task for message pump kworker thread 336*14af60b6SChris Blair * @pump_messages: work struct for scheduling work to the message pump 337ca632f55SGrant Likely * @queue_lock: spinlock to syncronise access to message queue 338ca632f55SGrant Likely * @queue: message queue 339*14af60b6SChris Blair * @busy: message pump is busy 340*14af60b6SChris Blair * @running: message pump is running 341ca632f55SGrant Likely * @pump_transfers: Tasklet used in Interrupt Transfer mode 342ca632f55SGrant Likely * @cur_msg: Pointer to current spi_message being processed 343ca632f55SGrant Likely * @cur_transfer: Pointer to current spi_transfer 344ca632f55SGrant Likely * @cur_chip: pointer to current clients chip(assigned from controller_state) 3458b8d7191SVirupax Sadashivpetimath * @next_msg_cs_active: the next message in the queue has been examined 3468b8d7191SVirupax Sadashivpetimath * and it was found that it uses the same chip select as the previous 3478b8d7191SVirupax Sadashivpetimath * message, so we left it active after the previous transfer, and it's 3488b8d7191SVirupax Sadashivpetimath * active already. 349ca632f55SGrant Likely * @tx: current position in TX buffer to be read 350ca632f55SGrant Likely * @tx_end: end position in TX buffer to be read 351ca632f55SGrant Likely * @rx: current position in RX buffer to be written 352ca632f55SGrant Likely * @rx_end: end position in RX buffer to be written 353ca632f55SGrant Likely * @read: the type of read currently going on 354ca632f55SGrant Likely * @write: the type of write currently going on 355ca632f55SGrant Likely * @exp_fifo_level: expected FIFO level 356ca632f55SGrant Likely * @dma_rx_channel: optional channel for RX DMA 357ca632f55SGrant Likely * @dma_tx_channel: optional channel for TX DMA 358ca632f55SGrant Likely * @sgt_rx: scattertable for the RX transfer 359ca632f55SGrant Likely * @sgt_tx: scattertable for the TX transfer 360ca632f55SGrant Likely * @dummypage: a dummy page used for driving data on the bus with DMA 361ca632f55SGrant Likely */ 362ca632f55SGrant Likely struct pl022 { 363ca632f55SGrant Likely struct amba_device *adev; 364ca632f55SGrant Likely struct vendor_data *vendor; 365ca632f55SGrant Likely resource_size_t phybase; 366ca632f55SGrant Likely void __iomem *virtbase; 367ca632f55SGrant Likely struct clk *clk; 368ca632f55SGrant Likely struct spi_master *master; 369ca632f55SGrant Likely struct pl022_ssp_controller *master_info; 370*14af60b6SChris Blair /* Driver message pump */ 371*14af60b6SChris Blair struct kthread_worker kworker; 372*14af60b6SChris Blair struct task_struct *kworker_task; 373*14af60b6SChris Blair struct kthread_work pump_messages; 374ca632f55SGrant Likely spinlock_t queue_lock; 375ca632f55SGrant Likely struct list_head queue; 376ca632f55SGrant Likely bool busy; 377ca632f55SGrant Likely bool running; 378ca632f55SGrant Likely /* Message transfer pump */ 379ca632f55SGrant Likely struct tasklet_struct pump_transfers; 380ca632f55SGrant Likely struct spi_message *cur_msg; 381ca632f55SGrant Likely struct spi_transfer *cur_transfer; 382ca632f55SGrant Likely struct chip_data *cur_chip; 3838b8d7191SVirupax Sadashivpetimath bool next_msg_cs_active; 384ca632f55SGrant Likely void *tx; 385ca632f55SGrant Likely void *tx_end; 386ca632f55SGrant Likely void *rx; 387ca632f55SGrant Likely void *rx_end; 388ca632f55SGrant Likely enum ssp_reading read; 389ca632f55SGrant Likely enum ssp_writing write; 390ca632f55SGrant Likely u32 exp_fifo_level; 391083be3f0SLinus Walleij enum ssp_rx_level_trig rx_lev_trig; 392083be3f0SLinus Walleij enum ssp_tx_level_trig tx_lev_trig; 393ca632f55SGrant Likely /* DMA settings */ 394ca632f55SGrant Likely #ifdef CONFIG_DMA_ENGINE 395ca632f55SGrant Likely struct dma_chan *dma_rx_channel; 396ca632f55SGrant Likely struct dma_chan *dma_tx_channel; 397ca632f55SGrant Likely struct sg_table sgt_rx; 398ca632f55SGrant Likely struct sg_table sgt_tx; 399ca632f55SGrant Likely char *dummypage; 400ca632f55SGrant Likely #endif 401ca632f55SGrant Likely }; 402ca632f55SGrant Likely 403ca632f55SGrant Likely /** 404ca632f55SGrant Likely * struct chip_data - To maintain runtime state of SSP for each client chip 405ca632f55SGrant Likely * @cr0: Value of control register CR0 of SSP - on later ST variants this 406ca632f55SGrant Likely * register is 32 bits wide rather than just 16 407ca632f55SGrant Likely * @cr1: Value of control register CR1 of SSP 408ca632f55SGrant Likely * @dmacr: Value of DMA control Register of SSP 409ca632f55SGrant Likely * @cpsr: Value of Clock prescale register 410ca632f55SGrant Likely * @n_bytes: how many bytes(power of 2) reqd for a given data width of client 411ca632f55SGrant Likely * @enable_dma: Whether to enable DMA or not 412ca632f55SGrant Likely * @read: function ptr to be used to read when doing xfer for this chip 413ca632f55SGrant Likely * @write: function ptr to be used to write when doing xfer for this chip 414ca632f55SGrant Likely * @cs_control: chip select callback provided by chip 415ca632f55SGrant Likely * @xfer_type: polling/interrupt/DMA 416ca632f55SGrant Likely * 417ca632f55SGrant Likely * Runtime state of the SSP controller, maintained per chip, 418ca632f55SGrant Likely * This would be set according to the current message that would be served 419ca632f55SGrant Likely */ 420ca632f55SGrant Likely struct chip_data { 421ca632f55SGrant Likely u32 cr0; 422ca632f55SGrant Likely u16 cr1; 423ca632f55SGrant Likely u16 dmacr; 424ca632f55SGrant Likely u16 cpsr; 425ca632f55SGrant Likely u8 n_bytes; 426ca632f55SGrant Likely bool enable_dma; 427ca632f55SGrant Likely enum ssp_reading read; 428ca632f55SGrant Likely enum ssp_writing write; 429ca632f55SGrant Likely void (*cs_control) (u32 command); 430ca632f55SGrant Likely int xfer_type; 431ca632f55SGrant Likely }; 432ca632f55SGrant Likely 433ca632f55SGrant Likely /** 434ca632f55SGrant Likely * null_cs_control - Dummy chip select function 435ca632f55SGrant Likely * @command: select/delect the chip 436ca632f55SGrant Likely * 437ca632f55SGrant Likely * If no chip select function is provided by client this is used as dummy 438ca632f55SGrant Likely * chip select 439ca632f55SGrant Likely */ 440ca632f55SGrant Likely static void null_cs_control(u32 command) 441ca632f55SGrant Likely { 442ca632f55SGrant Likely pr_debug("pl022: dummy chip select control, CS=0x%x\n", command); 443ca632f55SGrant Likely } 444ca632f55SGrant Likely 445ca632f55SGrant Likely /** 446ca632f55SGrant Likely * giveback - current spi_message is over, schedule next message and call 447ca632f55SGrant Likely * callback of this message. Assumes that caller already 448ca632f55SGrant Likely * set message->status; dma and pio irqs are blocked 449ca632f55SGrant Likely * @pl022: SSP driver private data structure 450ca632f55SGrant Likely */ 451ca632f55SGrant Likely static void giveback(struct pl022 *pl022) 452ca632f55SGrant Likely { 453ca632f55SGrant Likely struct spi_transfer *last_transfer; 454ca632f55SGrant Likely unsigned long flags; 455ca632f55SGrant Likely struct spi_message *msg; 4568b8d7191SVirupax Sadashivpetimath pl022->next_msg_cs_active = false; 457ca632f55SGrant Likely 4588b8d7191SVirupax Sadashivpetimath last_transfer = list_entry(pl022->cur_msg->transfers.prev, 459ca632f55SGrant Likely struct spi_transfer, 460ca632f55SGrant Likely transfer_list); 461ca632f55SGrant Likely 462ca632f55SGrant Likely /* Delay if requested before any change in chip select */ 463ca632f55SGrant Likely if (last_transfer->delay_usecs) 464ca632f55SGrant Likely /* 465ca632f55SGrant Likely * FIXME: This runs in interrupt context. 466ca632f55SGrant Likely * Is this really smart? 467ca632f55SGrant Likely */ 468ca632f55SGrant Likely udelay(last_transfer->delay_usecs); 469ca632f55SGrant Likely 4708b8d7191SVirupax Sadashivpetimath if (!last_transfer->cs_change) { 471ca632f55SGrant Likely struct spi_message *next_msg; 472ca632f55SGrant Likely 4738b8d7191SVirupax Sadashivpetimath /* 4748b8d7191SVirupax Sadashivpetimath * cs_change was not set. We can keep the chip select 4758b8d7191SVirupax Sadashivpetimath * enabled if there is message in the queue and it is 4768b8d7191SVirupax Sadashivpetimath * for the same spi device. 477ca632f55SGrant Likely * 478ca632f55SGrant Likely * We cannot postpone this until pump_messages, because 479ca632f55SGrant Likely * after calling msg->complete (below) the driver that 480ca632f55SGrant Likely * sent the current message could be unloaded, which 481ca632f55SGrant Likely * could invalidate the cs_control() callback... 482ca632f55SGrant Likely */ 483ca632f55SGrant Likely 484ca632f55SGrant Likely /* get a pointer to the next message, if any */ 485ca632f55SGrant Likely spin_lock_irqsave(&pl022->queue_lock, flags); 486ca632f55SGrant Likely if (list_empty(&pl022->queue)) 487ca632f55SGrant Likely next_msg = NULL; 488ca632f55SGrant Likely else 489ca632f55SGrant Likely next_msg = list_entry(pl022->queue.next, 490ca632f55SGrant Likely struct spi_message, queue); 491ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 492ca632f55SGrant Likely 4938b8d7191SVirupax Sadashivpetimath /* 4948b8d7191SVirupax Sadashivpetimath * see if the next and current messages point 4958b8d7191SVirupax Sadashivpetimath * to the same spi device. 496ca632f55SGrant Likely */ 4978b8d7191SVirupax Sadashivpetimath if (next_msg && next_msg->spi != pl022->cur_msg->spi) 498ca632f55SGrant Likely next_msg = NULL; 4998b8d7191SVirupax Sadashivpetimath if (!next_msg || pl022->cur_msg->state == STATE_ERROR) 5008b8d7191SVirupax Sadashivpetimath pl022->cur_chip->cs_control(SSP_CHIP_DESELECT); 5018b8d7191SVirupax Sadashivpetimath else 5028b8d7191SVirupax Sadashivpetimath pl022->next_msg_cs_active = true; 503ca632f55SGrant Likely } 5048b8d7191SVirupax Sadashivpetimath 5058b8d7191SVirupax Sadashivpetimath spin_lock_irqsave(&pl022->queue_lock, flags); 5068b8d7191SVirupax Sadashivpetimath msg = pl022->cur_msg; 5078b8d7191SVirupax Sadashivpetimath pl022->cur_msg = NULL; 5088b8d7191SVirupax Sadashivpetimath pl022->cur_transfer = NULL; 5098b8d7191SVirupax Sadashivpetimath pl022->cur_chip = NULL; 510*14af60b6SChris Blair queue_kthread_work(&pl022->kworker, &pl022->pump_messages); 5118b8d7191SVirupax Sadashivpetimath spin_unlock_irqrestore(&pl022->queue_lock, flags); 5128b8d7191SVirupax Sadashivpetimath 513ca632f55SGrant Likely msg->state = NULL; 514ca632f55SGrant Likely if (msg->complete) 515ca632f55SGrant Likely msg->complete(msg->context); 516ca632f55SGrant Likely } 517ca632f55SGrant Likely 518ca632f55SGrant Likely /** 519ca632f55SGrant Likely * flush - flush the FIFO to reach a clean state 520ca632f55SGrant Likely * @pl022: SSP driver private data structure 521ca632f55SGrant Likely */ 522ca632f55SGrant Likely static int flush(struct pl022 *pl022) 523ca632f55SGrant Likely { 524ca632f55SGrant Likely unsigned long limit = loops_per_jiffy << 1; 525ca632f55SGrant Likely 526ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "flush\n"); 527ca632f55SGrant Likely do { 528ca632f55SGrant Likely while (readw(SSP_SR(pl022->virtbase)) & SSP_SR_MASK_RNE) 529ca632f55SGrant Likely readw(SSP_DR(pl022->virtbase)); 530ca632f55SGrant Likely } while ((readw(SSP_SR(pl022->virtbase)) & SSP_SR_MASK_BSY) && limit--); 531ca632f55SGrant Likely 532ca632f55SGrant Likely pl022->exp_fifo_level = 0; 533ca632f55SGrant Likely 534ca632f55SGrant Likely return limit; 535ca632f55SGrant Likely } 536ca632f55SGrant Likely 537ca632f55SGrant Likely /** 538ca632f55SGrant Likely * restore_state - Load configuration of current chip 539ca632f55SGrant Likely * @pl022: SSP driver private data structure 540ca632f55SGrant Likely */ 541ca632f55SGrant Likely static void restore_state(struct pl022 *pl022) 542ca632f55SGrant Likely { 543ca632f55SGrant Likely struct chip_data *chip = pl022->cur_chip; 544ca632f55SGrant Likely 545ca632f55SGrant Likely if (pl022->vendor->extended_cr) 546ca632f55SGrant Likely writel(chip->cr0, SSP_CR0(pl022->virtbase)); 547ca632f55SGrant Likely else 548ca632f55SGrant Likely writew(chip->cr0, SSP_CR0(pl022->virtbase)); 549ca632f55SGrant Likely writew(chip->cr1, SSP_CR1(pl022->virtbase)); 550ca632f55SGrant Likely writew(chip->dmacr, SSP_DMACR(pl022->virtbase)); 551ca632f55SGrant Likely writew(chip->cpsr, SSP_CPSR(pl022->virtbase)); 552ca632f55SGrant Likely writew(DISABLE_ALL_INTERRUPTS, SSP_IMSC(pl022->virtbase)); 553ca632f55SGrant Likely writew(CLEAR_ALL_INTERRUPTS, SSP_ICR(pl022->virtbase)); 554ca632f55SGrant Likely } 555ca632f55SGrant Likely 556ca632f55SGrant Likely /* 557ca632f55SGrant Likely * Default SSP Register Values 558ca632f55SGrant Likely */ 559ca632f55SGrant Likely #define DEFAULT_SSP_REG_CR0 ( \ 560ca632f55SGrant Likely GEN_MASK_BITS(SSP_DATA_BITS_12, SSP_CR0_MASK_DSS, 0) | \ 561ca632f55SGrant Likely GEN_MASK_BITS(SSP_INTERFACE_MOTOROLA_SPI, SSP_CR0_MASK_FRF, 4) | \ 562ca632f55SGrant Likely GEN_MASK_BITS(SSP_CLK_POL_IDLE_LOW, SSP_CR0_MASK_SPO, 6) | \ 563ca632f55SGrant Likely GEN_MASK_BITS(SSP_CLK_SECOND_EDGE, SSP_CR0_MASK_SPH, 7) | \ 564ca632f55SGrant Likely GEN_MASK_BITS(SSP_DEFAULT_CLKRATE, SSP_CR0_MASK_SCR, 8) \ 565ca632f55SGrant Likely ) 566ca632f55SGrant Likely 567ca632f55SGrant Likely /* ST versions have slightly different bit layout */ 568ca632f55SGrant Likely #define DEFAULT_SSP_REG_CR0_ST ( \ 569ca632f55SGrant Likely GEN_MASK_BITS(SSP_DATA_BITS_12, SSP_CR0_MASK_DSS_ST, 0) | \ 570ca632f55SGrant Likely GEN_MASK_BITS(SSP_MICROWIRE_CHANNEL_FULL_DUPLEX, SSP_CR0_MASK_HALFDUP_ST, 5) | \ 571ca632f55SGrant Likely GEN_MASK_BITS(SSP_CLK_POL_IDLE_LOW, SSP_CR0_MASK_SPO, 6) | \ 572ca632f55SGrant Likely GEN_MASK_BITS(SSP_CLK_SECOND_EDGE, SSP_CR0_MASK_SPH, 7) | \ 573ca632f55SGrant Likely GEN_MASK_BITS(SSP_DEFAULT_CLKRATE, SSP_CR0_MASK_SCR, 8) | \ 574ca632f55SGrant Likely GEN_MASK_BITS(SSP_BITS_8, SSP_CR0_MASK_CSS_ST, 16) | \ 575ca632f55SGrant Likely GEN_MASK_BITS(SSP_INTERFACE_MOTOROLA_SPI, SSP_CR0_MASK_FRF_ST, 21) \ 576ca632f55SGrant Likely ) 577ca632f55SGrant Likely 578ca632f55SGrant Likely /* The PL023 version is slightly different again */ 579ca632f55SGrant Likely #define DEFAULT_SSP_REG_CR0_ST_PL023 ( \ 580ca632f55SGrant Likely GEN_MASK_BITS(SSP_DATA_BITS_12, SSP_CR0_MASK_DSS_ST, 0) | \ 581ca632f55SGrant Likely GEN_MASK_BITS(SSP_CLK_POL_IDLE_LOW, SSP_CR0_MASK_SPO, 6) | \ 582ca632f55SGrant Likely GEN_MASK_BITS(SSP_CLK_SECOND_EDGE, SSP_CR0_MASK_SPH, 7) | \ 583ca632f55SGrant Likely GEN_MASK_BITS(SSP_DEFAULT_CLKRATE, SSP_CR0_MASK_SCR, 8) \ 584ca632f55SGrant Likely ) 585ca632f55SGrant Likely 586ca632f55SGrant Likely #define DEFAULT_SSP_REG_CR1 ( \ 587ca632f55SGrant Likely GEN_MASK_BITS(LOOPBACK_DISABLED, SSP_CR1_MASK_LBM, 0) | \ 588ca632f55SGrant Likely GEN_MASK_BITS(SSP_DISABLED, SSP_CR1_MASK_SSE, 1) | \ 589ca632f55SGrant Likely GEN_MASK_BITS(SSP_MASTER, SSP_CR1_MASK_MS, 2) | \ 590ca632f55SGrant Likely GEN_MASK_BITS(DO_NOT_DRIVE_TX, SSP_CR1_MASK_SOD, 3) \ 591ca632f55SGrant Likely ) 592ca632f55SGrant Likely 593ca632f55SGrant Likely /* ST versions extend this register to use all 16 bits */ 594ca632f55SGrant Likely #define DEFAULT_SSP_REG_CR1_ST ( \ 595ca632f55SGrant Likely DEFAULT_SSP_REG_CR1 | \ 596ca632f55SGrant Likely GEN_MASK_BITS(SSP_RX_MSB, SSP_CR1_MASK_RENDN_ST, 4) | \ 597ca632f55SGrant Likely GEN_MASK_BITS(SSP_TX_MSB, SSP_CR1_MASK_TENDN_ST, 5) | \ 598ca632f55SGrant Likely GEN_MASK_BITS(SSP_MWIRE_WAIT_ZERO, SSP_CR1_MASK_MWAIT_ST, 6) |\ 599ca632f55SGrant Likely GEN_MASK_BITS(SSP_RX_1_OR_MORE_ELEM, SSP_CR1_MASK_RXIFLSEL_ST, 7) | \ 600ca632f55SGrant Likely GEN_MASK_BITS(SSP_TX_1_OR_MORE_EMPTY_LOC, SSP_CR1_MASK_TXIFLSEL_ST, 10) \ 601ca632f55SGrant Likely ) 602ca632f55SGrant Likely 603ca632f55SGrant Likely /* 604ca632f55SGrant Likely * The PL023 variant has further differences: no loopback mode, no microwire 605ca632f55SGrant Likely * support, and a new clock feedback delay setting. 606ca632f55SGrant Likely */ 607ca632f55SGrant Likely #define DEFAULT_SSP_REG_CR1_ST_PL023 ( \ 608ca632f55SGrant Likely GEN_MASK_BITS(SSP_DISABLED, SSP_CR1_MASK_SSE, 1) | \ 609ca632f55SGrant Likely GEN_MASK_BITS(SSP_MASTER, SSP_CR1_MASK_MS, 2) | \ 610ca632f55SGrant Likely GEN_MASK_BITS(DO_NOT_DRIVE_TX, SSP_CR1_MASK_SOD, 3) | \ 611ca632f55SGrant Likely GEN_MASK_BITS(SSP_RX_MSB, SSP_CR1_MASK_RENDN_ST, 4) | \ 612ca632f55SGrant Likely GEN_MASK_BITS(SSP_TX_MSB, SSP_CR1_MASK_TENDN_ST, 5) | \ 613ca632f55SGrant Likely GEN_MASK_BITS(SSP_RX_1_OR_MORE_ELEM, SSP_CR1_MASK_RXIFLSEL_ST, 7) | \ 614ca632f55SGrant Likely GEN_MASK_BITS(SSP_TX_1_OR_MORE_EMPTY_LOC, SSP_CR1_MASK_TXIFLSEL_ST, 10) | \ 615ca632f55SGrant Likely GEN_MASK_BITS(SSP_FEEDBACK_CLK_DELAY_NONE, SSP_CR1_MASK_FBCLKDEL_ST, 13) \ 616ca632f55SGrant Likely ) 617ca632f55SGrant Likely 618ca632f55SGrant Likely #define DEFAULT_SSP_REG_CPSR ( \ 619ca632f55SGrant Likely GEN_MASK_BITS(SSP_DEFAULT_PRESCALE, SSP_CPSR_MASK_CPSDVSR, 0) \ 620ca632f55SGrant Likely ) 621ca632f55SGrant Likely 622ca632f55SGrant Likely #define DEFAULT_SSP_REG_DMACR (\ 623ca632f55SGrant Likely GEN_MASK_BITS(SSP_DMA_DISABLED, SSP_DMACR_MASK_RXDMAE, 0) | \ 624ca632f55SGrant Likely GEN_MASK_BITS(SSP_DMA_DISABLED, SSP_DMACR_MASK_TXDMAE, 1) \ 625ca632f55SGrant Likely ) 626ca632f55SGrant Likely 627ca632f55SGrant Likely /** 628ca632f55SGrant Likely * load_ssp_default_config - Load default configuration for SSP 629ca632f55SGrant Likely * @pl022: SSP driver private data structure 630ca632f55SGrant Likely */ 631ca632f55SGrant Likely static void load_ssp_default_config(struct pl022 *pl022) 632ca632f55SGrant Likely { 633ca632f55SGrant Likely if (pl022->vendor->pl023) { 634ca632f55SGrant Likely writel(DEFAULT_SSP_REG_CR0_ST_PL023, SSP_CR0(pl022->virtbase)); 635ca632f55SGrant Likely writew(DEFAULT_SSP_REG_CR1_ST_PL023, SSP_CR1(pl022->virtbase)); 636ca632f55SGrant Likely } else if (pl022->vendor->extended_cr) { 637ca632f55SGrant Likely writel(DEFAULT_SSP_REG_CR0_ST, SSP_CR0(pl022->virtbase)); 638ca632f55SGrant Likely writew(DEFAULT_SSP_REG_CR1_ST, SSP_CR1(pl022->virtbase)); 639ca632f55SGrant Likely } else { 640ca632f55SGrant Likely writew(DEFAULT_SSP_REG_CR0, SSP_CR0(pl022->virtbase)); 641ca632f55SGrant Likely writew(DEFAULT_SSP_REG_CR1, SSP_CR1(pl022->virtbase)); 642ca632f55SGrant Likely } 643ca632f55SGrant Likely writew(DEFAULT_SSP_REG_DMACR, SSP_DMACR(pl022->virtbase)); 644ca632f55SGrant Likely writew(DEFAULT_SSP_REG_CPSR, SSP_CPSR(pl022->virtbase)); 645ca632f55SGrant Likely writew(DISABLE_ALL_INTERRUPTS, SSP_IMSC(pl022->virtbase)); 646ca632f55SGrant Likely writew(CLEAR_ALL_INTERRUPTS, SSP_ICR(pl022->virtbase)); 647ca632f55SGrant Likely } 648ca632f55SGrant Likely 649ca632f55SGrant Likely /** 650ca632f55SGrant Likely * This will write to TX and read from RX according to the parameters 651ca632f55SGrant Likely * set in pl022. 652ca632f55SGrant Likely */ 653ca632f55SGrant Likely static void readwriter(struct pl022 *pl022) 654ca632f55SGrant Likely { 655ca632f55SGrant Likely 656ca632f55SGrant Likely /* 657ca632f55SGrant Likely * The FIFO depth is different between primecell variants. 658ca632f55SGrant Likely * I believe filling in too much in the FIFO might cause 659ca632f55SGrant Likely * errons in 8bit wide transfers on ARM variants (just 8 words 660ca632f55SGrant Likely * FIFO, means only 8x8 = 64 bits in FIFO) at least. 661ca632f55SGrant Likely * 662ca632f55SGrant Likely * To prevent this issue, the TX FIFO is only filled to the 663ca632f55SGrant Likely * unused RX FIFO fill length, regardless of what the TX 664ca632f55SGrant Likely * FIFO status flag indicates. 665ca632f55SGrant Likely */ 666ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, 667ca632f55SGrant Likely "%s, rx: %p, rxend: %p, tx: %p, txend: %p\n", 668ca632f55SGrant Likely __func__, pl022->rx, pl022->rx_end, pl022->tx, pl022->tx_end); 669ca632f55SGrant Likely 670ca632f55SGrant Likely /* Read as much as you can */ 671ca632f55SGrant Likely while ((readw(SSP_SR(pl022->virtbase)) & SSP_SR_MASK_RNE) 672ca632f55SGrant Likely && (pl022->rx < pl022->rx_end)) { 673ca632f55SGrant Likely switch (pl022->read) { 674ca632f55SGrant Likely case READING_NULL: 675ca632f55SGrant Likely readw(SSP_DR(pl022->virtbase)); 676ca632f55SGrant Likely break; 677ca632f55SGrant Likely case READING_U8: 678ca632f55SGrant Likely *(u8 *) (pl022->rx) = 679ca632f55SGrant Likely readw(SSP_DR(pl022->virtbase)) & 0xFFU; 680ca632f55SGrant Likely break; 681ca632f55SGrant Likely case READING_U16: 682ca632f55SGrant Likely *(u16 *) (pl022->rx) = 683ca632f55SGrant Likely (u16) readw(SSP_DR(pl022->virtbase)); 684ca632f55SGrant Likely break; 685ca632f55SGrant Likely case READING_U32: 686ca632f55SGrant Likely *(u32 *) (pl022->rx) = 687ca632f55SGrant Likely readl(SSP_DR(pl022->virtbase)); 688ca632f55SGrant Likely break; 689ca632f55SGrant Likely } 690ca632f55SGrant Likely pl022->rx += (pl022->cur_chip->n_bytes); 691ca632f55SGrant Likely pl022->exp_fifo_level--; 692ca632f55SGrant Likely } 693ca632f55SGrant Likely /* 694ca632f55SGrant Likely * Write as much as possible up to the RX FIFO size 695ca632f55SGrant Likely */ 696ca632f55SGrant Likely while ((pl022->exp_fifo_level < pl022->vendor->fifodepth) 697ca632f55SGrant Likely && (pl022->tx < pl022->tx_end)) { 698ca632f55SGrant Likely switch (pl022->write) { 699ca632f55SGrant Likely case WRITING_NULL: 700ca632f55SGrant Likely writew(0x0, SSP_DR(pl022->virtbase)); 701ca632f55SGrant Likely break; 702ca632f55SGrant Likely case WRITING_U8: 703ca632f55SGrant Likely writew(*(u8 *) (pl022->tx), SSP_DR(pl022->virtbase)); 704ca632f55SGrant Likely break; 705ca632f55SGrant Likely case WRITING_U16: 706ca632f55SGrant Likely writew((*(u16 *) (pl022->tx)), SSP_DR(pl022->virtbase)); 707ca632f55SGrant Likely break; 708ca632f55SGrant Likely case WRITING_U32: 709ca632f55SGrant Likely writel(*(u32 *) (pl022->tx), SSP_DR(pl022->virtbase)); 710ca632f55SGrant Likely break; 711ca632f55SGrant Likely } 712ca632f55SGrant Likely pl022->tx += (pl022->cur_chip->n_bytes); 713ca632f55SGrant Likely pl022->exp_fifo_level++; 714ca632f55SGrant Likely /* 715ca632f55SGrant Likely * This inner reader takes care of things appearing in the RX 716ca632f55SGrant Likely * FIFO as we're transmitting. This will happen a lot since the 717ca632f55SGrant Likely * clock starts running when you put things into the TX FIFO, 718ca632f55SGrant Likely * and then things are continuously clocked into the RX FIFO. 719ca632f55SGrant Likely */ 720ca632f55SGrant Likely while ((readw(SSP_SR(pl022->virtbase)) & SSP_SR_MASK_RNE) 721ca632f55SGrant Likely && (pl022->rx < pl022->rx_end)) { 722ca632f55SGrant Likely switch (pl022->read) { 723ca632f55SGrant Likely case READING_NULL: 724ca632f55SGrant Likely readw(SSP_DR(pl022->virtbase)); 725ca632f55SGrant Likely break; 726ca632f55SGrant Likely case READING_U8: 727ca632f55SGrant Likely *(u8 *) (pl022->rx) = 728ca632f55SGrant Likely readw(SSP_DR(pl022->virtbase)) & 0xFFU; 729ca632f55SGrant Likely break; 730ca632f55SGrant Likely case READING_U16: 731ca632f55SGrant Likely *(u16 *) (pl022->rx) = 732ca632f55SGrant Likely (u16) readw(SSP_DR(pl022->virtbase)); 733ca632f55SGrant Likely break; 734ca632f55SGrant Likely case READING_U32: 735ca632f55SGrant Likely *(u32 *) (pl022->rx) = 736ca632f55SGrant Likely readl(SSP_DR(pl022->virtbase)); 737ca632f55SGrant Likely break; 738ca632f55SGrant Likely } 739ca632f55SGrant Likely pl022->rx += (pl022->cur_chip->n_bytes); 740ca632f55SGrant Likely pl022->exp_fifo_level--; 741ca632f55SGrant Likely } 742ca632f55SGrant Likely } 743ca632f55SGrant Likely /* 744ca632f55SGrant Likely * When we exit here the TX FIFO should be full and the RX FIFO 745ca632f55SGrant Likely * should be empty 746ca632f55SGrant Likely */ 747ca632f55SGrant Likely } 748ca632f55SGrant Likely 749ca632f55SGrant Likely /** 750ca632f55SGrant Likely * next_transfer - Move to the Next transfer in the current spi message 751ca632f55SGrant Likely * @pl022: SSP driver private data structure 752ca632f55SGrant Likely * 753ca632f55SGrant Likely * This function moves though the linked list of spi transfers in the 754ca632f55SGrant Likely * current spi message and returns with the state of current spi 755ca632f55SGrant Likely * message i.e whether its last transfer is done(STATE_DONE) or 756ca632f55SGrant Likely * Next transfer is ready(STATE_RUNNING) 757ca632f55SGrant Likely */ 758ca632f55SGrant Likely static void *next_transfer(struct pl022 *pl022) 759ca632f55SGrant Likely { 760ca632f55SGrant Likely struct spi_message *msg = pl022->cur_msg; 761ca632f55SGrant Likely struct spi_transfer *trans = pl022->cur_transfer; 762ca632f55SGrant Likely 763ca632f55SGrant Likely /* Move to next transfer */ 764ca632f55SGrant Likely if (trans->transfer_list.next != &msg->transfers) { 765ca632f55SGrant Likely pl022->cur_transfer = 766ca632f55SGrant Likely list_entry(trans->transfer_list.next, 767ca632f55SGrant Likely struct spi_transfer, transfer_list); 768ca632f55SGrant Likely return STATE_RUNNING; 769ca632f55SGrant Likely } 770ca632f55SGrant Likely return STATE_DONE; 771ca632f55SGrant Likely } 772ca632f55SGrant Likely 773ca632f55SGrant Likely /* 774ca632f55SGrant Likely * This DMA functionality is only compiled in if we have 775ca632f55SGrant Likely * access to the generic DMA devices/DMA engine. 776ca632f55SGrant Likely */ 777ca632f55SGrant Likely #ifdef CONFIG_DMA_ENGINE 778ca632f55SGrant Likely static void unmap_free_dma_scatter(struct pl022 *pl022) 779ca632f55SGrant Likely { 780ca632f55SGrant Likely /* Unmap and free the SG tables */ 781ca632f55SGrant Likely dma_unmap_sg(pl022->dma_tx_channel->device->dev, pl022->sgt_tx.sgl, 782ca632f55SGrant Likely pl022->sgt_tx.nents, DMA_TO_DEVICE); 783ca632f55SGrant Likely dma_unmap_sg(pl022->dma_rx_channel->device->dev, pl022->sgt_rx.sgl, 784ca632f55SGrant Likely pl022->sgt_rx.nents, DMA_FROM_DEVICE); 785ca632f55SGrant Likely sg_free_table(&pl022->sgt_rx); 786ca632f55SGrant Likely sg_free_table(&pl022->sgt_tx); 787ca632f55SGrant Likely } 788ca632f55SGrant Likely 789ca632f55SGrant Likely static void dma_callback(void *data) 790ca632f55SGrant Likely { 791ca632f55SGrant Likely struct pl022 *pl022 = data; 792ca632f55SGrant Likely struct spi_message *msg = pl022->cur_msg; 793ca632f55SGrant Likely 794ca632f55SGrant Likely BUG_ON(!pl022->sgt_rx.sgl); 795ca632f55SGrant Likely 796ca632f55SGrant Likely #ifdef VERBOSE_DEBUG 797ca632f55SGrant Likely /* 798ca632f55SGrant Likely * Optionally dump out buffers to inspect contents, this is 799ca632f55SGrant Likely * good if you want to convince yourself that the loopback 800ca632f55SGrant Likely * read/write contents are the same, when adopting to a new 801ca632f55SGrant Likely * DMA engine. 802ca632f55SGrant Likely */ 803ca632f55SGrant Likely { 804ca632f55SGrant Likely struct scatterlist *sg; 805ca632f55SGrant Likely unsigned int i; 806ca632f55SGrant Likely 807ca632f55SGrant Likely dma_sync_sg_for_cpu(&pl022->adev->dev, 808ca632f55SGrant Likely pl022->sgt_rx.sgl, 809ca632f55SGrant Likely pl022->sgt_rx.nents, 810ca632f55SGrant Likely DMA_FROM_DEVICE); 811ca632f55SGrant Likely 812ca632f55SGrant Likely for_each_sg(pl022->sgt_rx.sgl, sg, pl022->sgt_rx.nents, i) { 813ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "SPI RX SG ENTRY: %d", i); 814ca632f55SGrant Likely print_hex_dump(KERN_ERR, "SPI RX: ", 815ca632f55SGrant Likely DUMP_PREFIX_OFFSET, 816ca632f55SGrant Likely 16, 817ca632f55SGrant Likely 1, 818ca632f55SGrant Likely sg_virt(sg), 819ca632f55SGrant Likely sg_dma_len(sg), 820ca632f55SGrant Likely 1); 821ca632f55SGrant Likely } 822ca632f55SGrant Likely for_each_sg(pl022->sgt_tx.sgl, sg, pl022->sgt_tx.nents, i) { 823ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "SPI TX SG ENTRY: %d", i); 824ca632f55SGrant Likely print_hex_dump(KERN_ERR, "SPI TX: ", 825ca632f55SGrant Likely DUMP_PREFIX_OFFSET, 826ca632f55SGrant Likely 16, 827ca632f55SGrant Likely 1, 828ca632f55SGrant Likely sg_virt(sg), 829ca632f55SGrant Likely sg_dma_len(sg), 830ca632f55SGrant Likely 1); 831ca632f55SGrant Likely } 832ca632f55SGrant Likely } 833ca632f55SGrant Likely #endif 834ca632f55SGrant Likely 835ca632f55SGrant Likely unmap_free_dma_scatter(pl022); 836ca632f55SGrant Likely 837ca632f55SGrant Likely /* Update total bytes transferred */ 838ca632f55SGrant Likely msg->actual_length += pl022->cur_transfer->len; 839ca632f55SGrant Likely if (pl022->cur_transfer->cs_change) 840ca632f55SGrant Likely pl022->cur_chip-> 841ca632f55SGrant Likely cs_control(SSP_CHIP_DESELECT); 842ca632f55SGrant Likely 843ca632f55SGrant Likely /* Move to next transfer */ 844ca632f55SGrant Likely msg->state = next_transfer(pl022); 845ca632f55SGrant Likely tasklet_schedule(&pl022->pump_transfers); 846ca632f55SGrant Likely } 847ca632f55SGrant Likely 848ca632f55SGrant Likely static void setup_dma_scatter(struct pl022 *pl022, 849ca632f55SGrant Likely void *buffer, 850ca632f55SGrant Likely unsigned int length, 851ca632f55SGrant Likely struct sg_table *sgtab) 852ca632f55SGrant Likely { 853ca632f55SGrant Likely struct scatterlist *sg; 854ca632f55SGrant Likely int bytesleft = length; 855ca632f55SGrant Likely void *bufp = buffer; 856ca632f55SGrant Likely int mapbytes; 857ca632f55SGrant Likely int i; 858ca632f55SGrant Likely 859ca632f55SGrant Likely if (buffer) { 860ca632f55SGrant Likely for_each_sg(sgtab->sgl, sg, sgtab->nents, i) { 861ca632f55SGrant Likely /* 862ca632f55SGrant Likely * If there are less bytes left than what fits 863ca632f55SGrant Likely * in the current page (plus page alignment offset) 864ca632f55SGrant Likely * we just feed in this, else we stuff in as much 865ca632f55SGrant Likely * as we can. 866ca632f55SGrant Likely */ 867ca632f55SGrant Likely if (bytesleft < (PAGE_SIZE - offset_in_page(bufp))) 868ca632f55SGrant Likely mapbytes = bytesleft; 869ca632f55SGrant Likely else 870ca632f55SGrant Likely mapbytes = PAGE_SIZE - offset_in_page(bufp); 871ca632f55SGrant Likely sg_set_page(sg, virt_to_page(bufp), 872ca632f55SGrant Likely mapbytes, offset_in_page(bufp)); 873ca632f55SGrant Likely bufp += mapbytes; 874ca632f55SGrant Likely bytesleft -= mapbytes; 875ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, 876ca632f55SGrant Likely "set RX/TX target page @ %p, %d bytes, %d left\n", 877ca632f55SGrant Likely bufp, mapbytes, bytesleft); 878ca632f55SGrant Likely } 879ca632f55SGrant Likely } else { 880ca632f55SGrant Likely /* Map the dummy buffer on every page */ 881ca632f55SGrant Likely for_each_sg(sgtab->sgl, sg, sgtab->nents, i) { 882ca632f55SGrant Likely if (bytesleft < PAGE_SIZE) 883ca632f55SGrant Likely mapbytes = bytesleft; 884ca632f55SGrant Likely else 885ca632f55SGrant Likely mapbytes = PAGE_SIZE; 886ca632f55SGrant Likely sg_set_page(sg, virt_to_page(pl022->dummypage), 887ca632f55SGrant Likely mapbytes, 0); 888ca632f55SGrant Likely bytesleft -= mapbytes; 889ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, 890ca632f55SGrant Likely "set RX/TX to dummy page %d bytes, %d left\n", 891ca632f55SGrant Likely mapbytes, bytesleft); 892ca632f55SGrant Likely 893ca632f55SGrant Likely } 894ca632f55SGrant Likely } 895ca632f55SGrant Likely BUG_ON(bytesleft); 896ca632f55SGrant Likely } 897ca632f55SGrant Likely 898ca632f55SGrant Likely /** 899ca632f55SGrant Likely * configure_dma - configures the channels for the next transfer 900ca632f55SGrant Likely * @pl022: SSP driver's private data structure 901ca632f55SGrant Likely */ 902ca632f55SGrant Likely static int configure_dma(struct pl022 *pl022) 903ca632f55SGrant Likely { 904ca632f55SGrant Likely struct dma_slave_config rx_conf = { 905ca632f55SGrant Likely .src_addr = SSP_DR(pl022->phybase), 906a485df4bSVinod Koul .direction = DMA_DEV_TO_MEM, 907ca632f55SGrant Likely }; 908ca632f55SGrant Likely struct dma_slave_config tx_conf = { 909ca632f55SGrant Likely .dst_addr = SSP_DR(pl022->phybase), 910a485df4bSVinod Koul .direction = DMA_MEM_TO_DEV, 911ca632f55SGrant Likely }; 912ca632f55SGrant Likely unsigned int pages; 913ca632f55SGrant Likely int ret; 914ca632f55SGrant Likely int rx_sglen, tx_sglen; 915ca632f55SGrant Likely struct dma_chan *rxchan = pl022->dma_rx_channel; 916ca632f55SGrant Likely struct dma_chan *txchan = pl022->dma_tx_channel; 917ca632f55SGrant Likely struct dma_async_tx_descriptor *rxdesc; 918ca632f55SGrant Likely struct dma_async_tx_descriptor *txdesc; 919ca632f55SGrant Likely 920ca632f55SGrant Likely /* Check that the channels are available */ 921ca632f55SGrant Likely if (!rxchan || !txchan) 922ca632f55SGrant Likely return -ENODEV; 923ca632f55SGrant Likely 924083be3f0SLinus Walleij /* 925083be3f0SLinus Walleij * If supplied, the DMA burstsize should equal the FIFO trigger level. 926083be3f0SLinus Walleij * Notice that the DMA engine uses one-to-one mapping. Since we can 927083be3f0SLinus Walleij * not trigger on 2 elements this needs explicit mapping rather than 928083be3f0SLinus Walleij * calculation. 929083be3f0SLinus Walleij */ 930083be3f0SLinus Walleij switch (pl022->rx_lev_trig) { 931083be3f0SLinus Walleij case SSP_RX_1_OR_MORE_ELEM: 932083be3f0SLinus Walleij rx_conf.src_maxburst = 1; 933083be3f0SLinus Walleij break; 934083be3f0SLinus Walleij case SSP_RX_4_OR_MORE_ELEM: 935083be3f0SLinus Walleij rx_conf.src_maxburst = 4; 936083be3f0SLinus Walleij break; 937083be3f0SLinus Walleij case SSP_RX_8_OR_MORE_ELEM: 938083be3f0SLinus Walleij rx_conf.src_maxburst = 8; 939083be3f0SLinus Walleij break; 940083be3f0SLinus Walleij case SSP_RX_16_OR_MORE_ELEM: 941083be3f0SLinus Walleij rx_conf.src_maxburst = 16; 942083be3f0SLinus Walleij break; 943083be3f0SLinus Walleij case SSP_RX_32_OR_MORE_ELEM: 944083be3f0SLinus Walleij rx_conf.src_maxburst = 32; 945083be3f0SLinus Walleij break; 946083be3f0SLinus Walleij default: 947083be3f0SLinus Walleij rx_conf.src_maxburst = pl022->vendor->fifodepth >> 1; 948083be3f0SLinus Walleij break; 949083be3f0SLinus Walleij } 950083be3f0SLinus Walleij 951083be3f0SLinus Walleij switch (pl022->tx_lev_trig) { 952083be3f0SLinus Walleij case SSP_TX_1_OR_MORE_EMPTY_LOC: 953083be3f0SLinus Walleij tx_conf.dst_maxburst = 1; 954083be3f0SLinus Walleij break; 955083be3f0SLinus Walleij case SSP_TX_4_OR_MORE_EMPTY_LOC: 956083be3f0SLinus Walleij tx_conf.dst_maxburst = 4; 957083be3f0SLinus Walleij break; 958083be3f0SLinus Walleij case SSP_TX_8_OR_MORE_EMPTY_LOC: 959083be3f0SLinus Walleij tx_conf.dst_maxburst = 8; 960083be3f0SLinus Walleij break; 961083be3f0SLinus Walleij case SSP_TX_16_OR_MORE_EMPTY_LOC: 962083be3f0SLinus Walleij tx_conf.dst_maxburst = 16; 963083be3f0SLinus Walleij break; 964083be3f0SLinus Walleij case SSP_TX_32_OR_MORE_EMPTY_LOC: 965083be3f0SLinus Walleij tx_conf.dst_maxburst = 32; 966083be3f0SLinus Walleij break; 967083be3f0SLinus Walleij default: 968083be3f0SLinus Walleij tx_conf.dst_maxburst = pl022->vendor->fifodepth >> 1; 969083be3f0SLinus Walleij break; 970083be3f0SLinus Walleij } 971083be3f0SLinus Walleij 972ca632f55SGrant Likely switch (pl022->read) { 973ca632f55SGrant Likely case READING_NULL: 974ca632f55SGrant Likely /* Use the same as for writing */ 975ca632f55SGrant Likely rx_conf.src_addr_width = DMA_SLAVE_BUSWIDTH_UNDEFINED; 976ca632f55SGrant Likely break; 977ca632f55SGrant Likely case READING_U8: 978ca632f55SGrant Likely rx_conf.src_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE; 979ca632f55SGrant Likely break; 980ca632f55SGrant Likely case READING_U16: 981ca632f55SGrant Likely rx_conf.src_addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; 982ca632f55SGrant Likely break; 983ca632f55SGrant Likely case READING_U32: 984ca632f55SGrant Likely rx_conf.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; 985ca632f55SGrant Likely break; 986ca632f55SGrant Likely } 987ca632f55SGrant Likely 988ca632f55SGrant Likely switch (pl022->write) { 989ca632f55SGrant Likely case WRITING_NULL: 990ca632f55SGrant Likely /* Use the same as for reading */ 991ca632f55SGrant Likely tx_conf.dst_addr_width = DMA_SLAVE_BUSWIDTH_UNDEFINED; 992ca632f55SGrant Likely break; 993ca632f55SGrant Likely case WRITING_U8: 994ca632f55SGrant Likely tx_conf.dst_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE; 995ca632f55SGrant Likely break; 996ca632f55SGrant Likely case WRITING_U16: 997ca632f55SGrant Likely tx_conf.dst_addr_width = DMA_SLAVE_BUSWIDTH_2_BYTES; 998ca632f55SGrant Likely break; 999ca632f55SGrant Likely case WRITING_U32: 1000ca632f55SGrant Likely tx_conf.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; 1001ca632f55SGrant Likely break; 1002ca632f55SGrant Likely } 1003ca632f55SGrant Likely 1004ca632f55SGrant Likely /* SPI pecularity: we need to read and write the same width */ 1005ca632f55SGrant Likely if (rx_conf.src_addr_width == DMA_SLAVE_BUSWIDTH_UNDEFINED) 1006ca632f55SGrant Likely rx_conf.src_addr_width = tx_conf.dst_addr_width; 1007ca632f55SGrant Likely if (tx_conf.dst_addr_width == DMA_SLAVE_BUSWIDTH_UNDEFINED) 1008ca632f55SGrant Likely tx_conf.dst_addr_width = rx_conf.src_addr_width; 1009ca632f55SGrant Likely BUG_ON(rx_conf.src_addr_width != tx_conf.dst_addr_width); 1010ca632f55SGrant Likely 1011ca632f55SGrant Likely dmaengine_slave_config(rxchan, &rx_conf); 1012ca632f55SGrant Likely dmaengine_slave_config(txchan, &tx_conf); 1013ca632f55SGrant Likely 1014ca632f55SGrant Likely /* Create sglists for the transfers */ 1015b181565eSViresh Kumar pages = DIV_ROUND_UP(pl022->cur_transfer->len, PAGE_SIZE); 1016ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "using %d pages for transfer\n", pages); 1017ca632f55SGrant Likely 1018538a18dcSViresh Kumar ret = sg_alloc_table(&pl022->sgt_rx, pages, GFP_ATOMIC); 1019ca632f55SGrant Likely if (ret) 1020ca632f55SGrant Likely goto err_alloc_rx_sg; 1021ca632f55SGrant Likely 1022538a18dcSViresh Kumar ret = sg_alloc_table(&pl022->sgt_tx, pages, GFP_ATOMIC); 1023ca632f55SGrant Likely if (ret) 1024ca632f55SGrant Likely goto err_alloc_tx_sg; 1025ca632f55SGrant Likely 1026ca632f55SGrant Likely /* Fill in the scatterlists for the RX+TX buffers */ 1027ca632f55SGrant Likely setup_dma_scatter(pl022, pl022->rx, 1028ca632f55SGrant Likely pl022->cur_transfer->len, &pl022->sgt_rx); 1029ca632f55SGrant Likely setup_dma_scatter(pl022, pl022->tx, 1030ca632f55SGrant Likely pl022->cur_transfer->len, &pl022->sgt_tx); 1031ca632f55SGrant Likely 1032ca632f55SGrant Likely /* Map DMA buffers */ 1033ca632f55SGrant Likely rx_sglen = dma_map_sg(rxchan->device->dev, pl022->sgt_rx.sgl, 1034ca632f55SGrant Likely pl022->sgt_rx.nents, DMA_FROM_DEVICE); 1035ca632f55SGrant Likely if (!rx_sglen) 1036ca632f55SGrant Likely goto err_rx_sgmap; 1037ca632f55SGrant Likely 1038ca632f55SGrant Likely tx_sglen = dma_map_sg(txchan->device->dev, pl022->sgt_tx.sgl, 1039ca632f55SGrant Likely pl022->sgt_tx.nents, DMA_TO_DEVICE); 1040ca632f55SGrant Likely if (!tx_sglen) 1041ca632f55SGrant Likely goto err_tx_sgmap; 1042ca632f55SGrant Likely 1043ca632f55SGrant Likely /* Send both scatterlists */ 1044ca632f55SGrant Likely rxdesc = rxchan->device->device_prep_slave_sg(rxchan, 1045ca632f55SGrant Likely pl022->sgt_rx.sgl, 1046ca632f55SGrant Likely rx_sglen, 1047a485df4bSVinod Koul DMA_DEV_TO_MEM, 1048ca632f55SGrant Likely DMA_PREP_INTERRUPT | DMA_CTRL_ACK); 1049ca632f55SGrant Likely if (!rxdesc) 1050ca632f55SGrant Likely goto err_rxdesc; 1051ca632f55SGrant Likely 1052ca632f55SGrant Likely txdesc = txchan->device->device_prep_slave_sg(txchan, 1053ca632f55SGrant Likely pl022->sgt_tx.sgl, 1054ca632f55SGrant Likely tx_sglen, 1055a485df4bSVinod Koul DMA_MEM_TO_DEV, 1056ca632f55SGrant Likely DMA_PREP_INTERRUPT | DMA_CTRL_ACK); 1057ca632f55SGrant Likely if (!txdesc) 1058ca632f55SGrant Likely goto err_txdesc; 1059ca632f55SGrant Likely 1060ca632f55SGrant Likely /* Put the callback on the RX transfer only, that should finish last */ 1061ca632f55SGrant Likely rxdesc->callback = dma_callback; 1062ca632f55SGrant Likely rxdesc->callback_param = pl022; 1063ca632f55SGrant Likely 1064ca632f55SGrant Likely /* Submit and fire RX and TX with TX last so we're ready to read! */ 1065ca632f55SGrant Likely dmaengine_submit(rxdesc); 1066ca632f55SGrant Likely dmaengine_submit(txdesc); 1067ca632f55SGrant Likely dma_async_issue_pending(rxchan); 1068ca632f55SGrant Likely dma_async_issue_pending(txchan); 1069ca632f55SGrant Likely 1070ca632f55SGrant Likely return 0; 1071ca632f55SGrant Likely 1072ca632f55SGrant Likely err_txdesc: 1073ca632f55SGrant Likely dmaengine_terminate_all(txchan); 1074ca632f55SGrant Likely err_rxdesc: 1075ca632f55SGrant Likely dmaengine_terminate_all(rxchan); 1076ca632f55SGrant Likely dma_unmap_sg(txchan->device->dev, pl022->sgt_tx.sgl, 1077ca632f55SGrant Likely pl022->sgt_tx.nents, DMA_TO_DEVICE); 1078ca632f55SGrant Likely err_tx_sgmap: 1079ca632f55SGrant Likely dma_unmap_sg(rxchan->device->dev, pl022->sgt_rx.sgl, 1080ca632f55SGrant Likely pl022->sgt_tx.nents, DMA_FROM_DEVICE); 1081ca632f55SGrant Likely err_rx_sgmap: 1082ca632f55SGrant Likely sg_free_table(&pl022->sgt_tx); 1083ca632f55SGrant Likely err_alloc_tx_sg: 1084ca632f55SGrant Likely sg_free_table(&pl022->sgt_rx); 1085ca632f55SGrant Likely err_alloc_rx_sg: 1086ca632f55SGrant Likely return -ENOMEM; 1087ca632f55SGrant Likely } 1088ca632f55SGrant Likely 1089ca632f55SGrant Likely static int __init pl022_dma_probe(struct pl022 *pl022) 1090ca632f55SGrant Likely { 1091ca632f55SGrant Likely dma_cap_mask_t mask; 1092ca632f55SGrant Likely 1093ca632f55SGrant Likely /* Try to acquire a generic DMA engine slave channel */ 1094ca632f55SGrant Likely dma_cap_zero(mask); 1095ca632f55SGrant Likely dma_cap_set(DMA_SLAVE, mask); 1096ca632f55SGrant Likely /* 1097ca632f55SGrant Likely * We need both RX and TX channels to do DMA, else do none 1098ca632f55SGrant Likely * of them. 1099ca632f55SGrant Likely */ 1100ca632f55SGrant Likely pl022->dma_rx_channel = dma_request_channel(mask, 1101ca632f55SGrant Likely pl022->master_info->dma_filter, 1102ca632f55SGrant Likely pl022->master_info->dma_rx_param); 1103ca632f55SGrant Likely if (!pl022->dma_rx_channel) { 1104ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "no RX DMA channel!\n"); 1105ca632f55SGrant Likely goto err_no_rxchan; 1106ca632f55SGrant Likely } 1107ca632f55SGrant Likely 1108ca632f55SGrant Likely pl022->dma_tx_channel = dma_request_channel(mask, 1109ca632f55SGrant Likely pl022->master_info->dma_filter, 1110ca632f55SGrant Likely pl022->master_info->dma_tx_param); 1111ca632f55SGrant Likely if (!pl022->dma_tx_channel) { 1112ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "no TX DMA channel!\n"); 1113ca632f55SGrant Likely goto err_no_txchan; 1114ca632f55SGrant Likely } 1115ca632f55SGrant Likely 1116ca632f55SGrant Likely pl022->dummypage = kmalloc(PAGE_SIZE, GFP_KERNEL); 1117ca632f55SGrant Likely if (!pl022->dummypage) { 1118ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "no DMA dummypage!\n"); 1119ca632f55SGrant Likely goto err_no_dummypage; 1120ca632f55SGrant Likely } 1121ca632f55SGrant Likely 1122ca632f55SGrant Likely dev_info(&pl022->adev->dev, "setup for DMA on RX %s, TX %s\n", 1123ca632f55SGrant Likely dma_chan_name(pl022->dma_rx_channel), 1124ca632f55SGrant Likely dma_chan_name(pl022->dma_tx_channel)); 1125ca632f55SGrant Likely 1126ca632f55SGrant Likely return 0; 1127ca632f55SGrant Likely 1128ca632f55SGrant Likely err_no_dummypage: 1129ca632f55SGrant Likely dma_release_channel(pl022->dma_tx_channel); 1130ca632f55SGrant Likely err_no_txchan: 1131ca632f55SGrant Likely dma_release_channel(pl022->dma_rx_channel); 1132ca632f55SGrant Likely pl022->dma_rx_channel = NULL; 1133ca632f55SGrant Likely err_no_rxchan: 1134ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1135ca632f55SGrant Likely "Failed to work in dma mode, work without dma!\n"); 1136ca632f55SGrant Likely return -ENODEV; 1137ca632f55SGrant Likely } 1138ca632f55SGrant Likely 1139ca632f55SGrant Likely static void terminate_dma(struct pl022 *pl022) 1140ca632f55SGrant Likely { 1141ca632f55SGrant Likely struct dma_chan *rxchan = pl022->dma_rx_channel; 1142ca632f55SGrant Likely struct dma_chan *txchan = pl022->dma_tx_channel; 1143ca632f55SGrant Likely 1144ca632f55SGrant Likely dmaengine_terminate_all(rxchan); 1145ca632f55SGrant Likely dmaengine_terminate_all(txchan); 1146ca632f55SGrant Likely unmap_free_dma_scatter(pl022); 1147ca632f55SGrant Likely } 1148ca632f55SGrant Likely 1149ca632f55SGrant Likely static void pl022_dma_remove(struct pl022 *pl022) 1150ca632f55SGrant Likely { 1151ca632f55SGrant Likely if (pl022->busy) 1152ca632f55SGrant Likely terminate_dma(pl022); 1153ca632f55SGrant Likely if (pl022->dma_tx_channel) 1154ca632f55SGrant Likely dma_release_channel(pl022->dma_tx_channel); 1155ca632f55SGrant Likely if (pl022->dma_rx_channel) 1156ca632f55SGrant Likely dma_release_channel(pl022->dma_rx_channel); 1157ca632f55SGrant Likely kfree(pl022->dummypage); 1158ca632f55SGrant Likely } 1159ca632f55SGrant Likely 1160ca632f55SGrant Likely #else 1161ca632f55SGrant Likely static inline int configure_dma(struct pl022 *pl022) 1162ca632f55SGrant Likely { 1163ca632f55SGrant Likely return -ENODEV; 1164ca632f55SGrant Likely } 1165ca632f55SGrant Likely 1166ca632f55SGrant Likely static inline int pl022_dma_probe(struct pl022 *pl022) 1167ca632f55SGrant Likely { 1168ca632f55SGrant Likely return 0; 1169ca632f55SGrant Likely } 1170ca632f55SGrant Likely 1171ca632f55SGrant Likely static inline void pl022_dma_remove(struct pl022 *pl022) 1172ca632f55SGrant Likely { 1173ca632f55SGrant Likely } 1174ca632f55SGrant Likely #endif 1175ca632f55SGrant Likely 1176ca632f55SGrant Likely /** 1177ca632f55SGrant Likely * pl022_interrupt_handler - Interrupt handler for SSP controller 1178ca632f55SGrant Likely * 1179ca632f55SGrant Likely * This function handles interrupts generated for an interrupt based transfer. 1180ca632f55SGrant Likely * If a receive overrun (ROR) interrupt is there then we disable SSP, flag the 1181ca632f55SGrant Likely * current message's state as STATE_ERROR and schedule the tasklet 1182ca632f55SGrant Likely * pump_transfers which will do the postprocessing of the current message by 1183ca632f55SGrant Likely * calling giveback(). Otherwise it reads data from RX FIFO till there is no 1184ca632f55SGrant Likely * more data, and writes data in TX FIFO till it is not full. If we complete 1185ca632f55SGrant Likely * the transfer we move to the next transfer and schedule the tasklet. 1186ca632f55SGrant Likely */ 1187ca632f55SGrant Likely static irqreturn_t pl022_interrupt_handler(int irq, void *dev_id) 1188ca632f55SGrant Likely { 1189ca632f55SGrant Likely struct pl022 *pl022 = dev_id; 1190ca632f55SGrant Likely struct spi_message *msg = pl022->cur_msg; 1191ca632f55SGrant Likely u16 irq_status = 0; 1192ca632f55SGrant Likely u16 flag = 0; 1193ca632f55SGrant Likely 1194ca632f55SGrant Likely if (unlikely(!msg)) { 1195ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1196ca632f55SGrant Likely "bad message state in interrupt handler"); 1197ca632f55SGrant Likely /* Never fail */ 1198ca632f55SGrant Likely return IRQ_HANDLED; 1199ca632f55SGrant Likely } 1200ca632f55SGrant Likely 1201ca632f55SGrant Likely /* Read the Interrupt Status Register */ 1202ca632f55SGrant Likely irq_status = readw(SSP_MIS(pl022->virtbase)); 1203ca632f55SGrant Likely 1204ca632f55SGrant Likely if (unlikely(!irq_status)) 1205ca632f55SGrant Likely return IRQ_NONE; 1206ca632f55SGrant Likely 1207ca632f55SGrant Likely /* 1208ca632f55SGrant Likely * This handles the FIFO interrupts, the timeout 1209ca632f55SGrant Likely * interrupts are flatly ignored, they cannot be 1210ca632f55SGrant Likely * trusted. 1211ca632f55SGrant Likely */ 1212ca632f55SGrant Likely if (unlikely(irq_status & SSP_MIS_MASK_RORMIS)) { 1213ca632f55SGrant Likely /* 1214ca632f55SGrant Likely * Overrun interrupt - bail out since our Data has been 1215ca632f55SGrant Likely * corrupted 1216ca632f55SGrant Likely */ 1217ca632f55SGrant Likely dev_err(&pl022->adev->dev, "FIFO overrun\n"); 1218ca632f55SGrant Likely if (readw(SSP_SR(pl022->virtbase)) & SSP_SR_MASK_RFF) 1219ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1220ca632f55SGrant Likely "RXFIFO is full\n"); 1221ca632f55SGrant Likely if (readw(SSP_SR(pl022->virtbase)) & SSP_SR_MASK_TNF) 1222ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1223ca632f55SGrant Likely "TXFIFO is full\n"); 1224ca632f55SGrant Likely 1225ca632f55SGrant Likely /* 1226ca632f55SGrant Likely * Disable and clear interrupts, disable SSP, 1227ca632f55SGrant Likely * mark message with bad status so it can be 1228ca632f55SGrant Likely * retried. 1229ca632f55SGrant Likely */ 1230ca632f55SGrant Likely writew(DISABLE_ALL_INTERRUPTS, 1231ca632f55SGrant Likely SSP_IMSC(pl022->virtbase)); 1232ca632f55SGrant Likely writew(CLEAR_ALL_INTERRUPTS, SSP_ICR(pl022->virtbase)); 1233ca632f55SGrant Likely writew((readw(SSP_CR1(pl022->virtbase)) & 1234ca632f55SGrant Likely (~SSP_CR1_MASK_SSE)), SSP_CR1(pl022->virtbase)); 1235ca632f55SGrant Likely msg->state = STATE_ERROR; 1236ca632f55SGrant Likely 1237ca632f55SGrant Likely /* Schedule message queue handler */ 1238ca632f55SGrant Likely tasklet_schedule(&pl022->pump_transfers); 1239ca632f55SGrant Likely return IRQ_HANDLED; 1240ca632f55SGrant Likely } 1241ca632f55SGrant Likely 1242ca632f55SGrant Likely readwriter(pl022); 1243ca632f55SGrant Likely 1244ca632f55SGrant Likely if ((pl022->tx == pl022->tx_end) && (flag == 0)) { 1245ca632f55SGrant Likely flag = 1; 1246172289dfSChris Blair /* Disable Transmit interrupt, enable receive interrupt */ 1247172289dfSChris Blair writew((readw(SSP_IMSC(pl022->virtbase)) & 1248172289dfSChris Blair ~SSP_IMSC_MASK_TXIM) | SSP_IMSC_MASK_RXIM, 1249ca632f55SGrant Likely SSP_IMSC(pl022->virtbase)); 1250ca632f55SGrant Likely } 1251ca632f55SGrant Likely 1252ca632f55SGrant Likely /* 1253ca632f55SGrant Likely * Since all transactions must write as much as shall be read, 1254ca632f55SGrant Likely * we can conclude the entire transaction once RX is complete. 1255ca632f55SGrant Likely * At this point, all TX will always be finished. 1256ca632f55SGrant Likely */ 1257ca632f55SGrant Likely if (pl022->rx >= pl022->rx_end) { 1258ca632f55SGrant Likely writew(DISABLE_ALL_INTERRUPTS, 1259ca632f55SGrant Likely SSP_IMSC(pl022->virtbase)); 1260ca632f55SGrant Likely writew(CLEAR_ALL_INTERRUPTS, SSP_ICR(pl022->virtbase)); 1261ca632f55SGrant Likely if (unlikely(pl022->rx > pl022->rx_end)) { 1262ca632f55SGrant Likely dev_warn(&pl022->adev->dev, "read %u surplus " 1263ca632f55SGrant Likely "bytes (did you request an odd " 1264ca632f55SGrant Likely "number of bytes on a 16bit bus?)\n", 1265ca632f55SGrant Likely (u32) (pl022->rx - pl022->rx_end)); 1266ca632f55SGrant Likely } 1267ca632f55SGrant Likely /* Update total bytes transferred */ 1268ca632f55SGrant Likely msg->actual_length += pl022->cur_transfer->len; 1269ca632f55SGrant Likely if (pl022->cur_transfer->cs_change) 1270ca632f55SGrant Likely pl022->cur_chip-> 1271ca632f55SGrant Likely cs_control(SSP_CHIP_DESELECT); 1272ca632f55SGrant Likely /* Move to next transfer */ 1273ca632f55SGrant Likely msg->state = next_transfer(pl022); 1274ca632f55SGrant Likely tasklet_schedule(&pl022->pump_transfers); 1275ca632f55SGrant Likely return IRQ_HANDLED; 1276ca632f55SGrant Likely } 1277ca632f55SGrant Likely 1278ca632f55SGrant Likely return IRQ_HANDLED; 1279ca632f55SGrant Likely } 1280ca632f55SGrant Likely 1281ca632f55SGrant Likely /** 1282ca632f55SGrant Likely * This sets up the pointers to memory for the next message to 1283ca632f55SGrant Likely * send out on the SPI bus. 1284ca632f55SGrant Likely */ 1285ca632f55SGrant Likely static int set_up_next_transfer(struct pl022 *pl022, 1286ca632f55SGrant Likely struct spi_transfer *transfer) 1287ca632f55SGrant Likely { 1288ca632f55SGrant Likely int residue; 1289ca632f55SGrant Likely 1290ca632f55SGrant Likely /* Sanity check the message for this bus width */ 1291ca632f55SGrant Likely residue = pl022->cur_transfer->len % pl022->cur_chip->n_bytes; 1292ca632f55SGrant Likely if (unlikely(residue != 0)) { 1293ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1294ca632f55SGrant Likely "message of %u bytes to transmit but the current " 1295ca632f55SGrant Likely "chip bus has a data width of %u bytes!\n", 1296ca632f55SGrant Likely pl022->cur_transfer->len, 1297ca632f55SGrant Likely pl022->cur_chip->n_bytes); 1298ca632f55SGrant Likely dev_err(&pl022->adev->dev, "skipping this message\n"); 1299ca632f55SGrant Likely return -EIO; 1300ca632f55SGrant Likely } 1301ca632f55SGrant Likely pl022->tx = (void *)transfer->tx_buf; 1302ca632f55SGrant Likely pl022->tx_end = pl022->tx + pl022->cur_transfer->len; 1303ca632f55SGrant Likely pl022->rx = (void *)transfer->rx_buf; 1304ca632f55SGrant Likely pl022->rx_end = pl022->rx + pl022->cur_transfer->len; 1305ca632f55SGrant Likely pl022->write = 1306ca632f55SGrant Likely pl022->tx ? pl022->cur_chip->write : WRITING_NULL; 1307ca632f55SGrant Likely pl022->read = pl022->rx ? pl022->cur_chip->read : READING_NULL; 1308ca632f55SGrant Likely return 0; 1309ca632f55SGrant Likely } 1310ca632f55SGrant Likely 1311ca632f55SGrant Likely /** 1312ca632f55SGrant Likely * pump_transfers - Tasklet function which schedules next transfer 1313ca632f55SGrant Likely * when running in interrupt or DMA transfer mode. 1314ca632f55SGrant Likely * @data: SSP driver private data structure 1315ca632f55SGrant Likely * 1316ca632f55SGrant Likely */ 1317ca632f55SGrant Likely static void pump_transfers(unsigned long data) 1318ca632f55SGrant Likely { 1319ca632f55SGrant Likely struct pl022 *pl022 = (struct pl022 *) data; 1320ca632f55SGrant Likely struct spi_message *message = NULL; 1321ca632f55SGrant Likely struct spi_transfer *transfer = NULL; 1322ca632f55SGrant Likely struct spi_transfer *previous = NULL; 1323ca632f55SGrant Likely 1324ca632f55SGrant Likely /* Get current state information */ 1325ca632f55SGrant Likely message = pl022->cur_msg; 1326ca632f55SGrant Likely transfer = pl022->cur_transfer; 1327ca632f55SGrant Likely 1328ca632f55SGrant Likely /* Handle for abort */ 1329ca632f55SGrant Likely if (message->state == STATE_ERROR) { 1330ca632f55SGrant Likely message->status = -EIO; 1331ca632f55SGrant Likely giveback(pl022); 1332ca632f55SGrant Likely return; 1333ca632f55SGrant Likely } 1334ca632f55SGrant Likely 1335ca632f55SGrant Likely /* Handle end of message */ 1336ca632f55SGrant Likely if (message->state == STATE_DONE) { 1337ca632f55SGrant Likely message->status = 0; 1338ca632f55SGrant Likely giveback(pl022); 1339ca632f55SGrant Likely return; 1340ca632f55SGrant Likely } 1341ca632f55SGrant Likely 1342ca632f55SGrant Likely /* Delay if requested at end of transfer before CS change */ 1343ca632f55SGrant Likely if (message->state == STATE_RUNNING) { 1344ca632f55SGrant Likely previous = list_entry(transfer->transfer_list.prev, 1345ca632f55SGrant Likely struct spi_transfer, 1346ca632f55SGrant Likely transfer_list); 1347ca632f55SGrant Likely if (previous->delay_usecs) 1348ca632f55SGrant Likely /* 1349ca632f55SGrant Likely * FIXME: This runs in interrupt context. 1350ca632f55SGrant Likely * Is this really smart? 1351ca632f55SGrant Likely */ 1352ca632f55SGrant Likely udelay(previous->delay_usecs); 1353ca632f55SGrant Likely 13548b8d7191SVirupax Sadashivpetimath /* Reselect chip select only if cs_change was requested */ 1355ca632f55SGrant Likely if (previous->cs_change) 1356ca632f55SGrant Likely pl022->cur_chip->cs_control(SSP_CHIP_SELECT); 1357ca632f55SGrant Likely } else { 1358ca632f55SGrant Likely /* STATE_START */ 1359ca632f55SGrant Likely message->state = STATE_RUNNING; 1360ca632f55SGrant Likely } 1361ca632f55SGrant Likely 1362ca632f55SGrant Likely if (set_up_next_transfer(pl022, transfer)) { 1363ca632f55SGrant Likely message->state = STATE_ERROR; 1364ca632f55SGrant Likely message->status = -EIO; 1365ca632f55SGrant Likely giveback(pl022); 1366ca632f55SGrant Likely return; 1367ca632f55SGrant Likely } 1368ca632f55SGrant Likely /* Flush the FIFOs and let's go! */ 1369ca632f55SGrant Likely flush(pl022); 1370ca632f55SGrant Likely 1371ca632f55SGrant Likely if (pl022->cur_chip->enable_dma) { 1372ca632f55SGrant Likely if (configure_dma(pl022)) { 1373ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, 1374ca632f55SGrant Likely "configuration of DMA failed, fall back to interrupt mode\n"); 1375ca632f55SGrant Likely goto err_config_dma; 1376ca632f55SGrant Likely } 1377ca632f55SGrant Likely return; 1378ca632f55SGrant Likely } 1379ca632f55SGrant Likely 1380ca632f55SGrant Likely err_config_dma: 1381172289dfSChris Blair /* enable all interrupts except RX */ 1382172289dfSChris Blair writew(ENABLE_ALL_INTERRUPTS & ~SSP_IMSC_MASK_RXIM, SSP_IMSC(pl022->virtbase)); 1383ca632f55SGrant Likely } 1384ca632f55SGrant Likely 1385ca632f55SGrant Likely static void do_interrupt_dma_transfer(struct pl022 *pl022) 1386ca632f55SGrant Likely { 1387172289dfSChris Blair /* 1388172289dfSChris Blair * Default is to enable all interrupts except RX - 1389172289dfSChris Blair * this will be enabled once TX is complete 1390172289dfSChris Blair */ 1391172289dfSChris Blair u32 irqflags = ENABLE_ALL_INTERRUPTS & ~SSP_IMSC_MASK_RXIM; 1392ca632f55SGrant Likely 13938b8d7191SVirupax Sadashivpetimath /* Enable target chip, if not already active */ 13948b8d7191SVirupax Sadashivpetimath if (!pl022->next_msg_cs_active) 1395ca632f55SGrant Likely pl022->cur_chip->cs_control(SSP_CHIP_SELECT); 13968b8d7191SVirupax Sadashivpetimath 1397ca632f55SGrant Likely if (set_up_next_transfer(pl022, pl022->cur_transfer)) { 1398ca632f55SGrant Likely /* Error path */ 1399ca632f55SGrant Likely pl022->cur_msg->state = STATE_ERROR; 1400ca632f55SGrant Likely pl022->cur_msg->status = -EIO; 1401ca632f55SGrant Likely giveback(pl022); 1402ca632f55SGrant Likely return; 1403ca632f55SGrant Likely } 1404ca632f55SGrant Likely /* If we're using DMA, set up DMA here */ 1405ca632f55SGrant Likely if (pl022->cur_chip->enable_dma) { 1406ca632f55SGrant Likely /* Configure DMA transfer */ 1407ca632f55SGrant Likely if (configure_dma(pl022)) { 1408ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, 1409ca632f55SGrant Likely "configuration of DMA failed, fall back to interrupt mode\n"); 1410ca632f55SGrant Likely goto err_config_dma; 1411ca632f55SGrant Likely } 1412ca632f55SGrant Likely /* Disable interrupts in DMA mode, IRQ from DMA controller */ 1413ca632f55SGrant Likely irqflags = DISABLE_ALL_INTERRUPTS; 1414ca632f55SGrant Likely } 1415ca632f55SGrant Likely err_config_dma: 1416ca632f55SGrant Likely /* Enable SSP, turn on interrupts */ 1417ca632f55SGrant Likely writew((readw(SSP_CR1(pl022->virtbase)) | SSP_CR1_MASK_SSE), 1418ca632f55SGrant Likely SSP_CR1(pl022->virtbase)); 1419ca632f55SGrant Likely writew(irqflags, SSP_IMSC(pl022->virtbase)); 1420ca632f55SGrant Likely } 1421ca632f55SGrant Likely 1422ca632f55SGrant Likely static void do_polling_transfer(struct pl022 *pl022) 1423ca632f55SGrant Likely { 1424ca632f55SGrant Likely struct spi_message *message = NULL; 1425ca632f55SGrant Likely struct spi_transfer *transfer = NULL; 1426ca632f55SGrant Likely struct spi_transfer *previous = NULL; 1427ca632f55SGrant Likely struct chip_data *chip; 1428ca632f55SGrant Likely unsigned long time, timeout; 1429ca632f55SGrant Likely 1430ca632f55SGrant Likely chip = pl022->cur_chip; 1431ca632f55SGrant Likely message = pl022->cur_msg; 1432ca632f55SGrant Likely 1433ca632f55SGrant Likely while (message->state != STATE_DONE) { 1434ca632f55SGrant Likely /* Handle for abort */ 1435ca632f55SGrant Likely if (message->state == STATE_ERROR) 1436ca632f55SGrant Likely break; 1437ca632f55SGrant Likely transfer = pl022->cur_transfer; 1438ca632f55SGrant Likely 1439ca632f55SGrant Likely /* Delay if requested at end of transfer */ 1440ca632f55SGrant Likely if (message->state == STATE_RUNNING) { 1441ca632f55SGrant Likely previous = 1442ca632f55SGrant Likely list_entry(transfer->transfer_list.prev, 1443ca632f55SGrant Likely struct spi_transfer, transfer_list); 1444ca632f55SGrant Likely if (previous->delay_usecs) 1445ca632f55SGrant Likely udelay(previous->delay_usecs); 1446ca632f55SGrant Likely if (previous->cs_change) 1447ca632f55SGrant Likely pl022->cur_chip->cs_control(SSP_CHIP_SELECT); 1448ca632f55SGrant Likely } else { 1449ca632f55SGrant Likely /* STATE_START */ 1450ca632f55SGrant Likely message->state = STATE_RUNNING; 14518b8d7191SVirupax Sadashivpetimath if (!pl022->next_msg_cs_active) 1452ca632f55SGrant Likely pl022->cur_chip->cs_control(SSP_CHIP_SELECT); 1453ca632f55SGrant Likely } 1454ca632f55SGrant Likely 1455ca632f55SGrant Likely /* Configuration Changing Per Transfer */ 1456ca632f55SGrant Likely if (set_up_next_transfer(pl022, transfer)) { 1457ca632f55SGrant Likely /* Error path */ 1458ca632f55SGrant Likely message->state = STATE_ERROR; 1459ca632f55SGrant Likely break; 1460ca632f55SGrant Likely } 1461ca632f55SGrant Likely /* Flush FIFOs and enable SSP */ 1462ca632f55SGrant Likely flush(pl022); 1463ca632f55SGrant Likely writew((readw(SSP_CR1(pl022->virtbase)) | SSP_CR1_MASK_SSE), 1464ca632f55SGrant Likely SSP_CR1(pl022->virtbase)); 1465ca632f55SGrant Likely 1466ca632f55SGrant Likely dev_dbg(&pl022->adev->dev, "polling transfer ongoing ...\n"); 1467ca632f55SGrant Likely 1468ca632f55SGrant Likely timeout = jiffies + msecs_to_jiffies(SPI_POLLING_TIMEOUT); 1469ca632f55SGrant Likely while (pl022->tx < pl022->tx_end || pl022->rx < pl022->rx_end) { 1470ca632f55SGrant Likely time = jiffies; 1471ca632f55SGrant Likely readwriter(pl022); 1472ca632f55SGrant Likely if (time_after(time, timeout)) { 1473ca632f55SGrant Likely dev_warn(&pl022->adev->dev, 1474ca632f55SGrant Likely "%s: timeout!\n", __func__); 1475ca632f55SGrant Likely message->state = STATE_ERROR; 1476ca632f55SGrant Likely goto out; 1477ca632f55SGrant Likely } 1478ca632f55SGrant Likely cpu_relax(); 1479ca632f55SGrant Likely } 1480ca632f55SGrant Likely 1481ca632f55SGrant Likely /* Update total byte transferred */ 1482ca632f55SGrant Likely message->actual_length += pl022->cur_transfer->len; 1483ca632f55SGrant Likely if (pl022->cur_transfer->cs_change) 1484ca632f55SGrant Likely pl022->cur_chip->cs_control(SSP_CHIP_DESELECT); 1485ca632f55SGrant Likely /* Move to next transfer */ 1486ca632f55SGrant Likely message->state = next_transfer(pl022); 1487ca632f55SGrant Likely } 1488ca632f55SGrant Likely out: 1489ca632f55SGrant Likely /* Handle end of message */ 1490ca632f55SGrant Likely if (message->state == STATE_DONE) 1491ca632f55SGrant Likely message->status = 0; 1492ca632f55SGrant Likely else 1493ca632f55SGrant Likely message->status = -EIO; 1494ca632f55SGrant Likely 1495ca632f55SGrant Likely giveback(pl022); 1496ca632f55SGrant Likely return; 1497ca632f55SGrant Likely } 1498ca632f55SGrant Likely 1499ca632f55SGrant Likely /** 1500*14af60b6SChris Blair * pump_messages - kthread work function which processes spi message queue 1501*14af60b6SChris Blair * @work: pointer to kthread work struct contained in the pl022 private struct 1502ca632f55SGrant Likely * 1503ca632f55SGrant Likely * This function checks if there is any spi message in the queue that 1504ca632f55SGrant Likely * needs processing and delegate control to appropriate function 1505ca632f55SGrant Likely * do_polling_transfer()/do_interrupt_dma_transfer() 1506ca632f55SGrant Likely * based on the kind of the transfer 1507ca632f55SGrant Likely * 1508ca632f55SGrant Likely */ 1509*14af60b6SChris Blair static void pump_messages(struct kthread_work *work) 1510ca632f55SGrant Likely { 1511ca632f55SGrant Likely struct pl022 *pl022 = 1512ca632f55SGrant Likely container_of(work, struct pl022, pump_messages); 1513ca632f55SGrant Likely unsigned long flags; 1514d4b6af2eSChris Blair bool was_busy = false; 1515ca632f55SGrant Likely 1516ca632f55SGrant Likely /* Lock queue and check for queue work */ 1517ca632f55SGrant Likely spin_lock_irqsave(&pl022->queue_lock, flags); 1518ca632f55SGrant Likely if (list_empty(&pl022->queue) || !pl022->running) { 15190ad2deeaSVirupax Sadashivpetimath if (pl022->busy) { 15200ad2deeaSVirupax Sadashivpetimath /* nothing more to do - disable spi/ssp and power off */ 15210ad2deeaSVirupax Sadashivpetimath writew((readw(SSP_CR1(pl022->virtbase)) & 15220ad2deeaSVirupax Sadashivpetimath (~SSP_CR1_MASK_SSE)), SSP_CR1(pl022->virtbase)); 152353e4aceaSChris Blair 152453e4aceaSChris Blair if (pl022->master_info->autosuspend_delay > 0) { 152553e4aceaSChris Blair pm_runtime_mark_last_busy(&pl022->adev->dev); 152653e4aceaSChris Blair pm_runtime_put_autosuspend(&pl022->adev->dev); 152753e4aceaSChris Blair } else { 1528d4b6af2eSChris Blair pm_runtime_put(&pl022->adev->dev); 15290ad2deeaSVirupax Sadashivpetimath } 153053e4aceaSChris Blair } 1531ca632f55SGrant Likely pl022->busy = false; 1532ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1533ca632f55SGrant Likely return; 1534ca632f55SGrant Likely } 1535d4b6af2eSChris Blair 1536ca632f55SGrant Likely /* Make sure we are not already running a message */ 1537ca632f55SGrant Likely if (pl022->cur_msg) { 1538ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1539ca632f55SGrant Likely return; 1540ca632f55SGrant Likely } 1541ca632f55SGrant Likely /* Extract head of queue */ 1542ca632f55SGrant Likely pl022->cur_msg = 1543ca632f55SGrant Likely list_entry(pl022->queue.next, struct spi_message, queue); 1544ca632f55SGrant Likely 1545ca632f55SGrant Likely list_del_init(&pl022->cur_msg->queue); 1546d4b6af2eSChris Blair if (pl022->busy) 1547d4b6af2eSChris Blair was_busy = true; 1548d4b6af2eSChris Blair else 1549ca632f55SGrant Likely pl022->busy = true; 1550ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1551ca632f55SGrant Likely 1552ca632f55SGrant Likely /* Initial message state */ 1553ca632f55SGrant Likely pl022->cur_msg->state = STATE_START; 1554ca632f55SGrant Likely pl022->cur_transfer = list_entry(pl022->cur_msg->transfers.next, 1555f1e45f86SViresh Kumar struct spi_transfer, transfer_list); 1556ca632f55SGrant Likely 1557ca632f55SGrant Likely /* Setup the SPI using the per chip configuration */ 1558ca632f55SGrant Likely pl022->cur_chip = spi_get_ctldata(pl022->cur_msg->spi); 1559d4b6af2eSChris Blair if (!was_busy) 1560ca632f55SGrant Likely /* 1561ca632f55SGrant Likely * We enable the core voltage and clocks here, then the clocks 1562*14af60b6SChris Blair * and core will be disabled when this thread is run again 1563d4b6af2eSChris Blair * and there is no more work to be done. 1564ca632f55SGrant Likely */ 1565bcda6ff8SRabin Vincent pm_runtime_get_sync(&pl022->adev->dev); 1566d4b6af2eSChris Blair 1567ca632f55SGrant Likely restore_state(pl022); 1568ca632f55SGrant Likely flush(pl022); 1569ca632f55SGrant Likely 1570ca632f55SGrant Likely if (pl022->cur_chip->xfer_type == POLLING_TRANSFER) 1571ca632f55SGrant Likely do_polling_transfer(pl022); 1572ca632f55SGrant Likely else 1573ca632f55SGrant Likely do_interrupt_dma_transfer(pl022); 1574ca632f55SGrant Likely } 1575ca632f55SGrant Likely 1576ca632f55SGrant Likely static int __init init_queue(struct pl022 *pl022) 1577ca632f55SGrant Likely { 1578*14af60b6SChris Blair struct sched_param param = { .sched_priority = MAX_RT_PRIO - 1 }; 1579*14af60b6SChris Blair 1580ca632f55SGrant Likely INIT_LIST_HEAD(&pl022->queue); 1581ca632f55SGrant Likely spin_lock_init(&pl022->queue_lock); 1582ca632f55SGrant Likely 1583ca632f55SGrant Likely pl022->running = false; 1584ca632f55SGrant Likely pl022->busy = false; 1585ca632f55SGrant Likely 1586f1e45f86SViresh Kumar tasklet_init(&pl022->pump_transfers, pump_transfers, 1587f1e45f86SViresh Kumar (unsigned long)pl022); 1588ca632f55SGrant Likely 1589*14af60b6SChris Blair init_kthread_worker(&pl022->kworker); 1590*14af60b6SChris Blair pl022->kworker_task = kthread_run(kthread_worker_fn, 1591*14af60b6SChris Blair &pl022->kworker, 1592ca632f55SGrant Likely dev_name(pl022->master->dev.parent)); 1593*14af60b6SChris Blair if (IS_ERR(pl022->kworker_task)) { 1594*14af60b6SChris Blair dev_err(&pl022->adev->dev, 1595*14af60b6SChris Blair "failed to create message pump task\n"); 1596*14af60b6SChris Blair return -ENOMEM; 1597*14af60b6SChris Blair } 1598*14af60b6SChris Blair init_kthread_work(&pl022->pump_messages, pump_messages); 1599*14af60b6SChris Blair 1600*14af60b6SChris Blair /* 1601*14af60b6SChris Blair * Board config will indicate if this controller should run the 1602*14af60b6SChris Blair * message pump with high (realtime) priority to reduce the transfer 1603*14af60b6SChris Blair * latency on the bus by minimising the delay between a transfer 1604*14af60b6SChris Blair * request and the scheduling of the message pump thread. Without this 1605*14af60b6SChris Blair * setting the message pump thread will remain at default priority. 1606*14af60b6SChris Blair */ 1607*14af60b6SChris Blair if (pl022->master_info->rt) { 1608*14af60b6SChris Blair dev_info(&pl022->adev->dev, 1609*14af60b6SChris Blair "will run message pump with realtime priority\n"); 1610*14af60b6SChris Blair sched_setscheduler(pl022->kworker_task, SCHED_FIFO, ¶m); 1611*14af60b6SChris Blair } 1612ca632f55SGrant Likely 1613ca632f55SGrant Likely return 0; 1614ca632f55SGrant Likely } 1615ca632f55SGrant Likely 1616ca632f55SGrant Likely static int start_queue(struct pl022 *pl022) 1617ca632f55SGrant Likely { 1618ca632f55SGrant Likely unsigned long flags; 1619ca632f55SGrant Likely 1620ca632f55SGrant Likely spin_lock_irqsave(&pl022->queue_lock, flags); 1621ca632f55SGrant Likely 1622ca632f55SGrant Likely if (pl022->running || pl022->busy) { 1623ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1624ca632f55SGrant Likely return -EBUSY; 1625ca632f55SGrant Likely } 1626ca632f55SGrant Likely 1627ca632f55SGrant Likely pl022->running = true; 1628ca632f55SGrant Likely pl022->cur_msg = NULL; 1629ca632f55SGrant Likely pl022->cur_transfer = NULL; 1630ca632f55SGrant Likely pl022->cur_chip = NULL; 16318b8d7191SVirupax Sadashivpetimath pl022->next_msg_cs_active = false; 1632ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1633ca632f55SGrant Likely 1634*14af60b6SChris Blair queue_kthread_work(&pl022->kworker, &pl022->pump_messages); 1635ca632f55SGrant Likely 1636ca632f55SGrant Likely return 0; 1637ca632f55SGrant Likely } 1638ca632f55SGrant Likely 1639ca632f55SGrant Likely static int stop_queue(struct pl022 *pl022) 1640ca632f55SGrant Likely { 1641ca632f55SGrant Likely unsigned long flags; 1642ca632f55SGrant Likely unsigned limit = 500; 1643ca632f55SGrant Likely int status = 0; 1644ca632f55SGrant Likely 1645ca632f55SGrant Likely spin_lock_irqsave(&pl022->queue_lock, flags); 1646ca632f55SGrant Likely 1647ca632f55SGrant Likely /* This is a bit lame, but is optimized for the common execution path. 1648ca632f55SGrant Likely * A wait_queue on the pl022->busy could be used, but then the common 1649ca632f55SGrant Likely * execution path (pump_messages) would be required to call wake_up or 1650ca632f55SGrant Likely * friends on every SPI message. Do this instead */ 1651ca632f55SGrant Likely while ((!list_empty(&pl022->queue) || pl022->busy) && limit--) { 1652ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1653ca632f55SGrant Likely msleep(10); 1654ca632f55SGrant Likely spin_lock_irqsave(&pl022->queue_lock, flags); 1655ca632f55SGrant Likely } 1656ca632f55SGrant Likely 1657ca632f55SGrant Likely if (!list_empty(&pl022->queue) || pl022->busy) 1658ca632f55SGrant Likely status = -EBUSY; 1659ca632f55SGrant Likely else 1660ca632f55SGrant Likely pl022->running = false; 1661ca632f55SGrant Likely 1662ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1663ca632f55SGrant Likely 1664ca632f55SGrant Likely return status; 1665ca632f55SGrant Likely } 1666ca632f55SGrant Likely 1667ca632f55SGrant Likely static int destroy_queue(struct pl022 *pl022) 1668ca632f55SGrant Likely { 1669ca632f55SGrant Likely int status; 1670ca632f55SGrant Likely 1671ca632f55SGrant Likely status = stop_queue(pl022); 1672*14af60b6SChris Blair 1673*14af60b6SChris Blair /* 1674*14af60b6SChris Blair * We are unloading the module or failing to load (only two calls 1675ca632f55SGrant Likely * to this routine), and neither call can handle a return value. 1676*14af60b6SChris Blair * However, flush_kthread_worker will block until all work is done. 1677*14af60b6SChris Blair * If the reason that stop_queue timed out is that the work will never 1678*14af60b6SChris Blair * finish, then it does no good to call flush/stop thread, so 1679*14af60b6SChris Blair * return anyway. 1680*14af60b6SChris Blair */ 1681ca632f55SGrant Likely if (status != 0) 1682ca632f55SGrant Likely return status; 1683ca632f55SGrant Likely 1684*14af60b6SChris Blair flush_kthread_worker(&pl022->kworker); 1685*14af60b6SChris Blair kthread_stop(pl022->kworker_task); 1686ca632f55SGrant Likely 1687ca632f55SGrant Likely return 0; 1688ca632f55SGrant Likely } 1689ca632f55SGrant Likely 1690ca632f55SGrant Likely static int verify_controller_parameters(struct pl022 *pl022, 1691ca632f55SGrant Likely struct pl022_config_chip const *chip_info) 1692ca632f55SGrant Likely { 1693ca632f55SGrant Likely if ((chip_info->iface < SSP_INTERFACE_MOTOROLA_SPI) 1694ca632f55SGrant Likely || (chip_info->iface > SSP_INTERFACE_UNIDIRECTIONAL)) { 1695ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1696ca632f55SGrant Likely "interface is configured incorrectly\n"); 1697ca632f55SGrant Likely return -EINVAL; 1698ca632f55SGrant Likely } 1699ca632f55SGrant Likely if ((chip_info->iface == SSP_INTERFACE_UNIDIRECTIONAL) && 1700ca632f55SGrant Likely (!pl022->vendor->unidir)) { 1701ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1702ca632f55SGrant Likely "unidirectional mode not supported in this " 1703ca632f55SGrant Likely "hardware version\n"); 1704ca632f55SGrant Likely return -EINVAL; 1705ca632f55SGrant Likely } 1706ca632f55SGrant Likely if ((chip_info->hierarchy != SSP_MASTER) 1707ca632f55SGrant Likely && (chip_info->hierarchy != SSP_SLAVE)) { 1708ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1709ca632f55SGrant Likely "hierarchy is configured incorrectly\n"); 1710ca632f55SGrant Likely return -EINVAL; 1711ca632f55SGrant Likely } 1712ca632f55SGrant Likely if ((chip_info->com_mode != INTERRUPT_TRANSFER) 1713ca632f55SGrant Likely && (chip_info->com_mode != DMA_TRANSFER) 1714ca632f55SGrant Likely && (chip_info->com_mode != POLLING_TRANSFER)) { 1715ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1716ca632f55SGrant Likely "Communication mode is configured incorrectly\n"); 1717ca632f55SGrant Likely return -EINVAL; 1718ca632f55SGrant Likely } 171978b2b911SLinus Walleij switch (chip_info->rx_lev_trig) { 172078b2b911SLinus Walleij case SSP_RX_1_OR_MORE_ELEM: 172178b2b911SLinus Walleij case SSP_RX_4_OR_MORE_ELEM: 172278b2b911SLinus Walleij case SSP_RX_8_OR_MORE_ELEM: 172378b2b911SLinus Walleij /* These are always OK, all variants can handle this */ 172478b2b911SLinus Walleij break; 172578b2b911SLinus Walleij case SSP_RX_16_OR_MORE_ELEM: 172678b2b911SLinus Walleij if (pl022->vendor->fifodepth < 16) { 1727ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1728ca632f55SGrant Likely "RX FIFO Trigger Level is configured incorrectly\n"); 1729ca632f55SGrant Likely return -EINVAL; 1730ca632f55SGrant Likely } 173178b2b911SLinus Walleij break; 173278b2b911SLinus Walleij case SSP_RX_32_OR_MORE_ELEM: 173378b2b911SLinus Walleij if (pl022->vendor->fifodepth < 32) { 173478b2b911SLinus Walleij dev_err(&pl022->adev->dev, 173578b2b911SLinus Walleij "RX FIFO Trigger Level is configured incorrectly\n"); 173678b2b911SLinus Walleij return -EINVAL; 173778b2b911SLinus Walleij } 173878b2b911SLinus Walleij break; 173978b2b911SLinus Walleij default: 174078b2b911SLinus Walleij dev_err(&pl022->adev->dev, 174178b2b911SLinus Walleij "RX FIFO Trigger Level is configured incorrectly\n"); 174278b2b911SLinus Walleij return -EINVAL; 174378b2b911SLinus Walleij break; 174478b2b911SLinus Walleij } 174578b2b911SLinus Walleij switch (chip_info->tx_lev_trig) { 174678b2b911SLinus Walleij case SSP_TX_1_OR_MORE_EMPTY_LOC: 174778b2b911SLinus Walleij case SSP_TX_4_OR_MORE_EMPTY_LOC: 174878b2b911SLinus Walleij case SSP_TX_8_OR_MORE_EMPTY_LOC: 174978b2b911SLinus Walleij /* These are always OK, all variants can handle this */ 175078b2b911SLinus Walleij break; 175178b2b911SLinus Walleij case SSP_TX_16_OR_MORE_EMPTY_LOC: 175278b2b911SLinus Walleij if (pl022->vendor->fifodepth < 16) { 1753ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1754ca632f55SGrant Likely "TX FIFO Trigger Level is configured incorrectly\n"); 1755ca632f55SGrant Likely return -EINVAL; 1756ca632f55SGrant Likely } 175778b2b911SLinus Walleij break; 175878b2b911SLinus Walleij case SSP_TX_32_OR_MORE_EMPTY_LOC: 175978b2b911SLinus Walleij if (pl022->vendor->fifodepth < 32) { 176078b2b911SLinus Walleij dev_err(&pl022->adev->dev, 176178b2b911SLinus Walleij "TX FIFO Trigger Level is configured incorrectly\n"); 176278b2b911SLinus Walleij return -EINVAL; 176378b2b911SLinus Walleij } 176478b2b911SLinus Walleij break; 176578b2b911SLinus Walleij default: 176678b2b911SLinus Walleij dev_err(&pl022->adev->dev, 176778b2b911SLinus Walleij "TX FIFO Trigger Level is configured incorrectly\n"); 176878b2b911SLinus Walleij return -EINVAL; 176978b2b911SLinus Walleij break; 177078b2b911SLinus Walleij } 1771ca632f55SGrant Likely if (chip_info->iface == SSP_INTERFACE_NATIONAL_MICROWIRE) { 1772ca632f55SGrant Likely if ((chip_info->ctrl_len < SSP_BITS_4) 1773ca632f55SGrant Likely || (chip_info->ctrl_len > SSP_BITS_32)) { 1774ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1775ca632f55SGrant Likely "CTRL LEN is configured incorrectly\n"); 1776ca632f55SGrant Likely return -EINVAL; 1777ca632f55SGrant Likely } 1778ca632f55SGrant Likely if ((chip_info->wait_state != SSP_MWIRE_WAIT_ZERO) 1779ca632f55SGrant Likely && (chip_info->wait_state != SSP_MWIRE_WAIT_ONE)) { 1780ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1781ca632f55SGrant Likely "Wait State is configured incorrectly\n"); 1782ca632f55SGrant Likely return -EINVAL; 1783ca632f55SGrant Likely } 1784ca632f55SGrant Likely /* Half duplex is only available in the ST Micro version */ 1785ca632f55SGrant Likely if (pl022->vendor->extended_cr) { 1786ca632f55SGrant Likely if ((chip_info->duplex != 1787ca632f55SGrant Likely SSP_MICROWIRE_CHANNEL_FULL_DUPLEX) 1788ca632f55SGrant Likely && (chip_info->duplex != 1789ca632f55SGrant Likely SSP_MICROWIRE_CHANNEL_HALF_DUPLEX)) { 1790ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1791ca632f55SGrant Likely "Microwire duplex mode is configured incorrectly\n"); 1792ca632f55SGrant Likely return -EINVAL; 1793ca632f55SGrant Likely } 1794ca632f55SGrant Likely } else { 1795ca632f55SGrant Likely if (chip_info->duplex != SSP_MICROWIRE_CHANNEL_FULL_DUPLEX) 1796ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1797ca632f55SGrant Likely "Microwire half duplex mode requested," 1798ca632f55SGrant Likely " but this is only available in the" 1799ca632f55SGrant Likely " ST version of PL022\n"); 1800ca632f55SGrant Likely return -EINVAL; 1801ca632f55SGrant Likely } 1802ca632f55SGrant Likely } 1803ca632f55SGrant Likely return 0; 1804ca632f55SGrant Likely } 1805ca632f55SGrant Likely 1806ca632f55SGrant Likely /** 1807ca632f55SGrant Likely * pl022_transfer - transfer function registered to SPI master framework 1808ca632f55SGrant Likely * @spi: spi device which is requesting transfer 1809ca632f55SGrant Likely * @msg: spi message which is to handled is queued to driver queue 1810ca632f55SGrant Likely * 1811ca632f55SGrant Likely * This function is registered to the SPI framework for this SPI master 1812ca632f55SGrant Likely * controller. It will queue the spi_message in the queue of driver if 1813ca632f55SGrant Likely * the queue is not stopped and return. 1814ca632f55SGrant Likely */ 1815ca632f55SGrant Likely static int pl022_transfer(struct spi_device *spi, struct spi_message *msg) 1816ca632f55SGrant Likely { 1817ca632f55SGrant Likely struct pl022 *pl022 = spi_master_get_devdata(spi->master); 1818ca632f55SGrant Likely unsigned long flags; 1819ca632f55SGrant Likely 1820ca632f55SGrant Likely spin_lock_irqsave(&pl022->queue_lock, flags); 1821ca632f55SGrant Likely 1822ca632f55SGrant Likely if (!pl022->running) { 1823ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1824ca632f55SGrant Likely return -ESHUTDOWN; 1825ca632f55SGrant Likely } 1826ca632f55SGrant Likely msg->actual_length = 0; 1827ca632f55SGrant Likely msg->status = -EINPROGRESS; 1828ca632f55SGrant Likely msg->state = STATE_START; 1829ca632f55SGrant Likely 1830ca632f55SGrant Likely list_add_tail(&msg->queue, &pl022->queue); 1831ca632f55SGrant Likely if (pl022->running && !pl022->busy) 1832*14af60b6SChris Blair queue_kthread_work(&pl022->kworker, &pl022->pump_messages); 1833ca632f55SGrant Likely 1834ca632f55SGrant Likely spin_unlock_irqrestore(&pl022->queue_lock, flags); 1835ca632f55SGrant Likely return 0; 1836ca632f55SGrant Likely } 1837ca632f55SGrant Likely 18380379b2a3SViresh Kumar static inline u32 spi_rate(u32 rate, u16 cpsdvsr, u16 scr) 18390379b2a3SViresh Kumar { 18400379b2a3SViresh Kumar return rate / (cpsdvsr * (1 + scr)); 18410379b2a3SViresh Kumar } 18420379b2a3SViresh Kumar 18430379b2a3SViresh Kumar static int calculate_effective_freq(struct pl022 *pl022, int freq, struct 18440379b2a3SViresh Kumar ssp_clock_params * clk_freq) 1845ca632f55SGrant Likely { 1846ca632f55SGrant Likely /* Lets calculate the frequency parameters */ 18470379b2a3SViresh Kumar u16 cpsdvsr = CPSDVR_MIN, scr = SCR_MIN; 18480379b2a3SViresh Kumar u32 rate, max_tclk, min_tclk, best_freq = 0, best_cpsdvsr = 0, 18490379b2a3SViresh Kumar best_scr = 0, tmp, found = 0; 1850ca632f55SGrant Likely 1851ca632f55SGrant Likely rate = clk_get_rate(pl022->clk); 1852ca632f55SGrant Likely /* cpsdvscr = 2 & scr 0 */ 18530379b2a3SViresh Kumar max_tclk = spi_rate(rate, CPSDVR_MIN, SCR_MIN); 1854ca632f55SGrant Likely /* cpsdvsr = 254 & scr = 255 */ 18550379b2a3SViresh Kumar min_tclk = spi_rate(rate, CPSDVR_MAX, SCR_MAX); 1856ca632f55SGrant Likely 18570379b2a3SViresh Kumar if (!((freq <= max_tclk) && (freq >= min_tclk))) { 1858ca632f55SGrant Likely dev_err(&pl022->adev->dev, 1859ca632f55SGrant Likely "controller data is incorrect: out of range frequency"); 1860ca632f55SGrant Likely return -EINVAL; 1861ca632f55SGrant Likely } 18620379b2a3SViresh Kumar 18630379b2a3SViresh Kumar /* 18640379b2a3SViresh Kumar * best_freq will give closest possible available rate (<= requested 18650379b2a3SViresh Kumar * freq) for all values of scr & cpsdvsr. 18660379b2a3SViresh Kumar */ 18670379b2a3SViresh Kumar while ((cpsdvsr <= CPSDVR_MAX) && !found) { 18680379b2a3SViresh Kumar while (scr <= SCR_MAX) { 18690379b2a3SViresh Kumar tmp = spi_rate(rate, cpsdvsr, scr); 18700379b2a3SViresh Kumar 18710379b2a3SViresh Kumar if (tmp > freq) 18720379b2a3SViresh Kumar scr++; 18730379b2a3SViresh Kumar /* 18740379b2a3SViresh Kumar * If found exact value, update and break. 18750379b2a3SViresh Kumar * If found more closer value, update and continue. 18760379b2a3SViresh Kumar */ 18770379b2a3SViresh Kumar else if ((tmp == freq) || (tmp > best_freq)) { 18780379b2a3SViresh Kumar best_freq = tmp; 18790379b2a3SViresh Kumar best_cpsdvsr = cpsdvsr; 18800379b2a3SViresh Kumar best_scr = scr; 18810379b2a3SViresh Kumar 18820379b2a3SViresh Kumar if (tmp == freq) 18830379b2a3SViresh Kumar break; 18840379b2a3SViresh Kumar } 18850379b2a3SViresh Kumar scr++; 18860379b2a3SViresh Kumar } 18870379b2a3SViresh Kumar cpsdvsr += 2; 18880379b2a3SViresh Kumar scr = SCR_MIN; 1889ca632f55SGrant Likely } 1890ca632f55SGrant Likely 18910379b2a3SViresh Kumar clk_freq->cpsdvsr = (u8) (best_cpsdvsr & 0xFF); 18920379b2a3SViresh Kumar clk_freq->scr = (u8) (best_scr & 0xFF); 18930379b2a3SViresh Kumar dev_dbg(&pl022->adev->dev, 18940379b2a3SViresh Kumar "SSP Target Frequency is: %u, Effective Frequency is %u\n", 18950379b2a3SViresh Kumar freq, best_freq); 18960379b2a3SViresh Kumar dev_dbg(&pl022->adev->dev, "SSP cpsdvsr = %d, scr = %d\n", 18970379b2a3SViresh Kumar clk_freq->cpsdvsr, clk_freq->scr); 18980379b2a3SViresh Kumar 1899ca632f55SGrant Likely return 0; 1900ca632f55SGrant Likely } 1901ca632f55SGrant Likely 1902ca632f55SGrant Likely /* 1903ca632f55SGrant Likely * A piece of default chip info unless the platform 1904ca632f55SGrant Likely * supplies it. 1905ca632f55SGrant Likely */ 1906ca632f55SGrant Likely static const struct pl022_config_chip pl022_default_chip_info = { 1907ca632f55SGrant Likely .com_mode = POLLING_TRANSFER, 1908ca632f55SGrant Likely .iface = SSP_INTERFACE_MOTOROLA_SPI, 1909ca632f55SGrant Likely .hierarchy = SSP_SLAVE, 1910ca632f55SGrant Likely .slave_tx_disable = DO_NOT_DRIVE_TX, 1911ca632f55SGrant Likely .rx_lev_trig = SSP_RX_1_OR_MORE_ELEM, 1912ca632f55SGrant Likely .tx_lev_trig = SSP_TX_1_OR_MORE_EMPTY_LOC, 1913ca632f55SGrant Likely .ctrl_len = SSP_BITS_8, 1914ca632f55SGrant Likely .wait_state = SSP_MWIRE_WAIT_ZERO, 1915ca632f55SGrant Likely .duplex = SSP_MICROWIRE_CHANNEL_FULL_DUPLEX, 1916ca632f55SGrant Likely .cs_control = null_cs_control, 1917ca632f55SGrant Likely }; 1918ca632f55SGrant Likely 1919ca632f55SGrant Likely /** 1920ca632f55SGrant Likely * pl022_setup - setup function registered to SPI master framework 1921ca632f55SGrant Likely * @spi: spi device which is requesting setup 1922ca632f55SGrant Likely * 1923ca632f55SGrant Likely * This function is registered to the SPI framework for this SPI master 1924ca632f55SGrant Likely * controller. If it is the first time when setup is called by this device, 1925ca632f55SGrant Likely * this function will initialize the runtime state for this chip and save 1926ca632f55SGrant Likely * the same in the device structure. Else it will update the runtime info 1927ca632f55SGrant Likely * with the updated chip info. Nothing is really being written to the 1928ca632f55SGrant Likely * controller hardware here, that is not done until the actual transfer 1929ca632f55SGrant Likely * commence. 1930ca632f55SGrant Likely */ 1931ca632f55SGrant Likely static int pl022_setup(struct spi_device *spi) 1932ca632f55SGrant Likely { 1933ca632f55SGrant Likely struct pl022_config_chip const *chip_info; 1934ca632f55SGrant Likely struct chip_data *chip; 1935c4a47843SJonas Aaberg struct ssp_clock_params clk_freq = { .cpsdvsr = 0, .scr = 0}; 1936ca632f55SGrant Likely int status = 0; 1937ca632f55SGrant Likely struct pl022 *pl022 = spi_master_get_devdata(spi->master); 1938ca632f55SGrant Likely unsigned int bits = spi->bits_per_word; 1939ca632f55SGrant Likely u32 tmp; 1940ca632f55SGrant Likely 1941ca632f55SGrant Likely if (!spi->max_speed_hz) 1942ca632f55SGrant Likely return -EINVAL; 1943ca632f55SGrant Likely 1944ca632f55SGrant Likely /* Get controller_state if one is supplied */ 1945ca632f55SGrant Likely chip = spi_get_ctldata(spi); 1946ca632f55SGrant Likely 1947ca632f55SGrant Likely if (chip == NULL) { 1948ca632f55SGrant Likely chip = kzalloc(sizeof(struct chip_data), GFP_KERNEL); 1949ca632f55SGrant Likely if (!chip) { 1950ca632f55SGrant Likely dev_err(&spi->dev, 1951ca632f55SGrant Likely "cannot allocate controller state\n"); 1952ca632f55SGrant Likely return -ENOMEM; 1953ca632f55SGrant Likely } 1954ca632f55SGrant Likely dev_dbg(&spi->dev, 1955ca632f55SGrant Likely "allocated memory for controller's runtime state\n"); 1956ca632f55SGrant Likely } 1957ca632f55SGrant Likely 1958ca632f55SGrant Likely /* Get controller data if one is supplied */ 1959ca632f55SGrant Likely chip_info = spi->controller_data; 1960ca632f55SGrant Likely 1961ca632f55SGrant Likely if (chip_info == NULL) { 1962ca632f55SGrant Likely chip_info = &pl022_default_chip_info; 1963ca632f55SGrant Likely /* spi_board_info.controller_data not is supplied */ 1964ca632f55SGrant Likely dev_dbg(&spi->dev, 1965ca632f55SGrant Likely "using default controller_data settings\n"); 1966ca632f55SGrant Likely } else 1967ca632f55SGrant Likely dev_dbg(&spi->dev, 1968ca632f55SGrant Likely "using user supplied controller_data settings\n"); 1969ca632f55SGrant Likely 1970ca632f55SGrant Likely /* 1971ca632f55SGrant Likely * We can override with custom divisors, else we use the board 1972ca632f55SGrant Likely * frequency setting 1973ca632f55SGrant Likely */ 1974ca632f55SGrant Likely if ((0 == chip_info->clk_freq.cpsdvsr) 1975ca632f55SGrant Likely && (0 == chip_info->clk_freq.scr)) { 1976ca632f55SGrant Likely status = calculate_effective_freq(pl022, 1977ca632f55SGrant Likely spi->max_speed_hz, 1978ca632f55SGrant Likely &clk_freq); 1979ca632f55SGrant Likely if (status < 0) 1980ca632f55SGrant Likely goto err_config_params; 1981ca632f55SGrant Likely } else { 1982ca632f55SGrant Likely memcpy(&clk_freq, &chip_info->clk_freq, sizeof(clk_freq)); 1983ca632f55SGrant Likely if ((clk_freq.cpsdvsr % 2) != 0) 1984ca632f55SGrant Likely clk_freq.cpsdvsr = 1985ca632f55SGrant Likely clk_freq.cpsdvsr - 1; 1986ca632f55SGrant Likely } 1987ca632f55SGrant Likely if ((clk_freq.cpsdvsr < CPSDVR_MIN) 1988ca632f55SGrant Likely || (clk_freq.cpsdvsr > CPSDVR_MAX)) { 1989f8db4cc4SGrant Likely status = -EINVAL; 1990ca632f55SGrant Likely dev_err(&spi->dev, 1991ca632f55SGrant Likely "cpsdvsr is configured incorrectly\n"); 1992ca632f55SGrant Likely goto err_config_params; 1993ca632f55SGrant Likely } 1994ca632f55SGrant Likely 1995ca632f55SGrant Likely status = verify_controller_parameters(pl022, chip_info); 1996ca632f55SGrant Likely if (status) { 1997ca632f55SGrant Likely dev_err(&spi->dev, "controller data is incorrect"); 1998ca632f55SGrant Likely goto err_config_params; 1999ca632f55SGrant Likely } 2000ca632f55SGrant Likely 2001083be3f0SLinus Walleij pl022->rx_lev_trig = chip_info->rx_lev_trig; 2002083be3f0SLinus Walleij pl022->tx_lev_trig = chip_info->tx_lev_trig; 2003083be3f0SLinus Walleij 2004ca632f55SGrant Likely /* Now set controller state based on controller data */ 2005ca632f55SGrant Likely chip->xfer_type = chip_info->com_mode; 2006ca632f55SGrant Likely if (!chip_info->cs_control) { 2007ca632f55SGrant Likely chip->cs_control = null_cs_control; 2008ca632f55SGrant Likely dev_warn(&spi->dev, 2009ca632f55SGrant Likely "chip select function is NULL for this chip\n"); 2010ca632f55SGrant Likely } else 2011ca632f55SGrant Likely chip->cs_control = chip_info->cs_control; 2012ca632f55SGrant Likely 2013ca632f55SGrant Likely if (bits <= 3) { 2014ca632f55SGrant Likely /* PL022 doesn't support less than 4-bits */ 2015ca632f55SGrant Likely status = -ENOTSUPP; 2016ca632f55SGrant Likely goto err_config_params; 2017ca632f55SGrant Likely } else if (bits <= 8) { 2018ca632f55SGrant Likely dev_dbg(&spi->dev, "4 <= n <=8 bits per word\n"); 2019ca632f55SGrant Likely chip->n_bytes = 1; 2020ca632f55SGrant Likely chip->read = READING_U8; 2021ca632f55SGrant Likely chip->write = WRITING_U8; 2022ca632f55SGrant Likely } else if (bits <= 16) { 2023ca632f55SGrant Likely dev_dbg(&spi->dev, "9 <= n <= 16 bits per word\n"); 2024ca632f55SGrant Likely chip->n_bytes = 2; 2025ca632f55SGrant Likely chip->read = READING_U16; 2026ca632f55SGrant Likely chip->write = WRITING_U16; 2027ca632f55SGrant Likely } else { 2028ca632f55SGrant Likely if (pl022->vendor->max_bpw >= 32) { 2029ca632f55SGrant Likely dev_dbg(&spi->dev, "17 <= n <= 32 bits per word\n"); 2030ca632f55SGrant Likely chip->n_bytes = 4; 2031ca632f55SGrant Likely chip->read = READING_U32; 2032ca632f55SGrant Likely chip->write = WRITING_U32; 2033ca632f55SGrant Likely } else { 2034ca632f55SGrant Likely dev_err(&spi->dev, 2035ca632f55SGrant Likely "illegal data size for this controller!\n"); 2036ca632f55SGrant Likely dev_err(&spi->dev, 2037ca632f55SGrant Likely "a standard pl022 can only handle " 2038ca632f55SGrant Likely "1 <= n <= 16 bit words\n"); 2039ca632f55SGrant Likely status = -ENOTSUPP; 2040ca632f55SGrant Likely goto err_config_params; 2041ca632f55SGrant Likely } 2042ca632f55SGrant Likely } 2043ca632f55SGrant Likely 2044ca632f55SGrant Likely /* Now Initialize all register settings required for this chip */ 2045ca632f55SGrant Likely chip->cr0 = 0; 2046ca632f55SGrant Likely chip->cr1 = 0; 2047ca632f55SGrant Likely chip->dmacr = 0; 2048ca632f55SGrant Likely chip->cpsr = 0; 2049ca632f55SGrant Likely if ((chip_info->com_mode == DMA_TRANSFER) 2050ca632f55SGrant Likely && ((pl022->master_info)->enable_dma)) { 2051ca632f55SGrant Likely chip->enable_dma = true; 2052ca632f55SGrant Likely dev_dbg(&spi->dev, "DMA mode set in controller state\n"); 2053ca632f55SGrant Likely SSP_WRITE_BITS(chip->dmacr, SSP_DMA_ENABLED, 2054ca632f55SGrant Likely SSP_DMACR_MASK_RXDMAE, 0); 2055ca632f55SGrant Likely SSP_WRITE_BITS(chip->dmacr, SSP_DMA_ENABLED, 2056ca632f55SGrant Likely SSP_DMACR_MASK_TXDMAE, 1); 2057ca632f55SGrant Likely } else { 2058ca632f55SGrant Likely chip->enable_dma = false; 2059ca632f55SGrant Likely dev_dbg(&spi->dev, "DMA mode NOT set in controller state\n"); 2060ca632f55SGrant Likely SSP_WRITE_BITS(chip->dmacr, SSP_DMA_DISABLED, 2061ca632f55SGrant Likely SSP_DMACR_MASK_RXDMAE, 0); 2062ca632f55SGrant Likely SSP_WRITE_BITS(chip->dmacr, SSP_DMA_DISABLED, 2063ca632f55SGrant Likely SSP_DMACR_MASK_TXDMAE, 1); 2064ca632f55SGrant Likely } 2065ca632f55SGrant Likely 2066ca632f55SGrant Likely chip->cpsr = clk_freq.cpsdvsr; 2067ca632f55SGrant Likely 2068ca632f55SGrant Likely /* Special setup for the ST micro extended control registers */ 2069ca632f55SGrant Likely if (pl022->vendor->extended_cr) { 2070ca632f55SGrant Likely u32 etx; 2071ca632f55SGrant Likely 2072ca632f55SGrant Likely if (pl022->vendor->pl023) { 2073ca632f55SGrant Likely /* These bits are only in the PL023 */ 2074ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, chip_info->clkdelay, 2075ca632f55SGrant Likely SSP_CR1_MASK_FBCLKDEL_ST, 13); 2076ca632f55SGrant Likely } else { 2077ca632f55SGrant Likely /* These bits are in the PL022 but not PL023 */ 2078ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, chip_info->duplex, 2079ca632f55SGrant Likely SSP_CR0_MASK_HALFDUP_ST, 5); 2080ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, chip_info->ctrl_len, 2081ca632f55SGrant Likely SSP_CR0_MASK_CSS_ST, 16); 2082ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, chip_info->iface, 2083ca632f55SGrant Likely SSP_CR0_MASK_FRF_ST, 21); 2084ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, chip_info->wait_state, 2085ca632f55SGrant Likely SSP_CR1_MASK_MWAIT_ST, 6); 2086ca632f55SGrant Likely } 2087ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, bits - 1, 2088ca632f55SGrant Likely SSP_CR0_MASK_DSS_ST, 0); 2089ca632f55SGrant Likely 2090ca632f55SGrant Likely if (spi->mode & SPI_LSB_FIRST) { 2091ca632f55SGrant Likely tmp = SSP_RX_LSB; 2092ca632f55SGrant Likely etx = SSP_TX_LSB; 2093ca632f55SGrant Likely } else { 2094ca632f55SGrant Likely tmp = SSP_RX_MSB; 2095ca632f55SGrant Likely etx = SSP_TX_MSB; 2096ca632f55SGrant Likely } 2097ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, tmp, SSP_CR1_MASK_RENDN_ST, 4); 2098ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, etx, SSP_CR1_MASK_TENDN_ST, 5); 2099ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, chip_info->rx_lev_trig, 2100ca632f55SGrant Likely SSP_CR1_MASK_RXIFLSEL_ST, 7); 2101ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, chip_info->tx_lev_trig, 2102ca632f55SGrant Likely SSP_CR1_MASK_TXIFLSEL_ST, 10); 2103ca632f55SGrant Likely } else { 2104ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, bits - 1, 2105ca632f55SGrant Likely SSP_CR0_MASK_DSS, 0); 2106ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, chip_info->iface, 2107ca632f55SGrant Likely SSP_CR0_MASK_FRF, 4); 2108ca632f55SGrant Likely } 2109ca632f55SGrant Likely 2110ca632f55SGrant Likely /* Stuff that is common for all versions */ 2111ca632f55SGrant Likely if (spi->mode & SPI_CPOL) 2112ca632f55SGrant Likely tmp = SSP_CLK_POL_IDLE_HIGH; 2113ca632f55SGrant Likely else 2114ca632f55SGrant Likely tmp = SSP_CLK_POL_IDLE_LOW; 2115ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, tmp, SSP_CR0_MASK_SPO, 6); 2116ca632f55SGrant Likely 2117ca632f55SGrant Likely if (spi->mode & SPI_CPHA) 2118ca632f55SGrant Likely tmp = SSP_CLK_SECOND_EDGE; 2119ca632f55SGrant Likely else 2120ca632f55SGrant Likely tmp = SSP_CLK_FIRST_EDGE; 2121ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, tmp, SSP_CR0_MASK_SPH, 7); 2122ca632f55SGrant Likely 2123ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr0, clk_freq.scr, SSP_CR0_MASK_SCR, 8); 2124ca632f55SGrant Likely /* Loopback is available on all versions except PL023 */ 2125ca632f55SGrant Likely if (pl022->vendor->loopback) { 2126ca632f55SGrant Likely if (spi->mode & SPI_LOOP) 2127ca632f55SGrant Likely tmp = LOOPBACK_ENABLED; 2128ca632f55SGrant Likely else 2129ca632f55SGrant Likely tmp = LOOPBACK_DISABLED; 2130ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, tmp, SSP_CR1_MASK_LBM, 0); 2131ca632f55SGrant Likely } 2132ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, SSP_DISABLED, SSP_CR1_MASK_SSE, 1); 2133ca632f55SGrant Likely SSP_WRITE_BITS(chip->cr1, chip_info->hierarchy, SSP_CR1_MASK_MS, 2); 2134f1e45f86SViresh Kumar SSP_WRITE_BITS(chip->cr1, chip_info->slave_tx_disable, SSP_CR1_MASK_SOD, 2135f1e45f86SViresh Kumar 3); 2136ca632f55SGrant Likely 2137ca632f55SGrant Likely /* Save controller_state */ 2138ca632f55SGrant Likely spi_set_ctldata(spi, chip); 2139ca632f55SGrant Likely return status; 2140ca632f55SGrant Likely err_config_params: 2141ca632f55SGrant Likely spi_set_ctldata(spi, NULL); 2142ca632f55SGrant Likely kfree(chip); 2143ca632f55SGrant Likely return status; 2144ca632f55SGrant Likely } 2145ca632f55SGrant Likely 2146ca632f55SGrant Likely /** 2147ca632f55SGrant Likely * pl022_cleanup - cleanup function registered to SPI master framework 2148ca632f55SGrant Likely * @spi: spi device which is requesting cleanup 2149ca632f55SGrant Likely * 2150ca632f55SGrant Likely * This function is registered to the SPI framework for this SPI master 2151ca632f55SGrant Likely * controller. It will free the runtime state of chip. 2152ca632f55SGrant Likely */ 2153ca632f55SGrant Likely static void pl022_cleanup(struct spi_device *spi) 2154ca632f55SGrant Likely { 2155ca632f55SGrant Likely struct chip_data *chip = spi_get_ctldata(spi); 2156ca632f55SGrant Likely 2157ca632f55SGrant Likely spi_set_ctldata(spi, NULL); 2158ca632f55SGrant Likely kfree(chip); 2159ca632f55SGrant Likely } 2160ca632f55SGrant Likely 2161ca632f55SGrant Likely static int __devinit 2162ca632f55SGrant Likely pl022_probe(struct amba_device *adev, const struct amba_id *id) 2163ca632f55SGrant Likely { 2164ca632f55SGrant Likely struct device *dev = &adev->dev; 2165ca632f55SGrant Likely struct pl022_ssp_controller *platform_info = adev->dev.platform_data; 2166ca632f55SGrant Likely struct spi_master *master; 2167ca632f55SGrant Likely struct pl022 *pl022 = NULL; /*Data for this driver */ 2168ca632f55SGrant Likely int status = 0; 2169ca632f55SGrant Likely 2170ca632f55SGrant Likely dev_info(&adev->dev, 2171ca632f55SGrant Likely "ARM PL022 driver, device ID: 0x%08x\n", adev->periphid); 2172ca632f55SGrant Likely if (platform_info == NULL) { 2173ca632f55SGrant Likely dev_err(&adev->dev, "probe - no platform data supplied\n"); 2174ca632f55SGrant Likely status = -ENODEV; 2175ca632f55SGrant Likely goto err_no_pdata; 2176ca632f55SGrant Likely } 2177ca632f55SGrant Likely 2178ca632f55SGrant Likely /* Allocate master with space for data */ 2179ca632f55SGrant Likely master = spi_alloc_master(dev, sizeof(struct pl022)); 2180ca632f55SGrant Likely if (master == NULL) { 2181ca632f55SGrant Likely dev_err(&adev->dev, "probe - cannot alloc SPI master\n"); 2182ca632f55SGrant Likely status = -ENOMEM; 2183ca632f55SGrant Likely goto err_no_master; 2184ca632f55SGrant Likely } 2185ca632f55SGrant Likely 2186ca632f55SGrant Likely pl022 = spi_master_get_devdata(master); 2187ca632f55SGrant Likely pl022->master = master; 2188ca632f55SGrant Likely pl022->master_info = platform_info; 2189ca632f55SGrant Likely pl022->adev = adev; 2190ca632f55SGrant Likely pl022->vendor = id->data; 2191ca632f55SGrant Likely 2192ca632f55SGrant Likely /* 2193ca632f55SGrant Likely * Bus Number Which has been Assigned to this SSP controller 2194ca632f55SGrant Likely * on this board 2195ca632f55SGrant Likely */ 2196ca632f55SGrant Likely master->bus_num = platform_info->bus_id; 2197ca632f55SGrant Likely master->num_chipselect = platform_info->num_chipselect; 2198ca632f55SGrant Likely master->cleanup = pl022_cleanup; 2199ca632f55SGrant Likely master->setup = pl022_setup; 2200ca632f55SGrant Likely master->transfer = pl022_transfer; 2201ca632f55SGrant Likely 2202ca632f55SGrant Likely /* 2203ca632f55SGrant Likely * Supports mode 0-3, loopback, and active low CS. Transfers are 2204ca632f55SGrant Likely * always MS bit first on the original pl022. 2205ca632f55SGrant Likely */ 2206ca632f55SGrant Likely master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | SPI_LOOP; 2207ca632f55SGrant Likely if (pl022->vendor->extended_cr) 2208ca632f55SGrant Likely master->mode_bits |= SPI_LSB_FIRST; 2209ca632f55SGrant Likely 2210ca632f55SGrant Likely dev_dbg(&adev->dev, "BUSNO: %d\n", master->bus_num); 2211ca632f55SGrant Likely 2212ca632f55SGrant Likely status = amba_request_regions(adev, NULL); 2213ca632f55SGrant Likely if (status) 2214ca632f55SGrant Likely goto err_no_ioregion; 2215ca632f55SGrant Likely 2216ca632f55SGrant Likely pl022->phybase = adev->res.start; 2217ca632f55SGrant Likely pl022->virtbase = ioremap(adev->res.start, resource_size(&adev->res)); 2218ca632f55SGrant Likely if (pl022->virtbase == NULL) { 2219ca632f55SGrant Likely status = -ENOMEM; 2220ca632f55SGrant Likely goto err_no_ioremap; 2221ca632f55SGrant Likely } 2222ca632f55SGrant Likely printk(KERN_INFO "pl022: mapped registers from 0x%08x to %p\n", 2223ca632f55SGrant Likely adev->res.start, pl022->virtbase); 2224ca632f55SGrant Likely 2225ca632f55SGrant Likely pl022->clk = clk_get(&adev->dev, NULL); 2226ca632f55SGrant Likely if (IS_ERR(pl022->clk)) { 2227ca632f55SGrant Likely status = PTR_ERR(pl022->clk); 2228ca632f55SGrant Likely dev_err(&adev->dev, "could not retrieve SSP/SPI bus clock\n"); 2229ca632f55SGrant Likely goto err_no_clk; 2230ca632f55SGrant Likely } 22317ff6bcf0SRussell King 22327ff6bcf0SRussell King status = clk_prepare(pl022->clk); 22337ff6bcf0SRussell King if (status) { 22347ff6bcf0SRussell King dev_err(&adev->dev, "could not prepare SSP/SPI bus clock\n"); 22357ff6bcf0SRussell King goto err_clk_prep; 22367ff6bcf0SRussell King } 22377ff6bcf0SRussell King 223871e63e74SUlf Hansson status = clk_enable(pl022->clk); 223971e63e74SUlf Hansson if (status) { 224071e63e74SUlf Hansson dev_err(&adev->dev, "could not enable SSP/SPI bus clock\n"); 224171e63e74SUlf Hansson goto err_no_clk_en; 224271e63e74SUlf Hansson } 224371e63e74SUlf Hansson 2244ca632f55SGrant Likely /* Disable SSP */ 2245ca632f55SGrant Likely writew((readw(SSP_CR1(pl022->virtbase)) & (~SSP_CR1_MASK_SSE)), 2246ca632f55SGrant Likely SSP_CR1(pl022->virtbase)); 2247ca632f55SGrant Likely load_ssp_default_config(pl022); 2248ca632f55SGrant Likely 2249ca632f55SGrant Likely status = request_irq(adev->irq[0], pl022_interrupt_handler, 0, "pl022", 2250ca632f55SGrant Likely pl022); 2251ca632f55SGrant Likely if (status < 0) { 2252ca632f55SGrant Likely dev_err(&adev->dev, "probe - cannot get IRQ (%d)\n", status); 2253ca632f55SGrant Likely goto err_no_irq; 2254ca632f55SGrant Likely } 2255ca632f55SGrant Likely 2256ca632f55SGrant Likely /* Get DMA channels */ 2257ca632f55SGrant Likely if (platform_info->enable_dma) { 2258ca632f55SGrant Likely status = pl022_dma_probe(pl022); 2259ca632f55SGrant Likely if (status != 0) 2260ca632f55SGrant Likely platform_info->enable_dma = 0; 2261ca632f55SGrant Likely } 2262ca632f55SGrant Likely 2263ca632f55SGrant Likely /* Initialize and start queue */ 2264ca632f55SGrant Likely status = init_queue(pl022); 2265ca632f55SGrant Likely if (status != 0) { 2266ca632f55SGrant Likely dev_err(&adev->dev, "probe - problem initializing queue\n"); 2267ca632f55SGrant Likely goto err_init_queue; 2268ca632f55SGrant Likely } 2269ca632f55SGrant Likely status = start_queue(pl022); 2270ca632f55SGrant Likely if (status != 0) { 2271ca632f55SGrant Likely dev_err(&adev->dev, "probe - problem starting queue\n"); 2272ca632f55SGrant Likely goto err_start_queue; 2273ca632f55SGrant Likely } 2274ca632f55SGrant Likely /* Register with the SPI framework */ 2275ca632f55SGrant Likely amba_set_drvdata(adev, pl022); 2276ca632f55SGrant Likely status = spi_register_master(master); 2277ca632f55SGrant Likely if (status != 0) { 2278ca632f55SGrant Likely dev_err(&adev->dev, 2279ca632f55SGrant Likely "probe - problem registering spi master\n"); 2280ca632f55SGrant Likely goto err_spi_register; 2281ca632f55SGrant Likely } 2282ca632f55SGrant Likely dev_dbg(dev, "probe succeeded\n"); 228392b97f0aSRussell King 228492b97f0aSRussell King /* let runtime pm put suspend */ 228553e4aceaSChris Blair if (platform_info->autosuspend_delay > 0) { 228653e4aceaSChris Blair dev_info(&adev->dev, 228753e4aceaSChris Blair "will use autosuspend for runtime pm, delay %dms\n", 228853e4aceaSChris Blair platform_info->autosuspend_delay); 228953e4aceaSChris Blair pm_runtime_set_autosuspend_delay(dev, 229053e4aceaSChris Blair platform_info->autosuspend_delay); 229153e4aceaSChris Blair pm_runtime_use_autosuspend(dev); 229253e4aceaSChris Blair pm_runtime_put_autosuspend(dev); 229353e4aceaSChris Blair } else { 229492b97f0aSRussell King pm_runtime_put(dev); 229553e4aceaSChris Blair } 2296ca632f55SGrant Likely return 0; 2297ca632f55SGrant Likely 2298ca632f55SGrant Likely err_spi_register: 2299ca632f55SGrant Likely err_start_queue: 2300ca632f55SGrant Likely err_init_queue: 2301ca632f55SGrant Likely destroy_queue(pl022); 23023e3ea716SViresh Kumar if (platform_info->enable_dma) 2303ca632f55SGrant Likely pl022_dma_remove(pl022); 23043e3ea716SViresh Kumar 2305ca632f55SGrant Likely free_irq(adev->irq[0], pl022); 2306ca632f55SGrant Likely err_no_irq: 230771e63e74SUlf Hansson clk_disable(pl022->clk); 230871e63e74SUlf Hansson err_no_clk_en: 23097ff6bcf0SRussell King clk_unprepare(pl022->clk); 23107ff6bcf0SRussell King err_clk_prep: 2311ca632f55SGrant Likely clk_put(pl022->clk); 2312ca632f55SGrant Likely err_no_clk: 2313ca632f55SGrant Likely iounmap(pl022->virtbase); 2314ca632f55SGrant Likely err_no_ioremap: 2315ca632f55SGrant Likely amba_release_regions(adev); 2316ca632f55SGrant Likely err_no_ioregion: 2317ca632f55SGrant Likely spi_master_put(master); 2318ca632f55SGrant Likely err_no_master: 2319ca632f55SGrant Likely err_no_pdata: 2320ca632f55SGrant Likely return status; 2321ca632f55SGrant Likely } 2322ca632f55SGrant Likely 2323ca632f55SGrant Likely static int __devexit 2324ca632f55SGrant Likely pl022_remove(struct amba_device *adev) 2325ca632f55SGrant Likely { 2326ca632f55SGrant Likely struct pl022 *pl022 = amba_get_drvdata(adev); 232750658b66SLinus Walleij 2328ca632f55SGrant Likely if (!pl022) 2329ca632f55SGrant Likely return 0; 2330ca632f55SGrant Likely 233192b97f0aSRussell King /* 233292b97f0aSRussell King * undo pm_runtime_put() in probe. I assume that we're not 233392b97f0aSRussell King * accessing the primecell here. 233492b97f0aSRussell King */ 233592b97f0aSRussell King pm_runtime_get_noresume(&adev->dev); 233692b97f0aSRussell King 2337ca632f55SGrant Likely /* Remove the queue */ 233850658b66SLinus Walleij if (destroy_queue(pl022) != 0) 233950658b66SLinus Walleij dev_err(&adev->dev, "queue remove failed\n"); 2340ca632f55SGrant Likely load_ssp_default_config(pl022); 23413e3ea716SViresh Kumar if (pl022->master_info->enable_dma) 2342ca632f55SGrant Likely pl022_dma_remove(pl022); 23433e3ea716SViresh Kumar 2344ca632f55SGrant Likely free_irq(adev->irq[0], pl022); 2345ca632f55SGrant Likely clk_disable(pl022->clk); 23467ff6bcf0SRussell King clk_unprepare(pl022->clk); 2347ca632f55SGrant Likely clk_put(pl022->clk); 2348ca632f55SGrant Likely iounmap(pl022->virtbase); 2349ca632f55SGrant Likely amba_release_regions(adev); 2350ca632f55SGrant Likely tasklet_disable(&pl022->pump_transfers); 2351ca632f55SGrant Likely spi_unregister_master(pl022->master); 2352ca632f55SGrant Likely spi_master_put(pl022->master); 2353ca632f55SGrant Likely amba_set_drvdata(adev, NULL); 2354ca632f55SGrant Likely return 0; 2355ca632f55SGrant Likely } 2356ca632f55SGrant Likely 235792b97f0aSRussell King #ifdef CONFIG_SUSPEND 23586cfa6279SPeter Hüwe static int pl022_suspend(struct device *dev) 2359ca632f55SGrant Likely { 236092b97f0aSRussell King struct pl022 *pl022 = dev_get_drvdata(dev); 2361ca632f55SGrant Likely int status = 0; 2362ca632f55SGrant Likely 2363ca632f55SGrant Likely status = stop_queue(pl022); 2364ca632f55SGrant Likely if (status) { 23656cfa6279SPeter Hüwe dev_warn(dev, "suspend cannot stop queue\n"); 2366ca632f55SGrant Likely return status; 2367ca632f55SGrant Likely } 2368ca632f55SGrant Likely 23696cfa6279SPeter Hüwe dev_dbg(dev, "suspended\n"); 2370ca632f55SGrant Likely return 0; 2371ca632f55SGrant Likely } 2372ca632f55SGrant Likely 237392b97f0aSRussell King static int pl022_resume(struct device *dev) 2374ca632f55SGrant Likely { 237592b97f0aSRussell King struct pl022 *pl022 = dev_get_drvdata(dev); 2376ca632f55SGrant Likely int status = 0; 2377ca632f55SGrant Likely 2378ca632f55SGrant Likely /* Start the queue running */ 2379ca632f55SGrant Likely status = start_queue(pl022); 2380ca632f55SGrant Likely if (status) 238192b97f0aSRussell King dev_err(dev, "problem starting queue (%d)\n", status); 2382ca632f55SGrant Likely else 238392b97f0aSRussell King dev_dbg(dev, "resumed\n"); 2384ca632f55SGrant Likely 2385ca632f55SGrant Likely return status; 2386ca632f55SGrant Likely } 2387ca632f55SGrant Likely #endif /* CONFIG_PM */ 2388ca632f55SGrant Likely 238992b97f0aSRussell King #ifdef CONFIG_PM_RUNTIME 239092b97f0aSRussell King static int pl022_runtime_suspend(struct device *dev) 239192b97f0aSRussell King { 239292b97f0aSRussell King struct pl022 *pl022 = dev_get_drvdata(dev); 239392b97f0aSRussell King 239492b97f0aSRussell King clk_disable(pl022->clk); 239592b97f0aSRussell King amba_vcore_disable(pl022->adev); 239692b97f0aSRussell King 239792b97f0aSRussell King return 0; 239892b97f0aSRussell King } 239992b97f0aSRussell King 240092b97f0aSRussell King static int pl022_runtime_resume(struct device *dev) 240192b97f0aSRussell King { 240292b97f0aSRussell King struct pl022 *pl022 = dev_get_drvdata(dev); 240392b97f0aSRussell King 240492b97f0aSRussell King amba_vcore_enable(pl022->adev); 240592b97f0aSRussell King clk_enable(pl022->clk); 240692b97f0aSRussell King 240792b97f0aSRussell King return 0; 240892b97f0aSRussell King } 240992b97f0aSRussell King #endif 241092b97f0aSRussell King 241192b97f0aSRussell King static const struct dev_pm_ops pl022_dev_pm_ops = { 241292b97f0aSRussell King SET_SYSTEM_SLEEP_PM_OPS(pl022_suspend, pl022_resume) 241392b97f0aSRussell King SET_RUNTIME_PM_OPS(pl022_runtime_suspend, pl022_runtime_resume, NULL) 241492b97f0aSRussell King }; 241592b97f0aSRussell King 2416ca632f55SGrant Likely static struct vendor_data vendor_arm = { 2417ca632f55SGrant Likely .fifodepth = 8, 2418ca632f55SGrant Likely .max_bpw = 16, 2419ca632f55SGrant Likely .unidir = false, 2420ca632f55SGrant Likely .extended_cr = false, 2421ca632f55SGrant Likely .pl023 = false, 2422ca632f55SGrant Likely .loopback = true, 2423ca632f55SGrant Likely }; 2424ca632f55SGrant Likely 2425ca632f55SGrant Likely static struct vendor_data vendor_st = { 2426ca632f55SGrant Likely .fifodepth = 32, 2427ca632f55SGrant Likely .max_bpw = 32, 2428ca632f55SGrant Likely .unidir = false, 2429ca632f55SGrant Likely .extended_cr = true, 2430ca632f55SGrant Likely .pl023 = false, 2431ca632f55SGrant Likely .loopback = true, 2432ca632f55SGrant Likely }; 2433ca632f55SGrant Likely 2434ca632f55SGrant Likely static struct vendor_data vendor_st_pl023 = { 2435ca632f55SGrant Likely .fifodepth = 32, 2436ca632f55SGrant Likely .max_bpw = 32, 2437ca632f55SGrant Likely .unidir = false, 2438ca632f55SGrant Likely .extended_cr = true, 2439ca632f55SGrant Likely .pl023 = true, 2440ca632f55SGrant Likely .loopback = false, 2441ca632f55SGrant Likely }; 2442ca632f55SGrant Likely 2443ca632f55SGrant Likely static struct vendor_data vendor_db5500_pl023 = { 2444ca632f55SGrant Likely .fifodepth = 32, 2445ca632f55SGrant Likely .max_bpw = 32, 2446ca632f55SGrant Likely .unidir = false, 2447ca632f55SGrant Likely .extended_cr = true, 2448ca632f55SGrant Likely .pl023 = true, 2449ca632f55SGrant Likely .loopback = true, 2450ca632f55SGrant Likely }; 2451ca632f55SGrant Likely 2452ca632f55SGrant Likely static struct amba_id pl022_ids[] = { 2453ca632f55SGrant Likely { 2454ca632f55SGrant Likely /* 2455ca632f55SGrant Likely * ARM PL022 variant, this has a 16bit wide 2456ca632f55SGrant Likely * and 8 locations deep TX/RX FIFO 2457ca632f55SGrant Likely */ 2458ca632f55SGrant Likely .id = 0x00041022, 2459ca632f55SGrant Likely .mask = 0x000fffff, 2460ca632f55SGrant Likely .data = &vendor_arm, 2461ca632f55SGrant Likely }, 2462ca632f55SGrant Likely { 2463ca632f55SGrant Likely /* 2464ca632f55SGrant Likely * ST Micro derivative, this has 32bit wide 2465ca632f55SGrant Likely * and 32 locations deep TX/RX FIFO 2466ca632f55SGrant Likely */ 2467ca632f55SGrant Likely .id = 0x01080022, 2468ca632f55SGrant Likely .mask = 0xffffffff, 2469ca632f55SGrant Likely .data = &vendor_st, 2470ca632f55SGrant Likely }, 2471ca632f55SGrant Likely { 2472ca632f55SGrant Likely /* 2473ca632f55SGrant Likely * ST-Ericsson derivative "PL023" (this is not 2474ca632f55SGrant Likely * an official ARM number), this is a PL022 SSP block 2475ca632f55SGrant Likely * stripped to SPI mode only, it has 32bit wide 2476ca632f55SGrant Likely * and 32 locations deep TX/RX FIFO but no extended 2477ca632f55SGrant Likely * CR0/CR1 register 2478ca632f55SGrant Likely */ 2479ca632f55SGrant Likely .id = 0x00080023, 2480ca632f55SGrant Likely .mask = 0xffffffff, 2481ca632f55SGrant Likely .data = &vendor_st_pl023, 2482ca632f55SGrant Likely }, 2483ca632f55SGrant Likely { 2484ca632f55SGrant Likely .id = 0x10080023, 2485ca632f55SGrant Likely .mask = 0xffffffff, 2486ca632f55SGrant Likely .data = &vendor_db5500_pl023, 2487ca632f55SGrant Likely }, 2488ca632f55SGrant Likely { 0, 0 }, 2489ca632f55SGrant Likely }; 2490ca632f55SGrant Likely 24917eeac71bSDave Martin MODULE_DEVICE_TABLE(amba, pl022_ids); 24927eeac71bSDave Martin 2493ca632f55SGrant Likely static struct amba_driver pl022_driver = { 2494ca632f55SGrant Likely .drv = { 2495ca632f55SGrant Likely .name = "ssp-pl022", 249692b97f0aSRussell King .pm = &pl022_dev_pm_ops, 2497ca632f55SGrant Likely }, 2498ca632f55SGrant Likely .id_table = pl022_ids, 2499ca632f55SGrant Likely .probe = pl022_probe, 2500ca632f55SGrant Likely .remove = __devexit_p(pl022_remove), 2501ca632f55SGrant Likely }; 2502ca632f55SGrant Likely 2503ca632f55SGrant Likely static int __init pl022_init(void) 2504ca632f55SGrant Likely { 2505ca632f55SGrant Likely return amba_driver_register(&pl022_driver); 2506ca632f55SGrant Likely } 2507ca632f55SGrant Likely subsys_initcall(pl022_init); 2508ca632f55SGrant Likely 2509ca632f55SGrant Likely static void __exit pl022_exit(void) 2510ca632f55SGrant Likely { 2511ca632f55SGrant Likely amba_driver_unregister(&pl022_driver); 2512ca632f55SGrant Likely } 2513ca632f55SGrant Likely module_exit(pl022_exit); 2514ca632f55SGrant Likely 2515ca632f55SGrant Likely MODULE_AUTHOR("Linus Walleij <linus.walleij@stericsson.com>"); 2516ca632f55SGrant Likely MODULE_DESCRIPTION("PL022 SSP Controller Driver"); 2517ca632f55SGrant Likely MODULE_LICENSE("GPL"); 2518