]> git.kernelconcepts.de Git - karo-tx-linux.git/blob - drivers/pci/host/pci-layerscape.c
PCI: layerscape: Update ls_add_pcie_port()
[karo-tx-linux.git] / drivers / pci / host / pci-layerscape.c
1 /*
2  * PCIe host controller driver for Freescale Layerscape SoCs
3  *
4  * Copyright (C) 2014 Freescale Semiconductor.
5  *
6   * Author: Minghuan Lian <Minghuan.Lian@freescale.com>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12
13 #include <linux/kernel.h>
14 #include <linux/interrupt.h>
15 #include <linux/module.h>
16 #include <linux/of_pci.h>
17 #include <linux/of_platform.h>
18 #include <linux/of_irq.h>
19 #include <linux/of_address.h>
20 #include <linux/pci.h>
21 #include <linux/platform_device.h>
22 #include <linux/resource.h>
23 #include <linux/mfd/syscon.h>
24 #include <linux/regmap.h>
25
26 #include "pcie-designware.h"
27
28 /* PEX1/2 Misc Ports Status Register */
29 #define SCFG_PEXMSCPORTSR(pex_idx)      (0x94 + (pex_idx) * 4)
30 #define LTSSM_STATE_SHIFT       20
31 #define LTSSM_STATE_MASK        0x3f
32 #define LTSSM_PCIE_L0           0x11 /* L0 state */
33
34 /* Symbol Timer Register and Filter Mask Register 1 */
35 #define PCIE_STRFMR1 0x71c
36
37 struct ls_pcie_drvdata {
38         struct pcie_host_ops *ops;
39 };
40
41 struct ls_pcie {
42         struct list_head node;
43         struct device *dev;
44         struct pci_bus *bus;
45         void __iomem *dbi;
46         struct regmap *scfg;
47         struct pcie_port pp;
48         const struct ls_pcie_drvdata *drvdata;
49         int index;
50         int msi_irq;
51 };
52
53 #define to_ls_pcie(x)   container_of(x, struct ls_pcie, pp)
54
55 static bool ls_pcie_is_bridge(struct ls_pcie *pcie)
56 {
57         u32 header_type;
58
59         header_type = ioread8(pcie->dbi + PCI_HEADER_TYPE);
60         header_type &= 0x7f;
61
62         return header_type == PCI_HEADER_TYPE_BRIDGE;
63 }
64
65 static int ls1021_pcie_link_up(struct pcie_port *pp)
66 {
67         u32 state;
68         struct ls_pcie *pcie = to_ls_pcie(pp);
69
70         if (!pcie->scfg)
71                 return 0;
72
73         regmap_read(pcie->scfg, SCFG_PEXMSCPORTSR(pcie->index), &state);
74         state = (state >> LTSSM_STATE_SHIFT) & LTSSM_STATE_MASK;
75
76         if (state < LTSSM_PCIE_L0)
77                 return 0;
78
79         return 1;
80 }
81
82 static void ls1021_pcie_host_init(struct pcie_port *pp)
83 {
84         struct ls_pcie *pcie = to_ls_pcie(pp);
85         u32 val, index[2];
86
87         pcie->scfg = syscon_regmap_lookup_by_phandle(pp->dev->of_node,
88                                                      "fsl,pcie-scfg");
89         if (IS_ERR(pcie->scfg)) {
90                 dev_err(pp->dev, "No syscfg phandle specified\n");
91                 pcie->scfg = NULL;
92                 return;
93         }
94
95         if (of_property_read_u32_array(pp->dev->of_node,
96                                        "fsl,pcie-scfg", index, 2)) {
97                 pcie->scfg = NULL;
98                 return;
99         }
100         pcie->index = index[1];
101
102         dw_pcie_setup_rc(pp);
103
104         /*
105          * LS1021A Workaround for internal TKT228622
106          * to fix the INTx hang issue
107          */
108         val = ioread32(pcie->dbi + PCIE_STRFMR1);
109         val &= 0xffff;
110         iowrite32(val, pcie->dbi + PCIE_STRFMR1);
111 }
112
113 static struct pcie_host_ops ls1021_pcie_host_ops = {
114         .link_up = ls1021_pcie_link_up,
115         .host_init = ls1021_pcie_host_init,
116 };
117
118 static struct ls_pcie_drvdata ls1021_drvdata = {
119         .ops = &ls1021_pcie_host_ops,
120 };
121
122 static const struct of_device_id ls_pcie_of_match[] = {
123         { .compatible = "fsl,ls1021a-pcie", .data = &ls1021_drvdata },
124         { },
125 };
126 MODULE_DEVICE_TABLE(of, ls_pcie_of_match);
127
128 static int __init ls_add_pcie_port(struct pcie_port *pp,
129                                    struct platform_device *pdev)
130 {
131         int ret;
132         struct ls_pcie *pcie = to_ls_pcie(pp);
133
134         pp->dev = &pdev->dev;
135         pp->dbi_base = pcie->dbi;
136         pp->ops = pcie->drvdata->ops;
137
138         ret = dw_pcie_host_init(pp);
139         if (ret) {
140                 dev_err(pp->dev, "failed to initialize host\n");
141                 return ret;
142         }
143
144         return 0;
145 }
146
147 static int __init ls_pcie_probe(struct platform_device *pdev)
148 {
149         const struct of_device_id *match;
150         struct ls_pcie *pcie;
151         struct resource *dbi_base;
152         int ret;
153
154         match = of_match_device(ls_pcie_of_match, &pdev->dev);
155         if (!match)
156                 return -ENODEV;
157
158         pcie = devm_kzalloc(&pdev->dev, sizeof(*pcie), GFP_KERNEL);
159         if (!pcie)
160                 return -ENOMEM;
161
162         dbi_base = platform_get_resource_byname(pdev, IORESOURCE_MEM, "regs");
163         pcie->dbi = devm_ioremap_resource(&pdev->dev, dbi_base);
164         if (IS_ERR(pcie->dbi)) {
165                 dev_err(&pdev->dev, "missing *regs* space\n");
166                 return PTR_ERR(pcie->dbi);
167         }
168
169         pcie->drvdata = match->data;
170
171         if (!ls_pcie_is_bridge(pcie))
172                 return -ENODEV;
173
174         ret = ls_add_pcie_port(&pcie->pp, pdev);
175         if (ret < 0)
176                 return ret;
177
178         platform_set_drvdata(pdev, pcie);
179
180         return 0;
181 }
182
183 static struct platform_driver ls_pcie_driver = {
184         .driver = {
185                 .name = "layerscape-pcie",
186                 .of_match_table = ls_pcie_of_match,
187         },
188 };
189
190 module_platform_driver_probe(ls_pcie_driver, ls_pcie_probe);
191
192 MODULE_AUTHOR("Minghuan Lian <Minghuan.Lian@freescale.com>");
193 MODULE_DESCRIPTION("Freescale Layerscape PCIe host controller driver");
194 MODULE_LICENSE("GPL v2");