Merge branch 'for-linus' of git://git.kernel.dk/linux-block
[linux-2.6-block.git] / drivers / pci / host / pci-imx6.c
1 /*
2  * PCIe host controller driver for Freescale i.MX6 SoCs
3  *
4  * Copyright (C) 2013 Kosagi
5  *              http://www.kosagi.com
6  *
7  * Author: Sean Cross <xobs@kosagi.com>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  */
13
14 #include <linux/clk.h>
15 #include <linux/delay.h>
16 #include <linux/gpio.h>
17 #include <linux/kernel.h>
18 #include <linux/mfd/syscon.h>
19 #include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
20 #include <linux/module.h>
21 #include <linux/of_gpio.h>
22 #include <linux/pci.h>
23 #include <linux/platform_device.h>
24 #include <linux/regmap.h>
25 #include <linux/resource.h>
26 #include <linux/signal.h>
27 #include <linux/types.h>
28 #include <linux/interrupt.h>
29
30 #include "pcie-designware.h"
31
32 #define to_imx6_pcie(x) container_of(x, struct imx6_pcie, pp)
33
34 struct imx6_pcie {
35         int                     reset_gpio;
36         struct clk              *pcie_bus;
37         struct clk              *pcie_phy;
38         struct clk              *pcie;
39         struct pcie_port        pp;
40         struct regmap           *iomuxc_gpr;
41         void __iomem            *mem_base;
42 };
43
44 /* PCIe Root Complex registers (memory-mapped) */
45 #define PCIE_RC_LCR                             0x7c
46 #define PCIE_RC_LCR_MAX_LINK_SPEEDS_GEN1        0x1
47 #define PCIE_RC_LCR_MAX_LINK_SPEEDS_GEN2        0x2
48 #define PCIE_RC_LCR_MAX_LINK_SPEEDS_MASK        0xf
49
50 /* PCIe Port Logic registers (memory-mapped) */
51 #define PL_OFFSET 0x700
52 #define PCIE_PL_PFLR (PL_OFFSET + 0x08)
53 #define PCIE_PL_PFLR_LINK_STATE_MASK            (0x3f << 16)
54 #define PCIE_PL_PFLR_FORCE_LINK                 (1 << 15)
55 #define PCIE_PHY_DEBUG_R0 (PL_OFFSET + 0x28)
56 #define PCIE_PHY_DEBUG_R1 (PL_OFFSET + 0x2c)
57 #define PCIE_PHY_DEBUG_R1_XMLH_LINK_IN_TRAINING (1 << 29)
58 #define PCIE_PHY_DEBUG_R1_XMLH_LINK_UP          (1 << 4)
59
60 #define PCIE_PHY_CTRL (PL_OFFSET + 0x114)
61 #define PCIE_PHY_CTRL_DATA_LOC 0
62 #define PCIE_PHY_CTRL_CAP_ADR_LOC 16
63 #define PCIE_PHY_CTRL_CAP_DAT_LOC 17
64 #define PCIE_PHY_CTRL_WR_LOC 18
65 #define PCIE_PHY_CTRL_RD_LOC 19
66
67 #define PCIE_PHY_STAT (PL_OFFSET + 0x110)
68 #define PCIE_PHY_STAT_ACK_LOC 16
69
70 #define PCIE_LINK_WIDTH_SPEED_CONTROL   0x80C
71 #define PORT_LOGIC_SPEED_CHANGE         (0x1 << 17)
72
73 /* PHY registers (not memory-mapped) */
74 #define PCIE_PHY_RX_ASIC_OUT 0x100D
75
76 #define PHY_RX_OVRD_IN_LO 0x1005
77 #define PHY_RX_OVRD_IN_LO_RX_DATA_EN (1 << 5)
78 #define PHY_RX_OVRD_IN_LO_RX_PLL_EN (1 << 3)
79
80 static int pcie_phy_poll_ack(void __iomem *dbi_base, int exp_val)
81 {
82         u32 val;
83         u32 max_iterations = 10;
84         u32 wait_counter = 0;
85
86         do {
87                 val = readl(dbi_base + PCIE_PHY_STAT);
88                 val = (val >> PCIE_PHY_STAT_ACK_LOC) & 0x1;
89                 wait_counter++;
90
91                 if (val == exp_val)
92                         return 0;
93
94                 udelay(1);
95         } while (wait_counter < max_iterations);
96
97         return -ETIMEDOUT;
98 }
99
100 static int pcie_phy_wait_ack(void __iomem *dbi_base, int addr)
101 {
102         u32 val;
103         int ret;
104
105         val = addr << PCIE_PHY_CTRL_DATA_LOC;
106         writel(val, dbi_base + PCIE_PHY_CTRL);
107
108         val |= (0x1 << PCIE_PHY_CTRL_CAP_ADR_LOC);
109         writel(val, dbi_base + PCIE_PHY_CTRL);
110
111         ret = pcie_phy_poll_ack(dbi_base, 1);
112         if (ret)
113                 return ret;
114
115         val = addr << PCIE_PHY_CTRL_DATA_LOC;
116         writel(val, dbi_base + PCIE_PHY_CTRL);
117
118         ret = pcie_phy_poll_ack(dbi_base, 0);
119         if (ret)
120                 return ret;
121
122         return 0;
123 }
124
125 /* Read from the 16-bit PCIe PHY control registers (not memory-mapped) */
126 static int pcie_phy_read(void __iomem *dbi_base, int addr , int *data)
127 {
128         u32 val, phy_ctl;
129         int ret;
130
131         ret = pcie_phy_wait_ack(dbi_base, addr);
132         if (ret)
133                 return ret;
134
135         /* assert Read signal */
136         phy_ctl = 0x1 << PCIE_PHY_CTRL_RD_LOC;
137         writel(phy_ctl, dbi_base + PCIE_PHY_CTRL);
138
139         ret = pcie_phy_poll_ack(dbi_base, 1);
140         if (ret)
141                 return ret;
142
143         val = readl(dbi_base + PCIE_PHY_STAT);
144         *data = val & 0xffff;
145
146         /* deassert Read signal */
147         writel(0x00, dbi_base + PCIE_PHY_CTRL);
148
149         ret = pcie_phy_poll_ack(dbi_base, 0);
150         if (ret)
151                 return ret;
152
153         return 0;
154 }
155
156 static int pcie_phy_write(void __iomem *dbi_base, int addr, int data)
157 {
158         u32 var;
159         int ret;
160
161         /* write addr */
162         /* cap addr */
163         ret = pcie_phy_wait_ack(dbi_base, addr);
164         if (ret)
165                 return ret;
166
167         var = data << PCIE_PHY_CTRL_DATA_LOC;
168         writel(var, dbi_base + PCIE_PHY_CTRL);
169
170         /* capture data */
171         var |= (0x1 << PCIE_PHY_CTRL_CAP_DAT_LOC);
172         writel(var, dbi_base + PCIE_PHY_CTRL);
173
174         ret = pcie_phy_poll_ack(dbi_base, 1);
175         if (ret)
176                 return ret;
177
178         /* deassert cap data */
179         var = data << PCIE_PHY_CTRL_DATA_LOC;
180         writel(var, dbi_base + PCIE_PHY_CTRL);
181
182         /* wait for ack de-assertion */
183         ret = pcie_phy_poll_ack(dbi_base, 0);
184         if (ret)
185                 return ret;
186
187         /* assert wr signal */
188         var = 0x1 << PCIE_PHY_CTRL_WR_LOC;
189         writel(var, dbi_base + PCIE_PHY_CTRL);
190
191         /* wait for ack */
192         ret = pcie_phy_poll_ack(dbi_base, 1);
193         if (ret)
194                 return ret;
195
196         /* deassert wr signal */
197         var = data << PCIE_PHY_CTRL_DATA_LOC;
198         writel(var, dbi_base + PCIE_PHY_CTRL);
199
200         /* wait for ack de-assertion */
201         ret = pcie_phy_poll_ack(dbi_base, 0);
202         if (ret)
203                 return ret;
204
205         writel(0x0, dbi_base + PCIE_PHY_CTRL);
206
207         return 0;
208 }
209
210 /*  Added for PCI abort handling */
211 static int imx6q_pcie_abort_handler(unsigned long addr,
212                 unsigned int fsr, struct pt_regs *regs)
213 {
214         return 0;
215 }
216
217 static int imx6_pcie_assert_core_reset(struct pcie_port *pp)
218 {
219         struct imx6_pcie *imx6_pcie = to_imx6_pcie(pp);
220         u32 val, gpr1, gpr12;
221
222         /*
223          * If the bootloader already enabled the link we need some special
224          * handling to get the core back into a state where it is safe to
225          * touch it for configuration.  As there is no dedicated reset signal
226          * wired up for MX6QDL, we need to manually force LTSSM into "detect"
227          * state before completely disabling LTSSM, which is a prerequisite
228          * for core configuration.
229          *
230          * If both LTSSM_ENABLE and REF_SSP_ENABLE are active we have a strong
231          * indication that the bootloader activated the link.
232          */
233         regmap_read(imx6_pcie->iomuxc_gpr, IOMUXC_GPR1, &gpr1);
234         regmap_read(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12, &gpr12);
235
236         if ((gpr1 & IMX6Q_GPR1_PCIE_REF_CLK_EN) &&
237             (gpr12 & IMX6Q_GPR12_PCIE_CTL_2)) {
238                 val = readl(pp->dbi_base + PCIE_PL_PFLR);
239                 val &= ~PCIE_PL_PFLR_LINK_STATE_MASK;
240                 val |= PCIE_PL_PFLR_FORCE_LINK;
241                 writel(val, pp->dbi_base + PCIE_PL_PFLR);
242
243                 regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
244                                 IMX6Q_GPR12_PCIE_CTL_2, 0 << 10);
245         }
246
247         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR1,
248                         IMX6Q_GPR1_PCIE_TEST_PD, 1 << 18);
249         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR1,
250                         IMX6Q_GPR1_PCIE_REF_CLK_EN, 0 << 16);
251
252         return 0;
253 }
254
255 static int imx6_pcie_deassert_core_reset(struct pcie_port *pp)
256 {
257         struct imx6_pcie *imx6_pcie = to_imx6_pcie(pp);
258         int ret;
259
260         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR1,
261                         IMX6Q_GPR1_PCIE_TEST_PD, 0 << 18);
262         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR1,
263                         IMX6Q_GPR1_PCIE_REF_CLK_EN, 1 << 16);
264
265         ret = clk_prepare_enable(imx6_pcie->pcie_phy);
266         if (ret) {
267                 dev_err(pp->dev, "unable to enable pcie_phy clock\n");
268                 goto err_pcie_phy;
269         }
270
271         ret = clk_prepare_enable(imx6_pcie->pcie_bus);
272         if (ret) {
273                 dev_err(pp->dev, "unable to enable pcie_bus clock\n");
274                 goto err_pcie_bus;
275         }
276
277         ret = clk_prepare_enable(imx6_pcie->pcie);
278         if (ret) {
279                 dev_err(pp->dev, "unable to enable pcie clock\n");
280                 goto err_pcie;
281         }
282
283         /* allow the clocks to stabilize */
284         usleep_range(200, 500);
285
286         /* Some boards don't have PCIe reset GPIO. */
287         if (gpio_is_valid(imx6_pcie->reset_gpio)) {
288                 gpio_set_value(imx6_pcie->reset_gpio, 0);
289                 msleep(100);
290                 gpio_set_value(imx6_pcie->reset_gpio, 1);
291         }
292         return 0;
293
294 err_pcie:
295         clk_disable_unprepare(imx6_pcie->pcie_bus);
296 err_pcie_bus:
297         clk_disable_unprepare(imx6_pcie->pcie_phy);
298 err_pcie_phy:
299         return ret;
300
301 }
302
303 static void imx6_pcie_init_phy(struct pcie_port *pp)
304 {
305         struct imx6_pcie *imx6_pcie = to_imx6_pcie(pp);
306
307         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
308                         IMX6Q_GPR12_PCIE_CTL_2, 0 << 10);
309
310         /* configure constant input signal to the pcie ctrl and phy */
311         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
312                         IMX6Q_GPR12_DEVICE_TYPE, PCI_EXP_TYPE_ROOT_PORT << 12);
313         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
314                         IMX6Q_GPR12_LOS_LEVEL, 9 << 4);
315
316         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
317                         IMX6Q_GPR8_TX_DEEMPH_GEN1, 0 << 0);
318         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
319                         IMX6Q_GPR8_TX_DEEMPH_GEN2_3P5DB, 0 << 6);
320         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
321                         IMX6Q_GPR8_TX_DEEMPH_GEN2_6DB, 20 << 12);
322         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
323                         IMX6Q_GPR8_TX_SWING_FULL, 127 << 18);
324         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
325                         IMX6Q_GPR8_TX_SWING_LOW, 127 << 25);
326 }
327
328 static int imx6_pcie_wait_for_link(struct pcie_port *pp)
329 {
330         int count = 200;
331
332         while (!dw_pcie_link_up(pp)) {
333                 usleep_range(100, 1000);
334                 if (--count)
335                         continue;
336
337                 dev_err(pp->dev, "phy link never came up\n");
338                 dev_dbg(pp->dev, "DEBUG_R0: 0x%08x, DEBUG_R1: 0x%08x\n",
339                         readl(pp->dbi_base + PCIE_PHY_DEBUG_R0),
340                         readl(pp->dbi_base + PCIE_PHY_DEBUG_R1));
341                 return -EINVAL;
342         }
343
344         return 0;
345 }
346
347 static irqreturn_t imx6_pcie_msi_handler(int irq, void *arg)
348 {
349         struct pcie_port *pp = arg;
350
351         return dw_handle_msi_irq(pp);
352 }
353
354 static int imx6_pcie_start_link(struct pcie_port *pp)
355 {
356         struct imx6_pcie *imx6_pcie = to_imx6_pcie(pp);
357         uint32_t tmp;
358         int ret, count;
359
360         /*
361          * Force Gen1 operation when starting the link.  In case the link is
362          * started in Gen2 mode, there is a possibility the devices on the
363          * bus will not be detected at all.  This happens with PCIe switches.
364          */
365         tmp = readl(pp->dbi_base + PCIE_RC_LCR);
366         tmp &= ~PCIE_RC_LCR_MAX_LINK_SPEEDS_MASK;
367         tmp |= PCIE_RC_LCR_MAX_LINK_SPEEDS_GEN1;
368         writel(tmp, pp->dbi_base + PCIE_RC_LCR);
369
370         /* Start LTSSM. */
371         regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
372                         IMX6Q_GPR12_PCIE_CTL_2, 1 << 10);
373
374         ret = imx6_pcie_wait_for_link(pp);
375         if (ret)
376                 return ret;
377
378         /* Allow Gen2 mode after the link is up. */
379         tmp = readl(pp->dbi_base + PCIE_RC_LCR);
380         tmp &= ~PCIE_RC_LCR_MAX_LINK_SPEEDS_MASK;
381         tmp |= PCIE_RC_LCR_MAX_LINK_SPEEDS_GEN2;
382         writel(tmp, pp->dbi_base + PCIE_RC_LCR);
383
384         /*
385          * Start Directed Speed Change so the best possible speed both link
386          * partners support can be negotiated.
387          */
388         tmp = readl(pp->dbi_base + PCIE_LINK_WIDTH_SPEED_CONTROL);
389         tmp |= PORT_LOGIC_SPEED_CHANGE;
390         writel(tmp, pp->dbi_base + PCIE_LINK_WIDTH_SPEED_CONTROL);
391
392         count = 200;
393         while (count--) {
394                 tmp = readl(pp->dbi_base + PCIE_LINK_WIDTH_SPEED_CONTROL);
395                 /* Test if the speed change finished. */
396                 if (!(tmp & PORT_LOGIC_SPEED_CHANGE))
397                         break;
398                 usleep_range(100, 1000);
399         }
400
401         /* Make sure link training is finished as well! */
402         if (count)
403                 ret = imx6_pcie_wait_for_link(pp);
404         else
405                 ret = -EINVAL;
406
407         if (ret) {
408                 dev_err(pp->dev, "Failed to bring link up!\n");
409         } else {
410                 tmp = readl(pp->dbi_base + 0x80);
411                 dev_dbg(pp->dev, "Link up, Gen=%i\n", (tmp >> 16) & 0xf);
412         }
413
414         return ret;
415 }
416
417 static void imx6_pcie_host_init(struct pcie_port *pp)
418 {
419         imx6_pcie_assert_core_reset(pp);
420
421         imx6_pcie_init_phy(pp);
422
423         imx6_pcie_deassert_core_reset(pp);
424
425         dw_pcie_setup_rc(pp);
426
427         imx6_pcie_start_link(pp);
428
429         if (IS_ENABLED(CONFIG_PCI_MSI))
430                 dw_pcie_msi_init(pp);
431 }
432
433 static void imx6_pcie_reset_phy(struct pcie_port *pp)
434 {
435         uint32_t temp;
436
437         pcie_phy_read(pp->dbi_base, PHY_RX_OVRD_IN_LO, &temp);
438         temp |= (PHY_RX_OVRD_IN_LO_RX_DATA_EN |
439                  PHY_RX_OVRD_IN_LO_RX_PLL_EN);
440         pcie_phy_write(pp->dbi_base, PHY_RX_OVRD_IN_LO, temp);
441
442         usleep_range(2000, 3000);
443
444         pcie_phy_read(pp->dbi_base, PHY_RX_OVRD_IN_LO, &temp);
445         temp &= ~(PHY_RX_OVRD_IN_LO_RX_DATA_EN |
446                   PHY_RX_OVRD_IN_LO_RX_PLL_EN);
447         pcie_phy_write(pp->dbi_base, PHY_RX_OVRD_IN_LO, temp);
448 }
449
450 static int imx6_pcie_link_up(struct pcie_port *pp)
451 {
452         u32 rc, debug_r0, rx_valid;
453         int count = 5;
454
455         /*
456          * Test if the PHY reports that the link is up and also that the LTSSM
457          * training finished. There are three possible states of the link when
458          * this code is called:
459          * 1) The link is DOWN (unlikely)
460          *     The link didn't come up yet for some reason. This usually means
461          *     we have a real problem somewhere. Reset the PHY and exit. This
462          *     state calls for inspection of the DEBUG registers.
463          * 2) The link is UP, but still in LTSSM training
464          *     Wait for the training to finish, which should take a very short
465          *     time. If the training does not finish, we have a problem and we
466          *     need to inspect the DEBUG registers. If the training does finish,
467          *     the link is up and operating correctly.
468          * 3) The link is UP and no longer in LTSSM training
469          *     The link is up and operating correctly.
470          */
471         while (1) {
472                 rc = readl(pp->dbi_base + PCIE_PHY_DEBUG_R1);
473                 if (!(rc & PCIE_PHY_DEBUG_R1_XMLH_LINK_UP))
474                         break;
475                 if (!(rc & PCIE_PHY_DEBUG_R1_XMLH_LINK_IN_TRAINING))
476                         return 1;
477                 if (!count--)
478                         break;
479                 dev_dbg(pp->dev, "Link is up, but still in training\n");
480                 /*
481                  * Wait a little bit, then re-check if the link finished
482                  * the training.
483                  */
484                 usleep_range(1000, 2000);
485         }
486         /*
487          * From L0, initiate MAC entry to gen2 if EP/RC supports gen2.
488          * Wait 2ms (LTSSM timeout is 24ms, PHY lock is ~5us in gen2).
489          * If (MAC/LTSSM.state == Recovery.RcvrLock)
490          * && (PHY/rx_valid==0) then pulse PHY/rx_reset. Transition
491          * to gen2 is stuck
492          */
493         pcie_phy_read(pp->dbi_base, PCIE_PHY_RX_ASIC_OUT, &rx_valid);
494         debug_r0 = readl(pp->dbi_base + PCIE_PHY_DEBUG_R0);
495
496         if (rx_valid & 0x01)
497                 return 0;
498
499         if ((debug_r0 & 0x3f) != 0x0d)
500                 return 0;
501
502         dev_err(pp->dev, "transition to gen2 is stuck, reset PHY!\n");
503         dev_dbg(pp->dev, "debug_r0=%08x debug_r1=%08x\n", debug_r0, rc);
504
505         imx6_pcie_reset_phy(pp);
506
507         return 0;
508 }
509
510 static struct pcie_host_ops imx6_pcie_host_ops = {
511         .link_up = imx6_pcie_link_up,
512         .host_init = imx6_pcie_host_init,
513 };
514
515 static int __init imx6_add_pcie_port(struct pcie_port *pp,
516                         struct platform_device *pdev)
517 {
518         int ret;
519
520         if (IS_ENABLED(CONFIG_PCI_MSI)) {
521                 pp->msi_irq = platform_get_irq_byname(pdev, "msi");
522                 if (pp->msi_irq <= 0) {
523                         dev_err(&pdev->dev, "failed to get MSI irq\n");
524                         return -ENODEV;
525                 }
526
527                 ret = devm_request_irq(&pdev->dev, pp->msi_irq,
528                                        imx6_pcie_msi_handler,
529                                        IRQF_SHARED, "mx6-pcie-msi", pp);
530                 if (ret) {
531                         dev_err(&pdev->dev, "failed to request MSI irq\n");
532                         return -ENODEV;
533                 }
534         }
535
536         pp->root_bus_nr = -1;
537         pp->ops = &imx6_pcie_host_ops;
538
539         ret = dw_pcie_host_init(pp);
540         if (ret) {
541                 dev_err(&pdev->dev, "failed to initialize host\n");
542                 return ret;
543         }
544
545         return 0;
546 }
547
548 static int __init imx6_pcie_probe(struct platform_device *pdev)
549 {
550         struct imx6_pcie *imx6_pcie;
551         struct pcie_port *pp;
552         struct device_node *np = pdev->dev.of_node;
553         struct resource *dbi_base;
554         int ret;
555
556         imx6_pcie = devm_kzalloc(&pdev->dev, sizeof(*imx6_pcie), GFP_KERNEL);
557         if (!imx6_pcie)
558                 return -ENOMEM;
559
560         pp = &imx6_pcie->pp;
561         pp->dev = &pdev->dev;
562
563         /* Added for PCI abort handling */
564         hook_fault_code(16 + 6, imx6q_pcie_abort_handler, SIGBUS, 0,
565                 "imprecise external abort");
566
567         dbi_base = platform_get_resource(pdev, IORESOURCE_MEM, 0);
568         pp->dbi_base = devm_ioremap_resource(&pdev->dev, dbi_base);
569         if (IS_ERR(pp->dbi_base))
570                 return PTR_ERR(pp->dbi_base);
571
572         /* Fetch GPIOs */
573         imx6_pcie->reset_gpio = of_get_named_gpio(np, "reset-gpio", 0);
574         if (gpio_is_valid(imx6_pcie->reset_gpio)) {
575                 ret = devm_gpio_request_one(&pdev->dev, imx6_pcie->reset_gpio,
576                                             GPIOF_OUT_INIT_LOW, "PCIe reset");
577                 if (ret) {
578                         dev_err(&pdev->dev, "unable to get reset gpio\n");
579                         return ret;
580                 }
581         }
582
583         /* Fetch clocks */
584         imx6_pcie->pcie_phy = devm_clk_get(&pdev->dev, "pcie_phy");
585         if (IS_ERR(imx6_pcie->pcie_phy)) {
586                 dev_err(&pdev->dev,
587                         "pcie_phy clock source missing or invalid\n");
588                 return PTR_ERR(imx6_pcie->pcie_phy);
589         }
590
591         imx6_pcie->pcie_bus = devm_clk_get(&pdev->dev, "pcie_bus");
592         if (IS_ERR(imx6_pcie->pcie_bus)) {
593                 dev_err(&pdev->dev,
594                         "pcie_bus clock source missing or invalid\n");
595                 return PTR_ERR(imx6_pcie->pcie_bus);
596         }
597
598         imx6_pcie->pcie = devm_clk_get(&pdev->dev, "pcie");
599         if (IS_ERR(imx6_pcie->pcie)) {
600                 dev_err(&pdev->dev,
601                         "pcie clock source missing or invalid\n");
602                 return PTR_ERR(imx6_pcie->pcie);
603         }
604
605         /* Grab GPR config register range */
606         imx6_pcie->iomuxc_gpr =
607                  syscon_regmap_lookup_by_compatible("fsl,imx6q-iomuxc-gpr");
608         if (IS_ERR(imx6_pcie->iomuxc_gpr)) {
609                 dev_err(&pdev->dev, "unable to find iomuxc registers\n");
610                 return PTR_ERR(imx6_pcie->iomuxc_gpr);
611         }
612
613         ret = imx6_add_pcie_port(pp, pdev);
614         if (ret < 0)
615                 return ret;
616
617         platform_set_drvdata(pdev, imx6_pcie);
618         return 0;
619 }
620
621 static void imx6_pcie_shutdown(struct platform_device *pdev)
622 {
623         struct imx6_pcie *imx6_pcie = platform_get_drvdata(pdev);
624
625         /* bring down link, so bootloader gets clean state in case of reboot */
626         imx6_pcie_assert_core_reset(&imx6_pcie->pp);
627 }
628
629 static const struct of_device_id imx6_pcie_of_match[] = {
630         { .compatible = "fsl,imx6q-pcie", },
631         {},
632 };
633 MODULE_DEVICE_TABLE(of, imx6_pcie_of_match);
634
635 static struct platform_driver imx6_pcie_driver = {
636         .driver = {
637                 .name   = "imx6q-pcie",
638                 .owner  = THIS_MODULE,
639                 .of_match_table = imx6_pcie_of_match,
640         },
641         .shutdown = imx6_pcie_shutdown,
642 };
643
644 /* Freescale PCIe driver does not allow module unload */
645
646 static int __init imx6_pcie_init(void)
647 {
648         return platform_driver_probe(&imx6_pcie_driver, imx6_pcie_probe);
649 }
650 fs_initcall(imx6_pcie_init);
651
652 MODULE_AUTHOR("Sean Cross <xobs@kosagi.com>");
653 MODULE_DESCRIPTION("Freescale i.MX6 PCIe host controller driver");
654 MODULE_LICENSE("GPL v2");