Commit | Line | Data |
---|---|---|
a3d4d643 GL |
1 | /* |
2 | * PS3 system bus driver. | |
3 | * | |
4 | * Copyright (C) 2006 Sony Computer Entertainment Inc. | |
5 | * Copyright 2006 Sony Corp. | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; version 2 of the License. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program; if not, write to the Free Software | |
18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
19 | */ | |
20 | ||
21 | #include <linux/kernel.h> | |
22 | #include <linux/init.h> | |
4b16f8e2 | 23 | #include <linux/export.h> |
a3d4d643 GL |
24 | #include <linux/dma-mapping.h> |
25 | #include <linux/err.h> | |
5a0e3ad6 | 26 | #include <linux/slab.h> |
a3d4d643 GL |
27 | |
28 | #include <asm/udbg.h> | |
a3d4d643 | 29 | #include <asm/lv1call.h> |
e22ba7e3 | 30 | #include <asm/firmware.h> |
9413c883 | 31 | #include <asm/cell-regs.h> |
a3d4d643 | 32 | |
2a08ea69 GL |
33 | #include "platform.h" |
34 | ||
6bb5cf10 | 35 | static struct device ps3_system_bus = { |
aab0d375 | 36 | .init_name = "ps3_system", |
6bb5cf10 GL |
37 | }; |
38 | ||
39 | /* FIXME: need device usage counters! */ | |
40 | struct { | |
41 | struct mutex mutex; | |
42 | int sb_11; /* usb 0 */ | |
43 | int sb_12; /* usb 0 */ | |
44 | int gpu; | |
45 | } static usage_hack; | |
46 | ||
034e0ab5 GU |
47 | static int ps3_is_device(struct ps3_system_bus_device *dev, u64 bus_id, |
48 | u64 dev_id) | |
6bb5cf10 GL |
49 | { |
50 | return dev->bus_id == bus_id && dev->dev_id == dev_id; | |
51 | } | |
52 | ||
53 | static int ps3_open_hv_device_sb(struct ps3_system_bus_device *dev) | |
54 | { | |
55 | int result; | |
56 | ||
57 | BUG_ON(!dev->bus_id); | |
58 | mutex_lock(&usage_hack.mutex); | |
59 | ||
60 | if (ps3_is_device(dev, 1, 1)) { | |
61 | usage_hack.sb_11++; | |
62 | if (usage_hack.sb_11 > 1) { | |
63 | result = 0; | |
64 | goto done; | |
65 | } | |
66 | } | |
67 | ||
68 | if (ps3_is_device(dev, 1, 2)) { | |
69 | usage_hack.sb_12++; | |
70 | if (usage_hack.sb_12 > 1) { | |
71 | result = 0; | |
72 | goto done; | |
73 | } | |
74 | } | |
75 | ||
76 | result = lv1_open_device(dev->bus_id, dev->dev_id, 0); | |
77 | ||
78 | if (result) { | |
79 | pr_debug("%s:%d: lv1_open_device failed: %s\n", __func__, | |
80 | __LINE__, ps3_result(result)); | |
81 | result = -EPERM; | |
82 | } | |
83 | ||
84 | done: | |
85 | mutex_unlock(&usage_hack.mutex); | |
86 | return result; | |
87 | } | |
88 | ||
89 | static int ps3_close_hv_device_sb(struct ps3_system_bus_device *dev) | |
90 | { | |
91 | int result; | |
92 | ||
93 | BUG_ON(!dev->bus_id); | |
94 | mutex_lock(&usage_hack.mutex); | |
95 | ||
96 | if (ps3_is_device(dev, 1, 1)) { | |
97 | usage_hack.sb_11--; | |
98 | if (usage_hack.sb_11) { | |
99 | result = 0; | |
100 | goto done; | |
101 | } | |
102 | } | |
103 | ||
104 | if (ps3_is_device(dev, 1, 2)) { | |
105 | usage_hack.sb_12--; | |
106 | if (usage_hack.sb_12) { | |
107 | result = 0; | |
108 | goto done; | |
109 | } | |
110 | } | |
111 | ||
112 | result = lv1_close_device(dev->bus_id, dev->dev_id); | |
113 | BUG_ON(result); | |
114 | ||
115 | done: | |
116 | mutex_unlock(&usage_hack.mutex); | |
117 | return result; | |
118 | } | |
119 | ||
120 | static int ps3_open_hv_device_gpu(struct ps3_system_bus_device *dev) | |
121 | { | |
122 | int result; | |
123 | ||
124 | mutex_lock(&usage_hack.mutex); | |
125 | ||
126 | usage_hack.gpu++; | |
127 | if (usage_hack.gpu > 1) { | |
128 | result = 0; | |
129 | goto done; | |
130 | } | |
131 | ||
132 | result = lv1_gpu_open(0); | |
133 | ||
134 | if (result) { | |
135 | pr_debug("%s:%d: lv1_gpu_open failed: %s\n", __func__, | |
136 | __LINE__, ps3_result(result)); | |
137 | result = -EPERM; | |
138 | } | |
139 | ||
140 | done: | |
141 | mutex_unlock(&usage_hack.mutex); | |
142 | return result; | |
143 | } | |
144 | ||
145 | static int ps3_close_hv_device_gpu(struct ps3_system_bus_device *dev) | |
146 | { | |
147 | int result; | |
148 | ||
149 | mutex_lock(&usage_hack.mutex); | |
150 | ||
151 | usage_hack.gpu--; | |
152 | if (usage_hack.gpu) { | |
153 | result = 0; | |
154 | goto done; | |
155 | } | |
156 | ||
157 | result = lv1_gpu_close(); | |
158 | BUG_ON(result); | |
159 | ||
160 | done: | |
161 | mutex_unlock(&usage_hack.mutex); | |
162 | return result; | |
163 | } | |
164 | ||
165 | int ps3_open_hv_device(struct ps3_system_bus_device *dev) | |
166 | { | |
167 | BUG_ON(!dev); | |
168 | pr_debug("%s:%d: match_id: %u\n", __func__, __LINE__, dev->match_id); | |
169 | ||
170 | switch (dev->match_id) { | |
171 | case PS3_MATCH_ID_EHCI: | |
172 | case PS3_MATCH_ID_OHCI: | |
173 | case PS3_MATCH_ID_GELIC: | |
174 | case PS3_MATCH_ID_STOR_DISK: | |
175 | case PS3_MATCH_ID_STOR_ROM: | |
176 | case PS3_MATCH_ID_STOR_FLASH: | |
177 | return ps3_open_hv_device_sb(dev); | |
178 | ||
179 | case PS3_MATCH_ID_SOUND: | |
46d01492 | 180 | case PS3_MATCH_ID_GPU: |
6bb5cf10 GL |
181 | return ps3_open_hv_device_gpu(dev); |
182 | ||
183 | case PS3_MATCH_ID_AV_SETTINGS: | |
184 | case PS3_MATCH_ID_SYSTEM_MANAGER: | |
185 | pr_debug("%s:%d: unsupported match_id: %u\n", __func__, | |
186 | __LINE__, dev->match_id); | |
5c949070 | 187 | pr_debug("%s:%d: bus_id: %llu\n", __func__, __LINE__, |
034e0ab5 | 188 | dev->bus_id); |
6bb5cf10 GL |
189 | BUG(); |
190 | return -EINVAL; | |
191 | ||
192 | default: | |
193 | break; | |
194 | } | |
195 | ||
196 | pr_debug("%s:%d: unknown match_id: %u\n", __func__, __LINE__, | |
197 | dev->match_id); | |
198 | BUG(); | |
199 | return -ENODEV; | |
200 | } | |
201 | EXPORT_SYMBOL_GPL(ps3_open_hv_device); | |
202 | ||
203 | int ps3_close_hv_device(struct ps3_system_bus_device *dev) | |
204 | { | |
205 | BUG_ON(!dev); | |
206 | pr_debug("%s:%d: match_id: %u\n", __func__, __LINE__, dev->match_id); | |
207 | ||
208 | switch (dev->match_id) { | |
209 | case PS3_MATCH_ID_EHCI: | |
210 | case PS3_MATCH_ID_OHCI: | |
211 | case PS3_MATCH_ID_GELIC: | |
212 | case PS3_MATCH_ID_STOR_DISK: | |
213 | case PS3_MATCH_ID_STOR_ROM: | |
214 | case PS3_MATCH_ID_STOR_FLASH: | |
215 | return ps3_close_hv_device_sb(dev); | |
216 | ||
217 | case PS3_MATCH_ID_SOUND: | |
46d01492 | 218 | case PS3_MATCH_ID_GPU: |
6bb5cf10 GL |
219 | return ps3_close_hv_device_gpu(dev); |
220 | ||
221 | case PS3_MATCH_ID_AV_SETTINGS: | |
222 | case PS3_MATCH_ID_SYSTEM_MANAGER: | |
223 | pr_debug("%s:%d: unsupported match_id: %u\n", __func__, | |
224 | __LINE__, dev->match_id); | |
5c949070 | 225 | pr_debug("%s:%d: bus_id: %llu\n", __func__, __LINE__, |
034e0ab5 | 226 | dev->bus_id); |
6bb5cf10 GL |
227 | BUG(); |
228 | return -EINVAL; | |
229 | ||
230 | default: | |
231 | break; | |
232 | } | |
233 | ||
234 | pr_debug("%s:%d: unknown match_id: %u\n", __func__, __LINE__, | |
235 | dev->match_id); | |
236 | BUG(); | |
237 | return -ENODEV; | |
238 | } | |
239 | EXPORT_SYMBOL_GPL(ps3_close_hv_device); | |
240 | ||
a3d4d643 GL |
241 | #define dump_mmio_region(_a) _dump_mmio_region(_a, __func__, __LINE__) |
242 | static void _dump_mmio_region(const struct ps3_mmio_region* r, | |
243 | const char* func, int line) | |
244 | { | |
5c949070 | 245 | pr_debug("%s:%d: dev %llu:%llu\n", func, line, r->dev->bus_id, |
6bb5cf10 | 246 | r->dev->dev_id); |
a3d4d643 GL |
247 | pr_debug("%s:%d: bus_addr %lxh\n", func, line, r->bus_addr); |
248 | pr_debug("%s:%d: len %lxh\n", func, line, r->len); | |
249 | pr_debug("%s:%d: lpar_addr %lxh\n", func, line, r->lpar_addr); | |
250 | } | |
251 | ||
6bb5cf10 | 252 | static int ps3_sb_mmio_region_create(struct ps3_mmio_region *r) |
a3d4d643 GL |
253 | { |
254 | int result; | |
b17b3df1 | 255 | u64 lpar_addr; |
a3d4d643 | 256 | |
6bb5cf10 | 257 | result = lv1_map_device_mmio_region(r->dev->bus_id, r->dev->dev_id, |
b17b3df1 SR |
258 | r->bus_addr, r->len, r->page_size, &lpar_addr); |
259 | r->lpar_addr = lpar_addr; | |
a3d4d643 GL |
260 | |
261 | if (result) { | |
262 | pr_debug("%s:%d: lv1_map_device_mmio_region failed: %s\n", | |
263 | __func__, __LINE__, ps3_result(result)); | |
43d80439 | 264 | r->lpar_addr = 0; |
a3d4d643 GL |
265 | } |
266 | ||
267 | dump_mmio_region(r); | |
268 | return result; | |
269 | } | |
6bb5cf10 GL |
270 | |
271 | static int ps3_ioc0_mmio_region_create(struct ps3_mmio_region *r) | |
272 | { | |
273 | /* device specific; do nothing currently */ | |
274 | return 0; | |
275 | } | |
276 | ||
277 | int ps3_mmio_region_create(struct ps3_mmio_region *r) | |
278 | { | |
279 | return r->mmio_ops->create(r); | |
280 | } | |
9288f5c3 | 281 | EXPORT_SYMBOL_GPL(ps3_mmio_region_create); |
a3d4d643 | 282 | |
6bb5cf10 | 283 | static int ps3_sb_free_mmio_region(struct ps3_mmio_region *r) |
a3d4d643 GL |
284 | { |
285 | int result; | |
286 | ||
6bb5cf10 | 287 | dump_mmio_region(r); |
6bb5cf10 | 288 | result = lv1_unmap_device_mmio_region(r->dev->bus_id, r->dev->dev_id, |
43d80439 | 289 | r->lpar_addr); |
a3d4d643 GL |
290 | |
291 | if (result) | |
292 | pr_debug("%s:%d: lv1_unmap_device_mmio_region failed: %s\n", | |
293 | __func__, __LINE__, ps3_result(result)); | |
294 | ||
43d80439 | 295 | r->lpar_addr = 0; |
a3d4d643 GL |
296 | return result; |
297 | } | |
6bb5cf10 GL |
298 | |
299 | static int ps3_ioc0_free_mmio_region(struct ps3_mmio_region *r) | |
300 | { | |
301 | /* device specific; do nothing currently */ | |
302 | return 0; | |
303 | } | |
304 | ||
305 | ||
306 | int ps3_free_mmio_region(struct ps3_mmio_region *r) | |
307 | { | |
308 | return r->mmio_ops->free(r); | |
309 | } | |
310 | ||
9288f5c3 | 311 | EXPORT_SYMBOL_GPL(ps3_free_mmio_region); |
a3d4d643 | 312 | |
6bb5cf10 GL |
313 | static const struct ps3_mmio_region_ops ps3_mmio_sb_region_ops = { |
314 | .create = ps3_sb_mmio_region_create, | |
315 | .free = ps3_sb_free_mmio_region | |
316 | }; | |
317 | ||
318 | static const struct ps3_mmio_region_ops ps3_mmio_ioc0_region_ops = { | |
319 | .create = ps3_ioc0_mmio_region_create, | |
320 | .free = ps3_ioc0_free_mmio_region | |
321 | }; | |
322 | ||
323 | int ps3_mmio_region_init(struct ps3_system_bus_device *dev, | |
324 | struct ps3_mmio_region *r, unsigned long bus_addr, unsigned long len, | |
325 | enum ps3_mmio_page_size page_size) | |
326 | { | |
327 | r->dev = dev; | |
328 | r->bus_addr = bus_addr; | |
329 | r->len = len; | |
330 | r->page_size = page_size; | |
331 | switch (dev->dev_type) { | |
332 | case PS3_DEVICE_TYPE_SB: | |
333 | r->mmio_ops = &ps3_mmio_sb_region_ops; | |
334 | break; | |
335 | case PS3_DEVICE_TYPE_IOC0: | |
336 | r->mmio_ops = &ps3_mmio_ioc0_region_ops; | |
337 | break; | |
338 | default: | |
339 | BUG(); | |
340 | return -EINVAL; | |
341 | } | |
342 | return 0; | |
343 | } | |
344 | EXPORT_SYMBOL_GPL(ps3_mmio_region_init); | |
345 | ||
a3d4d643 GL |
346 | static int ps3_system_bus_match(struct device *_dev, |
347 | struct device_driver *_drv) | |
348 | { | |
349 | int result; | |
6bb5cf10 GL |
350 | struct ps3_system_bus_driver *drv = ps3_drv_to_system_bus_drv(_drv); |
351 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); | |
a3d4d643 | 352 | |
059e4938 MM |
353 | if (!dev->match_sub_id) |
354 | result = dev->match_id == drv->match_id; | |
355 | else | |
356 | result = dev->match_sub_id == drv->match_sub_id && | |
357 | dev->match_id == drv->match_id; | |
a3d4d643 | 358 | |
88b90c96 | 359 | if (result) |
059e4938 MM |
360 | pr_info("%s:%d: dev=%u.%u(%s), drv=%u.%u(%s): match\n", |
361 | __func__, __LINE__, | |
aab0d375 | 362 | dev->match_id, dev->match_sub_id, dev_name(&dev->core), |
059e4938 | 363 | drv->match_id, drv->match_sub_id, drv->core.name); |
88b90c96 | 364 | else |
059e4938 MM |
365 | pr_debug("%s:%d: dev=%u.%u(%s), drv=%u.%u(%s): miss\n", |
366 | __func__, __LINE__, | |
aab0d375 | 367 | dev->match_id, dev->match_sub_id, dev_name(&dev->core), |
059e4938 MM |
368 | drv->match_id, drv->match_sub_id, drv->core.name); |
369 | ||
a3d4d643 GL |
370 | return result; |
371 | } | |
372 | ||
373 | static int ps3_system_bus_probe(struct device *_dev) | |
374 | { | |
6bb5cf10 GL |
375 | int result = 0; |
376 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); | |
377 | struct ps3_system_bus_driver *drv; | |
a3d4d643 | 378 | |
6bb5cf10 | 379 | BUG_ON(!dev); |
54ca5412 | 380 | dev_dbg(_dev, "%s:%d\n", __func__, __LINE__); |
a3d4d643 | 381 | |
6bb5cf10 | 382 | drv = ps3_system_bus_dev_to_system_bus_drv(dev); |
a3d4d643 GL |
383 | BUG_ON(!drv); |
384 | ||
385 | if (drv->probe) | |
386 | result = drv->probe(dev); | |
387 | else | |
88b90c96 | 388 | pr_debug("%s:%d: %s no probe method\n", __func__, __LINE__, |
aab0d375 | 389 | dev_name(&dev->core)); |
a3d4d643 | 390 | |
aab0d375 | 391 | pr_debug(" <- %s:%d: %s\n", __func__, __LINE__, dev_name(&dev->core)); |
a3d4d643 GL |
392 | return result; |
393 | } | |
394 | ||
395 | static int ps3_system_bus_remove(struct device *_dev) | |
396 | { | |
6bb5cf10 GL |
397 | int result = 0; |
398 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); | |
399 | struct ps3_system_bus_driver *drv; | |
400 | ||
401 | BUG_ON(!dev); | |
54ca5412 | 402 | dev_dbg(_dev, "%s:%d\n", __func__, __LINE__); |
6bb5cf10 GL |
403 | |
404 | drv = ps3_system_bus_dev_to_system_bus_drv(dev); | |
405 | BUG_ON(!drv); | |
a3d4d643 GL |
406 | |
407 | if (drv->remove) | |
6bb5cf10 | 408 | result = drv->remove(dev); |
a3d4d643 | 409 | else |
6bb5cf10 GL |
410 | dev_dbg(&dev->core, "%s:%d %s: no remove method\n", |
411 | __func__, __LINE__, drv->core.name); | |
412 | ||
aab0d375 | 413 | pr_debug(" <- %s:%d: %s\n", __func__, __LINE__, dev_name(&dev->core)); |
6bb5cf10 GL |
414 | return result; |
415 | } | |
a3d4d643 | 416 | |
6bb5cf10 GL |
417 | static void ps3_system_bus_shutdown(struct device *_dev) |
418 | { | |
419 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); | |
420 | struct ps3_system_bus_driver *drv; | |
a3d4d643 | 421 | |
6bb5cf10 GL |
422 | BUG_ON(!dev); |
423 | ||
424 | dev_dbg(&dev->core, " -> %s:%d: match_id %d\n", __func__, __LINE__, | |
425 | dev->match_id); | |
426 | ||
427 | if (!dev->core.driver) { | |
428 | dev_dbg(&dev->core, "%s:%d: no driver bound\n", __func__, | |
429 | __LINE__); | |
430 | return; | |
431 | } | |
432 | ||
433 | drv = ps3_system_bus_dev_to_system_bus_drv(dev); | |
434 | ||
435 | BUG_ON(!drv); | |
436 | ||
437 | dev_dbg(&dev->core, "%s:%d: %s -> %s\n", __func__, __LINE__, | |
aab0d375 | 438 | dev_name(&dev->core), drv->core.name); |
6bb5cf10 GL |
439 | |
440 | if (drv->shutdown) | |
441 | drv->shutdown(dev); | |
442 | else if (drv->remove) { | |
443 | dev_dbg(&dev->core, "%s:%d %s: no shutdown, calling remove\n", | |
444 | __func__, __LINE__, drv->core.name); | |
445 | drv->remove(dev); | |
446 | } else { | |
447 | dev_dbg(&dev->core, "%s:%d %s: no shutdown method\n", | |
448 | __func__, __LINE__, drv->core.name); | |
449 | BUG(); | |
450 | } | |
451 | ||
452 | dev_dbg(&dev->core, " <- %s:%d\n", __func__, __LINE__); | |
a3d4d643 GL |
453 | } |
454 | ||
7eff2e7a | 455 | static int ps3_system_bus_uevent(struct device *_dev, struct kobj_uevent_env *env) |
688b3378 DW |
456 | { |
457 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); | |
688b3378 | 458 | |
46d01492 GU |
459 | if (add_uevent_var(env, "MODALIAS=ps3:%d:%d", dev->match_id, |
460 | dev->match_sub_id)) | |
688b3378 | 461 | return -ENOMEM; |
688b3378 DW |
462 | return 0; |
463 | } | |
464 | ||
6758555d DW |
465 | static ssize_t modalias_show(struct device *_dev, struct device_attribute *a, |
466 | char *buf) | |
467 | { | |
468 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); | |
46d01492 GU |
469 | int len = snprintf(buf, PAGE_SIZE, "ps3:%d:%d\n", dev->match_id, |
470 | dev->match_sub_id); | |
6758555d DW |
471 | |
472 | return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; | |
473 | } | |
474 | ||
475 | static struct device_attribute ps3_system_bus_dev_attrs[] = { | |
476 | __ATTR_RO(modalias), | |
477 | __ATTR_NULL, | |
478 | }; | |
479 | ||
a3d4d643 | 480 | struct bus_type ps3_system_bus_type = { |
2a08ea69 | 481 | .name = "ps3_system_bus", |
a3d4d643 | 482 | .match = ps3_system_bus_match, |
688b3378 | 483 | .uevent = ps3_system_bus_uevent, |
a3d4d643 GL |
484 | .probe = ps3_system_bus_probe, |
485 | .remove = ps3_system_bus_remove, | |
6bb5cf10 | 486 | .shutdown = ps3_system_bus_shutdown, |
6758555d | 487 | .dev_attrs = ps3_system_bus_dev_attrs, |
a3d4d643 GL |
488 | }; |
489 | ||
6bb5cf10 | 490 | static int __init ps3_system_bus_init(void) |
a3d4d643 GL |
491 | { |
492 | int result; | |
493 | ||
e22ba7e3 | 494 | if (!firmware_has_feature(FW_FEATURE_PS3_LV1)) |
ef596c69 | 495 | return -ENODEV; |
e22ba7e3 | 496 | |
6bb5cf10 GL |
497 | pr_debug(" -> %s:%d\n", __func__, __LINE__); |
498 | ||
499 | mutex_init(&usage_hack.mutex); | |
500 | ||
501 | result = device_register(&ps3_system_bus); | |
502 | BUG_ON(result); | |
503 | ||
a3d4d643 GL |
504 | result = bus_register(&ps3_system_bus_type); |
505 | BUG_ON(result); | |
6bb5cf10 GL |
506 | |
507 | pr_debug(" <- %s:%d\n", __func__, __LINE__); | |
a3d4d643 GL |
508 | return result; |
509 | } | |
510 | ||
511 | core_initcall(ps3_system_bus_init); | |
512 | ||
513 | /* Allocates a contiguous real buffer and creates mappings over it. | |
514 | * Returns the virtual address of the buffer and sets dma_handle | |
515 | * to the dma address (mapping) of the first page. | |
516 | */ | |
a3d4d643 | 517 | static void * ps3_alloc_coherent(struct device *_dev, size_t size, |
bfbf7d61 AP |
518 | dma_addr_t *dma_handle, gfp_t flag, |
519 | struct dma_attrs *attrs) | |
a3d4d643 GL |
520 | { |
521 | int result; | |
6bb5cf10 | 522 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); |
a3d4d643 GL |
523 | unsigned long virt_addr; |
524 | ||
a3d4d643 GL |
525 | flag &= ~(__GFP_DMA | __GFP_HIGHMEM); |
526 | flag |= __GFP_ZERO; | |
527 | ||
528 | virt_addr = __get_free_pages(flag, get_order(size)); | |
529 | ||
530 | if (!virt_addr) { | |
531 | pr_debug("%s:%d: get_free_pages failed\n", __func__, __LINE__); | |
532 | goto clean_none; | |
533 | } | |
534 | ||
6bb5cf10 | 535 | result = ps3_dma_map(dev->d_region, virt_addr, size, dma_handle, |
5c6fc8db GU |
536 | CBE_IOPTE_PP_W | CBE_IOPTE_PP_R | |
537 | CBE_IOPTE_SO_RW | CBE_IOPTE_M); | |
a3d4d643 GL |
538 | |
539 | if (result) { | |
540 | pr_debug("%s:%d: ps3_dma_map failed (%d)\n", | |
541 | __func__, __LINE__, result); | |
542 | BUG_ON("check region type"); | |
543 | goto clean_alloc; | |
544 | } | |
545 | ||
546 | return (void*)virt_addr; | |
547 | ||
548 | clean_alloc: | |
549 | free_pages(virt_addr, get_order(size)); | |
550 | clean_none: | |
551 | dma_handle = NULL; | |
552 | return NULL; | |
553 | } | |
554 | ||
555 | static void ps3_free_coherent(struct device *_dev, size_t size, void *vaddr, | |
bfbf7d61 | 556 | dma_addr_t dma_handle, struct dma_attrs *attrs) |
a3d4d643 | 557 | { |
6bb5cf10 | 558 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); |
a3d4d643 GL |
559 | |
560 | ps3_dma_unmap(dev->d_region, dma_handle, size); | |
561 | free_pages((unsigned long)vaddr, get_order(size)); | |
562 | } | |
563 | ||
564 | /* Creates TCEs for a user provided buffer. The user buffer must be | |
f9226d57 MN |
565 | * contiguous real kernel storage (not vmalloc). The address passed here |
566 | * comprises a page address and offset into that page. The dma_addr_t | |
567 | * returned will point to the same byte within the page as was passed in. | |
a3d4d643 GL |
568 | */ |
569 | ||
f9226d57 MN |
570 | static dma_addr_t ps3_sb_map_page(struct device *_dev, struct page *page, |
571 | unsigned long offset, size_t size, enum dma_data_direction direction, | |
572 | struct dma_attrs *attrs) | |
a3d4d643 | 573 | { |
6bb5cf10 | 574 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); |
a3d4d643 | 575 | int result; |
494fd07a | 576 | dma_addr_t bus_addr; |
f9226d57 | 577 | void *ptr = page_address(page) + offset; |
a3d4d643 GL |
578 | |
579 | result = ps3_dma_map(dev->d_region, (unsigned long)ptr, size, | |
6bb5cf10 | 580 | &bus_addr, |
5c6fc8db GU |
581 | CBE_IOPTE_PP_R | CBE_IOPTE_PP_W | |
582 | CBE_IOPTE_SO_RW | CBE_IOPTE_M); | |
a3d4d643 GL |
583 | |
584 | if (result) { | |
585 | pr_debug("%s:%d: ps3_dma_map failed (%d)\n", | |
586 | __func__, __LINE__, result); | |
587 | } | |
588 | ||
589 | return bus_addr; | |
590 | } | |
591 | ||
f9226d57 MN |
592 | static dma_addr_t ps3_ioc0_map_page(struct device *_dev, struct page *page, |
593 | unsigned long offset, size_t size, | |
594 | enum dma_data_direction direction, | |
595 | struct dma_attrs *attrs) | |
6bb5cf10 GL |
596 | { |
597 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); | |
598 | int result; | |
494fd07a | 599 | dma_addr_t bus_addr; |
6bb5cf10 | 600 | u64 iopte_flag; |
f9226d57 | 601 | void *ptr = page_address(page) + offset; |
6bb5cf10 | 602 | |
5c6fc8db | 603 | iopte_flag = CBE_IOPTE_M; |
6bb5cf10 GL |
604 | switch (direction) { |
605 | case DMA_BIDIRECTIONAL: | |
5c6fc8db | 606 | iopte_flag |= CBE_IOPTE_PP_R | CBE_IOPTE_PP_W | CBE_IOPTE_SO_RW; |
6bb5cf10 GL |
607 | break; |
608 | case DMA_TO_DEVICE: | |
5c6fc8db | 609 | iopte_flag |= CBE_IOPTE_PP_R | CBE_IOPTE_SO_R; |
6bb5cf10 GL |
610 | break; |
611 | case DMA_FROM_DEVICE: | |
5c6fc8db | 612 | iopte_flag |= CBE_IOPTE_PP_W | CBE_IOPTE_SO_RW; |
6bb5cf10 GL |
613 | break; |
614 | default: | |
615 | /* not happned */ | |
616 | BUG(); | |
617 | }; | |
618 | result = ps3_dma_map(dev->d_region, (unsigned long)ptr, size, | |
619 | &bus_addr, iopte_flag); | |
620 | ||
621 | if (result) { | |
622 | pr_debug("%s:%d: ps3_dma_map failed (%d)\n", | |
623 | __func__, __LINE__, result); | |
624 | } | |
625 | return bus_addr; | |
626 | } | |
627 | ||
f9226d57 | 628 | static void ps3_unmap_page(struct device *_dev, dma_addr_t dma_addr, |
3affedc4 | 629 | size_t size, enum dma_data_direction direction, struct dma_attrs *attrs) |
a3d4d643 | 630 | { |
6bb5cf10 | 631 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); |
a3d4d643 GL |
632 | int result; |
633 | ||
634 | result = ps3_dma_unmap(dev->d_region, dma_addr, size); | |
635 | ||
636 | if (result) { | |
637 | pr_debug("%s:%d: ps3_dma_unmap failed (%d)\n", | |
638 | __func__, __LINE__, result); | |
639 | } | |
640 | } | |
641 | ||
d1ed455e | 642 | static int ps3_sb_map_sg(struct device *_dev, struct scatterlist *sgl, |
3affedc4 | 643 | int nents, enum dma_data_direction direction, struct dma_attrs *attrs) |
a3d4d643 GL |
644 | { |
645 | #if defined(CONFIG_PS3_DYNAMIC_DMA) | |
646 | BUG_ON("do"); | |
35063bb2 GL |
647 | return -EPERM; |
648 | #else | |
6bb5cf10 | 649 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); |
d1ed455e | 650 | struct scatterlist *sg; |
435e0b2b SR |
651 | int i; |
652 | ||
d1ed455e | 653 | for_each_sg(sgl, sg, nents, i) { |
58b053e4 JA |
654 | int result = ps3_dma_map(dev->d_region, sg_phys(sg), |
655 | sg->length, &sg->dma_address, 0); | |
35063bb2 GL |
656 | |
657 | if (result) { | |
658 | pr_debug("%s:%d: ps3_dma_map failed (%d)\n", | |
659 | __func__, __LINE__, result); | |
660 | return -EINVAL; | |
661 | } | |
662 | ||
663 | sg->dma_length = sg->length; | |
664 | } | |
665 | ||
666 | return nents; | |
a3d4d643 | 667 | #endif |
a3d4d643 GL |
668 | } |
669 | ||
6bb5cf10 GL |
670 | static int ps3_ioc0_map_sg(struct device *_dev, struct scatterlist *sg, |
671 | int nents, | |
3affedc4 MN |
672 | enum dma_data_direction direction, |
673 | struct dma_attrs *attrs) | |
6bb5cf10 GL |
674 | { |
675 | BUG(); | |
676 | return 0; | |
677 | } | |
678 | ||
679 | static void ps3_sb_unmap_sg(struct device *_dev, struct scatterlist *sg, | |
3affedc4 | 680 | int nents, enum dma_data_direction direction, struct dma_attrs *attrs) |
a3d4d643 GL |
681 | { |
682 | #if defined(CONFIG_PS3_DYNAMIC_DMA) | |
683 | BUG_ON("do"); | |
684 | #endif | |
685 | } | |
686 | ||
6bb5cf10 | 687 | static void ps3_ioc0_unmap_sg(struct device *_dev, struct scatterlist *sg, |
3affedc4 MN |
688 | int nents, enum dma_data_direction direction, |
689 | struct dma_attrs *attrs) | |
6bb5cf10 GL |
690 | { |
691 | BUG(); | |
692 | } | |
693 | ||
a3d4d643 GL |
694 | static int ps3_dma_supported(struct device *_dev, u64 mask) |
695 | { | |
284901a9 | 696 | return mask >= DMA_BIT_MASK(32); |
a3d4d643 GL |
697 | } |
698 | ||
d24f9c69 MM |
699 | static u64 ps3_dma_get_required_mask(struct device *_dev) |
700 | { | |
701 | return DMA_BIT_MASK(32); | |
702 | } | |
703 | ||
45223c54 | 704 | static struct dma_map_ops ps3_sb_dma_ops = { |
bfbf7d61 AP |
705 | .alloc = ps3_alloc_coherent, |
706 | .free = ps3_free_coherent, | |
6bb5cf10 GL |
707 | .map_sg = ps3_sb_map_sg, |
708 | .unmap_sg = ps3_sb_unmap_sg, | |
f9226d57 | 709 | .dma_supported = ps3_dma_supported, |
d24f9c69 | 710 | .get_required_mask = ps3_dma_get_required_mask, |
f9226d57 MN |
711 | .map_page = ps3_sb_map_page, |
712 | .unmap_page = ps3_unmap_page, | |
6bb5cf10 GL |
713 | }; |
714 | ||
45223c54 | 715 | static struct dma_map_ops ps3_ioc0_dma_ops = { |
bfbf7d61 AP |
716 | .alloc = ps3_alloc_coherent, |
717 | .free = ps3_free_coherent, | |
6bb5cf10 GL |
718 | .map_sg = ps3_ioc0_map_sg, |
719 | .unmap_sg = ps3_ioc0_unmap_sg, | |
f9226d57 | 720 | .dma_supported = ps3_dma_supported, |
d24f9c69 | 721 | .get_required_mask = ps3_dma_get_required_mask, |
f9226d57 MN |
722 | .map_page = ps3_ioc0_map_page, |
723 | .unmap_page = ps3_unmap_page, | |
a3d4d643 GL |
724 | }; |
725 | ||
726 | /** | |
727 | * ps3_system_bus_release_device - remove a device from the system bus | |
728 | */ | |
729 | ||
730 | static void ps3_system_bus_release_device(struct device *_dev) | |
731 | { | |
6bb5cf10 | 732 | struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev); |
a3d4d643 GL |
733 | kfree(dev); |
734 | } | |
735 | ||
736 | /** | |
737 | * ps3_system_bus_device_register - add a device to the system bus | |
738 | * | |
739 | * ps3_system_bus_device_register() expects the dev object to be allocated | |
740 | * dynamically by the caller. The system bus takes ownership of the dev | |
741 | * object and frees the object in ps3_system_bus_release_device(). | |
742 | */ | |
743 | ||
744 | int ps3_system_bus_device_register(struct ps3_system_bus_device *dev) | |
745 | { | |
746 | int result; | |
6bb5cf10 GL |
747 | static unsigned int dev_ioc0_count; |
748 | static unsigned int dev_sb_count; | |
749 | static unsigned int dev_vuart_count; | |
ed757002 | 750 | static unsigned int dev_lpm_count; |
a3d4d643 | 751 | |
6bb5cf10 GL |
752 | if (!dev->core.parent) |
753 | dev->core.parent = &ps3_system_bus; | |
a3d4d643 GL |
754 | dev->core.bus = &ps3_system_bus_type; |
755 | dev->core.release = ps3_system_bus_release_device; | |
756 | ||
6bb5cf10 GL |
757 | switch (dev->dev_type) { |
758 | case PS3_DEVICE_TYPE_IOC0: | |
759 | dev->core.archdata.dma_ops = &ps3_ioc0_dma_ops; | |
aab0d375 | 760 | dev_set_name(&dev->core, "ioc0_%02x", ++dev_ioc0_count); |
6bb5cf10 GL |
761 | break; |
762 | case PS3_DEVICE_TYPE_SB: | |
763 | dev->core.archdata.dma_ops = &ps3_sb_dma_ops; | |
aab0d375 | 764 | dev_set_name(&dev->core, "sb_%02x", ++dev_sb_count); |
6bb5cf10 GL |
765 | |
766 | break; | |
767 | case PS3_DEVICE_TYPE_VUART: | |
aab0d375 | 768 | dev_set_name(&dev->core, "vuart_%02x", ++dev_vuart_count); |
6bb5cf10 | 769 | break; |
ed757002 | 770 | case PS3_DEVICE_TYPE_LPM: |
aab0d375 | 771 | dev_set_name(&dev->core, "lpm_%02x", ++dev_lpm_count); |
ed757002 | 772 | break; |
6bb5cf10 GL |
773 | default: |
774 | BUG(); | |
775 | }; | |
776 | ||
d706c1b0 | 777 | dev->core.of_node = NULL; |
8fae0353 | 778 | set_dev_node(&dev->core, 0); |
a3d4d643 | 779 | |
aab0d375 | 780 | pr_debug("%s:%d add %s\n", __func__, __LINE__, dev_name(&dev->core)); |
a3d4d643 GL |
781 | |
782 | result = device_register(&dev->core); | |
783 | return result; | |
784 | } | |
785 | ||
786 | EXPORT_SYMBOL_GPL(ps3_system_bus_device_register); | |
787 | ||
788 | int ps3_system_bus_driver_register(struct ps3_system_bus_driver *drv) | |
789 | { | |
790 | int result; | |
791 | ||
6bb5cf10 GL |
792 | pr_debug(" -> %s:%d: %s\n", __func__, __LINE__, drv->core.name); |
793 | ||
794 | if (!firmware_has_feature(FW_FEATURE_PS3_LV1)) | |
795 | return -ENODEV; | |
796 | ||
a3d4d643 GL |
797 | drv->core.bus = &ps3_system_bus_type; |
798 | ||
799 | result = driver_register(&drv->core); | |
6bb5cf10 | 800 | pr_debug(" <- %s:%d: %s\n", __func__, __LINE__, drv->core.name); |
a3d4d643 GL |
801 | return result; |
802 | } | |
803 | ||
804 | EXPORT_SYMBOL_GPL(ps3_system_bus_driver_register); | |
805 | ||
806 | void ps3_system_bus_driver_unregister(struct ps3_system_bus_driver *drv) | |
807 | { | |
6bb5cf10 | 808 | pr_debug(" -> %s:%d: %s\n", __func__, __LINE__, drv->core.name); |
a3d4d643 | 809 | driver_unregister(&drv->core); |
6bb5cf10 | 810 | pr_debug(" <- %s:%d: %s\n", __func__, __LINE__, drv->core.name); |
a3d4d643 GL |
811 | } |
812 | ||
813 | EXPORT_SYMBOL_GPL(ps3_system_bus_driver_unregister); |