/* * spi-rt2880.c -- Ralink RT288x/RT305x SPI controller driver * * Copyright (C) 2011 Sergiy * Copyright (C) 2011-2013 Gabor Juhos * * Some parts are based on spi-orion.c: * Author: Shadi Ammouri * Copyright (C) 2007-2008 Marvell Ltd. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ #include #include #include #include #include #include #include #include #include #include #include #define SPI_BPW_MASK(bits) BIT((bits) - 1) #define DRIVER_NAME "spi-rt2880" /* in usec */ #define RALINK_SPI_WAIT_MAX_LOOP 2000 #define RAMIPS_SPI_DEV_OFFSET 0x40 #define RAMIPS_SPI_STAT(cs) (0x00 + (cs * RAMIPS_SPI_DEV_OFFSET)) #define RAMIPS_SPI_CFG(cs) (0x10 + (cs * RAMIPS_SPI_DEV_OFFSET)) #define RAMIPS_SPI_CTL(cs) (0x14 + (cs * RAMIPS_SPI_DEV_OFFSET)) #define RAMIPS_SPI_DATA(cs) (0x20 + (cs * RAMIPS_SPI_DEV_OFFSET)) #define RAMIPS_SPI_FIFO_STAT(cs) (0x38 + (cs * RAMIPS_SPI_DEV_OFFSET)) #define RAMIPS_SPI_ARBITER 0xF0 /* SPISTAT register bit field */ #define SPISTAT_BUSY BIT(0) /* SPICFG register bit field */ #define SPICFG_LSBFIRST 0 #define SPICFG_MSBFIRST BIT(8) #define SPICFG_SPICLKPOL BIT(6) #define SPICFG_RXCLKEDGE_FALLING BIT(5) #define SPICFG_TXCLKEDGE_FALLING BIT(4) #define SPICFG_SPICLK_PRESCALE_MASK 0x7 #define SPICFG_SPICLK_DIV2 0 #define SPICFG_SPICLK_DIV4 1 #define SPICFG_SPICLK_DIV8 2 #define SPICFG_SPICLK_DIV16 3 #define SPICFG_SPICLK_DIV32 4 #define SPICFG_SPICLK_DIV64 5 #define SPICFG_SPICLK_DIV128 6 #define SPICFG_SPICLK_DISABLE 7 /* SPICTL register bit field */ #define SPICTL_HIZSDO BIT(3) #define SPICTL_STARTWR BIT(2) #define SPICTL_STARTRD BIT(1) #define SPICTL_SPIENA BIT(0) /* SPIFIFOSTAT register bit field */ #define SPIFIFOSTAT_TXFULL BIT(17) #define SPICTL_ARB_EN BIT(31) #define SPI1_POR BIT(1) #define SPI0_POR BIT(0) #define MT7621_SPI_TRANS 0x00 #define SPITRANS_BUSY BIT(16) #define MT7621_SPI_OPCODE 0x04 #define MT7621_SPI_DATA0 0x08 #define SPI_CTL_TX_RX_CNT_MASK 0xff #define SPI_CTL_START BIT(8) #define MT7621_SPI_POLAR 0x38 #define MT7621_SPI_MASTER 0x28 #define MT7621_SPI_SPACE 0x3c #define RT2880_SPI_MODE_BITS (SPI_CPOL | SPI_CPHA | SPI_LSB_FIRST | SPI_CS_HIGH) struct rt2880_spi; struct rt2880_spi_ops { void (*init_hw)(struct rt2880_spi *rs); void (*set_cs)(struct spi_device *spi, int enable); int (*baudrate_set)(struct spi_device *spi, unsigned int speed); unsigned int (*write_read)(struct spi_device *spi, struct list_head *list, struct spi_transfer *xfer); int num_cs; }; struct rt2880_spi { struct spi_master *master; void __iomem *base; unsigned int sys_freq; unsigned int speed; struct clk *clk; spinlock_t lock; bool debug; int delay; struct rt2880_spi_ops *ops; }; static inline struct rt2880_spi *spidev_to_rt2880_spi(struct spi_device *spi) { return spi_master_get_devdata(spi->master); } static inline u32 rt2880_spi_read(struct rt2880_spi *rs, u32 reg) { return ioread32(rs->base + reg); } static inline void rt2880_spi_write(struct rt2880_spi *rs, u32 reg, u32 val) { iowrite32(val, rs->base + reg); } static u32 rt5350_dirty_read32(struct rt2880_spi *rs, u32 reg) { /* spi register offset is 0x0b00, so rs->base - 0x0b00 is real base */ return ioread32(rs->base - 0x0b00 + reg); } static void rt5350_dirty_write32(struct rt2880_spi *rs, u32 reg, u32 val) { iowrite32(val, rs->base - 0x0b00 + reg); } static inline void rt5350_spi_gpio_mode(struct rt2880_spi *rs, int enable) { /* pin mux spi/spics1 gpio control offset is 0x0060 */ u32 val = rt5350_dirty_read32(rs, 0x0060); if(enable) { val |= 0x00000002; } else { val &= ~0x00000002; } /* 21, 22bits are used to control spics1, 10: gpio, 00: spi cs1 */ if (enable) { val |= 0x00400000; } else { val &= ~0x00400000; } rt5350_dirty_write32(rs, 0x0060, val); /* set gpio direction, mosi, miso, clock, cs0 */ val = rt5350_dirty_read32(rs, 0x0624); val |= 0x00000038; val &= ~0x00000040; rt5350_dirty_write32(rs, 0x0624, val); /* set gpio direction, cs1 */ val = rt5350_dirty_read32(rs, 0x0674); val |= 0x00000020; rt5350_dirty_write32(rs, 0x0674, val); } static inline void setsck(struct spi_device *spi, int is_on) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); u32 val = rt5350_dirty_read32(rs, 0x0620); if(is_on) { val |= 0x00000010; } else { val &= ~0x00000010; } rt5350_dirty_write32(rs, 0x0620, val); } static inline void setmosi(struct spi_device *spi, int is_on) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); u32 val = rt5350_dirty_read32(rs, 0x0620); if(is_on) { val |= 0x00000020; } else { val &= ~0x00000020; } rt5350_dirty_write32(rs, 0x0620, val); } static inline int getmiso(struct spi_device *spi) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); u32 val = rt5350_dirty_read32(rs, 0x0620); return !!(val & 0x00000040); } static inline void spidelay(unsigned nsecs) { if (unlikely(nsecs)) ndelay(nsecs); } static inline void rt5350_set_gpio_chipselect(struct spi_device *spi, int is_active) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); int cs = spi->chip_select; if (is_active) setsck(spi, spi->mode & SPI_CPOL); if(rs->debug) dev_warn(&spi->dev, "cs = %d, %s", cs, is_active ? "on" : "off"); if(cs) { u32 val = rt5350_dirty_read32(rs, 0x0670); /* gpio 27: bit 5 */ int state = ((spi->mode & SPI_CS_HIGH) ? is_active : !is_active); if(state) val |= 0x00000020; else val &= ~0x00000020; rt5350_dirty_write32(rs, 0x0670, val); } else { u32 val = rt5350_dirty_read32(rs, 0x0620); /* gpio 3: bit 3 */ int state = ((spi->mode & SPI_CS_HIGH) ? is_active : !is_active); if(state) val |= 0x00000008; else val &= ~0x00000008; rt5350_dirty_write32(rs, 0x0620, val); } } static int rt5350_spi_gpio_baudrate_set(struct spi_device *spi, unsigned int speed) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); if (!speed) speed = spi->max_speed_hz; if (speed) { rs->delay = (1000000000/2) / speed; if (rs->delay > (MAX_UDELAY_MS * 1000 * 1000)) return -EINVAL; } if(rs->debug) dev_warn(&spi->dev, "delay = %d", rs->delay); return 0; } #include "spi-bitbang-txrx.h" static unsigned int rt5350_spi_gpio_write_read(struct spi_device *spi, struct list_head *list, struct spi_transfer *t) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); unsigned count = 0; u8 *rx = t->rx_buf; const u8 *tx = t->tx_buf; while(likely(count < t->len)) { u8 word = 0; if (tx) word = *tx++; word = bitbang_txrx_be_cpha0(spi, rs->delay, 0, 0, word, t->bits_per_word); if (rx) *rx++ = word; count++; } if(rs->debug) dev_warn(&spi->dev, "tx/rx: %d,%d", t->bits_per_word, count); return count; } static inline void rt2880_spi_setbits(struct rt2880_spi *rs, u32 reg, u32 mask) { void __iomem *addr = rs->base + reg; unsigned long flags; u32 val; spin_lock_irqsave(&rs->lock, flags); val = ioread32(addr); val |= mask; iowrite32(val, addr); spin_unlock_irqrestore(&rs->lock, flags); } static inline void rt2880_spi_clrbits(struct rt2880_spi *rs, u32 reg, u32 mask) { void __iomem *addr = rs->base + reg; unsigned long flags; u32 val; spin_lock_irqsave(&rs->lock, flags); val = ioread32(addr); val &= ~mask; iowrite32(val, addr); spin_unlock_irqrestore(&rs->lock, flags); } static int rt2880_spi_baudrate_set(struct spi_device *spi, unsigned int speed) { int cs = spi->chip_select; struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); u32 rate; u32 prescale; u32 reg; dev_dbg(&spi->dev, "speed:%u\n", speed); /* * the supported rates are: 2, 4, 8, ... 128 * round up as we look for equal or less speed */ rate = DIV_ROUND_UP(rs->sys_freq, speed); dev_dbg(&spi->dev, "rate-1:%u\n", rate); rate = roundup_pow_of_two(rate); dev_dbg(&spi->dev, "rate-2:%u\n", rate); /* check if requested speed is too small */ if (rate > 128) return -EINVAL; if (rate < 2) rate = 2; /* Convert the rate to SPI clock divisor value. */ prescale = ilog2(rate / 2); dev_dbg(&spi->dev, "prescale:%u\n", prescale); reg = rt2880_spi_read(rs, RAMIPS_SPI_CFG(cs)); reg = ((reg & ~SPICFG_SPICLK_PRESCALE_MASK) | prescale); rt2880_spi_write(rs, RAMIPS_SPI_CFG(cs), reg); rs->speed = speed; return 0; } static int mt7621_spi_baudrate_set(struct spi_device *spi, unsigned int speed) { /* u32 master = rt2880_spi_read(rs, MT7621_SPI_MASTER); // set default clock to hclk/5 master &= ~(0xfff << 16); master |= 0x3 << 16; */ return 0; } static void rt2880_spi_set_cs(struct spi_device *spi, int enable) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); int cs = spi->chip_select; if (enable) rt2880_spi_clrbits(rs, RAMIPS_SPI_CTL(cs), SPICTL_SPIENA); else rt2880_spi_setbits(rs, RAMIPS_SPI_CTL(cs), SPICTL_SPIENA); } static inline int rt2880_spi_wait_till_ready(struct spi_device *spi) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); int cs = spi->chip_select; int i; for (i = 0; i < RALINK_SPI_WAIT_MAX_LOOP; i++) { u32 status; status = rt2880_spi_read(rs, RAMIPS_SPI_STAT(cs)); if ((status & SPISTAT_BUSY) == 0) return 0; cpu_relax(); udelay(1); } return -ETIMEDOUT; } static unsigned int rt2880_spi_write_read(struct spi_device *spi, struct list_head *list, struct spi_transfer *xfer) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); int cs = spi->chip_select; unsigned count = 0; u8 *rx = xfer->rx_buf; const u8 *tx = xfer->tx_buf; int err; dev_dbg(&spi->dev, "read (%d): %s %s\n", xfer->len, (tx != NULL) ? "tx" : " ", (rx != NULL) ? "rx" : " "); if (tx) { for (count = 0; count < xfer->len; count++) { rt2880_spi_write(rs, RAMIPS_SPI_DATA(cs), tx[count]); rt2880_spi_setbits(rs, RAMIPS_SPI_CTL(cs), SPICTL_STARTWR); err = rt2880_spi_wait_till_ready(spi); if (err) { dev_err(&spi->dev, "TX failed, err=%d\n", err); goto out; } } } if (rx) { for (count = 0; count < xfer->len; count++) { rt2880_spi_setbits(rs, RAMIPS_SPI_CTL(cs), SPICTL_STARTRD); err = rt2880_spi_wait_till_ready(spi); if (err) { dev_err(&spi->dev, "RX failed, err=%d\n", err); goto out; } rx[count] = (u8) rt2880_spi_read(rs, RAMIPS_SPI_DATA(cs)); } } out: return count; } /* * called only when no transfer is active on the bus */ static int rt2880_spi_setup_transfer(struct spi_device *spi, struct spi_transfer *t) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); unsigned int speed = spi->max_speed_hz; int rc, cs = spi->chip_select; u32 reg; if ((t != NULL) && t->speed_hz) speed = t->speed_hz; /* speed < 937.5KHz, change to gpio mode */ if(speed < 937500) { rt5350_spi_gpio_mode(rs, 1); rs->ops->baudrate_set = rt5350_spi_gpio_baudrate_set; rs->ops->set_cs = rt5350_set_gpio_chipselect; rs->ops->write_read = rt5350_spi_gpio_write_read; if(rs->debug) dev_warn(&spi->dev, "low speed mode."); } else { rt5350_spi_gpio_mode(rs, 0); rs->ops->baudrate_set = rt2880_spi_baudrate_set; rs->ops->set_cs = rt2880_spi_set_cs; rs->ops->write_read = rt2880_spi_write_read; } if (rs->speed != speed) { dev_dbg(&spi->dev, "speed_hz:%u\n", speed); rc = rs->ops->baudrate_set(spi, speed); if (rc) return rc; } reg = rt2880_spi_read(rs, RAMIPS_SPI_CFG(cs)); reg = (reg & ~SPICFG_MSBFIRST); if (!(spi->mode & SPI_LSB_FIRST)) reg |= SPICFG_MSBFIRST; reg = (reg & ~(SPICFG_SPICLKPOL | SPICFG_RXCLKEDGE_FALLING | SPICFG_TXCLKEDGE_FALLING)); switch(spi->mode & (SPI_CPOL | SPI_CPHA)) { case SPI_MODE_0: reg |= SPICFG_SPICLKPOL | SPICFG_TXCLKEDGE_FALLING; break; case SPI_MODE_1: reg |= SPICFG_SPICLKPOL | SPICFG_RXCLKEDGE_FALLING; break; case SPI_MODE_2: reg |= SPICFG_RXCLKEDGE_FALLING; break; case SPI_MODE_3: reg |= SPICFG_TXCLKEDGE_FALLING; break; } rt2880_spi_write(rs, RAMIPS_SPI_CFG(cs), reg); reg = SPICTL_ARB_EN; if (spi->mode & SPI_CS_HIGH) { switch(cs) { case 0: reg |= SPI0_POR; break; case 1: reg |= SPI1_POR; break; } } rt2880_spi_write(rs, RAMIPS_SPI_ARBITER, reg); return 0; } static void mt7621_spi_set_cs(struct spi_device *spi, int enable) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); u32 polar = rt2880_spi_read(rs, MT7621_SPI_POLAR); if (enable) polar |= 1; else polar &= ~1; rt2880_spi_write(rs, MT7621_SPI_POLAR, polar); } static inline int mt7621_spi_wait_till_ready(struct spi_device *spi) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); int i; for (i = 0; i < RALINK_SPI_WAIT_MAX_LOOP; i++) { u32 status; status = rt2880_spi_read(rs, MT7621_SPI_TRANS); if ((status & SPITRANS_BUSY) == 0) { return 0; } cpu_relax(); udelay(1); } return -ETIMEDOUT; } static unsigned int mt7621_spi_write_read(struct spi_device *spi, struct list_head *list, struct spi_transfer *xfer) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); struct spi_transfer *next = NULL; const u8 *tx = xfer->tx_buf; u8 *rx = NULL; u32 trans; int len = xfer->len; if (!tx) return 0; if (!list_is_last(&xfer->transfer_list, list)) { next = list_entry(xfer->transfer_list.next, struct spi_transfer, transfer_list); rx = next->rx_buf; } trans = rt2880_spi_read(rs, MT7621_SPI_TRANS); trans &= ~SPI_CTL_TX_RX_CNT_MASK; if (tx) { u32 data0 = 0, opcode = 0; switch (xfer->len) { case 8: data0 |= tx[7] << 24; case 7: data0 |= tx[6] << 16; case 6: data0 |= tx[5] << 8; case 5: data0 |= tx[4]; case 4: opcode |= tx[3] << 8; case 3: opcode |= tx[2] << 16; case 2: opcode |= tx[1] << 24; case 1: opcode |= tx[0]; break; default: dev_err(&spi->dev, "trying to write too many bytes: %d\n", next->len); return -EINVAL; } rt2880_spi_write(rs, MT7621_SPI_DATA0, data0); rt2880_spi_write(rs, MT7621_SPI_OPCODE, opcode); trans |= xfer->len; } if (rx) trans |= (next->len << 4); rt2880_spi_write(rs, MT7621_SPI_TRANS, trans); trans |= SPI_CTL_START; rt2880_spi_write(rs, MT7621_SPI_TRANS, trans); mt7621_spi_wait_till_ready(spi); if (rx) { u32 data0 = rt2880_spi_read(rs, MT7621_SPI_DATA0); u32 opcode = rt2880_spi_read(rs, MT7621_SPI_OPCODE); switch (next->len) { case 8: rx[7] = (opcode >> 24) & 0xff; case 7: rx[6] = (opcode >> 16) & 0xff; case 6: rx[5] = (opcode >> 8) & 0xff; case 5: rx[4] = opcode & 0xff; case 4: rx[3] = (data0 >> 24) & 0xff; case 3: rx[2] = (data0 >> 16) & 0xff; case 2: rx[1] = (data0 >> 8) & 0xff; case 1: rx[0] = data0 & 0xff; break; default: dev_err(&spi->dev, "trying to read too many bytes: %d\n", next->len); return -EINVAL; } len += next->len; } return len; } static int rt2880_spi_transfer_one_message(struct spi_master *master, struct spi_message *m) { struct rt2880_spi *rs = spi_master_get_devdata(master); struct spi_device *spi = m->spi; struct spi_transfer *t = NULL; int par_override = 0; int status = 0; int cs_active = 0; /* Load defaults */ status = rt2880_spi_setup_transfer(spi, NULL); if (status < 0) goto msg_done; list_for_each_entry(t, &m->transfers, transfer_list) { if (t->tx_buf == NULL && t->rx_buf == NULL && t->len) { dev_err(&spi->dev, "message rejected: invalid transfer data buffers\n"); status = -EIO; goto msg_done; } // if (t->speed_hz && t->speed_hz < (rs->sys_freq / 128)) { // dev_err(&spi->dev, // "message rejected: device min speed (%d Hz) exceeds required transfer speed (%d Hz)\n", // (rs->sys_freq / 128), t->speed_hz); // status = -EIO; // goto msg_done; // } if (par_override || t->speed_hz || t->bits_per_word) { par_override = 1; status = rt2880_spi_setup_transfer(spi, t); if (status < 0) goto msg_done; if (!t->speed_hz && !t->bits_per_word) par_override = 0; } if (!cs_active) { rs->ops->set_cs(spi, 1); cs_active = 1; } if (t->len) m->actual_length += rs->ops->write_read(spi, &m->transfers, t); if (t->delay_usecs) udelay(t->delay_usecs); if (t->cs_change) { rs->ops->set_cs(spi, 0); cs_active = 0; } } msg_done: if (cs_active) rs->ops->set_cs(spi, 0); m->status = status; spi_finalize_current_message(master); return 0; } static int rt2880_spi_setup(struct spi_device *spi) { struct rt2880_spi *rs = spidev_to_rt2880_spi(spi); if ((spi->max_speed_hz == 0) || (spi->max_speed_hz > (rs->sys_freq / 2))) spi->max_speed_hz = (rs->sys_freq / 2); // if (spi->max_speed_hz < (rs->sys_freq / 128)) { // dev_err(&spi->dev, "setup: requested speed is too low %d Hz\n", // spi->max_speed_hz); // return -EINVAL; // } /* * baudrate & width will be set rt2880_spi_setup_transfer */ return 0; } static void rt2880_spi_reset(struct rt2880_spi *rs) { rt2880_spi_write(rs, RAMIPS_SPI_CFG(0), SPICFG_MSBFIRST | SPICFG_TXCLKEDGE_FALLING | SPICFG_SPICLK_DIV16 | SPICFG_SPICLKPOL); rt2880_spi_write(rs, RAMIPS_SPI_CTL(0), SPICTL_HIZSDO | SPICTL_SPIENA); } static void rt5350_spi_reset(struct rt2880_spi *rs) { int cs; rt2880_spi_write(rs, RAMIPS_SPI_ARBITER, SPICTL_ARB_EN); for (cs = 0; cs < rs->ops->num_cs; cs++) { rt2880_spi_write(rs, RAMIPS_SPI_CFG(cs), SPICFG_MSBFIRST | SPICFG_TXCLKEDGE_FALLING | SPICFG_SPICLK_DIV16 | SPICFG_SPICLKPOL); rt2880_spi_write(rs, RAMIPS_SPI_CTL(cs), SPICTL_HIZSDO | SPICTL_SPIENA); } } static void mt7621_spi_reset(struct rt2880_spi *rs) { u32 master = rt2880_spi_read(rs, MT7621_SPI_MASTER); master &= ~(0xfff << 16); master |= 3 << 16; master |= 7 << 29; rt2880_spi_write(rs, MT7621_SPI_MASTER, master); } static struct rt2880_spi_ops spi_ops[] = { { .init_hw = rt2880_spi_reset, .set_cs = rt2880_spi_set_cs, .baudrate_set = rt2880_spi_baudrate_set, .write_read = rt2880_spi_write_read, .num_cs = 1, }, { .init_hw = rt5350_spi_reset, .set_cs = rt2880_spi_set_cs, .baudrate_set = rt2880_spi_baudrate_set, .write_read = rt2880_spi_write_read, .num_cs = 2, }, { .init_hw = mt7621_spi_reset, .set_cs = mt7621_spi_set_cs, .baudrate_set = mt7621_spi_baudrate_set, .write_read = mt7621_spi_write_read, .num_cs = 1, }, }; static const struct of_device_id rt2880_spi_match[] = { { .compatible = "ralink,rt2880-spi", .data = &spi_ops[0]}, { .compatible = "ralink,rt5350-spi", .data = &spi_ops[1]}, { .compatible = "ralink,mt7621-spi", .data = &spi_ops[2] }, {}, }; MODULE_DEVICE_TABLE(of, rt2880_spi_match); static u32 ahtoi(const char *buf) { u32 ret = 0; while(*buf) { if(*buf >= '0' && *buf <= '9') ret = ret * 0x10 + *buf - '0'; if(*buf >= 'a' && *buf <= 'f') ret = ret * 0x10 + *buf - 'a' + 10; if(*buf >= 'A' && *buf <= 'F') ret = ret * 0x10 + *buf - 'A' + 10; buf++; } return ret; } static ssize_t rt2880_spi_debug_show(struct device *dev, struct device_attribute *attr, char *buf) { struct spi_master *master = (struct spi_master *)dev_get_drvdata(dev); struct rt2880_spi *rs = spi_master_get_devdata(master); return sprintf(buf, "%s\n", rs->debug ? "on" : "off"); } static ssize_t rt2880_spi_debug_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct spi_master *master = (struct spi_master *)dev_get_drvdata(dev); struct rt2880_spi *rs = spi_master_get_devdata(master); if(!memcmp(buf, "on", 2)) rs->debug = true; if(!memcmp(buf, "off", 3)) rs->debug = false; return count; } static DEVICE_ATTR(debug, S_IRUGO | S_IWUGO, rt2880_spi_debug_show, rt2880_spi_debug_store); static int rt2880_spi_probe(struct platform_device *pdev) { const struct of_device_id *match; struct spi_master *master; struct rt2880_spi *rs; unsigned long flags; void __iomem *base; struct resource *r; int status = 0; struct clk *clk; struct rt2880_spi_ops *ops; match = of_match_device(rt2880_spi_match, &pdev->dev); if (!match) return -EINVAL; ops = (struct rt2880_spi_ops *)match->data; r = platform_get_resource(pdev, IORESOURCE_MEM, 0); base = devm_ioremap_resource(&pdev->dev, r); if (IS_ERR(base)) return PTR_ERR(base); clk = devm_clk_get(&pdev->dev, NULL); if (IS_ERR(clk)) { dev_err(&pdev->dev, "unable to get SYS clock, err=%d\n", status); return PTR_ERR(clk); } status = clk_prepare_enable(clk); if (status) return status; master = spi_alloc_master(&pdev->dev, sizeof(*rs)); if (master == NULL) { dev_dbg(&pdev->dev, "master allocation failed\n"); return -ENOMEM; } master->mode_bits = RT2880_SPI_MODE_BITS; master->setup = rt2880_spi_setup; master->transfer_one_message = rt2880_spi_transfer_one_message; master->bits_per_word_mask = SPI_BPW_MASK(8); master->dev.of_node = pdev->dev.of_node; master->num_chipselect = ops->num_cs; dev_set_drvdata(&pdev->dev, master); rs = spi_master_get_devdata(master); rs->base = base; rs->clk = clk; rs->master = master; rs->sys_freq = clk_get_rate(rs->clk); rs->ops = ops; rs->debug = false; dev_dbg(&pdev->dev, "sys_freq: %u\n", rs->sys_freq); spin_lock_irqsave(&rs->lock, flags); device_reset(&pdev->dev); rs->ops->init_hw(rs); device_create_file(&pdev->dev, &dev_attr_debug); return spi_register_master(master); } static int rt2880_spi_remove(struct platform_device *pdev) { struct spi_master *master; struct rt2880_spi *rs; master = dev_get_drvdata(&pdev->dev); rs = spi_master_get_devdata(master); clk_disable(rs->clk); spi_unregister_master(master); return 0; } MODULE_ALIAS("platform:" DRIVER_NAME); static struct platform_driver rt2880_spi_driver = { .driver = { .name = DRIVER_NAME, .owner = THIS_MODULE, .of_match_table = rt2880_spi_match, }, .probe = rt2880_spi_probe, .remove = rt2880_spi_remove, }; module_platform_driver(rt2880_spi_driver); MODULE_DESCRIPTION("Ralink SPI driver"); MODULE_AUTHOR("Sergiy "); MODULE_AUTHOR("Gabor Juhos "); MODULE_LICENSE("GPL");