2 * PS3 system bus driver.
4 * Copyright (C) 2006 Sony Computer Entertainment Inc.
5 * Copyright 2006 Sony Corp.
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.
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.
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
21 #include <linux/kernel.h>
22 #include <linux/init.h>
23 #include <linux/module.h>
24 #include <linux/dma-mapping.h>
25 #include <linux/err.h>
28 #include <asm/lv1call.h>
29 #include <asm/firmware.h>
33 static struct device ps3_system_bus
= {
34 .bus_id
= "ps3_system",
37 /* FIXME: need device usage counters! */
40 int sb_11
; /* usb 0 */
41 int sb_12
; /* usb 0 */
45 static int ps3_is_device(struct ps3_system_bus_device
*dev
,
46 unsigned int bus_id
, unsigned int dev_id
)
48 return dev
->bus_id
== bus_id
&& dev
->dev_id
== dev_id
;
51 static int ps3_open_hv_device_sb(struct ps3_system_bus_device
*dev
)
56 mutex_lock(&usage_hack
.mutex
);
58 if (ps3_is_device(dev
, 1, 1)) {
60 if (usage_hack
.sb_11
> 1) {
66 if (ps3_is_device(dev
, 1, 2)) {
68 if (usage_hack
.sb_12
> 1) {
74 result
= lv1_open_device(dev
->bus_id
, dev
->dev_id
, 0);
77 pr_debug("%s:%d: lv1_open_device failed: %s\n", __func__
,
78 __LINE__
, ps3_result(result
));
83 mutex_unlock(&usage_hack
.mutex
);
87 static int ps3_close_hv_device_sb(struct ps3_system_bus_device
*dev
)
92 mutex_lock(&usage_hack
.mutex
);
94 if (ps3_is_device(dev
, 1, 1)) {
96 if (usage_hack
.sb_11
) {
102 if (ps3_is_device(dev
, 1, 2)) {
104 if (usage_hack
.sb_12
) {
110 result
= lv1_close_device(dev
->bus_id
, dev
->dev_id
);
114 mutex_unlock(&usage_hack
.mutex
);
118 static int ps3_open_hv_device_gpu(struct ps3_system_bus_device
*dev
)
122 mutex_lock(&usage_hack
.mutex
);
125 if (usage_hack
.gpu
> 1) {
130 result
= lv1_gpu_open(0);
133 pr_debug("%s:%d: lv1_gpu_open failed: %s\n", __func__
,
134 __LINE__
, ps3_result(result
));
139 mutex_unlock(&usage_hack
.mutex
);
143 static int ps3_close_hv_device_gpu(struct ps3_system_bus_device
*dev
)
147 mutex_lock(&usage_hack
.mutex
);
150 if (usage_hack
.gpu
) {
155 result
= lv1_gpu_close();
159 mutex_unlock(&usage_hack
.mutex
);
163 int ps3_open_hv_device(struct ps3_system_bus_device
*dev
)
166 pr_debug("%s:%d: match_id: %u\n", __func__
, __LINE__
, dev
->match_id
);
168 switch (dev
->match_id
) {
169 case PS3_MATCH_ID_EHCI
:
170 case PS3_MATCH_ID_OHCI
:
171 case PS3_MATCH_ID_GELIC
:
172 case PS3_MATCH_ID_STOR_DISK
:
173 case PS3_MATCH_ID_STOR_ROM
:
174 case PS3_MATCH_ID_STOR_FLASH
:
175 return ps3_open_hv_device_sb(dev
);
177 case PS3_MATCH_ID_SOUND
:
178 case PS3_MATCH_ID_GRAPHICS
:
179 return ps3_open_hv_device_gpu(dev
);
181 case PS3_MATCH_ID_AV_SETTINGS
:
182 case PS3_MATCH_ID_SYSTEM_MANAGER
:
183 pr_debug("%s:%d: unsupported match_id: %u\n", __func__
,
184 __LINE__
, dev
->match_id
);
185 pr_debug("%s:%d: bus_id: %u\n", __func__
,
186 __LINE__
, dev
->bus_id
);
194 pr_debug("%s:%d: unknown match_id: %u\n", __func__
, __LINE__
,
199 EXPORT_SYMBOL_GPL(ps3_open_hv_device
);
201 int ps3_close_hv_device(struct ps3_system_bus_device
*dev
)
204 pr_debug("%s:%d: match_id: %u\n", __func__
, __LINE__
, dev
->match_id
);
206 switch (dev
->match_id
) {
207 case PS3_MATCH_ID_EHCI
:
208 case PS3_MATCH_ID_OHCI
:
209 case PS3_MATCH_ID_GELIC
:
210 case PS3_MATCH_ID_STOR_DISK
:
211 case PS3_MATCH_ID_STOR_ROM
:
212 case PS3_MATCH_ID_STOR_FLASH
:
213 return ps3_close_hv_device_sb(dev
);
215 case PS3_MATCH_ID_SOUND
:
216 case PS3_MATCH_ID_GRAPHICS
:
217 return ps3_close_hv_device_gpu(dev
);
219 case PS3_MATCH_ID_AV_SETTINGS
:
220 case PS3_MATCH_ID_SYSTEM_MANAGER
:
221 pr_debug("%s:%d: unsupported match_id: %u\n", __func__
,
222 __LINE__
, dev
->match_id
);
223 pr_debug("%s:%d: bus_id: %u\n", __func__
,
224 __LINE__
, dev
->bus_id
);
232 pr_debug("%s:%d: unknown match_id: %u\n", __func__
, __LINE__
,
237 EXPORT_SYMBOL_GPL(ps3_close_hv_device
);
239 #define dump_mmio_region(_a) _dump_mmio_region(_a, __func__, __LINE__)
240 static void _dump_mmio_region(const struct ps3_mmio_region
* r
,
241 const char* func
, int line
)
243 pr_debug("%s:%d: dev %u:%u\n", func
, line
, r
->dev
->bus_id
,
245 pr_debug("%s:%d: bus_addr %lxh\n", func
, line
, r
->bus_addr
);
246 pr_debug("%s:%d: len %lxh\n", func
, line
, r
->len
);
247 pr_debug("%s:%d: lpar_addr %lxh\n", func
, line
, r
->lpar_addr
);
250 static int ps3_sb_mmio_region_create(struct ps3_mmio_region
*r
)
254 result
= lv1_map_device_mmio_region(r
->dev
->bus_id
, r
->dev
->dev_id
,
255 r
->bus_addr
, r
->len
, r
->page_size
, &r
->lpar_addr
);
258 pr_debug("%s:%d: lv1_map_device_mmio_region failed: %s\n",
259 __func__
, __LINE__
, ps3_result(result
));
267 static int ps3_ioc0_mmio_region_create(struct ps3_mmio_region
*r
)
269 /* device specific; do nothing currently */
273 int ps3_mmio_region_create(struct ps3_mmio_region
*r
)
275 return r
->mmio_ops
->create(r
);
277 EXPORT_SYMBOL_GPL(ps3_mmio_region_create
);
279 static int ps3_sb_free_mmio_region(struct ps3_mmio_region
*r
)
285 result
= lv1_unmap_device_mmio_region(r
->dev
->bus_id
, r
->dev
->dev_id
,
289 pr_debug("%s:%d: lv1_unmap_device_mmio_region failed: %s\n",
290 __func__
, __LINE__
, ps3_result(result
));
296 static int ps3_ioc0_free_mmio_region(struct ps3_mmio_region
*r
)
298 /* device specific; do nothing currently */
303 int ps3_free_mmio_region(struct ps3_mmio_region
*r
)
305 return r
->mmio_ops
->free(r
);
308 EXPORT_SYMBOL_GPL(ps3_free_mmio_region
);
310 static const struct ps3_mmio_region_ops ps3_mmio_sb_region_ops
= {
311 .create
= ps3_sb_mmio_region_create
,
312 .free
= ps3_sb_free_mmio_region
315 static const struct ps3_mmio_region_ops ps3_mmio_ioc0_region_ops
= {
316 .create
= ps3_ioc0_mmio_region_create
,
317 .free
= ps3_ioc0_free_mmio_region
320 int ps3_mmio_region_init(struct ps3_system_bus_device
*dev
,
321 struct ps3_mmio_region
*r
, unsigned long bus_addr
, unsigned long len
,
322 enum ps3_mmio_page_size page_size
)
325 r
->bus_addr
= bus_addr
;
327 r
->page_size
= page_size
;
328 switch (dev
->dev_type
) {
329 case PS3_DEVICE_TYPE_SB
:
330 r
->mmio_ops
= &ps3_mmio_sb_region_ops
;
332 case PS3_DEVICE_TYPE_IOC0
:
333 r
->mmio_ops
= &ps3_mmio_ioc0_region_ops
;
341 EXPORT_SYMBOL_GPL(ps3_mmio_region_init
);
343 static int ps3_system_bus_match(struct device
*_dev
,
344 struct device_driver
*_drv
)
347 struct ps3_system_bus_driver
*drv
= ps3_drv_to_system_bus_drv(_drv
);
348 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
350 result
= dev
->match_id
== drv
->match_id
;
352 pr_info("%s:%d: dev=%u(%s), drv=%u(%s): %s\n", __func__
, __LINE__
,
353 dev
->match_id
, dev
->core
.bus_id
, drv
->match_id
, drv
->core
.name
,
354 (result
? "match" : "miss"));
358 static int ps3_system_bus_probe(struct device
*_dev
)
361 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
362 struct ps3_system_bus_driver
*drv
;
365 pr_info(" -> %s:%d: %s\n", __func__
, __LINE__
, _dev
->bus_id
);
367 drv
= ps3_system_bus_dev_to_system_bus_drv(dev
);
371 result
= drv
->probe(dev
);
373 pr_info("%s:%d: %s no probe method\n", __func__
, __LINE__
,
376 pr_info(" <- %s:%d: %s\n", __func__
, __LINE__
, dev
->core
.bus_id
);
380 static int ps3_system_bus_remove(struct device
*_dev
)
383 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
384 struct ps3_system_bus_driver
*drv
;
387 pr_info(" -> %s:%d: %s\n", __func__
, __LINE__
, _dev
->bus_id
);
389 drv
= ps3_system_bus_dev_to_system_bus_drv(dev
);
393 result
= drv
->remove(dev
);
395 dev_dbg(&dev
->core
, "%s:%d %s: no remove method\n",
396 __func__
, __LINE__
, drv
->core
.name
);
398 pr_info(" <- %s:%d: %s\n", __func__
, __LINE__
, dev
->core
.bus_id
);
402 static void ps3_system_bus_shutdown(struct device
*_dev
)
404 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
405 struct ps3_system_bus_driver
*drv
;
409 dev_dbg(&dev
->core
, " -> %s:%d: match_id %d\n", __func__
, __LINE__
,
412 if (!dev
->core
.driver
) {
413 dev_dbg(&dev
->core
, "%s:%d: no driver bound\n", __func__
,
418 drv
= ps3_system_bus_dev_to_system_bus_drv(dev
);
422 dev_dbg(&dev
->core
, "%s:%d: %s -> %s\n", __func__
, __LINE__
,
423 dev
->core
.bus_id
, drv
->core
.name
);
427 else if (drv
->remove
) {
428 dev_dbg(&dev
->core
, "%s:%d %s: no shutdown, calling remove\n",
429 __func__
, __LINE__
, drv
->core
.name
);
432 dev_dbg(&dev
->core
, "%s:%d %s: no shutdown method\n",
433 __func__
, __LINE__
, drv
->core
.name
);
437 dev_dbg(&dev
->core
, " <- %s:%d\n", __func__
, __LINE__
);
440 static int ps3_system_bus_uevent(struct device
*_dev
, struct kobj_uevent_env
*env
)
442 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
443 int i
= 0, length
= 0;
445 if (add_uevent_var(env
, "MODALIAS=ps3:%d", dev
->match_id
))
450 static ssize_t
modalias_show(struct device
*_dev
, struct device_attribute
*a
,
453 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
454 int len
= snprintf(buf
, PAGE_SIZE
, "ps3:%d\n", dev
->match_id
);
456 return (len
>= PAGE_SIZE
) ? (PAGE_SIZE
- 1) : len
;
459 static struct device_attribute ps3_system_bus_dev_attrs
[] = {
464 struct bus_type ps3_system_bus_type
= {
465 .name
= "ps3_system_bus",
466 .match
= ps3_system_bus_match
,
467 .uevent
= ps3_system_bus_uevent
,
468 .probe
= ps3_system_bus_probe
,
469 .remove
= ps3_system_bus_remove
,
470 .shutdown
= ps3_system_bus_shutdown
,
471 .dev_attrs
= ps3_system_bus_dev_attrs
,
474 static int __init
ps3_system_bus_init(void)
478 if (!firmware_has_feature(FW_FEATURE_PS3_LV1
))
481 pr_debug(" -> %s:%d\n", __func__
, __LINE__
);
483 mutex_init(&usage_hack
.mutex
);
485 result
= device_register(&ps3_system_bus
);
488 result
= bus_register(&ps3_system_bus_type
);
491 pr_debug(" <- %s:%d\n", __func__
, __LINE__
);
495 core_initcall(ps3_system_bus_init
);
497 /* Allocates a contiguous real buffer and creates mappings over it.
498 * Returns the virtual address of the buffer and sets dma_handle
499 * to the dma address (mapping) of the first page.
501 static void * ps3_alloc_coherent(struct device
*_dev
, size_t size
,
502 dma_addr_t
*dma_handle
, gfp_t flag
)
505 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
506 unsigned long virt_addr
;
508 flag
&= ~(__GFP_DMA
| __GFP_HIGHMEM
);
511 virt_addr
= __get_free_pages(flag
, get_order(size
));
514 pr_debug("%s:%d: get_free_pages failed\n", __func__
, __LINE__
);
518 result
= ps3_dma_map(dev
->d_region
, virt_addr
, size
, dma_handle
,
519 IOPTE_PP_W
| IOPTE_PP_R
| IOPTE_SO_RW
| IOPTE_M
);
522 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
523 __func__
, __LINE__
, result
);
524 BUG_ON("check region type");
528 return (void*)virt_addr
;
531 free_pages(virt_addr
, get_order(size
));
537 static void ps3_free_coherent(struct device
*_dev
, size_t size
, void *vaddr
,
538 dma_addr_t dma_handle
)
540 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
542 ps3_dma_unmap(dev
->d_region
, dma_handle
, size
);
543 free_pages((unsigned long)vaddr
, get_order(size
));
546 /* Creates TCEs for a user provided buffer. The user buffer must be
547 * contiguous real kernel storage (not vmalloc). The address of the buffer
548 * passed here is the kernel (virtual) address of the buffer. The buffer
549 * need not be page aligned, the dma_addr_t returned will point to the same
550 * byte within the page as vaddr.
553 static dma_addr_t
ps3_sb_map_single(struct device
*_dev
, void *ptr
, size_t size
,
554 enum dma_data_direction direction
)
556 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
558 unsigned long bus_addr
;
560 result
= ps3_dma_map(dev
->d_region
, (unsigned long)ptr
, size
,
562 IOPTE_PP_R
| IOPTE_PP_W
| IOPTE_SO_RW
| IOPTE_M
);
565 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
566 __func__
, __LINE__
, result
);
572 static dma_addr_t
ps3_ioc0_map_single(struct device
*_dev
, void *ptr
,
574 enum dma_data_direction direction
)
576 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
578 unsigned long bus_addr
;
581 iopte_flag
= IOPTE_M
;
583 case DMA_BIDIRECTIONAL
:
584 iopte_flag
|= IOPTE_PP_R
| IOPTE_PP_W
| IOPTE_SO_RW
;
587 iopte_flag
|= IOPTE_PP_R
| IOPTE_SO_R
;
589 case DMA_FROM_DEVICE
:
590 iopte_flag
|= IOPTE_PP_W
| IOPTE_SO_RW
;
596 result
= ps3_dma_map(dev
->d_region
, (unsigned long)ptr
, size
,
597 &bus_addr
, iopte_flag
);
600 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
601 __func__
, __LINE__
, result
);
606 static void ps3_unmap_single(struct device
*_dev
, dma_addr_t dma_addr
,
607 size_t size
, enum dma_data_direction direction
)
609 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
612 result
= ps3_dma_unmap(dev
->d_region
, dma_addr
, size
);
615 pr_debug("%s:%d: ps3_dma_unmap failed (%d)\n",
616 __func__
, __LINE__
, result
);
620 static int ps3_sb_map_sg(struct device
*_dev
, struct scatterlist
*sg
, int nents
,
621 enum dma_data_direction direction
)
623 #if defined(CONFIG_PS3_DYNAMIC_DMA)
627 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
630 for (i
= 0; i
< nents
; i
++, sg
++) {
631 int result
= ps3_dma_map(dev
->d_region
,
632 page_to_phys(sg
->page
) + sg
->offset
, sg
->length
,
633 &sg
->dma_address
, 0);
636 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
637 __func__
, __LINE__
, result
);
641 sg
->dma_length
= sg
->length
;
648 static int ps3_ioc0_map_sg(struct device
*_dev
, struct scatterlist
*sg
,
650 enum dma_data_direction direction
)
656 static void ps3_sb_unmap_sg(struct device
*_dev
, struct scatterlist
*sg
,
657 int nents
, enum dma_data_direction direction
)
659 #if defined(CONFIG_PS3_DYNAMIC_DMA)
664 static void ps3_ioc0_unmap_sg(struct device
*_dev
, struct scatterlist
*sg
,
665 int nents
, enum dma_data_direction direction
)
670 static int ps3_dma_supported(struct device
*_dev
, u64 mask
)
672 return mask
>= DMA_32BIT_MASK
;
675 static struct dma_mapping_ops ps3_sb_dma_ops
= {
676 .alloc_coherent
= ps3_alloc_coherent
,
677 .free_coherent
= ps3_free_coherent
,
678 .map_single
= ps3_sb_map_single
,
679 .unmap_single
= ps3_unmap_single
,
680 .map_sg
= ps3_sb_map_sg
,
681 .unmap_sg
= ps3_sb_unmap_sg
,
682 .dma_supported
= ps3_dma_supported
685 static struct dma_mapping_ops ps3_ioc0_dma_ops
= {
686 .alloc_coherent
= ps3_alloc_coherent
,
687 .free_coherent
= ps3_free_coherent
,
688 .map_single
= ps3_ioc0_map_single
,
689 .unmap_single
= ps3_unmap_single
,
690 .map_sg
= ps3_ioc0_map_sg
,
691 .unmap_sg
= ps3_ioc0_unmap_sg
,
692 .dma_supported
= ps3_dma_supported
696 * ps3_system_bus_release_device - remove a device from the system bus
699 static void ps3_system_bus_release_device(struct device
*_dev
)
701 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
706 * ps3_system_bus_device_register - add a device to the system bus
708 * ps3_system_bus_device_register() expects the dev object to be allocated
709 * dynamically by the caller. The system bus takes ownership of the dev
710 * object and frees the object in ps3_system_bus_release_device().
713 int ps3_system_bus_device_register(struct ps3_system_bus_device
*dev
)
716 static unsigned int dev_ioc0_count
;
717 static unsigned int dev_sb_count
;
718 static unsigned int dev_vuart_count
;
720 if (!dev
->core
.parent
)
721 dev
->core
.parent
= &ps3_system_bus
;
722 dev
->core
.bus
= &ps3_system_bus_type
;
723 dev
->core
.release
= ps3_system_bus_release_device
;
725 switch (dev
->dev_type
) {
726 case PS3_DEVICE_TYPE_IOC0
:
727 dev
->core
.archdata
.dma_ops
= &ps3_ioc0_dma_ops
;
728 snprintf(dev
->core
.bus_id
, sizeof(dev
->core
.bus_id
),
729 "ioc0_%02x", ++dev_ioc0_count
);
731 case PS3_DEVICE_TYPE_SB
:
732 dev
->core
.archdata
.dma_ops
= &ps3_sb_dma_ops
;
733 snprintf(dev
->core
.bus_id
, sizeof(dev
->core
.bus_id
),
734 "sb_%02x", ++dev_sb_count
);
737 case PS3_DEVICE_TYPE_VUART
:
738 snprintf(dev
->core
.bus_id
, sizeof(dev
->core
.bus_id
),
739 "vuart_%02x", ++dev_vuart_count
);
745 dev
->core
.archdata
.of_node
= NULL
;
746 dev
->core
.archdata
.numa_node
= 0;
748 pr_debug("%s:%d add %s\n", __func__
, __LINE__
, dev
->core
.bus_id
);
750 result
= device_register(&dev
->core
);
754 EXPORT_SYMBOL_GPL(ps3_system_bus_device_register
);
756 int ps3_system_bus_driver_register(struct ps3_system_bus_driver
*drv
)
760 pr_debug(" -> %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
762 if (!firmware_has_feature(FW_FEATURE_PS3_LV1
))
765 drv
->core
.bus
= &ps3_system_bus_type
;
767 result
= driver_register(&drv
->core
);
768 pr_debug(" <- %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
772 EXPORT_SYMBOL_GPL(ps3_system_bus_driver_register
);
774 void ps3_system_bus_driver_unregister(struct ps3_system_bus_driver
*drv
)
776 pr_debug(" -> %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
777 driver_unregister(&drv
->core
);
778 pr_debug(" <- %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
781 EXPORT_SYMBOL_GPL(ps3_system_bus_driver_unregister
);