Merge git://git.infradead.org/mtd-2.6
[linux-2.6] / arch / powerpc / sysdev / fsl_rio.c
1 /*
2  * Freescale MPC85xx/MPC86xx RapidIO support
3  *
4  * Copyright (C) 2007, 2008 Freescale Semiconductor, Inc.
5  * Zhang Wei <wei.zhang@freescale.com>
6  *
7  * Copyright 2005 MontaVista Software, Inc.
8  * Matt Porter <mporter@kernel.crashing.org>
9  *
10  * This program is free software; you can redistribute  it and/or modify it
11  * under  the terms of  the GNU General  Public License as published by the
12  * Free Software Foundation;  either version 2 of the  License, or (at your
13  * option) any later version.
14  */
15
16 #include <linux/init.h>
17 #include <linux/module.h>
18 #include <linux/types.h>
19 #include <linux/dma-mapping.h>
20 #include <linux/interrupt.h>
21 #include <linux/device.h>
22 #include <linux/rio.h>
23 #include <linux/rio_drv.h>
24 #include <linux/of_platform.h>
25 #include <linux/delay.h>
26
27 #include <asm/io.h>
28
29 /* RapidIO definition irq, which read from OF-tree */
30 #define IRQ_RIO_BELL(m)         (((struct rio_priv *)(m->priv))->bellirq)
31 #define IRQ_RIO_TX(m)           (((struct rio_priv *)(m->priv))->txirq)
32 #define IRQ_RIO_RX(m)           (((struct rio_priv *)(m->priv))->rxirq)
33
34 #define RIO_ATMU_REGS_OFFSET    0x10c00
35 #define RIO_P_MSG_REGS_OFFSET   0x11000
36 #define RIO_S_MSG_REGS_OFFSET   0x13000
37 #define RIO_ESCSR               0x158
38 #define RIO_CCSR                0x15c
39 #define RIO_ISR_AACR            0x10120
40 #define RIO_ISR_AACR_AA         0x1     /* Accept All ID */
41 #define RIO_MAINT_WIN_SIZE      0x400000
42 #define RIO_DBELL_WIN_SIZE      0x1000
43
44 #define RIO_MSG_OMR_MUI         0x00000002
45 #define RIO_MSG_OSR_TE          0x00000080
46 #define RIO_MSG_OSR_QOI         0x00000020
47 #define RIO_MSG_OSR_QFI         0x00000010
48 #define RIO_MSG_OSR_MUB         0x00000004
49 #define RIO_MSG_OSR_EOMI        0x00000002
50 #define RIO_MSG_OSR_QEI         0x00000001
51
52 #define RIO_MSG_IMR_MI          0x00000002
53 #define RIO_MSG_ISR_TE          0x00000080
54 #define RIO_MSG_ISR_QFI         0x00000010
55 #define RIO_MSG_ISR_DIQI        0x00000001
56
57 #define RIO_MSG_DESC_SIZE       32
58 #define RIO_MSG_BUFFER_SIZE     4096
59 #define RIO_MIN_TX_RING_SIZE    2
60 #define RIO_MAX_TX_RING_SIZE    2048
61 #define RIO_MIN_RX_RING_SIZE    2
62 #define RIO_MAX_RX_RING_SIZE    2048
63
64 #define DOORBELL_DMR_DI         0x00000002
65 #define DOORBELL_DSR_TE         0x00000080
66 #define DOORBELL_DSR_QFI        0x00000010
67 #define DOORBELL_DSR_DIQI       0x00000001
68 #define DOORBELL_TID_OFFSET     0x02
69 #define DOORBELL_SID_OFFSET     0x04
70 #define DOORBELL_INFO_OFFSET    0x06
71
72 #define DOORBELL_MESSAGE_SIZE   0x08
73 #define DBELL_SID(x)            (*(u16 *)(x + DOORBELL_SID_OFFSET))
74 #define DBELL_TID(x)            (*(u16 *)(x + DOORBELL_TID_OFFSET))
75 #define DBELL_INF(x)            (*(u16 *)(x + DOORBELL_INFO_OFFSET))
76
77 struct rio_atmu_regs {
78         u32 rowtar;
79         u32 rowtear;
80         u32 rowbar;
81         u32 pad2;
82         u32 rowar;
83         u32 pad3[3];
84 };
85
86 struct rio_msg_regs {
87         u32 omr;
88         u32 osr;
89         u32 pad1;
90         u32 odqdpar;
91         u32 pad2;
92         u32 osar;
93         u32 odpr;
94         u32 odatr;
95         u32 odcr;
96         u32 pad3;
97         u32 odqepar;
98         u32 pad4[13];
99         u32 imr;
100         u32 isr;
101         u32 pad5;
102         u32 ifqdpar;
103         u32 pad6;
104         u32 ifqepar;
105         u32 pad7[226];
106         u32 odmr;
107         u32 odsr;
108         u32 res0[4];
109         u32 oddpr;
110         u32 oddatr;
111         u32 res1[3];
112         u32 odretcr;
113         u32 res2[12];
114         u32 dmr;
115         u32 dsr;
116         u32 pad8;
117         u32 dqdpar;
118         u32 pad9;
119         u32 dqepar;
120         u32 pad10[26];
121         u32 pwmr;
122         u32 pwsr;
123         u32 pad11;
124         u32 pwqbar;
125 };
126
127 struct rio_tx_desc {
128         u32 res1;
129         u32 saddr;
130         u32 dport;
131         u32 dattr;
132         u32 res2;
133         u32 res3;
134         u32 dwcnt;
135         u32 res4;
136 };
137
138 struct rio_dbell_ring {
139         void *virt;
140         dma_addr_t phys;
141 };
142
143 struct rio_msg_tx_ring {
144         void *virt;
145         dma_addr_t phys;
146         void *virt_buffer[RIO_MAX_TX_RING_SIZE];
147         dma_addr_t phys_buffer[RIO_MAX_TX_RING_SIZE];
148         int tx_slot;
149         int size;
150         void *dev_id;
151 };
152
153 struct rio_msg_rx_ring {
154         void *virt;
155         dma_addr_t phys;
156         void *virt_buffer[RIO_MAX_RX_RING_SIZE];
157         int rx_slot;
158         int size;
159         void *dev_id;
160 };
161
162 struct rio_priv {
163         struct device *dev;
164         void __iomem *regs_win;
165         struct rio_atmu_regs __iomem *atmu_regs;
166         struct rio_atmu_regs __iomem *maint_atmu_regs;
167         struct rio_atmu_regs __iomem *dbell_atmu_regs;
168         void __iomem *dbell_win;
169         void __iomem *maint_win;
170         struct rio_msg_regs __iomem *msg_regs;
171         struct rio_dbell_ring dbell_ring;
172         struct rio_msg_tx_ring msg_tx_ring;
173         struct rio_msg_rx_ring msg_rx_ring;
174         int bellirq;
175         int txirq;
176         int rxirq;
177 };
178
179 /**
180  * fsl_rio_doorbell_send - Send a MPC85xx doorbell message
181  * @mport: RapidIO master port info
182  * @index: ID of RapidIO interface
183  * @destid: Destination ID of target device
184  * @data: 16-bit info field of RapidIO doorbell message
185  *
186  * Sends a MPC85xx doorbell message. Returns %0 on success or
187  * %-EINVAL on failure.
188  */
189 static int fsl_rio_doorbell_send(struct rio_mport *mport,
190                                 int index, u16 destid, u16 data)
191 {
192         struct rio_priv *priv = mport->priv;
193         pr_debug("fsl_doorbell_send: index %d destid %4.4x data %4.4x\n",
194                  index, destid, data);
195         switch (mport->phy_type) {
196         case RIO_PHY_PARALLEL:
197                 out_be32(&priv->dbell_atmu_regs->rowtar, destid << 22);
198                 out_be16(priv->dbell_win, data);
199                 break;
200         case RIO_PHY_SERIAL:
201                 /* In the serial version silicons, such as MPC8548, MPC8641,
202                  * below operations is must be.
203                  */
204                 out_be32(&priv->msg_regs->odmr, 0x00000000);
205                 out_be32(&priv->msg_regs->odretcr, 0x00000004);
206                 out_be32(&priv->msg_regs->oddpr, destid << 16);
207                 out_be32(&priv->msg_regs->oddatr, data);
208                 out_be32(&priv->msg_regs->odmr, 0x00000001);
209                 break;
210         }
211
212         return 0;
213 }
214
215 /**
216  * fsl_local_config_read - Generate a MPC85xx local config space read
217  * @mport: RapidIO master port info
218  * @index: ID of RapdiIO interface
219  * @offset: Offset into configuration space
220  * @len: Length (in bytes) of the maintenance transaction
221  * @data: Value to be read into
222  *
223  * Generates a MPC85xx local configuration space read. Returns %0 on
224  * success or %-EINVAL on failure.
225  */
226 static int fsl_local_config_read(struct rio_mport *mport,
227                                 int index, u32 offset, int len, u32 *data)
228 {
229         struct rio_priv *priv = mport->priv;
230         pr_debug("fsl_local_config_read: index %d offset %8.8x\n", index,
231                  offset);
232         *data = in_be32(priv->regs_win + offset);
233
234         return 0;
235 }
236
237 /**
238  * fsl_local_config_write - Generate a MPC85xx local config space write
239  * @mport: RapidIO master port info
240  * @index: ID of RapdiIO interface
241  * @offset: Offset into configuration space
242  * @len: Length (in bytes) of the maintenance transaction
243  * @data: Value to be written
244  *
245  * Generates a MPC85xx local configuration space write. Returns %0 on
246  * success or %-EINVAL on failure.
247  */
248 static int fsl_local_config_write(struct rio_mport *mport,
249                                 int index, u32 offset, int len, u32 data)
250 {
251         struct rio_priv *priv = mport->priv;
252         pr_debug
253             ("fsl_local_config_write: index %d offset %8.8x data %8.8x\n",
254              index, offset, data);
255         out_be32(priv->regs_win + offset, data);
256
257         return 0;
258 }
259
260 /**
261  * fsl_rio_config_read - Generate a MPC85xx read maintenance transaction
262  * @mport: RapidIO master port info
263  * @index: ID of RapdiIO interface
264  * @destid: Destination ID of transaction
265  * @hopcount: Number of hops to target device
266  * @offset: Offset into configuration space
267  * @len: Length (in bytes) of the maintenance transaction
268  * @val: Location to be read into
269  *
270  * Generates a MPC85xx read maintenance transaction. Returns %0 on
271  * success or %-EINVAL on failure.
272  */
273 static int
274 fsl_rio_config_read(struct rio_mport *mport, int index, u16 destid,
275                         u8 hopcount, u32 offset, int len, u32 *val)
276 {
277         struct rio_priv *priv = mport->priv;
278         u8 *data;
279
280         pr_debug
281             ("fsl_rio_config_read: index %d destid %d hopcount %d offset %8.8x len %d\n",
282              index, destid, hopcount, offset, len);
283         out_be32(&priv->maint_atmu_regs->rowtar,
284                  (destid << 22) | (hopcount << 12) | ((offset & ~0x3) >> 9));
285
286         data = (u8 *) priv->maint_win + offset;
287         switch (len) {
288         case 1:
289                 *val = in_8((u8 *) data);
290                 break;
291         case 2:
292                 *val = in_be16((u16 *) data);
293                 break;
294         default:
295                 *val = in_be32((u32 *) data);
296                 break;
297         }
298
299         return 0;
300 }
301
302 /**
303  * fsl_rio_config_write - Generate a MPC85xx write maintenance transaction
304  * @mport: RapidIO master port info
305  * @index: ID of RapdiIO interface
306  * @destid: Destination ID of transaction
307  * @hopcount: Number of hops to target device
308  * @offset: Offset into configuration space
309  * @len: Length (in bytes) of the maintenance transaction
310  * @val: Value to be written
311  *
312  * Generates an MPC85xx write maintenance transaction. Returns %0 on
313  * success or %-EINVAL on failure.
314  */
315 static int
316 fsl_rio_config_write(struct rio_mport *mport, int index, u16 destid,
317                         u8 hopcount, u32 offset, int len, u32 val)
318 {
319         struct rio_priv *priv = mport->priv;
320         u8 *data;
321         pr_debug
322             ("fsl_rio_config_write: index %d destid %d hopcount %d offset %8.8x len %d val %8.8x\n",
323              index, destid, hopcount, offset, len, val);
324         out_be32(&priv->maint_atmu_regs->rowtar,
325                  (destid << 22) | (hopcount << 12) | ((offset & ~0x3) >> 9));
326
327         data = (u8 *) priv->maint_win + offset;
328         switch (len) {
329         case 1:
330                 out_8((u8 *) data, val);
331                 break;
332         case 2:
333                 out_be16((u16 *) data, val);
334                 break;
335         default:
336                 out_be32((u32 *) data, val);
337                 break;
338         }
339
340         return 0;
341 }
342
343 /**
344  * rio_hw_add_outb_message - Add message to the MPC85xx outbound message queue
345  * @mport: Master port with outbound message queue
346  * @rdev: Target of outbound message
347  * @mbox: Outbound mailbox
348  * @buffer: Message to add to outbound queue
349  * @len: Length of message
350  *
351  * Adds the @buffer message to the MPC85xx outbound message queue. Returns
352  * %0 on success or %-EINVAL on failure.
353  */
354 int
355 rio_hw_add_outb_message(struct rio_mport *mport, struct rio_dev *rdev, int mbox,
356                         void *buffer, size_t len)
357 {
358         struct rio_priv *priv = mport->priv;
359         u32 omr;
360         struct rio_tx_desc *desc = (struct rio_tx_desc *)priv->msg_tx_ring.virt
361                                         + priv->msg_tx_ring.tx_slot;
362         int ret = 0;
363
364         pr_debug
365             ("RIO: rio_hw_add_outb_message(): destid %4.4x mbox %d buffer %8.8x len %8.8x\n",
366              rdev->destid, mbox, (int)buffer, len);
367
368         if ((len < 8) || (len > RIO_MAX_MSG_SIZE)) {
369                 ret = -EINVAL;
370                 goto out;
371         }
372
373         /* Copy and clear rest of buffer */
374         memcpy(priv->msg_tx_ring.virt_buffer[priv->msg_tx_ring.tx_slot], buffer,
375                         len);
376         if (len < (RIO_MAX_MSG_SIZE - 4))
377                 memset(priv->msg_tx_ring.virt_buffer[priv->msg_tx_ring.tx_slot]
378                                 + len, 0, RIO_MAX_MSG_SIZE - len);
379
380         switch (mport->phy_type) {
381         case RIO_PHY_PARALLEL:
382                 /* Set mbox field for message */
383                 desc->dport = mbox & 0x3;
384
385                 /* Enable EOMI interrupt, set priority, and set destid */
386                 desc->dattr = 0x28000000 | (rdev->destid << 2);
387                 break;
388         case RIO_PHY_SERIAL:
389                 /* Set mbox field for message, and set destid */
390                 desc->dport = (rdev->destid << 16) | (mbox & 0x3);
391
392                 /* Enable EOMI interrupt and priority */
393                 desc->dattr = 0x28000000;
394                 break;
395         }
396
397         /* Set transfer size aligned to next power of 2 (in double words) */
398         desc->dwcnt = is_power_of_2(len) ? len : 1 << get_bitmask_order(len);
399
400         /* Set snooping and source buffer address */
401         desc->saddr = 0x00000004
402                 | priv->msg_tx_ring.phys_buffer[priv->msg_tx_ring.tx_slot];
403
404         /* Increment enqueue pointer */
405         omr = in_be32(&priv->msg_regs->omr);
406         out_be32(&priv->msg_regs->omr, omr | RIO_MSG_OMR_MUI);
407
408         /* Go to next descriptor */
409         if (++priv->msg_tx_ring.tx_slot == priv->msg_tx_ring.size)
410                 priv->msg_tx_ring.tx_slot = 0;
411
412       out:
413         return ret;
414 }
415
416 EXPORT_SYMBOL_GPL(rio_hw_add_outb_message);
417
418 /**
419  * fsl_rio_tx_handler - MPC85xx outbound message interrupt handler
420  * @irq: Linux interrupt number
421  * @dev_instance: Pointer to interrupt-specific data
422  *
423  * Handles outbound message interrupts. Executes a register outbound
424  * mailbox event handler and acks the interrupt occurrence.
425  */
426 static irqreturn_t
427 fsl_rio_tx_handler(int irq, void *dev_instance)
428 {
429         int osr;
430         struct rio_mport *port = (struct rio_mport *)dev_instance;
431         struct rio_priv *priv = port->priv;
432
433         osr = in_be32(&priv->msg_regs->osr);
434
435         if (osr & RIO_MSG_OSR_TE) {
436                 pr_info("RIO: outbound message transmission error\n");
437                 out_be32(&priv->msg_regs->osr, RIO_MSG_OSR_TE);
438                 goto out;
439         }
440
441         if (osr & RIO_MSG_OSR_QOI) {
442                 pr_info("RIO: outbound message queue overflow\n");
443                 out_be32(&priv->msg_regs->osr, RIO_MSG_OSR_QOI);
444                 goto out;
445         }
446
447         if (osr & RIO_MSG_OSR_EOMI) {
448                 u32 dqp = in_be32(&priv->msg_regs->odqdpar);
449                 int slot = (dqp - priv->msg_tx_ring.phys) >> 5;
450                 port->outb_msg[0].mcback(port, priv->msg_tx_ring.dev_id, -1,
451                                 slot);
452
453                 /* Ack the end-of-message interrupt */
454                 out_be32(&priv->msg_regs->osr, RIO_MSG_OSR_EOMI);
455         }
456
457       out:
458         return IRQ_HANDLED;
459 }
460
461 /**
462  * rio_open_outb_mbox - Initialize MPC85xx outbound mailbox
463  * @mport: Master port implementing the outbound message unit
464  * @dev_id: Device specific pointer to pass on event
465  * @mbox: Mailbox to open
466  * @entries: Number of entries in the outbound mailbox ring
467  *
468  * Initializes buffer ring, request the outbound message interrupt,
469  * and enables the outbound message unit. Returns %0 on success and
470  * %-EINVAL or %-ENOMEM on failure.
471  */
472 int rio_open_outb_mbox(struct rio_mport *mport, void *dev_id, int mbox, int entries)
473 {
474         int i, j, rc = 0;
475         struct rio_priv *priv = mport->priv;
476
477         if ((entries < RIO_MIN_TX_RING_SIZE) ||
478             (entries > RIO_MAX_TX_RING_SIZE) || (!is_power_of_2(entries))) {
479                 rc = -EINVAL;
480                 goto out;
481         }
482
483         /* Initialize shadow copy ring */
484         priv->msg_tx_ring.dev_id = dev_id;
485         priv->msg_tx_ring.size = entries;
486
487         for (i = 0; i < priv->msg_tx_ring.size; i++) {
488                 priv->msg_tx_ring.virt_buffer[i] =
489                         dma_alloc_coherent(priv->dev, RIO_MSG_BUFFER_SIZE,
490                                 &priv->msg_tx_ring.phys_buffer[i], GFP_KERNEL);
491                 if (!priv->msg_tx_ring.virt_buffer[i]) {
492                         rc = -ENOMEM;
493                         for (j = 0; j < priv->msg_tx_ring.size; j++)
494                                 if (priv->msg_tx_ring.virt_buffer[j])
495                                         dma_free_coherent(priv->dev,
496                                                         RIO_MSG_BUFFER_SIZE,
497                                                         priv->msg_tx_ring.
498                                                         virt_buffer[j],
499                                                         priv->msg_tx_ring.
500                                                         phys_buffer[j]);
501                         goto out;
502                 }
503         }
504
505         /* Initialize outbound message descriptor ring */
506         priv->msg_tx_ring.virt = dma_alloc_coherent(priv->dev,
507                                 priv->msg_tx_ring.size * RIO_MSG_DESC_SIZE,
508                                 &priv->msg_tx_ring.phys, GFP_KERNEL);
509         if (!priv->msg_tx_ring.virt) {
510                 rc = -ENOMEM;
511                 goto out_dma;
512         }
513         memset(priv->msg_tx_ring.virt, 0,
514                         priv->msg_tx_ring.size * RIO_MSG_DESC_SIZE);
515         priv->msg_tx_ring.tx_slot = 0;
516
517         /* Point dequeue/enqueue pointers at first entry in ring */
518         out_be32(&priv->msg_regs->odqdpar, priv->msg_tx_ring.phys);
519         out_be32(&priv->msg_regs->odqepar, priv->msg_tx_ring.phys);
520
521         /* Configure for snooping */
522         out_be32(&priv->msg_regs->osar, 0x00000004);
523
524         /* Clear interrupt status */
525         out_be32(&priv->msg_regs->osr, 0x000000b3);
526
527         /* Hook up outbound message handler */
528         rc = request_irq(IRQ_RIO_TX(mport), fsl_rio_tx_handler, 0,
529                          "msg_tx", (void *)mport);
530         if (rc < 0)
531                 goto out_irq;
532
533         /*
534          * Configure outbound message unit
535          *      Snooping
536          *      Interrupts (all enabled, except QEIE)
537          *      Chaining mode
538          *      Disable
539          */
540         out_be32(&priv->msg_regs->omr, 0x00100220);
541
542         /* Set number of entries */
543         out_be32(&priv->msg_regs->omr,
544                  in_be32(&priv->msg_regs->omr) |
545                  ((get_bitmask_order(entries) - 2) << 12));
546
547         /* Now enable the unit */
548         out_be32(&priv->msg_regs->omr, in_be32(&priv->msg_regs->omr) | 0x1);
549
550       out:
551         return rc;
552
553       out_irq:
554         dma_free_coherent(priv->dev,
555                           priv->msg_tx_ring.size * RIO_MSG_DESC_SIZE,
556                           priv->msg_tx_ring.virt, priv->msg_tx_ring.phys);
557
558       out_dma:
559         for (i = 0; i < priv->msg_tx_ring.size; i++)
560                 dma_free_coherent(priv->dev, RIO_MSG_BUFFER_SIZE,
561                                   priv->msg_tx_ring.virt_buffer[i],
562                                   priv->msg_tx_ring.phys_buffer[i]);
563
564         return rc;
565 }
566
567 /**
568  * rio_close_outb_mbox - Shut down MPC85xx outbound mailbox
569  * @mport: Master port implementing the outbound message unit
570  * @mbox: Mailbox to close
571  *
572  * Disables the outbound message unit, free all buffers, and
573  * frees the outbound message interrupt.
574  */
575 void rio_close_outb_mbox(struct rio_mport *mport, int mbox)
576 {
577         struct rio_priv *priv = mport->priv;
578         /* Disable inbound message unit */
579         out_be32(&priv->msg_regs->omr, 0);
580
581         /* Free ring */
582         dma_free_coherent(priv->dev,
583                           priv->msg_tx_ring.size * RIO_MSG_DESC_SIZE,
584                           priv->msg_tx_ring.virt, priv->msg_tx_ring.phys);
585
586         /* Free interrupt */
587         free_irq(IRQ_RIO_TX(mport), (void *)mport);
588 }
589
590 /**
591  * fsl_rio_rx_handler - MPC85xx inbound message interrupt handler
592  * @irq: Linux interrupt number
593  * @dev_instance: Pointer to interrupt-specific data
594  *
595  * Handles inbound message interrupts. Executes a registered inbound
596  * mailbox event handler and acks the interrupt occurrence.
597  */
598 static irqreturn_t
599 fsl_rio_rx_handler(int irq, void *dev_instance)
600 {
601         int isr;
602         struct rio_mport *port = (struct rio_mport *)dev_instance;
603         struct rio_priv *priv = port->priv;
604
605         isr = in_be32(&priv->msg_regs->isr);
606
607         if (isr & RIO_MSG_ISR_TE) {
608                 pr_info("RIO: inbound message reception error\n");
609                 out_be32((void *)&priv->msg_regs->isr, RIO_MSG_ISR_TE);
610                 goto out;
611         }
612
613         /* XXX Need to check/dispatch until queue empty */
614         if (isr & RIO_MSG_ISR_DIQI) {
615                 /*
616                  * We implement *only* mailbox 0, but can receive messages
617                  * for any mailbox/letter to that mailbox destination. So,
618                  * make the callback with an unknown/invalid mailbox number
619                  * argument.
620                  */
621                 port->inb_msg[0].mcback(port, priv->msg_rx_ring.dev_id, -1, -1);
622
623                 /* Ack the queueing interrupt */
624                 out_be32(&priv->msg_regs->isr, RIO_MSG_ISR_DIQI);
625         }
626
627       out:
628         return IRQ_HANDLED;
629 }
630
631 /**
632  * rio_open_inb_mbox - Initialize MPC85xx inbound mailbox
633  * @mport: Master port implementing the inbound message unit
634  * @dev_id: Device specific pointer to pass on event
635  * @mbox: Mailbox to open
636  * @entries: Number of entries in the inbound mailbox ring
637  *
638  * Initializes buffer ring, request the inbound message interrupt,
639  * and enables the inbound message unit. Returns %0 on success
640  * and %-EINVAL or %-ENOMEM on failure.
641  */
642 int rio_open_inb_mbox(struct rio_mport *mport, void *dev_id, int mbox, int entries)
643 {
644         int i, rc = 0;
645         struct rio_priv *priv = mport->priv;
646
647         if ((entries < RIO_MIN_RX_RING_SIZE) ||
648             (entries > RIO_MAX_RX_RING_SIZE) || (!is_power_of_2(entries))) {
649                 rc = -EINVAL;
650                 goto out;
651         }
652
653         /* Initialize client buffer ring */
654         priv->msg_rx_ring.dev_id = dev_id;
655         priv->msg_rx_ring.size = entries;
656         priv->msg_rx_ring.rx_slot = 0;
657         for (i = 0; i < priv->msg_rx_ring.size; i++)
658                 priv->msg_rx_ring.virt_buffer[i] = NULL;
659
660         /* Initialize inbound message ring */
661         priv->msg_rx_ring.virt = dma_alloc_coherent(priv->dev,
662                                 priv->msg_rx_ring.size * RIO_MAX_MSG_SIZE,
663                                 &priv->msg_rx_ring.phys, GFP_KERNEL);
664         if (!priv->msg_rx_ring.virt) {
665                 rc = -ENOMEM;
666                 goto out;
667         }
668
669         /* Point dequeue/enqueue pointers at first entry in ring */
670         out_be32(&priv->msg_regs->ifqdpar, (u32) priv->msg_rx_ring.phys);
671         out_be32(&priv->msg_regs->ifqepar, (u32) priv->msg_rx_ring.phys);
672
673         /* Clear interrupt status */
674         out_be32(&priv->msg_regs->isr, 0x00000091);
675
676         /* Hook up inbound message handler */
677         rc = request_irq(IRQ_RIO_RX(mport), fsl_rio_rx_handler, 0,
678                          "msg_rx", (void *)mport);
679         if (rc < 0) {
680                 dma_free_coherent(priv->dev, RIO_MSG_BUFFER_SIZE,
681                                   priv->msg_tx_ring.virt_buffer[i],
682                                   priv->msg_tx_ring.phys_buffer[i]);
683                 goto out;
684         }
685
686         /*
687          * Configure inbound message unit:
688          *      Snooping
689          *      4KB max message size
690          *      Unmask all interrupt sources
691          *      Disable
692          */
693         out_be32(&priv->msg_regs->imr, 0x001b0060);
694
695         /* Set number of queue entries */
696         setbits32(&priv->msg_regs->imr, (get_bitmask_order(entries) - 2) << 12);
697
698         /* Now enable the unit */
699         setbits32(&priv->msg_regs->imr, 0x1);
700
701       out:
702         return rc;
703 }
704
705 /**
706  * rio_close_inb_mbox - Shut down MPC85xx inbound mailbox
707  * @mport: Master port implementing the inbound message unit
708  * @mbox: Mailbox to close
709  *
710  * Disables the inbound message unit, free all buffers, and
711  * frees the inbound message interrupt.
712  */
713 void rio_close_inb_mbox(struct rio_mport *mport, int mbox)
714 {
715         struct rio_priv *priv = mport->priv;
716         /* Disable inbound message unit */
717         out_be32(&priv->msg_regs->imr, 0);
718
719         /* Free ring */
720         dma_free_coherent(priv->dev, priv->msg_rx_ring.size * RIO_MAX_MSG_SIZE,
721                           priv->msg_rx_ring.virt, priv->msg_rx_ring.phys);
722
723         /* Free interrupt */
724         free_irq(IRQ_RIO_RX(mport), (void *)mport);
725 }
726
727 /**
728  * rio_hw_add_inb_buffer - Add buffer to the MPC85xx inbound message queue
729  * @mport: Master port implementing the inbound message unit
730  * @mbox: Inbound mailbox number
731  * @buf: Buffer to add to inbound queue
732  *
733  * Adds the @buf buffer to the MPC85xx inbound message queue. Returns
734  * %0 on success or %-EINVAL on failure.
735  */
736 int rio_hw_add_inb_buffer(struct rio_mport *mport, int mbox, void *buf)
737 {
738         int rc = 0;
739         struct rio_priv *priv = mport->priv;
740
741         pr_debug("RIO: rio_hw_add_inb_buffer(), msg_rx_ring.rx_slot %d\n",
742                  priv->msg_rx_ring.rx_slot);
743
744         if (priv->msg_rx_ring.virt_buffer[priv->msg_rx_ring.rx_slot]) {
745                 printk(KERN_ERR
746                        "RIO: error adding inbound buffer %d, buffer exists\n",
747                        priv->msg_rx_ring.rx_slot);
748                 rc = -EINVAL;
749                 goto out;
750         }
751
752         priv->msg_rx_ring.virt_buffer[priv->msg_rx_ring.rx_slot] = buf;
753         if (++priv->msg_rx_ring.rx_slot == priv->msg_rx_ring.size)
754                 priv->msg_rx_ring.rx_slot = 0;
755
756       out:
757         return rc;
758 }
759
760 EXPORT_SYMBOL_GPL(rio_hw_add_inb_buffer);
761
762 /**
763  * rio_hw_get_inb_message - Fetch inbound message from the MPC85xx message unit
764  * @mport: Master port implementing the inbound message unit
765  * @mbox: Inbound mailbox number
766  *
767  * Gets the next available inbound message from the inbound message queue.
768  * A pointer to the message is returned on success or NULL on failure.
769  */
770 void *rio_hw_get_inb_message(struct rio_mport *mport, int mbox)
771 {
772         struct rio_priv *priv = mport->priv;
773         u32 phys_buf, virt_buf;
774         void *buf = NULL;
775         int buf_idx;
776
777         phys_buf = in_be32(&priv->msg_regs->ifqdpar);
778
779         /* If no more messages, then bail out */
780         if (phys_buf == in_be32(&priv->msg_regs->ifqepar))
781                 goto out2;
782
783         virt_buf = (u32) priv->msg_rx_ring.virt + (phys_buf
784                                                 - priv->msg_rx_ring.phys);
785         buf_idx = (phys_buf - priv->msg_rx_ring.phys) / RIO_MAX_MSG_SIZE;
786         buf = priv->msg_rx_ring.virt_buffer[buf_idx];
787
788         if (!buf) {
789                 printk(KERN_ERR
790                        "RIO: inbound message copy failed, no buffers\n");
791                 goto out1;
792         }
793
794         /* Copy max message size, caller is expected to allocate that big */
795         memcpy(buf, (void *)virt_buf, RIO_MAX_MSG_SIZE);
796
797         /* Clear the available buffer */
798         priv->msg_rx_ring.virt_buffer[buf_idx] = NULL;
799
800       out1:
801         setbits32(&priv->msg_regs->imr, RIO_MSG_IMR_MI);
802
803       out2:
804         return buf;
805 }
806
807 EXPORT_SYMBOL_GPL(rio_hw_get_inb_message);
808
809 /**
810  * fsl_rio_dbell_handler - MPC85xx doorbell interrupt handler
811  * @irq: Linux interrupt number
812  * @dev_instance: Pointer to interrupt-specific data
813  *
814  * Handles doorbell interrupts. Parses a list of registered
815  * doorbell event handlers and executes a matching event handler.
816  */
817 static irqreturn_t
818 fsl_rio_dbell_handler(int irq, void *dev_instance)
819 {
820         int dsr;
821         struct rio_mport *port = (struct rio_mport *)dev_instance;
822         struct rio_priv *priv = port->priv;
823
824         dsr = in_be32(&priv->msg_regs->dsr);
825
826         if (dsr & DOORBELL_DSR_TE) {
827                 pr_info("RIO: doorbell reception error\n");
828                 out_be32(&priv->msg_regs->dsr, DOORBELL_DSR_TE);
829                 goto out;
830         }
831
832         if (dsr & DOORBELL_DSR_QFI) {
833                 pr_info("RIO: doorbell queue full\n");
834                 out_be32(&priv->msg_regs->dsr, DOORBELL_DSR_QFI);
835                 goto out;
836         }
837
838         /* XXX Need to check/dispatch until queue empty */
839         if (dsr & DOORBELL_DSR_DIQI) {
840                 u32 dmsg =
841                     (u32) priv->dbell_ring.virt +
842                     (in_be32(&priv->msg_regs->dqdpar) & 0xfff);
843                 struct rio_dbell *dbell;
844                 int found = 0;
845
846                 pr_debug
847                     ("RIO: processing doorbell, sid %2.2x tid %2.2x info %4.4x\n",
848                      DBELL_SID(dmsg), DBELL_TID(dmsg), DBELL_INF(dmsg));
849
850                 list_for_each_entry(dbell, &port->dbells, node) {
851                         if ((dbell->res->start <= DBELL_INF(dmsg)) &&
852                             (dbell->res->end >= DBELL_INF(dmsg))) {
853                                 found = 1;
854                                 break;
855                         }
856                 }
857                 if (found) {
858                         dbell->dinb(port, dbell->dev_id, DBELL_SID(dmsg), DBELL_TID(dmsg),
859                                     DBELL_INF(dmsg));
860                 } else {
861                         pr_debug
862                             ("RIO: spurious doorbell, sid %2.2x tid %2.2x info %4.4x\n",
863                              DBELL_SID(dmsg), DBELL_TID(dmsg), DBELL_INF(dmsg));
864                 }
865                 setbits32(&priv->msg_regs->dmr, DOORBELL_DMR_DI);
866                 out_be32(&priv->msg_regs->dsr, DOORBELL_DSR_DIQI);
867         }
868
869       out:
870         return IRQ_HANDLED;
871 }
872
873 /**
874  * fsl_rio_doorbell_init - MPC85xx doorbell interface init
875  * @mport: Master port implementing the inbound doorbell unit
876  *
877  * Initializes doorbell unit hardware and inbound DMA buffer
878  * ring. Called from fsl_rio_setup(). Returns %0 on success
879  * or %-ENOMEM on failure.
880  */
881 static int fsl_rio_doorbell_init(struct rio_mport *mport)
882 {
883         struct rio_priv *priv = mport->priv;
884         int rc = 0;
885
886         /* Map outbound doorbell window immediately after maintenance window */
887         priv->dbell_win = ioremap(mport->iores.start + RIO_MAINT_WIN_SIZE,
888                             RIO_DBELL_WIN_SIZE);
889         if (!priv->dbell_win) {
890                 printk(KERN_ERR
891                        "RIO: unable to map outbound doorbell window\n");
892                 rc = -ENOMEM;
893                 goto out;
894         }
895
896         /* Initialize inbound doorbells */
897         priv->dbell_ring.virt = dma_alloc_coherent(priv->dev, 512 *
898                     DOORBELL_MESSAGE_SIZE, &priv->dbell_ring.phys, GFP_KERNEL);
899         if (!priv->dbell_ring.virt) {
900                 printk(KERN_ERR "RIO: unable allocate inbound doorbell ring\n");
901                 rc = -ENOMEM;
902                 iounmap(priv->dbell_win);
903                 goto out;
904         }
905
906         /* Point dequeue/enqueue pointers at first entry in ring */
907         out_be32(&priv->msg_regs->dqdpar, (u32) priv->dbell_ring.phys);
908         out_be32(&priv->msg_regs->dqepar, (u32) priv->dbell_ring.phys);
909
910         /* Clear interrupt status */
911         out_be32(&priv->msg_regs->dsr, 0x00000091);
912
913         /* Hook up doorbell handler */
914         rc = request_irq(IRQ_RIO_BELL(mport), fsl_rio_dbell_handler, 0,
915                          "dbell_rx", (void *)mport);
916         if (rc < 0) {
917                 iounmap(priv->dbell_win);
918                 dma_free_coherent(priv->dev, 512 * DOORBELL_MESSAGE_SIZE,
919                                   priv->dbell_ring.virt, priv->dbell_ring.phys);
920                 printk(KERN_ERR
921                        "MPC85xx RIO: unable to request inbound doorbell irq");
922                 goto out;
923         }
924
925         /* Configure doorbells for snooping, 512 entries, and enable */
926         out_be32(&priv->msg_regs->dmr, 0x00108161);
927
928       out:
929         return rc;
930 }
931
932 static char *cmdline = NULL;
933
934 static int fsl_rio_get_hdid(int index)
935 {
936         /* XXX Need to parse multiple entries in some format */
937         if (!cmdline)
938                 return -1;
939
940         return simple_strtol(cmdline, NULL, 0);
941 }
942
943 static int fsl_rio_get_cmdline(char *s)
944 {
945         if (!s)
946                 return 0;
947
948         cmdline = s;
949         return 1;
950 }
951
952 __setup("riohdid=", fsl_rio_get_cmdline);
953
954 static inline void fsl_rio_info(struct device *dev, u32 ccsr)
955 {
956         const char *str;
957         if (ccsr & 1) {
958                 /* Serial phy */
959                 switch (ccsr >> 30) {
960                 case 0:
961                         str = "1";
962                         break;
963                 case 1:
964                         str = "4";
965                         break;
966                 default:
967                         str = "Unknown";
968                         break;;
969                 }
970                 dev_info(dev, "Hardware port width: %s\n", str);
971
972                 switch ((ccsr >> 27) & 7) {
973                 case 0:
974                         str = "Single-lane 0";
975                         break;
976                 case 1:
977                         str = "Single-lane 2";
978                         break;
979                 case 2:
980                         str = "Four-lane";
981                         break;
982                 default:
983                         str = "Unknown";
984                         break;
985                 }
986                 dev_info(dev, "Training connection status: %s\n", str);
987         } else {
988                 /* Parallel phy */
989                 if (!(ccsr & 0x80000000))
990                         dev_info(dev, "Output port operating in 8-bit mode\n");
991                 if (!(ccsr & 0x08000000))
992                         dev_info(dev, "Input port operating in 8-bit mode\n");
993         }
994 }
995
996 /**
997  * fsl_rio_setup - Setup Freescale PowerPC RapidIO interface
998  * @dev: of_device pointer
999  *
1000  * Initializes MPC85xx RapidIO hardware interface, configures
1001  * master port with system-specific info, and registers the
1002  * master port with the RapidIO subsystem.
1003  */
1004 int fsl_rio_setup(struct of_device *dev)
1005 {
1006         struct rio_ops *ops;
1007         struct rio_mport *port;
1008         struct rio_priv *priv;
1009         int rc = 0;
1010         const u32 *dt_range, *cell;
1011         struct resource regs;
1012         int rlen;
1013         u32 ccsr;
1014         u64 law_start, law_size;
1015         int paw, aw, sw;
1016
1017         if (!dev->node) {
1018                 dev_err(&dev->dev, "Device OF-Node is NULL");
1019                 return -EFAULT;
1020         }
1021
1022         rc = of_address_to_resource(dev->node, 0, &regs);
1023         if (rc) {
1024                 dev_err(&dev->dev, "Can't get %s property 'reg'\n",
1025                                 dev->node->full_name);
1026                 return -EFAULT;
1027         }
1028         dev_info(&dev->dev, "Of-device full name %s\n", dev->node->full_name);
1029         dev_info(&dev->dev, "Regs start 0x%08x size 0x%08x\n",  regs.start,
1030                                                 regs.end - regs.start + 1);
1031
1032         dt_range = of_get_property(dev->node, "ranges", &rlen);
1033         if (!dt_range) {
1034                 dev_err(&dev->dev, "Can't get %s property 'ranges'\n",
1035                                 dev->node->full_name);
1036                 return -EFAULT;
1037         }
1038
1039         /* Get node address wide */
1040         cell = of_get_property(dev->node, "#address-cells", NULL);
1041         if (cell)
1042                 aw = *cell;
1043         else
1044                 aw = of_n_addr_cells(dev->node);
1045         /* Get node size wide */
1046         cell = of_get_property(dev->node, "#size-cells", NULL);
1047         if (cell)
1048                 sw = *cell;
1049         else
1050                 sw = of_n_size_cells(dev->node);
1051         /* Get parent address wide wide */
1052         paw = of_n_addr_cells(dev->node);
1053
1054         law_start = of_read_number(dt_range + aw, paw);
1055         law_size = of_read_number(dt_range + aw + paw, sw);
1056
1057         dev_info(&dev->dev, "LAW start 0x%016llx, size 0x%016llx.\n",
1058                         law_start, law_size);
1059
1060         ops = kmalloc(sizeof(struct rio_ops), GFP_KERNEL);
1061         ops->lcread = fsl_local_config_read;
1062         ops->lcwrite = fsl_local_config_write;
1063         ops->cread = fsl_rio_config_read;
1064         ops->cwrite = fsl_rio_config_write;
1065         ops->dsend = fsl_rio_doorbell_send;
1066
1067         port = kzalloc(sizeof(struct rio_mport), GFP_KERNEL);
1068         port->id = 0;
1069         port->index = 0;
1070
1071         priv = kzalloc(sizeof(struct rio_priv), GFP_KERNEL);
1072         if (!priv) {
1073                 printk(KERN_ERR "Can't alloc memory for 'priv'\n");
1074                 rc = -ENOMEM;
1075                 goto err;
1076         }
1077
1078         INIT_LIST_HEAD(&port->dbells);
1079         port->iores.start = law_start;
1080         port->iores.end = law_start + law_size;
1081         port->iores.flags = IORESOURCE_MEM;
1082
1083         priv->bellirq = irq_of_parse_and_map(dev->node, 2);
1084         priv->txirq = irq_of_parse_and_map(dev->node, 3);
1085         priv->rxirq = irq_of_parse_and_map(dev->node, 4);
1086         dev_info(&dev->dev, "bellirq: %d, txirq: %d, rxirq %d\n", priv->bellirq,
1087                                 priv->txirq, priv->rxirq);
1088
1089         rio_init_dbell_res(&port->riores[RIO_DOORBELL_RESOURCE], 0, 0xffff);
1090         rio_init_mbox_res(&port->riores[RIO_INB_MBOX_RESOURCE], 0, 0);
1091         rio_init_mbox_res(&port->riores[RIO_OUTB_MBOX_RESOURCE], 0, 0);
1092         strcpy(port->name, "RIO0 mport");
1093
1094         priv->dev = &dev->dev;
1095
1096         port->ops = ops;
1097         port->host_deviceid = fsl_rio_get_hdid(port->id);
1098
1099         port->priv = priv;
1100         rio_register_mport(port);
1101
1102         priv->regs_win = ioremap(regs.start, regs.end - regs.start + 1);
1103
1104         /* Probe the master port phy type */
1105         ccsr = in_be32(priv->regs_win + RIO_CCSR);
1106         port->phy_type = (ccsr & 1) ? RIO_PHY_SERIAL : RIO_PHY_PARALLEL;
1107         dev_info(&dev->dev, "RapidIO PHY type: %s\n",
1108                         (port->phy_type == RIO_PHY_PARALLEL) ? "parallel" :
1109                         ((port->phy_type == RIO_PHY_SERIAL) ? "serial" :
1110                          "unknown"));
1111         /* Checking the port training status */
1112         if (in_be32((priv->regs_win + RIO_ESCSR)) & 1) {
1113                 dev_err(&dev->dev, "Port is not ready. "
1114                                    "Try to restart connection...\n");
1115                 switch (port->phy_type) {
1116                 case RIO_PHY_SERIAL:
1117                         /* Disable ports */
1118                         out_be32(priv->regs_win + RIO_CCSR, 0);
1119                         /* Set 1x lane */
1120                         setbits32(priv->regs_win + RIO_CCSR, 0x02000000);
1121                         /* Enable ports */
1122                         setbits32(priv->regs_win + RIO_CCSR, 0x00600000);
1123                         break;
1124                 case RIO_PHY_PARALLEL:
1125                         /* Disable ports */
1126                         out_be32(priv->regs_win + RIO_CCSR, 0x22000000);
1127                         /* Enable ports */
1128                         out_be32(priv->regs_win + RIO_CCSR, 0x44000000);
1129                         break;
1130                 }
1131                 msleep(100);
1132                 if (in_be32((priv->regs_win + RIO_ESCSR)) & 1) {
1133                         dev_err(&dev->dev, "Port restart failed.\n");
1134                         rc = -ENOLINK;
1135                         goto err;
1136                 }
1137                 dev_info(&dev->dev, "Port restart success!\n");
1138         }
1139         fsl_rio_info(&dev->dev, ccsr);
1140
1141         port->sys_size = (in_be32((priv->regs_win + RIO_PEF_CAR))
1142                                         & RIO_PEF_CTLS) >> 4;
1143         dev_info(&dev->dev, "RapidIO Common Transport System size: %d\n",
1144                         port->sys_size ? 65536 : 256);
1145
1146         priv->atmu_regs = (struct rio_atmu_regs *)(priv->regs_win
1147                                         + RIO_ATMU_REGS_OFFSET);
1148         priv->maint_atmu_regs = priv->atmu_regs + 1;
1149         priv->dbell_atmu_regs = priv->atmu_regs + 2;
1150         priv->msg_regs = (struct rio_msg_regs *)(priv->regs_win +
1151                                 ((port->phy_type == RIO_PHY_SERIAL) ?
1152                                 RIO_S_MSG_REGS_OFFSET : RIO_P_MSG_REGS_OFFSET));
1153
1154         /* Set to receive any dist ID for serial RapidIO controller. */
1155         if (port->phy_type == RIO_PHY_SERIAL)
1156                 out_be32((priv->regs_win + RIO_ISR_AACR), RIO_ISR_AACR_AA);
1157
1158         /* Configure maintenance transaction window */
1159         out_be32(&priv->maint_atmu_regs->rowbar, 0x000c0000);
1160         out_be32(&priv->maint_atmu_regs->rowar, 0x80077015);
1161
1162         priv->maint_win = ioremap(law_start, RIO_MAINT_WIN_SIZE);
1163
1164         /* Configure outbound doorbell window */
1165         out_be32(&priv->dbell_atmu_regs->rowbar, 0x000c0400);
1166         out_be32(&priv->dbell_atmu_regs->rowar, 0x8004200b);
1167         fsl_rio_doorbell_init(port);
1168
1169         return 0;
1170 err:
1171         if (priv)
1172                 iounmap(priv->regs_win);
1173         kfree(ops);
1174         kfree(priv);
1175         kfree(port);
1176         return rc;
1177 }
1178
1179 /* The probe function for RapidIO peer-to-peer network.
1180  */
1181 static int __devinit fsl_of_rio_rpn_probe(struct of_device *dev,
1182                                      const struct of_device_id *match)
1183 {
1184         int rc;
1185         printk(KERN_INFO "Setting up RapidIO peer-to-peer network %s\n",
1186                         dev->node->full_name);
1187
1188         rc = fsl_rio_setup(dev);
1189         if (rc)
1190                 goto out;
1191
1192         /* Enumerate all registered ports */
1193         rc = rio_init_mports();
1194 out:
1195         return rc;
1196 };
1197
1198 static const struct of_device_id fsl_of_rio_rpn_ids[] = {
1199         {
1200                 .compatible = "fsl,rapidio-delta",
1201         },
1202         {},
1203 };
1204
1205 static struct of_platform_driver fsl_of_rio_rpn_driver = {
1206         .name = "fsl-of-rio",
1207         .match_table = fsl_of_rio_rpn_ids,
1208         .probe = fsl_of_rio_rpn_probe,
1209 };
1210
1211 static __init int fsl_of_rio_rpn_init(void)
1212 {
1213         return of_register_platform_driver(&fsl_of_rio_rpn_driver);
1214 }
1215
1216 subsys_initcall(fsl_of_rio_rpn_init);