Lines Matching full:ms

82 	int (*state)(int irq, struct mpc52xx_spi *ms, u8 status, u8 data);
95 static void mpc52xx_spi_chipsel(struct mpc52xx_spi *ms, int value) in mpc52xx_spi_chipsel() argument
99 if (ms->gpio_cs_count > 0) { in mpc52xx_spi_chipsel()
100 cs = ms->message->spi->chip_select; in mpc52xx_spi_chipsel()
101 gpio_set_value(ms->gpio_cs[cs], value ? 0 : 1); in mpc52xx_spi_chipsel()
103 out_8(ms->regs + SPI_PORTDATA, value ? 0 : 0x08); in mpc52xx_spi_chipsel()
111 static void mpc52xx_spi_start_transfer(struct mpc52xx_spi *ms) in mpc52xx_spi_start_transfer() argument
113 ms->rx_buf = ms->transfer->rx_buf; in mpc52xx_spi_start_transfer()
114 ms->tx_buf = ms->transfer->tx_buf; in mpc52xx_spi_start_transfer()
115 ms->len = ms->transfer->len; in mpc52xx_spi_start_transfer()
118 if (ms->cs_change) in mpc52xx_spi_start_transfer()
119 mpc52xx_spi_chipsel(ms, 1); in mpc52xx_spi_start_transfer()
120 ms->cs_change = ms->transfer->cs_change; in mpc52xx_spi_start_transfer()
123 ms->wcol_tx_timestamp = mftb(); in mpc52xx_spi_start_transfer()
124 if (ms->tx_buf) in mpc52xx_spi_start_transfer()
125 out_8(ms->regs + SPI_DATA, *ms->tx_buf++); in mpc52xx_spi_start_transfer()
127 out_8(ms->regs + SPI_DATA, 0); in mpc52xx_spi_start_transfer()
131 static int mpc52xx_spi_fsmstate_transfer(int irq, struct mpc52xx_spi *ms,
133 static int mpc52xx_spi_fsmstate_wait(int irq, struct mpc52xx_spi *ms,
143 mpc52xx_spi_fsmstate_idle(int irq, struct mpc52xx_spi *ms, u8 status, u8 data) in mpc52xx_spi_fsmstate_idle() argument
150 dev_err(&ms->master->dev, "spurious irq, status=0x%.2x\n", in mpc52xx_spi_fsmstate_idle()
154 if (list_empty(&ms->queue)) in mpc52xx_spi_fsmstate_idle()
158 ms->message = list_first_entry(&ms->queue, struct spi_message, queue); in mpc52xx_spi_fsmstate_idle()
159 list_del_init(&ms->message->queue); in mpc52xx_spi_fsmstate_idle()
163 spi = ms->message->spi; in mpc52xx_spi_fsmstate_idle()
170 out_8(ms->regs + SPI_CTRL1, ctrl1); in mpc52xx_spi_fsmstate_idle()
175 sppr = ((ms->ipb_freq / ms->message->spi->max_speed_hz) + 1) >> 1; in mpc52xx_spi_fsmstate_idle()
189 out_8(ms->regs + SPI_BRR, sppr << 4 | spr); /* Set speed */ in mpc52xx_spi_fsmstate_idle()
191 ms->cs_change = 1; in mpc52xx_spi_fsmstate_idle()
192 ms->transfer = container_of(ms->message->transfers.next, in mpc52xx_spi_fsmstate_idle()
195 mpc52xx_spi_start_transfer(ms); in mpc52xx_spi_fsmstate_idle()
196 ms->state = mpc52xx_spi_fsmstate_transfer; in mpc52xx_spi_fsmstate_idle()
209 static int mpc52xx_spi_fsmstate_transfer(int irq, struct mpc52xx_spi *ms, in mpc52xx_spi_fsmstate_transfer() argument
213 return ms->irq0 ? FSM_STOP : FSM_POLL; in mpc52xx_spi_fsmstate_transfer()
223 ms->wcol_count++; in mpc52xx_spi_fsmstate_transfer()
224 ms->wcol_ticks += mftb() - ms->wcol_tx_timestamp; in mpc52xx_spi_fsmstate_transfer()
225 ms->wcol_tx_timestamp = mftb(); in mpc52xx_spi_fsmstate_transfer()
227 if (ms->tx_buf) in mpc52xx_spi_fsmstate_transfer()
228 data = *(ms->tx_buf - 1); in mpc52xx_spi_fsmstate_transfer()
229 out_8(ms->regs + SPI_DATA, data); /* try again */ in mpc52xx_spi_fsmstate_transfer()
232 ms->modf_count++; in mpc52xx_spi_fsmstate_transfer()
233 dev_err(&ms->master->dev, "mode fault\n"); in mpc52xx_spi_fsmstate_transfer()
234 mpc52xx_spi_chipsel(ms, 0); in mpc52xx_spi_fsmstate_transfer()
235 ms->message->status = -EIO; in mpc52xx_spi_fsmstate_transfer()
236 if (ms->message->complete) in mpc52xx_spi_fsmstate_transfer()
237 ms->message->complete(ms->message->context); in mpc52xx_spi_fsmstate_transfer()
238 ms->state = mpc52xx_spi_fsmstate_idle; in mpc52xx_spi_fsmstate_transfer()
243 ms->byte_count++; in mpc52xx_spi_fsmstate_transfer()
244 if (ms->rx_buf) in mpc52xx_spi_fsmstate_transfer()
245 *ms->rx_buf++ = data; in mpc52xx_spi_fsmstate_transfer()
248 ms->len--; in mpc52xx_spi_fsmstate_transfer()
249 if (ms->len == 0) { in mpc52xx_spi_fsmstate_transfer()
250 ms->timestamp = mftb(); in mpc52xx_spi_fsmstate_transfer()
251 if (ms->transfer->delay.unit == SPI_DELAY_UNIT_USECS) in mpc52xx_spi_fsmstate_transfer()
252 ms->timestamp += ms->transfer->delay.value * in mpc52xx_spi_fsmstate_transfer()
254 ms->state = mpc52xx_spi_fsmstate_wait; in mpc52xx_spi_fsmstate_transfer()
259 ms->wcol_tx_timestamp = mftb(); in mpc52xx_spi_fsmstate_transfer()
260 if (ms->tx_buf) in mpc52xx_spi_fsmstate_transfer()
261 out_8(ms->regs + SPI_DATA, *ms->tx_buf++); in mpc52xx_spi_fsmstate_transfer()
263 out_8(ms->regs + SPI_DATA, 0); in mpc52xx_spi_fsmstate_transfer()
275 mpc52xx_spi_fsmstate_wait(int irq, struct mpc52xx_spi *ms, u8 status, u8 data) in mpc52xx_spi_fsmstate_wait() argument
278 dev_err(&ms->master->dev, "spurious irq, status=0x%.2x\n", in mpc52xx_spi_fsmstate_wait()
281 if (((int)mftb()) - ms->timestamp < 0) in mpc52xx_spi_fsmstate_wait()
284 ms->message->actual_length += ms->transfer->len; in mpc52xx_spi_fsmstate_wait()
289 if (ms->transfer->transfer_list.next == &ms->message->transfers) { in mpc52xx_spi_fsmstate_wait()
290 ms->msg_count++; in mpc52xx_spi_fsmstate_wait()
291 mpc52xx_spi_chipsel(ms, 0); in mpc52xx_spi_fsmstate_wait()
292 ms->message->status = 0; in mpc52xx_spi_fsmstate_wait()
293 if (ms->message->complete) in mpc52xx_spi_fsmstate_wait()
294 ms->message->complete(ms->message->context); in mpc52xx_spi_fsmstate_wait()
295 ms->state = mpc52xx_spi_fsmstate_idle; in mpc52xx_spi_fsmstate_wait()
301 if (ms->cs_change) in mpc52xx_spi_fsmstate_wait()
302 mpc52xx_spi_chipsel(ms, 0); in mpc52xx_spi_fsmstate_wait()
304 ms->transfer = container_of(ms->transfer->transfer_list.next, in mpc52xx_spi_fsmstate_wait()
306 mpc52xx_spi_start_transfer(ms); in mpc52xx_spi_fsmstate_wait()
307 ms->state = mpc52xx_spi_fsmstate_transfer; in mpc52xx_spi_fsmstate_wait()
314 * @ms: pointer to mpc52xx_spi driver data
316 static void mpc52xx_spi_fsm_process(int irq, struct mpc52xx_spi *ms) in mpc52xx_spi_fsm_process() argument
324 status = in_8(ms->regs + SPI_STATUS); in mpc52xx_spi_fsm_process()
325 data = in_8(ms->regs + SPI_DATA); in mpc52xx_spi_fsm_process()
326 rc = ms->state(irq, ms, status, data); in mpc52xx_spi_fsm_process()
330 schedule_work(&ms->work); in mpc52xx_spi_fsm_process()
338 struct mpc52xx_spi *ms = _ms; in mpc52xx_spi_irq() local
339 spin_lock(&ms->lock); in mpc52xx_spi_irq()
340 mpc52xx_spi_fsm_process(irq, ms); in mpc52xx_spi_irq()
341 spin_unlock(&ms->lock); in mpc52xx_spi_irq()
350 struct mpc52xx_spi *ms = container_of(work, struct mpc52xx_spi, work); in mpc52xx_spi_wq() local
353 spin_lock_irqsave(&ms->lock, flags); in mpc52xx_spi_wq()
354 mpc52xx_spi_fsm_process(0, ms); in mpc52xx_spi_wq()
355 spin_unlock_irqrestore(&ms->lock, flags); in mpc52xx_spi_wq()
364 struct mpc52xx_spi *ms = spi_master_get_devdata(spi->master); in mpc52xx_spi_transfer() local
370 spin_lock_irqsave(&ms->lock, flags); in mpc52xx_spi_transfer()
371 list_add_tail(&m->queue, &ms->queue); in mpc52xx_spi_transfer()
372 spin_unlock_irqrestore(&ms->lock, flags); in mpc52xx_spi_transfer()
373 schedule_work(&ms->work); in mpc52xx_spi_transfer()
384 struct mpc52xx_spi *ms; in mpc52xx_spi_probe() local
418 master = spi_alloc_master(&op->dev, sizeof(*ms)); in mpc52xx_spi_probe()
431 ms = spi_master_get_devdata(master); in mpc52xx_spi_probe()
432 ms->master = master; in mpc52xx_spi_probe()
433 ms->regs = regs; in mpc52xx_spi_probe()
434 ms->irq0 = irq_of_parse_and_map(op->dev.of_node, 0); in mpc52xx_spi_probe()
435 ms->irq1 = irq_of_parse_and_map(op->dev.of_node, 1); in mpc52xx_spi_probe()
436 ms->state = mpc52xx_spi_fsmstate_idle; in mpc52xx_spi_probe()
437 ms->ipb_freq = mpc5xxx_get_bus_frequency(op->dev.of_node); in mpc52xx_spi_probe()
438 ms->gpio_cs_count = of_gpio_count(op->dev.of_node); in mpc52xx_spi_probe()
439 if (ms->gpio_cs_count > 0) { in mpc52xx_spi_probe()
440 master->num_chipselect = ms->gpio_cs_count; in mpc52xx_spi_probe()
441 ms->gpio_cs = kmalloc_array(ms->gpio_cs_count, in mpc52xx_spi_probe()
442 sizeof(*ms->gpio_cs), in mpc52xx_spi_probe()
444 if (!ms->gpio_cs) { in mpc52xx_spi_probe()
449 for (i = 0; i < ms->gpio_cs_count; i++) { in mpc52xx_spi_probe()
467 ms->gpio_cs[i] = gpio_cs; in mpc52xx_spi_probe()
471 spin_lock_init(&ms->lock); in mpc52xx_spi_probe()
472 INIT_LIST_HEAD(&ms->queue); in mpc52xx_spi_probe()
473 INIT_WORK(&ms->work, mpc52xx_spi_wq); in mpc52xx_spi_probe()
476 if (ms->irq0 && ms->irq1) { in mpc52xx_spi_probe()
477 rc = request_irq(ms->irq0, mpc52xx_spi_irq, 0, in mpc52xx_spi_probe()
478 "mpc5200-spi-modf", ms); in mpc52xx_spi_probe()
479 rc |= request_irq(ms->irq1, mpc52xx_spi_irq, 0, in mpc52xx_spi_probe()
480 "mpc5200-spi-spif", ms); in mpc52xx_spi_probe()
482 free_irq(ms->irq0, ms); in mpc52xx_spi_probe()
483 free_irq(ms->irq1, ms); in mpc52xx_spi_probe()
484 ms->irq0 = ms->irq1 = 0; in mpc52xx_spi_probe()
488 ms->irq0 = ms->irq1 = 0; in mpc52xx_spi_probe()
491 if (!ms->irq0) in mpc52xx_spi_probe()
499 dev_info(&ms->master->dev, "registered MPC5200 SPI bus\n"); in mpc52xx_spi_probe()
504 dev_err(&ms->master->dev, "initialization failed\n"); in mpc52xx_spi_probe()
507 gpio_free(ms->gpio_cs[i]); in mpc52xx_spi_probe()
509 kfree(ms->gpio_cs); in mpc52xx_spi_probe()
521 struct mpc52xx_spi *ms = spi_master_get_devdata(master); in mpc52xx_spi_remove() local
524 free_irq(ms->irq0, ms); in mpc52xx_spi_remove()
525 free_irq(ms->irq1, ms); in mpc52xx_spi_remove()
527 for (i = 0; i < ms->gpio_cs_count; i++) in mpc52xx_spi_remove()
528 gpio_free(ms->gpio_cs[i]); in mpc52xx_spi_remove()
530 kfree(ms->gpio_cs); in mpc52xx_spi_remove()
532 iounmap(ms->regs); in mpc52xx_spi_remove()