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 .init_name
= "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
, u64 bus_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_GPU
:
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: %lu\n", __func__
, __LINE__
,
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_GPU
:
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: %lu\n", __func__
, __LINE__
,
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 %lu:%lu\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
)
255 result
= lv1_map_device_mmio_region(r
->dev
->bus_id
, r
->dev
->dev_id
,
256 r
->bus_addr
, r
->len
, r
->page_size
, &lpar_addr
);
257 r
->lpar_addr
= lpar_addr
;
260 pr_debug("%s:%d: lv1_map_device_mmio_region failed: %s\n",
261 __func__
, __LINE__
, ps3_result(result
));
269 static int ps3_ioc0_mmio_region_create(struct ps3_mmio_region
*r
)
271 /* device specific; do nothing currently */
275 int ps3_mmio_region_create(struct ps3_mmio_region
*r
)
277 return r
->mmio_ops
->create(r
);
279 EXPORT_SYMBOL_GPL(ps3_mmio_region_create
);
281 static int ps3_sb_free_mmio_region(struct ps3_mmio_region
*r
)
287 result
= lv1_unmap_device_mmio_region(r
->dev
->bus_id
, r
->dev
->dev_id
,
291 pr_debug("%s:%d: lv1_unmap_device_mmio_region failed: %s\n",
292 __func__
, __LINE__
, ps3_result(result
));
298 static int ps3_ioc0_free_mmio_region(struct ps3_mmio_region
*r
)
300 /* device specific; do nothing currently */
305 int ps3_free_mmio_region(struct ps3_mmio_region
*r
)
307 return r
->mmio_ops
->free(r
);
310 EXPORT_SYMBOL_GPL(ps3_free_mmio_region
);
312 static const struct ps3_mmio_region_ops ps3_mmio_sb_region_ops
= {
313 .create
= ps3_sb_mmio_region_create
,
314 .free
= ps3_sb_free_mmio_region
317 static const struct ps3_mmio_region_ops ps3_mmio_ioc0_region_ops
= {
318 .create
= ps3_ioc0_mmio_region_create
,
319 .free
= ps3_ioc0_free_mmio_region
322 int ps3_mmio_region_init(struct ps3_system_bus_device
*dev
,
323 struct ps3_mmio_region
*r
, unsigned long bus_addr
, unsigned long len
,
324 enum ps3_mmio_page_size page_size
)
327 r
->bus_addr
= bus_addr
;
329 r
->page_size
= page_size
;
330 switch (dev
->dev_type
) {
331 case PS3_DEVICE_TYPE_SB
:
332 r
->mmio_ops
= &ps3_mmio_sb_region_ops
;
334 case PS3_DEVICE_TYPE_IOC0
:
335 r
->mmio_ops
= &ps3_mmio_ioc0_region_ops
;
343 EXPORT_SYMBOL_GPL(ps3_mmio_region_init
);
345 static int ps3_system_bus_match(struct device
*_dev
,
346 struct device_driver
*_drv
)
349 struct ps3_system_bus_driver
*drv
= ps3_drv_to_system_bus_drv(_drv
);
350 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
352 if (!dev
->match_sub_id
)
353 result
= dev
->match_id
== drv
->match_id
;
355 result
= dev
->match_sub_id
== drv
->match_sub_id
&&
356 dev
->match_id
== drv
->match_id
;
359 pr_info("%s:%d: dev=%u.%u(%s), drv=%u.%u(%s): match\n",
361 dev
->match_id
, dev
->match_sub_id
, dev_name(&dev
->core
),
362 drv
->match_id
, drv
->match_sub_id
, drv
->core
.name
);
364 pr_debug("%s:%d: dev=%u.%u(%s), drv=%u.%u(%s): miss\n",
366 dev
->match_id
, dev
->match_sub_id
, dev_name(&dev
->core
),
367 drv
->match_id
, drv
->match_sub_id
, drv
->core
.name
);
372 static int ps3_system_bus_probe(struct device
*_dev
)
375 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
376 struct ps3_system_bus_driver
*drv
;
379 pr_debug(" -> %s:%d: %s\n", __func__
, __LINE__
, _dev
->bus_id
);
381 drv
= ps3_system_bus_dev_to_system_bus_drv(dev
);
385 result
= drv
->probe(dev
);
387 pr_debug("%s:%d: %s no probe method\n", __func__
, __LINE__
,
388 dev_name(&dev
->core
));
390 pr_debug(" <- %s:%d: %s\n", __func__
, __LINE__
, dev_name(&dev
->core
));
394 static int ps3_system_bus_remove(struct device
*_dev
)
397 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
398 struct ps3_system_bus_driver
*drv
;
401 pr_debug(" -> %s:%d: %s\n", __func__
, __LINE__
, _dev
->bus_id
);
403 drv
= ps3_system_bus_dev_to_system_bus_drv(dev
);
407 result
= drv
->remove(dev
);
409 dev_dbg(&dev
->core
, "%s:%d %s: no remove method\n",
410 __func__
, __LINE__
, drv
->core
.name
);
412 pr_debug(" <- %s:%d: %s\n", __func__
, __LINE__
, dev_name(&dev
->core
));
416 static void ps3_system_bus_shutdown(struct device
*_dev
)
418 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
419 struct ps3_system_bus_driver
*drv
;
423 dev_dbg(&dev
->core
, " -> %s:%d: match_id %d\n", __func__
, __LINE__
,
426 if (!dev
->core
.driver
) {
427 dev_dbg(&dev
->core
, "%s:%d: no driver bound\n", __func__
,
432 drv
= ps3_system_bus_dev_to_system_bus_drv(dev
);
436 dev_dbg(&dev
->core
, "%s:%d: %s -> %s\n", __func__
, __LINE__
,
437 dev_name(&dev
->core
), drv
->core
.name
);
441 else if (drv
->remove
) {
442 dev_dbg(&dev
->core
, "%s:%d %s: no shutdown, calling remove\n",
443 __func__
, __LINE__
, drv
->core
.name
);
446 dev_dbg(&dev
->core
, "%s:%d %s: no shutdown method\n",
447 __func__
, __LINE__
, drv
->core
.name
);
451 dev_dbg(&dev
->core
, " <- %s:%d\n", __func__
, __LINE__
);
454 static int ps3_system_bus_uevent(struct device
*_dev
, struct kobj_uevent_env
*env
)
456 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
458 if (add_uevent_var(env
, "MODALIAS=ps3:%d:%d", dev
->match_id
,
464 static ssize_t
modalias_show(struct device
*_dev
, struct device_attribute
*a
,
467 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
468 int len
= snprintf(buf
, PAGE_SIZE
, "ps3:%d:%d\n", dev
->match_id
,
471 return (len
>= PAGE_SIZE
) ? (PAGE_SIZE
- 1) : len
;
474 static struct device_attribute ps3_system_bus_dev_attrs
[] = {
479 struct bus_type ps3_system_bus_type
= {
480 .name
= "ps3_system_bus",
481 .match
= ps3_system_bus_match
,
482 .uevent
= ps3_system_bus_uevent
,
483 .probe
= ps3_system_bus_probe
,
484 .remove
= ps3_system_bus_remove
,
485 .shutdown
= ps3_system_bus_shutdown
,
486 .dev_attrs
= ps3_system_bus_dev_attrs
,
489 static int __init
ps3_system_bus_init(void)
493 if (!firmware_has_feature(FW_FEATURE_PS3_LV1
))
496 pr_debug(" -> %s:%d\n", __func__
, __LINE__
);
498 mutex_init(&usage_hack
.mutex
);
500 result
= device_register(&ps3_system_bus
);
503 result
= bus_register(&ps3_system_bus_type
);
506 pr_debug(" <- %s:%d\n", __func__
, __LINE__
);
510 core_initcall(ps3_system_bus_init
);
512 /* Allocates a contiguous real buffer and creates mappings over it.
513 * Returns the virtual address of the buffer and sets dma_handle
514 * to the dma address (mapping) of the first page.
516 static void * ps3_alloc_coherent(struct device
*_dev
, size_t size
,
517 dma_addr_t
*dma_handle
, gfp_t flag
)
520 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
521 unsigned long virt_addr
;
523 flag
&= ~(__GFP_DMA
| __GFP_HIGHMEM
);
526 virt_addr
= __get_free_pages(flag
, get_order(size
));
529 pr_debug("%s:%d: get_free_pages failed\n", __func__
, __LINE__
);
533 result
= ps3_dma_map(dev
->d_region
, virt_addr
, size
, dma_handle
,
534 IOPTE_PP_W
| IOPTE_PP_R
| IOPTE_SO_RW
| IOPTE_M
);
537 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
538 __func__
, __LINE__
, result
);
539 BUG_ON("check region type");
543 return (void*)virt_addr
;
546 free_pages(virt_addr
, get_order(size
));
552 static void ps3_free_coherent(struct device
*_dev
, size_t size
, void *vaddr
,
553 dma_addr_t dma_handle
)
555 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
557 ps3_dma_unmap(dev
->d_region
, dma_handle
, size
);
558 free_pages((unsigned long)vaddr
, get_order(size
));
561 /* Creates TCEs for a user provided buffer. The user buffer must be
562 * contiguous real kernel storage (not vmalloc). The address passed here
563 * comprises a page address and offset into that page. The dma_addr_t
564 * returned will point to the same byte within the page as was passed in.
567 static dma_addr_t
ps3_sb_map_page(struct device
*_dev
, struct page
*page
,
568 unsigned long offset
, size_t size
, enum dma_data_direction direction
,
569 struct dma_attrs
*attrs
)
571 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
574 void *ptr
= page_address(page
) + offset
;
576 result
= ps3_dma_map(dev
->d_region
, (unsigned long)ptr
, size
,
578 IOPTE_PP_R
| IOPTE_PP_W
| IOPTE_SO_RW
| IOPTE_M
);
581 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
582 __func__
, __LINE__
, result
);
588 static dma_addr_t
ps3_ioc0_map_page(struct device
*_dev
, struct page
*page
,
589 unsigned long offset
, size_t size
,
590 enum dma_data_direction direction
,
591 struct dma_attrs
*attrs
)
593 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
597 void *ptr
= page_address(page
) + offset
;
599 iopte_flag
= IOPTE_M
;
601 case DMA_BIDIRECTIONAL
:
602 iopte_flag
|= IOPTE_PP_R
| IOPTE_PP_W
| IOPTE_SO_RW
;
605 iopte_flag
|= IOPTE_PP_R
| IOPTE_SO_R
;
607 case DMA_FROM_DEVICE
:
608 iopte_flag
|= IOPTE_PP_W
| IOPTE_SO_RW
;
614 result
= ps3_dma_map(dev
->d_region
, (unsigned long)ptr
, size
,
615 &bus_addr
, iopte_flag
);
618 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
619 __func__
, __LINE__
, result
);
624 static void ps3_unmap_page(struct device
*_dev
, dma_addr_t dma_addr
,
625 size_t size
, enum dma_data_direction direction
, struct dma_attrs
*attrs
)
627 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
630 result
= ps3_dma_unmap(dev
->d_region
, dma_addr
, size
);
633 pr_debug("%s:%d: ps3_dma_unmap failed (%d)\n",
634 __func__
, __LINE__
, result
);
638 static int ps3_sb_map_sg(struct device
*_dev
, struct scatterlist
*sgl
,
639 int nents
, enum dma_data_direction direction
, struct dma_attrs
*attrs
)
641 #if defined(CONFIG_PS3_DYNAMIC_DMA)
645 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
646 struct scatterlist
*sg
;
649 for_each_sg(sgl
, sg
, nents
, i
) {
650 int result
= ps3_dma_map(dev
->d_region
, sg_phys(sg
),
651 sg
->length
, &sg
->dma_address
, 0);
654 pr_debug("%s:%d: ps3_dma_map failed (%d)\n",
655 __func__
, __LINE__
, result
);
659 sg
->dma_length
= sg
->length
;
666 static int ps3_ioc0_map_sg(struct device
*_dev
, struct scatterlist
*sg
,
668 enum dma_data_direction direction
,
669 struct dma_attrs
*attrs
)
675 static void ps3_sb_unmap_sg(struct device
*_dev
, struct scatterlist
*sg
,
676 int nents
, enum dma_data_direction direction
, struct dma_attrs
*attrs
)
678 #if defined(CONFIG_PS3_DYNAMIC_DMA)
683 static void ps3_ioc0_unmap_sg(struct device
*_dev
, struct scatterlist
*sg
,
684 int nents
, enum dma_data_direction direction
,
685 struct dma_attrs
*attrs
)
690 static int ps3_dma_supported(struct device
*_dev
, u64 mask
)
692 return mask
>= DMA_32BIT_MASK
;
695 static struct dma_mapping_ops ps3_sb_dma_ops
= {
696 .alloc_coherent
= ps3_alloc_coherent
,
697 .free_coherent
= ps3_free_coherent
,
698 .map_sg
= ps3_sb_map_sg
,
699 .unmap_sg
= ps3_sb_unmap_sg
,
700 .dma_supported
= ps3_dma_supported
,
701 .map_page
= ps3_sb_map_page
,
702 .unmap_page
= ps3_unmap_page
,
705 static struct dma_mapping_ops ps3_ioc0_dma_ops
= {
706 .alloc_coherent
= ps3_alloc_coherent
,
707 .free_coherent
= ps3_free_coherent
,
708 .map_sg
= ps3_ioc0_map_sg
,
709 .unmap_sg
= ps3_ioc0_unmap_sg
,
710 .dma_supported
= ps3_dma_supported
,
711 .map_page
= ps3_ioc0_map_page
,
712 .unmap_page
= ps3_unmap_page
,
716 * ps3_system_bus_release_device - remove a device from the system bus
719 static void ps3_system_bus_release_device(struct device
*_dev
)
721 struct ps3_system_bus_device
*dev
= ps3_dev_to_system_bus_dev(_dev
);
726 * ps3_system_bus_device_register - add a device to the system bus
728 * ps3_system_bus_device_register() expects the dev object to be allocated
729 * dynamically by the caller. The system bus takes ownership of the dev
730 * object and frees the object in ps3_system_bus_release_device().
733 int ps3_system_bus_device_register(struct ps3_system_bus_device
*dev
)
736 static unsigned int dev_ioc0_count
;
737 static unsigned int dev_sb_count
;
738 static unsigned int dev_vuart_count
;
739 static unsigned int dev_lpm_count
;
741 if (!dev
->core
.parent
)
742 dev
->core
.parent
= &ps3_system_bus
;
743 dev
->core
.bus
= &ps3_system_bus_type
;
744 dev
->core
.release
= ps3_system_bus_release_device
;
746 switch (dev
->dev_type
) {
747 case PS3_DEVICE_TYPE_IOC0
:
748 dev
->core
.archdata
.dma_ops
= &ps3_ioc0_dma_ops
;
749 dev_set_name(&dev
->core
, "ioc0_%02x", ++dev_ioc0_count
);
751 case PS3_DEVICE_TYPE_SB
:
752 dev
->core
.archdata
.dma_ops
= &ps3_sb_dma_ops
;
753 dev_set_name(&dev
->core
, "sb_%02x", ++dev_sb_count
);
756 case PS3_DEVICE_TYPE_VUART
:
757 dev_set_name(&dev
->core
, "vuart_%02x", ++dev_vuart_count
);
759 case PS3_DEVICE_TYPE_LPM
:
760 dev_set_name(&dev
->core
, "lpm_%02x", ++dev_lpm_count
);
766 dev
->core
.archdata
.of_node
= NULL
;
767 set_dev_node(&dev
->core
, 0);
769 pr_debug("%s:%d add %s\n", __func__
, __LINE__
, dev_name(&dev
->core
));
771 result
= device_register(&dev
->core
);
775 EXPORT_SYMBOL_GPL(ps3_system_bus_device_register
);
777 int ps3_system_bus_driver_register(struct ps3_system_bus_driver
*drv
)
781 pr_debug(" -> %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
783 if (!firmware_has_feature(FW_FEATURE_PS3_LV1
))
786 drv
->core
.bus
= &ps3_system_bus_type
;
788 result
= driver_register(&drv
->core
);
789 pr_debug(" <- %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
793 EXPORT_SYMBOL_GPL(ps3_system_bus_driver_register
);
795 void ps3_system_bus_driver_unregister(struct ps3_system_bus_driver
*drv
)
797 pr_debug(" -> %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
798 driver_unregister(&drv
->core
);
799 pr_debug(" <- %s:%d: %s\n", __func__
, __LINE__
, drv
->core
.name
);
802 EXPORT_SYMBOL_GPL(ps3_system_bus_driver_unregister
);