| @@ -1,491 +0,0 @@ |
| 1 | | −// SPDX-License-Identifier: GPL-2.0-only |
| 2 | | −/* |
| 3 | | − * Driver for Motorola PCAP2 as present in EZX phones |
| 4 | | − * |
| 5 | | − * Copyright (C) 2006 Harald Welte <laforge@openezx.org> |
| 6 | | − * Copyright (C) 2009 Daniel Ribeiro <drwyrm@gmail.com> |
| 7 | | − */ |
| 8 | | − |
| 9 | | −#include <linux/module.h> |
| 10 | | −#include <linux/kernel.h> |
| 11 | | −#include <linux/platform_device.h> |
| 12 | | −#include <linux/interrupt.h> |
| 13 | | −#include <linux/irq.h> |
| 14 | | −#include <linux/mfd/ezx-pcap.h> |
| 15 | | −#include <linux/spi/spi.h> |
| 16 | | −#include <linux/gpio.h> |
| 17 | | −#include <linux/slab.h> |
| 18 | | − |
| 19 | | −#define PCAP_ADC_MAXQ 8 |
| 20 | | −struct pcap_adc_request { |
| 21 | | − u8 bank; |
| 22 | | − u8 ch[2]; |
| 23 | | − u32 flags; |
| 24 | | − void (*callback)(void *, u16[]); |
| 25 | | − void *data; |
| 26 | | −}; |
| 27 | | − |
| 28 | | −struct pcap_chip { |
| 29 | | − struct spi_device *spi; |
| 30 | | − |
| 31 | | − /* IO */ |
| 32 | | − u32 buf; |
| 33 | | − spinlock_t io_lock; |
| 34 | | − |
| 35 | | − /* IRQ */ |
| 36 | | − unsigned int irq_base; |
| 37 | | − u32 msr; |
| 38 | | − struct work_struct isr_work; |
| 39 | | − struct work_struct msr_work; |
| 40 | | − struct workqueue_struct *workqueue; |
| 41 | | − |
| 42 | | − /* ADC */ |
| 43 | | − struct pcap_adc_request *adc_queue[PCAP_ADC_MAXQ]; |
| 44 | | − u8 adc_head; |
| 45 | | − u8 adc_tail; |
| 46 | | − spinlock_t adc_lock; |
| 47 | | −}; |
| 48 | | − |
| 49 | | −/* IO */ |
| 50 | | −static int ezx_pcap_putget(struct pcap_chip *pcap, u32 *data) |
| 51 | | −{ |
| 52 | | − struct spi_transfer t; |
| 53 | | − struct spi_message m; |
| 54 | | − int status; |
| 55 | | − |
| 56 | | − memset(&t, 0, sizeof(t)); |
| 57 | | − spi_message_init(&m); |
| 58 | | − t.len = sizeof(u32); |
| 59 | | − spi_message_add_tail(&t, &m); |
| 60 | | − |
| 61 | | − pcap->buf = *data; |
| 62 | | − t.tx_buf = (u8 *) &pcap->buf; |
| 63 | | − t.rx_buf = (u8 *) &pcap->buf; |
| 64 | | − status = spi_sync(pcap->spi, &m); |
| 65 | | − |
| 66 | | − if (status == 0) |
| 67 | | − *data = pcap->buf; |
| 68 | | − |
| 69 | | − return status; |
| 70 | | −} |
| 71 | | − |
| 72 | | −int ezx_pcap_write(struct pcap_chip *pcap, u8 reg_num, u32 value) |
| 73 | | −{ |
| 74 | | − unsigned long flags; |
| 75 | | − int ret; |
| 76 | | − |
| 77 | | − spin_lock_irqsave(&pcap->io_lock, flags); |
| 78 | | − value &= PCAP_REGISTER_VALUE_MASK; |
| 79 | | − value |= PCAP_REGISTER_WRITE_OP_BIT |
| 80 | | − | (reg_num << PCAP_REGISTER_ADDRESS_SHIFT); |
| 81 | | − ret = ezx_pcap_putget(pcap, &value); |
| 82 | | − spin_unlock_irqrestore(&pcap->io_lock, flags); |
| 83 | | − |
| 84 | | − return ret; |
| 85 | | −} |
| 86 | | −EXPORT_SYMBOL_GPL(ezx_pcap_write); |
| 87 | | − |
| 88 | | −int ezx_pcap_read(struct pcap_chip *pcap, u8 reg_num, u32 *value) |
| 89 | | −{ |
| 90 | | − unsigned long flags; |
| 91 | | − int ret; |
| 92 | | − |
| 93 | | − spin_lock_irqsave(&pcap->io_lock, flags); |
| 94 | | − *value = PCAP_REGISTER_READ_OP_BIT |
| 95 | | − | (reg_num << PCAP_REGISTER_ADDRESS_SHIFT); |
| 96 | | − |
| 97 | | − ret = ezx_pcap_putget(pcap, value); |
| 98 | | − spin_unlock_irqrestore(&pcap->io_lock, flags); |
| 99 | | − |
| 100 | | − return ret; |
| 101 | | −} |
| 102 | | −EXPORT_SYMBOL_GPL(ezx_pcap_read); |
| 103 | | − |
| 104 | | −int ezx_pcap_set_bits(struct pcap_chip *pcap, u8 reg_num, u32 mask, u32 val) |
| 105 | | −{ |
| 106 | | − unsigned long flags; |
| 107 | | − int ret; |
| 108 | | − u32 tmp = PCAP_REGISTER_READ_OP_BIT | |
| 109 | | − (reg_num << PCAP_REGISTER_ADDRESS_SHIFT); |
| 110 | | − |
| 111 | | − spin_lock_irqsave(&pcap->io_lock, flags); |
| 112 | | − ret = ezx_pcap_putget(pcap, &tmp); |
| 113 | | − if (ret) |
| 114 | | − goto out_unlock; |
| 115 | | − |
| 116 | | − tmp &= (PCAP_REGISTER_VALUE_MASK & ~mask); |
| 117 | | − tmp |= (val & mask) | PCAP_REGISTER_WRITE_OP_BIT | |
| 118 | | − (reg_num << PCAP_REGISTER_ADDRESS_SHIFT); |
| 119 | | − |
| 120 | | − ret = ezx_pcap_putget(pcap, &tmp); |
| 121 | | −out_unlock: |
| 122 | | − spin_unlock_irqrestore(&pcap->io_lock, flags); |
| 123 | | − |
| 124 | | − return ret; |
| 125 | | −} |
| 126 | | −EXPORT_SYMBOL_GPL(ezx_pcap_set_bits); |
| 127 | | − |
| 128 | | −/* IRQ */ |
| 129 | | −int irq_to_pcap(struct pcap_chip *pcap, int irq) |
| 130 | | −{ |
| 131 | | − return irq - pcap->irq_base; |
| 132 | | −} |
| 133 | | −EXPORT_SYMBOL_GPL(irq_to_pcap); |
| 134 | | − |
| 135 | | −int pcap_to_irq(struct pcap_chip *pcap, int irq) |
| 136 | | −{ |
| 137 | | − return pcap->irq_base + irq; |
| 138 | | −} |
| 139 | | −EXPORT_SYMBOL_GPL(pcap_to_irq); |
| 140 | | − |
| 141 | | −static void pcap_mask_irq(struct irq_data *d) |
| 142 | | −{ |
| 143 | | − struct pcap_chip *pcap = irq_data_get_irq_chip_data(d); |
| 144 | | − |
| 145 | | − pcap->msr |= 1 << irq_to_pcap(pcap, d->irq); |
| 146 | | − queue_work(pcap->workqueue, &pcap->msr_work); |
| 147 | | −} |
| 148 | | − |
| 149 | | −static void pcap_unmask_irq(struct irq_data *d) |
| 150 | | −{ |
| 151 | | − struct pcap_chip *pcap = irq_data_get_irq_chip_data(d); |
| 152 | | − |
| 153 | | − pcap->msr &= ~(1 << irq_to_pcap(pcap, d->irq)); |
| 154 | | − queue_work(pcap->workqueue, &pcap->msr_work); |
| 155 | | −} |
| 156 | | − |
| 157 | | −static struct irq_chip pcap_irq_chip = { |
| 158 | | − .name = "pcap", |
| 159 | | − .irq_disable = pcap_mask_irq, |
| 160 | | − .irq_mask = pcap_mask_irq, |
| 161 | | − .irq_unmask = pcap_unmask_irq, |
| 162 | | −}; |
| 163 | | − |
| 164 | | −static void pcap_msr_work(struct work_struct *work) |
| 165 | | −{ |
| 166 | | − struct pcap_chip *pcap = container_of(work, struct pcap_chip, msr_work); |
| 167 | | − |
| 168 | | − ezx_pcap_write(pcap, PCAP_REG_MSR, pcap->msr); |
| 169 | | −} |
| 170 | | − |
| 171 | | −static void pcap_isr_work(struct work_struct *work) |
| 172 | | −{ |
| 173 | | − struct pcap_chip *pcap = container_of(work, struct pcap_chip, isr_work); |
| 174 | | − struct pcap_platform_data *pdata = dev_get_platdata(&pcap->spi->dev); |
| 175 | | − u32 msr, isr, int_sel, service; |
| 176 | | − int irq; |
| 177 | | − |
| 178 | | − do { |
| 179 | | − ezx_pcap_read(pcap, PCAP_REG_MSR, &msr); |
| 180 | | − ezx_pcap_read(pcap, PCAP_REG_ISR, &isr); |
| 181 | | − |
| 182 | | − /* We can't service/ack irqs that are assigned to port 2 */ |
| 183 | | − if (!(pdata->config & PCAP_SECOND_PORT)) { |
| 184 | | − ezx_pcap_read(pcap, PCAP_REG_INT_SEL, &int_sel); |
| 185 | | − isr &= ~int_sel; |
| 186 | | − } |
| 187 | | − |
| 188 | | − ezx_pcap_write(pcap, PCAP_REG_MSR, isr | msr); |
| 189 | | − ezx_pcap_write(pcap, PCAP_REG_ISR, isr); |
| 190 | | − |
| 191 | | − service = isr & ~msr; |
| 192 | | − for (irq = pcap->irq_base; service; service >>= 1, irq++) { |
| 193 | | − if (service & 1) |
| 194 | | − generic_handle_irq_safe(irq); |
| 195 | | − } |
| 196 | | − ezx_pcap_write(pcap, PCAP_REG_MSR, pcap->msr); |
| 197 | | − } while (gpio_get_value(pdata->gpio)); |
| 198 | | −} |
| 199 | | − |
| 200 | | −static void pcap_irq_handler(struct irq_desc *desc) |
| 201 | | −{ |
| 202 | | − struct pcap_chip *pcap = irq_desc_get_handler_data(desc); |
| 203 | | − |
| 204 | | − desc->irq_data.chip->irq_ack(&desc->irq_data); |
| 205 | | − queue_work(pcap->workqueue, &pcap->isr_work); |
| 206 | | −} |
| 207 | | − |
| 208 | | −/* ADC */ |
| 209 | | −void pcap_set_ts_bits(struct pcap_chip *pcap, u32 bits) |
| 210 | | −{ |
| 211 | | − unsigned long flags; |
| 212 | | − u32 tmp; |
| 213 | | − |
| 214 | | − spin_lock_irqsave(&pcap->adc_lock, flags); |
| 215 | | − ezx_pcap_read(pcap, PCAP_REG_ADC, &tmp); |
| 216 | | − tmp &= ~(PCAP_ADC_TS_M_MASK | PCAP_ADC_TS_REF_LOWPWR); |
| 217 | | − tmp |= bits & (PCAP_ADC_TS_M_MASK | PCAP_ADC_TS_REF_LOWPWR); |
| 218 | | − ezx_pcap_write(pcap, PCAP_REG_ADC, tmp); |
| 219 | | − spin_unlock_irqrestore(&pcap->adc_lock, flags); |
| 220 | | −} |
| 221 | | −EXPORT_SYMBOL_GPL(pcap_set_ts_bits); |
| 222 | | − |
| 223 | | −static void pcap_disable_adc(struct pcap_chip *pcap) |
| 224 | | −{ |
| 225 | | − u32 tmp; |
| 226 | | − |
| 227 | | − ezx_pcap_read(pcap, PCAP_REG_ADC, &tmp); |
| 228 | | − tmp &= ~(PCAP_ADC_ADEN|PCAP_ADC_BATT_I_ADC|PCAP_ADC_BATT_I_POLARITY); |
| 229 | | − ezx_pcap_write(pcap, PCAP_REG_ADC, tmp); |
| 230 | | −} |
| 231 | | − |
| 232 | | −static void pcap_adc_trigger(struct pcap_chip *pcap) |
| 233 | | −{ |
| 234 | | − unsigned long flags; |
| 235 | | − u32 tmp; |
| 236 | | − u8 head; |
| 237 | | − |
| 238 | | − spin_lock_irqsave(&pcap->adc_lock, flags); |
| 239 | | − head = pcap->adc_head; |
| 240 | | − if (!pcap->adc_queue[head]) { |
| 241 | | − /* queue is empty, save power */ |
| 242 | | − pcap_disable_adc(pcap); |
| 243 | | − spin_unlock_irqrestore(&pcap->adc_lock, flags); |
| 244 | | − return; |
| 245 | | − } |
| 246 | | − /* start conversion on requested bank, save TS_M bits */ |
| 247 | | − ezx_pcap_read(pcap, PCAP_REG_ADC, &tmp); |
| 248 | | − tmp &= (PCAP_ADC_TS_M_MASK | PCAP_ADC_TS_REF_LOWPWR); |
| 249 | | − tmp |= pcap->adc_queue[head]->flags | PCAP_ADC_ADEN; |
| 250 | | − |
| 251 | | − if (pcap->adc_queue[head]->bank == PCAP_ADC_BANK_1) |
| 252 | | − tmp |= PCAP_ADC_AD_SEL1; |
| 253 | | − |
| 254 | | − ezx_pcap_write(pcap, PCAP_REG_ADC, tmp); |
| 255 | | − spin_unlock_irqrestore(&pcap->adc_lock, flags); |
| 256 | | − ezx_pcap_write(pcap, PCAP_REG_ADR, PCAP_ADR_ASC); |
| 257 | | −} |
| 258 | | − |
| 259 | | −static irqreturn_t pcap_adc_irq(int irq, void *_pcap) |
| 260 | | −{ |
| 261 | | − struct pcap_chip *pcap = _pcap; |
| 262 | | − struct pcap_adc_request *req; |
| 263 | | − u16 res[2]; |
| 264 | | − u32 tmp; |
| 265 | | − |
| 266 | | − spin_lock(&pcap->adc_lock); |
| 267 | | − req = pcap->adc_queue[pcap->adc_head]; |
| 268 | | − |
| 269 | | − if (WARN(!req, "adc irq without pending request\n")) { |
| 270 | | − spin_unlock(&pcap->adc_lock); |
| 271 | | − return IRQ_HANDLED; |
| 272 | | − } |
| 273 | | − |
| 274 | | − /* read requested channels results */ |
| 275 | | − ezx_pcap_read(pcap, PCAP_REG_ADC, &tmp); |
| 276 | | − tmp &= ~(PCAP_ADC_ADA1_MASK | PCAP_ADC_ADA2_MASK); |
| 277 | | − tmp |= (req->ch[0] << PCAP_ADC_ADA1_SHIFT); |
| 278 | | − tmp |= (req->ch[1] << PCAP_ADC_ADA2_SHIFT); |
| 279 | | − ezx_pcap_write(pcap, PCAP_REG_ADC, tmp); |
| 280 | | − ezx_pcap_read(pcap, PCAP_REG_ADR, &tmp); |
| 281 | | − res[0] = (tmp & PCAP_ADR_ADD1_MASK) >> PCAP_ADR_ADD1_SHIFT; |
| 282 | | − res[1] = (tmp & PCAP_ADR_ADD2_MASK) >> PCAP_ADR_ADD2_SHIFT; |
| 283 | | − |
| 284 | | − pcap->adc_queue[pcap->adc_head] = NULL; |
| 285 | | − pcap->adc_head = (pcap->adc_head + 1) & (PCAP_ADC_MAXQ - 1); |
| 286 | | − spin_unlock(&pcap->adc_lock); |
| 287 | | − |
| 288 | | − /* pass the results and release memory */ |
| 289 | | − req->callback(req->data, res); |
| 290 | | − kfree(req); |
| 291 | | − |
| 292 | | − /* trigger next conversion (if any) on queue */ |
| 293 | | − pcap_adc_trigger(pcap); |
| 294 | | − |
| 295 | | − return IRQ_HANDLED; |
| 296 | | −} |
| 297 | | − |
| 298 | | −int pcap_adc_async(struct pcap_chip *pcap, u8 bank, u32 flags, u8 ch[], |
| 299 | | − void *callback, void *data) |
| 300 | | −{ |
| 301 | | − struct pcap_adc_request *req; |
| 302 | | − unsigned long irq_flags; |
| 303 | | − |
| 304 | | − /* This will be freed after we have a result */ |
| 305 | | − req = kmalloc_obj(struct pcap_adc_request); |
| 306 | | − if (!req) |
| 307 | | − return -ENOMEM; |
| 308 | | − |
| 309 | | − req->bank = bank; |
| 310 | | − req->flags = flags; |
| 311 | | − req->ch[0] = ch[0]; |
| 312 | | − req->ch[1] = ch[1]; |
| 313 | | − req->callback = callback; |
| 314 | | − req->data = data; |
| 315 | | − |
| 316 | | − spin_lock_irqsave(&pcap->adc_lock, irq_flags); |
| 317 | | − if (pcap->adc_queue[pcap->adc_tail]) { |
| 318 | | − spin_unlock_irqrestore(&pcap->adc_lock, irq_flags); |
| 319 | | − kfree(req); |
| 320 | | − return -EBUSY; |
| 321 | | − } |
| 322 | | − pcap->adc_queue[pcap->adc_tail] = req; |
| 323 | | − pcap->adc_tail = (pcap->adc_tail + 1) & (PCAP_ADC_MAXQ - 1); |
| 324 | | − spin_unlock_irqrestore(&pcap->adc_lock, irq_flags); |
| 325 | | − |
| 326 | | − /* start conversion */ |
| 327 | | − pcap_adc_trigger(pcap); |
| 328 | | − |
| 329 | | − return 0; |
| 330 | | −} |
| 331 | | −EXPORT_SYMBOL_GPL(pcap_adc_async); |
| 332 | | − |
| 333 | | −/* subdevs */ |
| 334 | | −static int pcap_remove_subdev(struct device *dev, void *unused) |
| 335 | | −{ |
| 336 | | − platform_device_unregister(to_platform_device(dev)); |
| 337 | | − return 0; |
| 338 | | −} |
| 339 | | − |
| 340 | | −static int pcap_add_subdev(struct pcap_chip *pcap, |
| 341 | | − struct pcap_subdev *subdev) |
| 342 | | −{ |
| 343 | | − struct platform_device *pdev; |
| 344 | | − int ret; |
| 345 | | − |
| 346 | | − pdev = platform_device_alloc(subdev->name, subdev->id); |
| 347 | | − if (!pdev) |
| 348 | | − return -ENOMEM; |
| 349 | | − |
| 350 | | − pdev->dev.parent = &pcap->spi->dev; |
| 351 | | − pdev->dev.platform_data = subdev->platform_data; |
| 352 | | − |
| 353 | | − ret = platform_device_add(pdev); |
| 354 | | − if (ret) |
| 355 | | − platform_device_put(pdev); |
| 356 | | − |
| 357 | | − return ret; |
| 358 | | −} |
| 359 | | − |
| 360 | | −static void ezx_pcap_remove(struct spi_device *spi) |
| 361 | | −{ |
| 362 | | − struct pcap_chip *pcap = spi_get_drvdata(spi); |
| 363 | | − unsigned long flags; |
| 364 | | − int i; |
| 365 | | − |
| 366 | | − /* remove all registered subdevs */ |
| 367 | | − device_for_each_child(&spi->dev, NULL, pcap_remove_subdev); |
| 368 | | − |
| 369 | | − /* cleanup ADC */ |
| 370 | | − spin_lock_irqsave(&pcap->adc_lock, flags); |
| 371 | | − for (i = 0; i < PCAP_ADC_MAXQ; i++) |
| 372 | | − kfree(pcap->adc_queue[i]); |
| 373 | | − spin_unlock_irqrestore(&pcap->adc_lock, flags); |
| 374 | | − |
| 375 | | − /* cleanup irqchip */ |
| 376 | | − for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) |
| 377 | | − irq_set_chip_and_handler(i, NULL, NULL); |
| 378 | | −} |
| 379 | | − |
| 380 | | −static int ezx_pcap_probe(struct spi_device *spi) |
| 381 | | −{ |
| 382 | | − struct pcap_platform_data *pdata = dev_get_platdata(&spi->dev); |
| 383 | | − struct pcap_chip *pcap; |
| 384 | | − int i, adc_irq; |
| 385 | | − int ret; |
| 386 | | − |
| 387 | | − /* platform data is required */ |
| 388 | | − if (!pdata) |
| 389 | | − return -ENODEV; |
| 390 | | − |
| 391 | | − pcap = devm_kzalloc(&spi->dev, sizeof(*pcap), GFP_KERNEL); |
| 392 | | − if (!pcap) |
| 393 | | − return -ENOMEM; |
| 394 | | − |
| 395 | | − spin_lock_init(&pcap->io_lock); |
| 396 | | − spin_lock_init(&pcap->adc_lock); |
| 397 | | − INIT_WORK(&pcap->isr_work, pcap_isr_work); |
| 398 | | − INIT_WORK(&pcap->msr_work, pcap_msr_work); |
| 399 | | − spi_set_drvdata(spi, pcap); |
| 400 | | − |
| 401 | | − /* setup spi */ |
| 402 | | − spi->bits_per_word = 32; |
| 403 | | − spi->mode = SPI_MODE_0 | (pdata->config & PCAP_CS_AH ? SPI_CS_HIGH : 0); |
| 404 | | − ret = spi_setup(spi); |
| 405 | | − if (ret) |
| 406 | | − return ret; |
| 407 | | − |
| 408 | | − pcap->spi = spi; |
| 409 | | − |
| 410 | | − /* setup irq */ |
| 411 | | − pcap->irq_base = pdata->irq_base; |
| 412 | | − pcap->workqueue = devm_alloc_ordered_workqueue(&spi->dev, "pcapd", 0); |
| 413 | | − if (!pcap->workqueue) |
| 414 | | − return -ENOMEM; |
| 415 | | − |
| 416 | | − /* redirect interrupts to AP, except adcdone2 */ |
| 417 | | − if (!(pdata->config & PCAP_SECOND_PORT)) |
| 418 | | − ezx_pcap_write(pcap, PCAP_REG_INT_SEL, |
| 419 | | − (1 << PCAP_IRQ_ADCDONE2)); |
| 420 | | − |
| 421 | | − /* setup irq chip */ |
| 422 | | − for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) { |
| 423 | | − irq_set_chip_and_handler(i, &pcap_irq_chip, handle_simple_irq); |
| 424 | | − irq_set_chip_data(i, pcap); |
| 425 | | − irq_clear_status_flags(i, IRQ_NOREQUEST | IRQ_NOPROBE); |
| 426 | | − } |
| 427 | | − |
| 428 | | − /* mask/ack all PCAP interrupts */ |
| 429 | | − ezx_pcap_write(pcap, PCAP_REG_MSR, PCAP_MASK_ALL_INTERRUPT); |
| 430 | | − ezx_pcap_write(pcap, PCAP_REG_ISR, PCAP_CLEAR_INTERRUPT_REGISTER); |
| 431 | | − pcap->msr = PCAP_MASK_ALL_INTERRUPT; |
| 432 | | − |
| 433 | | − irq_set_irq_type(spi->irq, IRQ_TYPE_EDGE_RISING); |
| 434 | | − irq_set_chained_handler_and_data(spi->irq, pcap_irq_handler, pcap); |
| 435 | | − irq_set_irq_wake(spi->irq, 1); |
| 436 | | − |
| 437 | | − /* ADC */ |
| 438 | | − adc_irq = pcap_to_irq(pcap, (pdata->config & PCAP_SECOND_PORT) ? |
| 439 | | − PCAP_IRQ_ADCDONE2 : PCAP_IRQ_ADCDONE); |
| 440 | | − |
| 441 | | − ret = devm_request_irq(&spi->dev, adc_irq, pcap_adc_irq, 0, "ADC", |
| 442 | | − pcap); |
| 443 | | − if (ret) |
| 444 | | − goto free_irqchip; |
| 445 | | − |
| 446 | | − /* setup subdevs */ |
| 447 | | − for (i = 0; i < pdata->num_subdevs; i++) { |
| 448 | | − ret = pcap_add_subdev(pcap, &pdata->subdevs[i]); |
| 449 | | − if (ret) |
| 450 | | − goto remove_subdevs; |
| 451 | | − } |
| 452 | | − |
| 453 | | − /* board specific quirks */ |
| 454 | | − if (pdata->init) |
| 455 | | − pdata->init(pcap); |
| 456 | | − |
| 457 | | − return 0; |
| 458 | | − |
| 459 | | −remove_subdevs: |
| 460 | | − device_for_each_child(&spi->dev, NULL, pcap_remove_subdev); |
| 461 | | −free_irqchip: |
| 462 | | − for (i = pcap->irq_base; i < (pcap->irq_base + PCAP_NIRQS); i++) |
| 463 | | − irq_set_chip_and_handler(i, NULL, NULL); |
| 464 | | − |
| 465 | | − return ret; |
| 466 | | −} |
| 467 | | − |
| 468 | | −static struct spi_driver ezxpcap_driver = { |
| 469 | | − .probe = ezx_pcap_probe, |
| 470 | | − .remove = ezx_pcap_remove, |
| 471 | | − .driver = { |
| 472 | | − .name = "ezx-pcap", |
| 473 | | − }, |
| 474 | | −}; |
| 475 | | − |
| 476 | | −static int __init ezx_pcap_init(void) |
| 477 | | −{ |
| 478 | | − return spi_register_driver(&ezxpcap_driver); |
| 479 | | −} |
| 480 | | − |
| 481 | | −static void __exit ezx_pcap_exit(void) |
| 482 | | −{ |
| 483 | | − spi_unregister_driver(&ezxpcap_driver); |
| 484 | | −} |
| 485 | | − |
| 486 | | −subsys_initcall(ezx_pcap_init); |
| 487 | | −module_exit(ezx_pcap_exit); |
| 488 | | − |
| 489 | | −MODULE_AUTHOR("Daniel Ribeiro / Harald Welte"); |
| 490 | | −MODULE_DESCRIPTION("Motorola PCAP2 ASIC Driver"); |
| 491 | | −MODULE_ALIAS("spi:ezx-pcap"); |