| blob | d3b25da2df4994a1751421fa3e9f47c256556c92 |
1 --- a/drivers/char/Makefile 2012-02-03 21:39:51.000000000 +0100
2 +++ b/drivers/char/Makefile 2012-02-05 17:51:57.339262786 +0100
3 @@ -65,3 +65,5 @@
4 js-rtc-y = rtc.o
6 obj-$(CONFIG_TILE_SROM) += tile-srom.o
7 +
8 +obj-$(CONFIG_PS3_PHYSMEM) += ps3physmem.o
9 --- a/arch/powerpc/platforms/ps3/Kconfig 2012-02-04 21:13:42.539806178 +0100
10 +++ b/arch/powerpc/platforms/ps3/Kconfig 2012-02-05 17:54:38.698430717 +0100
11 @@ -179,6 +179,12 @@
12 profiling support of the Cell processor with programs like
13 oprofile and perfmon2, then say Y or M, otherwise say N.
15 +config PS3_PHYSMEM
16 + tristate "PS3 Physical Memory Driver"
17 + depends on PPC_PS3
18 + help
19 + This driver allows you direct access to the PS3 physical memory.
20 +
21 config PS3GELIC_UDBG
22 bool "PS3 udbg output via UDP broadcasts on Ethernet"
23 depends on PPC_PS3
24 --- /dev/null 2012-02-05 10:06:29.087361680 +0100
25 +++ b/drivers/char/ps3physmem.c 2012-02-05 17:50:30.897909862 +0100
26 @@ -0,0 +1,185 @@
27 +/*
28 + * PS3 Physical Memory Driver
29 + *
30 + * Copyright (C) 2011 graf_chokolo <grafchokolo@gmail.com>
31 + * Copyright (C) 2011, 2012 glevand <geoffrey.levand@mail.ru>
32 + * All rights reserved.
33 + *
34 + * This program is free software; you can redistribute it and/or modify it
35 + * under the terms of the GNU General Public License as published
36 + * by the Free Software Foundation; version 2 of the License.
37 + *
38 + * This program is distributed in the hope that it will be useful, but
39 + * WITHOUT ANY WARRANTY; without even the implied warranty of
40 + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
41 + * General Public License for more details.
42 + *
43 + * You should have received a copy of the GNU General Public License along
44 + * with this program; if not, write to the Free Software Foundation, Inc.,
45 + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
46 + */
47 +
48 +#include <linux/module.h>
49 +#include <linux/kernel.h>
50 +#include <linux/init.h>
51 +#include <linux/mm.h>
52 +#include <linux/fs.h>
53 +#include <linux/uaccess.h>
54 +#include <linux/miscdevice.h>
55 +
56 +#include <asm/io.h>
57 +#include <asm/ps3.h>
58 +#include <asm/lv1call.h>
59 +
60 +static unsigned long mem_start = 0;
61 +module_param(mem_start, ulong, 0);
62 +
63 +static unsigned long mem_size = 256 * 1024 * 1024;
64 +module_param(mem_size, ulong, 0);
65 +
66 +static unsigned long mem_pagesize = 24; /* 16MB */
67 +module_param(mem_pagesize, ulong, 0);
68 +
69 +static u64 ps3physmem_lpar;
70 +static char *ps3physmem_virt;
71 +
72 +static ssize_t ps3physmem_read(struct file *file, char __user *usrbuf,
73 + size_t count, loff_t *pos)
74 +{
75 + if (*pos + count > mem_size)
76 + count = mem_size - *pos;
77 +
78 + if (!count)
79 + return (0);
80 +
81 + if (copy_to_user(usrbuf, ps3physmem_virt + *pos, count))
82 + return (-EFAULT);
83 +
84 + *pos += count;
85 +
86 + return (count);
87 +}
88 +
89 +static ssize_t ps3physmem_write(struct file *file, const char __user *usrbuf,
90 + size_t count, loff_t *pos)
91 +{
92 + if (*pos + count > mem_size)
93 + count = mem_size - *pos;
94 +
95 + if (!count)
96 + return (0);
97 +
98 + if (copy_from_user(ps3physmem_virt + *pos, usrbuf, count))
99 + return (-EFAULT);
100 +
101 + *pos += count;
102 +
103 + return (count);
104 +}
105 +
106 +static void ps3physmem_vma_open(struct vm_area_struct *vma)
107 +{
108 +}
109 +
110 +static void ps3physmem_vma_close(struct vm_area_struct *vma)
111 +{
112 +}
113 +
114 +static struct vm_operations_struct ps3physmem_vm_ops = {
115 + .open = ps3physmem_vma_open,
116 + .close = ps3physmem_vma_close,
117 +};
118 +
119 +static int ps3physmem_mmap(struct file *file, struct vm_area_struct *vma)
120 +{
121 + unsigned long size, pfn;
122 + int res;
123 +
124 + size = vma->vm_end - vma->vm_start;
125 +
126 + if (((vma->vm_pgoff << PAGE_SHIFT) + size) > mem_size)
127 + return (-EINVAL);
128 +
129 + vma->vm_flags |= VM_DONTEXPAND | VM_DONTDUMP | VM_IO;
130 + vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
131 +
132 + pfn = ((unsigned long) ps3physmem_virt >> PAGE_SHIFT) + vma->vm_pgoff;
133 +
134 + res = io_remap_pfn_range(vma, vma->vm_start, pfn, size,
135 + vma->vm_page_prot);
136 + if (res)
137 + return (res);
138 +
139 + vma->vm_ops = &ps3physmem_vm_ops;
140 +
141 + ps3physmem_vma_open(vma);
142 +
143 + return (0);
144 +}
145 +
146 +static const struct file_operations ps3physmem_fops = {
147 + .owner = THIS_MODULE,
148 + .read = ps3physmem_read,
149 + .write = ps3physmem_write,
150 + .mmap = ps3physmem_mmap,
151 +};
152 +
153 +static struct miscdevice ps3physmem_misc = {
154 + .minor = MISC_DYNAMIC_MINOR,
155 + .name = "ps3physmem",
156 + .fops = &ps3physmem_fops,
157 +};
158 +
159 +static int __init ps3physmem_init(void)
160 +{
161 + int res;
162 +
163 + res = lv1_undocumented_function_114(mem_start,
164 + mem_pagesize, mem_size, &ps3physmem_lpar);
165 + if (res) {
166 + pr_info("%s:%u: lv1_undocumented_function_114 failed %d\n",
167 + __func__, __LINE__, res);
168 + return (-ENXIO);
169 + }
170 +
171 + ps3physmem_virt = ioremap_nocache(ps3physmem_lpar, mem_size);
172 + if (!ps3physmem_virt) {
173 + pr_info("%s:%u: ioremap_nocache failed\n", __func__, __LINE__);
174 + goto destroy_lpar;
175 + }
176 +
177 + res = misc_register(&ps3physmem_misc);
178 + if (res) {
179 + pr_info("%s:%u: misc_register failed %d\n",
180 + __func__, __LINE__, res);
181 + goto unmap_lpar;
182 + }
183 +
184 + return (0);
185 +
186 +unmap_lpar:
187 +
188 + iounmap((void *) ps3physmem_virt);
189 +
190 +destroy_lpar:
191 +
192 + lv1_undocumented_function_115(ps3physmem_lpar);
193 +
194 + return (res);
195 +}
196 +
197 +static void __exit ps3physmem_exit(void)
198 +{
199 + misc_deregister(&ps3physmem_misc);
200 +
201 + iounmap((void *) ps3physmem_virt);
202 +
203 + lv1_undocumented_function_115(ps3physmem_lpar);
204 +}
205 +
206 +module_init(ps3physmem_init);
207 +module_exit(ps3physmem_exit);
208 +
209 +MODULE_AUTHOR("glevand");
210 +MODULE_DESCRIPTION("PS3 Physical Memory Driver");
211 +MODULE_LICENSE("GPL");