1 /* Copyright 2008 - 2016 Freescale Semiconductor, Inc.
2 *
3 * Redistribution and use in source and binary forms, with or without
4 * modification, are permitted provided that the following conditions are met:
5 * * Redistributions of source code must retain the above copyright
6 * notice, this list of conditions and the following disclaimer.
7 * * Redistributions in binary form must reproduce the above copyright
8 * notice, this list of conditions and the following disclaimer in the
9 * documentation and/or other materials provided with the distribution.
10 * * Neither the name of Freescale Semiconductor nor the
11 * names of its contributors may be used to endorse or promote products
12 * derived from this software without specific prior written permission.
13 *
14 * ALTERNATIVELY, this software may be distributed under the terms of the
15 * GNU General Public License ("GPL") as published by the Free Software
16 * Foundation, either version 2 of that License or (at your option) any
17 * later version.
18 *
19 * THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY
20 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
21 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
22 * DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY
23 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
24 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
25 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
26 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
28 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 */
30
31 #include "bman_priv.h"
32
33 static struct bman_portal *affine_bportals[NR_CPUS];
34 static struct cpumask portal_cpus;
35 /* protect bman global registers and global data shared among portals */
36 static DEFINE_SPINLOCK(bman_lock);
37
init_pcfg(struct bm_portal_config * pcfg)38 static struct bman_portal *init_pcfg(struct bm_portal_config *pcfg)
39 {
40 struct bman_portal *p = bman_create_affine_portal(pcfg);
41
42 if (!p) {
43 dev_crit(pcfg->dev, "%s: Portal failure on cpu %d\n",
44 __func__, pcfg->cpu);
45 return NULL;
46 }
47
48 bman_p_irqsource_add(p, BM_PIRQ_RCRI);
49 affine_bportals[pcfg->cpu] = p;
50
51 dev_info(pcfg->dev, "Portal initialised, cpu %d\n", pcfg->cpu);
52
53 return p;
54 }
55
bman_offline_cpu(unsigned int cpu)56 static int bman_offline_cpu(unsigned int cpu)
57 {
58 struct bman_portal *p = affine_bportals[cpu];
59 const struct bm_portal_config *pcfg;
60
61 if (!p)
62 return 0;
63
64 pcfg = bman_get_bm_portal_config(p);
65 if (!pcfg)
66 return 0;
67
68 irq_set_affinity(pcfg->irq, cpumask_of(0));
69 return 0;
70 }
71
bman_online_cpu(unsigned int cpu)72 static int bman_online_cpu(unsigned int cpu)
73 {
74 struct bman_portal *p = affine_bportals[cpu];
75 const struct bm_portal_config *pcfg;
76
77 if (!p)
78 return 0;
79
80 pcfg = bman_get_bm_portal_config(p);
81 if (!pcfg)
82 return 0;
83
84 irq_set_affinity(pcfg->irq, cpumask_of(cpu));
85 return 0;
86 }
87
bman_portal_probe(struct platform_device * pdev)88 static int bman_portal_probe(struct platform_device *pdev)
89 {
90 struct device *dev = &pdev->dev;
91 struct device_node *node = dev->of_node;
92 struct bm_portal_config *pcfg;
93 struct resource *addr_phys[2];
94 int irq, cpu, err;
95
96 err = bman_is_probed();
97 if (!err)
98 return -EPROBE_DEFER;
99 if (err < 0) {
100 dev_err(&pdev->dev, "failing probe due to bman probe error\n");
101 return -ENODEV;
102 }
103
104 pcfg = devm_kmalloc(dev, sizeof(*pcfg), GFP_KERNEL);
105 if (!pcfg)
106 return -ENOMEM;
107
108 pcfg->dev = dev;
109
110 addr_phys[0] = platform_get_resource(pdev, IORESOURCE_MEM,
111 DPAA_PORTAL_CE);
112 if (!addr_phys[0]) {
113 dev_err(dev, "Can't get %pOF property 'reg::CE'\n", node);
114 return -ENXIO;
115 }
116
117 addr_phys[1] = platform_get_resource(pdev, IORESOURCE_MEM,
118 DPAA_PORTAL_CI);
119 if (!addr_phys[1]) {
120 dev_err(dev, "Can't get %pOF property 'reg::CI'\n", node);
121 return -ENXIO;
122 }
123
124 pcfg->cpu = -1;
125
126 irq = platform_get_irq(pdev, 0);
127 if (irq <= 0) {
128 dev_err(dev, "Can't get %pOF IRQ'\n", node);
129 return -ENXIO;
130 }
131 pcfg->irq = irq;
132
133 pcfg->addr_virt_ce = memremap(addr_phys[0]->start,
134 resource_size(addr_phys[0]),
135 QBMAN_MEMREMAP_ATTR);
136 if (!pcfg->addr_virt_ce) {
137 dev_err(dev, "memremap::CE failed\n");
138 goto err_ioremap1;
139 }
140
141 pcfg->addr_virt_ci = ioremap(addr_phys[1]->start,
142 resource_size(addr_phys[1]));
143 if (!pcfg->addr_virt_ci) {
144 dev_err(dev, "ioremap::CI failed\n");
145 goto err_ioremap2;
146 }
147
148 spin_lock(&bman_lock);
149 cpu = cpumask_next_zero(-1, &portal_cpus);
150 if (cpu >= nr_cpu_ids) {
151 /* unassigned portal, skip init */
152 spin_unlock(&bman_lock);
153 return 0;
154 }
155
156 cpumask_set_cpu(cpu, &portal_cpus);
157 spin_unlock(&bman_lock);
158 pcfg->cpu = cpu;
159
160 if (!init_pcfg(pcfg)) {
161 dev_err(dev, "portal init failed\n");
162 goto err_portal_init;
163 }
164
165 /* clear irq affinity if assigned cpu is offline */
166 if (!cpu_online(cpu))
167 bman_offline_cpu(cpu);
168
169 return 0;
170
171 err_portal_init:
172 iounmap(pcfg->addr_virt_ci);
173 err_ioremap2:
174 memunmap(pcfg->addr_virt_ce);
175 err_ioremap1:
176 return -ENXIO;
177 }
178
179 static const struct of_device_id bman_portal_ids[] = {
180 {
181 .compatible = "fsl,bman-portal",
182 },
183 {}
184 };
185 MODULE_DEVICE_TABLE(of, bman_portal_ids);
186
187 static struct platform_driver bman_portal_driver = {
188 .driver = {
189 .name = KBUILD_MODNAME,
190 .of_match_table = bman_portal_ids,
191 },
192 .probe = bman_portal_probe,
193 };
194
bman_portal_driver_register(struct platform_driver * drv)195 static int __init bman_portal_driver_register(struct platform_driver *drv)
196 {
197 int ret;
198
199 ret = platform_driver_register(drv);
200 if (ret < 0)
201 return ret;
202
203 ret = cpuhp_setup_state_nocalls(CPUHP_AP_ONLINE_DYN,
204 "soc/qbman_portal:online",
205 bman_online_cpu, bman_offline_cpu);
206 if (ret < 0) {
207 pr_err("bman: failed to register hotplug callbacks.\n");
208 platform_driver_unregister(drv);
209 return ret;
210 }
211 return 0;
212 }
213
214 module_driver(bman_portal_driver,
215 bman_portal_driver_register, platform_driver_unregister);
216