Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/* IBM POWER Barrier Synchronization Register Driver
  3 *
  4 * Copyright IBM Corporation 2008
  5 *
  6 * Author: Sonny Rao <sonnyrao@us.ibm.com>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  7 */
  8
  9#include <linux/device.h>
 10#include <linux/kernel.h>
 11#include <linux/of.h>
 12#include <linux/of_address.h>
 
 
 13#include <linux/fs.h>
 14#include <linux/module.h>
 15#include <linux/cdev.h>
 16#include <linux/list.h>
 17#include <linux/mm.h>
 18#include <linux/slab.h>
 
 19#include <asm/io.h>
 20
 21/*
 22 This driver exposes a special register which can be used for fast
 23 synchronization across a large SMP machine.  The hardware is exposed
 24 as an array of bytes where each process will write to one of the bytes to
 25 indicate it has finished the current stage and this update is broadcast to
 26 all processors without having to bounce a cacheline between them. In
 27 POWER5 and POWER6 there is one of these registers per SMP,  but it is
 28 presented in two forms; first, it is given as a whole and then as a number
 29 of smaller registers which alias to parts of the single whole register.
 30 This can potentially allow multiple groups of processes to each have their
 31 own private synchronization device.
 32
 33 Note that this hardware *must* be written to using *only* single byte writes.
 34 It may be read using 1, 2, 4, or 8 byte loads which must be aligned since
 35 this region is treated as cache-inhibited  processes should also use a
 36 full sync before and after writing to the BSR to ensure all stores and
 37 the BSR update have made it to all chips in the system
 38*/
 39
 40/* This is arbitrary number, up to Power6 it's been 17 or fewer  */
 41#define BSR_MAX_DEVS (32)
 42
 43struct bsr_dev {
 44	u64      bsr_addr;     /* Real address */
 45	u64      bsr_len;      /* length of mem region we can map */
 46	unsigned bsr_bytes;    /* size of the BSR reg itself */
 47	unsigned bsr_stride;   /* interval at which BSR repeats in the page */
 48	unsigned bsr_type;     /* maps to enum below */
 49	unsigned bsr_num;      /* bsr id number for its type */
 50	int      bsr_minor;
 51
 52	struct list_head bsr_list;
 53
 54	dev_t    bsr_dev;
 55	struct cdev bsr_cdev;
 56	struct device *bsr_device;
 57	char     bsr_name[32];
 58
 59};
 60
 61static unsigned total_bsr_devs;
 62static LIST_HEAD(bsr_devs);
 
 63static int bsr_major;
 64
 65enum {
 66	BSR_8    = 0,
 67	BSR_16   = 1,
 68	BSR_64   = 2,
 69	BSR_128  = 3,
 70	BSR_4096 = 4,
 71	BSR_UNKNOWN = 5,
 72	BSR_MAX  = 6,
 73};
 74
 75static unsigned bsr_types[BSR_MAX];
 76
 77static ssize_t
 78bsr_size_show(struct device *dev, struct device_attribute *attr, char *buf)
 79{
 80	struct bsr_dev *bsr_dev = dev_get_drvdata(dev);
 81	return sprintf(buf, "%u\n", bsr_dev->bsr_bytes);
 82}
 83static DEVICE_ATTR_RO(bsr_size);
 84
 85static ssize_t
 86bsr_stride_show(struct device *dev, struct device_attribute *attr, char *buf)
 87{
 88	struct bsr_dev *bsr_dev = dev_get_drvdata(dev);
 89	return sprintf(buf, "%u\n", bsr_dev->bsr_stride);
 90}
 91static DEVICE_ATTR_RO(bsr_stride);
 92
 93static ssize_t
 94bsr_length_show(struct device *dev, struct device_attribute *attr, char *buf)
 95{
 96	struct bsr_dev *bsr_dev = dev_get_drvdata(dev);
 97	return sprintf(buf, "%llu\n", bsr_dev->bsr_len);
 98}
 99static DEVICE_ATTR_RO(bsr_length);
100
101static struct attribute *bsr_dev_attrs[] = {
102	&dev_attr_bsr_size.attr,
103	&dev_attr_bsr_stride.attr,
104	&dev_attr_bsr_length.attr,
105	NULL,
106};
107ATTRIBUTE_GROUPS(bsr_dev);
108
109static const struct class bsr_class = {
110	.name		= "bsr",
111	.dev_groups	= bsr_dev_groups,
112};
113
114static int bsr_mmap(struct file *filp, struct vm_area_struct *vma)
115{
116	unsigned long size   = vma->vm_end - vma->vm_start;
117	struct bsr_dev *dev = filp->private_data;
118	int ret;
119
120	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
121
122	/* check for the case of a small BSR device and map one 4k page for it*/
123	if (dev->bsr_len < PAGE_SIZE && size == PAGE_SIZE)
124		ret = remap_4k_pfn(vma, vma->vm_start, dev->bsr_addr >> 12,
125				   vma->vm_page_prot);
126	else if (size <= dev->bsr_len)
127		ret = io_remap_pfn_range(vma, vma->vm_start,
128					 dev->bsr_addr >> PAGE_SHIFT,
129					 size, vma->vm_page_prot);
130	else
131		return -EINVAL;
132
133	if (ret)
134		return -EAGAIN;
135
136	return 0;
137}
138
139static int bsr_open(struct inode *inode, struct file *filp)
140{
141	struct cdev *cdev = inode->i_cdev;
142	struct bsr_dev *dev = container_of(cdev, struct bsr_dev, bsr_cdev);
143
144	filp->private_data = dev;
145	return 0;
146}
147
148static const struct file_operations bsr_fops = {
149	.owner = THIS_MODULE,
150	.mmap  = bsr_mmap,
151	.open  = bsr_open,
152	.llseek = noop_llseek,
153};
154
155static void bsr_cleanup_devs(void)
156{
157	struct bsr_dev *cur, *n;
158
159	list_for_each_entry_safe(cur, n, &bsr_devs, bsr_list) {
160		if (cur->bsr_device) {
161			cdev_del(&cur->bsr_cdev);
162			device_del(cur->bsr_device);
163		}
164		list_del(&cur->bsr_list);
165		kfree(cur);
166	}
167}
168
169static int bsr_add_node(struct device_node *bn)
170{
171	int bsr_stride_len, bsr_bytes_len, num_bsr_devs;
172	const u32 *bsr_stride;
173	const u32 *bsr_bytes;
174	unsigned i;
175	int ret = -ENODEV;
176
177	bsr_stride = of_get_property(bn, "ibm,lock-stride", &bsr_stride_len);
178	bsr_bytes  = of_get_property(bn, "ibm,#lock-bytes", &bsr_bytes_len);
179
180	if (!bsr_stride || !bsr_bytes ||
181	    (bsr_stride_len != bsr_bytes_len)) {
182		printk(KERN_ERR "bsr of-node has missing/incorrect property\n");
183		return ret;
184	}
185
186	num_bsr_devs = bsr_bytes_len / sizeof(u32);
187
188	for (i = 0 ; i < num_bsr_devs; i++) {
189		struct bsr_dev *cur = kzalloc(sizeof(struct bsr_dev),
190					      GFP_KERNEL);
191		struct resource res;
192		int result;
193
194		if (!cur) {
195			printk(KERN_ERR "Unable to alloc bsr dev\n");
196			ret = -ENOMEM;
197			goto out_err;
198		}
199
200		result = of_address_to_resource(bn, i, &res);
201		if (result < 0) {
202			printk(KERN_ERR "bsr of-node has invalid reg property, skipping\n");
203			kfree(cur);
204			continue;
205		}
206
207		cur->bsr_minor  = i + total_bsr_devs;
208		cur->bsr_addr   = res.start;
209		cur->bsr_len    = resource_size(&res);
210		cur->bsr_bytes  = bsr_bytes[i];
211		cur->bsr_stride = bsr_stride[i];
212		cur->bsr_dev    = MKDEV(bsr_major, i + total_bsr_devs);
213
214		/* if we have a bsr_len of > 4k and less then PAGE_SIZE (64k pages) */
215		/* we can only map 4k of it, so only advertise the 4k in sysfs */
216		if (cur->bsr_len > 4096 && cur->bsr_len < PAGE_SIZE)
217			cur->bsr_len = 4096;
218
219		switch(cur->bsr_bytes) {
220		case 8:
221			cur->bsr_type = BSR_8;
222			break;
223		case 16:
224			cur->bsr_type = BSR_16;
225			break;
226		case 64:
227			cur->bsr_type = BSR_64;
228			break;
229		case 128:
230			cur->bsr_type = BSR_128;
231			break;
232		case 4096:
233			cur->bsr_type = BSR_4096;
234			break;
235		default:
236			cur->bsr_type = BSR_UNKNOWN;
237		}
238
239		cur->bsr_num = bsr_types[cur->bsr_type];
240		snprintf(cur->bsr_name, 32, "bsr%d_%d",
241			 cur->bsr_bytes, cur->bsr_num);
242
243		cdev_init(&cur->bsr_cdev, &bsr_fops);
244		result = cdev_add(&cur->bsr_cdev, cur->bsr_dev, 1);
245		if (result) {
246			kfree(cur);
247			goto out_err;
248		}
249
250		cur->bsr_device = device_create(&bsr_class, NULL, cur->bsr_dev,
251						cur, "%s", cur->bsr_name);
252		if (IS_ERR(cur->bsr_device)) {
253			printk(KERN_ERR "device_create failed for %s\n",
254			       cur->bsr_name);
255			cdev_del(&cur->bsr_cdev);
256			kfree(cur);
257			goto out_err;
258		}
259
260		bsr_types[cur->bsr_type] = cur->bsr_num + 1;
261		list_add_tail(&cur->bsr_list, &bsr_devs);
262	}
263
264	total_bsr_devs += num_bsr_devs;
265
266	return 0;
267
268 out_err:
269
270	bsr_cleanup_devs();
271	return ret;
272}
273
274static int bsr_create_devs(struct device_node *bn)
275{
276	int ret;
277
278	while (bn) {
279		ret = bsr_add_node(bn);
280		if (ret) {
281			of_node_put(bn);
282			return ret;
283		}
284		bn = of_find_compatible_node(bn, NULL, "ibm,bsr");
285	}
286	return 0;
287}
288
289static int __init bsr_init(void)
290{
291	struct device_node *np;
292	dev_t bsr_dev;
293	int ret = -ENODEV;
294
295	np = of_find_compatible_node(NULL, NULL, "ibm,bsr");
296	if (!np)
297		goto out_err;
298
299	ret = class_register(&bsr_class);
300	if (ret)
 
 
301		goto out_err_1;
 
 
302
303	ret = alloc_chrdev_region(&bsr_dev, 0, BSR_MAX_DEVS, "bsr");
304	bsr_major = MAJOR(bsr_dev);
305	if (ret < 0) {
306		printk(KERN_ERR "alloc_chrdev_region() failed for bsr\n");
307		goto out_err_2;
308	}
309
310	ret = bsr_create_devs(np);
311	if (ret < 0) {
312		np = NULL;
313		goto out_err_3;
314	}
315
316	return 0;
317
318 out_err_3:
319	unregister_chrdev_region(bsr_dev, BSR_MAX_DEVS);
320
321 out_err_2:
322	class_unregister(&bsr_class);
323
324 out_err_1:
325	of_node_put(np);
326
327 out_err:
328
329	return ret;
330}
331
332static void __exit  bsr_exit(void)
333{
334
335	bsr_cleanup_devs();
336
337	class_unregister(&bsr_class);
 
338
339	if (bsr_major)
340		unregister_chrdev_region(MKDEV(bsr_major, 0), BSR_MAX_DEVS);
341}
342
343module_init(bsr_init);
344module_exit(bsr_exit);
345MODULE_LICENSE("GPL");
346MODULE_AUTHOR("Sonny Rao <sonnyrao@us.ibm.com>");
v4.6
 
  1/* IBM POWER Barrier Synchronization Register Driver
  2 *
  3 * Copyright IBM Corporation 2008
  4 *
  5 * Author: Sonny Rao <sonnyrao@us.ibm.com>
  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; either version 2 of the License, or
 10 * (at your option) any later version.
 11 *
 12 * This program is distributed in the hope that it will be useful,
 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 15 * GNU General Public License for more details.
 16 *
 17 * You should have received a copy of the GNU General Public License
 18 * along with this program; if not, write to the Free Software
 19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 20 */
 21
 
 22#include <linux/kernel.h>
 23#include <linux/of.h>
 24#include <linux/of_address.h>
 25#include <linux/of_device.h>
 26#include <linux/of_platform.h>
 27#include <linux/fs.h>
 28#include <linux/module.h>
 29#include <linux/cdev.h>
 30#include <linux/list.h>
 31#include <linux/mm.h>
 32#include <linux/slab.h>
 33#include <asm/pgtable.h>
 34#include <asm/io.h>
 35
 36/*
 37 This driver exposes a special register which can be used for fast
 38 synchronization across a large SMP machine.  The hardware is exposed
 39 as an array of bytes where each process will write to one of the bytes to
 40 indicate it has finished the current stage and this update is broadcast to
 41 all processors without having to bounce a cacheline between them. In
 42 POWER5 and POWER6 there is one of these registers per SMP,  but it is
 43 presented in two forms; first, it is given as a whole and then as a number
 44 of smaller registers which alias to parts of the single whole register.
 45 This can potentially allow multiple groups of processes to each have their
 46 own private synchronization device.
 47
 48 Note that this hardware *must* be written to using *only* single byte writes.
 49 It may be read using 1, 2, 4, or 8 byte loads which must be aligned since
 50 this region is treated as cache-inhibited  processes should also use a
 51 full sync before and after writing to the BSR to ensure all stores and
 52 the BSR update have made it to all chips in the system
 53*/
 54
 55/* This is arbitrary number, up to Power6 it's been 17 or fewer  */
 56#define BSR_MAX_DEVS (32)
 57
 58struct bsr_dev {
 59	u64      bsr_addr;     /* Real address */
 60	u64      bsr_len;      /* length of mem region we can map */
 61	unsigned bsr_bytes;    /* size of the BSR reg itself */
 62	unsigned bsr_stride;   /* interval at which BSR repeats in the page */
 63	unsigned bsr_type;     /* maps to enum below */
 64	unsigned bsr_num;      /* bsr id number for its type */
 65	int      bsr_minor;
 66
 67	struct list_head bsr_list;
 68
 69	dev_t    bsr_dev;
 70	struct cdev bsr_cdev;
 71	struct device *bsr_device;
 72	char     bsr_name[32];
 73
 74};
 75
 76static unsigned total_bsr_devs;
 77static struct list_head bsr_devs = LIST_HEAD_INIT(bsr_devs);
 78static struct class *bsr_class;
 79static int bsr_major;
 80
 81enum {
 82	BSR_8    = 0,
 83	BSR_16   = 1,
 84	BSR_64   = 2,
 85	BSR_128  = 3,
 86	BSR_4096 = 4,
 87	BSR_UNKNOWN = 5,
 88	BSR_MAX  = 6,
 89};
 90
 91static unsigned bsr_types[BSR_MAX];
 92
 93static ssize_t
 94bsr_size_show(struct device *dev, struct device_attribute *attr, char *buf)
 95{
 96	struct bsr_dev *bsr_dev = dev_get_drvdata(dev);
 97	return sprintf(buf, "%u\n", bsr_dev->bsr_bytes);
 98}
 99static DEVICE_ATTR_RO(bsr_size);
100
101static ssize_t
102bsr_stride_show(struct device *dev, struct device_attribute *attr, char *buf)
103{
104	struct bsr_dev *bsr_dev = dev_get_drvdata(dev);
105	return sprintf(buf, "%u\n", bsr_dev->bsr_stride);
106}
107static DEVICE_ATTR_RO(bsr_stride);
108
109static ssize_t
110bsr_length_show(struct device *dev, struct device_attribute *attr, char *buf)
111{
112	struct bsr_dev *bsr_dev = dev_get_drvdata(dev);
113	return sprintf(buf, "%llu\n", bsr_dev->bsr_len);
114}
115static DEVICE_ATTR_RO(bsr_length);
116
117static struct attribute *bsr_dev_attrs[] = {
118	&dev_attr_bsr_size.attr,
119	&dev_attr_bsr_stride.attr,
120	&dev_attr_bsr_length.attr,
121	NULL,
122};
123ATTRIBUTE_GROUPS(bsr_dev);
124
 
 
 
 
 
125static int bsr_mmap(struct file *filp, struct vm_area_struct *vma)
126{
127	unsigned long size   = vma->vm_end - vma->vm_start;
128	struct bsr_dev *dev = filp->private_data;
129	int ret;
130
131	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
132
133	/* check for the case of a small BSR device and map one 4k page for it*/
134	if (dev->bsr_len < PAGE_SIZE && size == PAGE_SIZE)
135		ret = remap_4k_pfn(vma, vma->vm_start, dev->bsr_addr >> 12,
136				   vma->vm_page_prot);
137	else if (size <= dev->bsr_len)
138		ret = io_remap_pfn_range(vma, vma->vm_start,
139					 dev->bsr_addr >> PAGE_SHIFT,
140					 size, vma->vm_page_prot);
141	else
142		return -EINVAL;
143
144	if (ret)
145		return -EAGAIN;
146
147	return 0;
148}
149
150static int bsr_open(struct inode * inode, struct file * filp)
151{
152	struct cdev *cdev = inode->i_cdev;
153	struct bsr_dev *dev = container_of(cdev, struct bsr_dev, bsr_cdev);
154
155	filp->private_data = dev;
156	return 0;
157}
158
159static const struct file_operations bsr_fops = {
160	.owner = THIS_MODULE,
161	.mmap  = bsr_mmap,
162	.open  = bsr_open,
163	.llseek = noop_llseek,
164};
165
166static void bsr_cleanup_devs(void)
167{
168	struct bsr_dev *cur, *n;
169
170	list_for_each_entry_safe(cur, n, &bsr_devs, bsr_list) {
171		if (cur->bsr_device) {
172			cdev_del(&cur->bsr_cdev);
173			device_del(cur->bsr_device);
174		}
175		list_del(&cur->bsr_list);
176		kfree(cur);
177	}
178}
179
180static int bsr_add_node(struct device_node *bn)
181{
182	int bsr_stride_len, bsr_bytes_len, num_bsr_devs;
183	const u32 *bsr_stride;
184	const u32 *bsr_bytes;
185	unsigned i;
186	int ret = -ENODEV;
187
188	bsr_stride = of_get_property(bn, "ibm,lock-stride", &bsr_stride_len);
189	bsr_bytes  = of_get_property(bn, "ibm,#lock-bytes", &bsr_bytes_len);
190
191	if (!bsr_stride || !bsr_bytes ||
192	    (bsr_stride_len != bsr_bytes_len)) {
193		printk(KERN_ERR "bsr of-node has missing/incorrect property\n");
194		return ret;
195	}
196
197	num_bsr_devs = bsr_bytes_len / sizeof(u32);
198
199	for (i = 0 ; i < num_bsr_devs; i++) {
200		struct bsr_dev *cur = kzalloc(sizeof(struct bsr_dev),
201					      GFP_KERNEL);
202		struct resource res;
203		int result;
204
205		if (!cur) {
206			printk(KERN_ERR "Unable to alloc bsr dev\n");
207			ret = -ENOMEM;
208			goto out_err;
209		}
210
211		result = of_address_to_resource(bn, i, &res);
212		if (result < 0) {
213			printk(KERN_ERR "bsr of-node has invalid reg property, skipping\n");
214			kfree(cur);
215			continue;
216		}
217
218		cur->bsr_minor  = i + total_bsr_devs;
219		cur->bsr_addr   = res.start;
220		cur->bsr_len    = resource_size(&res);
221		cur->bsr_bytes  = bsr_bytes[i];
222		cur->bsr_stride = bsr_stride[i];
223		cur->bsr_dev    = MKDEV(bsr_major, i + total_bsr_devs);
224
225		/* if we have a bsr_len of > 4k and less then PAGE_SIZE (64k pages) */
226		/* we can only map 4k of it, so only advertise the 4k in sysfs */
227		if (cur->bsr_len > 4096 && cur->bsr_len < PAGE_SIZE)
228			cur->bsr_len = 4096;
229
230		switch(cur->bsr_bytes) {
231		case 8:
232			cur->bsr_type = BSR_8;
233			break;
234		case 16:
235			cur->bsr_type = BSR_16;
236			break;
237		case 64:
238			cur->bsr_type = BSR_64;
239			break;
240		case 128:
241			cur->bsr_type = BSR_128;
242			break;
243		case 4096:
244			cur->bsr_type = BSR_4096;
245			break;
246		default:
247			cur->bsr_type = BSR_UNKNOWN;
248		}
249
250		cur->bsr_num = bsr_types[cur->bsr_type];
251		snprintf(cur->bsr_name, 32, "bsr%d_%d",
252			 cur->bsr_bytes, cur->bsr_num);
253
254		cdev_init(&cur->bsr_cdev, &bsr_fops);
255		result = cdev_add(&cur->bsr_cdev, cur->bsr_dev, 1);
256		if (result) {
257			kfree(cur);
258			goto out_err;
259		}
260
261		cur->bsr_device = device_create(bsr_class, NULL, cur->bsr_dev,
262						cur, "%s", cur->bsr_name);
263		if (IS_ERR(cur->bsr_device)) {
264			printk(KERN_ERR "device_create failed for %s\n",
265			       cur->bsr_name);
266			cdev_del(&cur->bsr_cdev);
267			kfree(cur);
268			goto out_err;
269		}
270
271		bsr_types[cur->bsr_type] = cur->bsr_num + 1;
272		list_add_tail(&cur->bsr_list, &bsr_devs);
273	}
274
275	total_bsr_devs += num_bsr_devs;
276
277	return 0;
278
279 out_err:
280
281	bsr_cleanup_devs();
282	return ret;
283}
284
285static int bsr_create_devs(struct device_node *bn)
286{
287	int ret;
288
289	while (bn) {
290		ret = bsr_add_node(bn);
291		if (ret) {
292			of_node_put(bn);
293			return ret;
294		}
295		bn = of_find_compatible_node(bn, NULL, "ibm,bsr");
296	}
297	return 0;
298}
299
300static int __init bsr_init(void)
301{
302	struct device_node *np;
303	dev_t bsr_dev;
304	int ret = -ENODEV;
305
306	np = of_find_compatible_node(NULL, NULL, "ibm,bsr");
307	if (!np)
308		goto out_err;
309
310	bsr_class = class_create(THIS_MODULE, "bsr");
311	if (IS_ERR(bsr_class)) {
312		printk(KERN_ERR "class_create() failed for bsr_class\n");
313		ret = PTR_ERR(bsr_class);
314		goto out_err_1;
315	}
316	bsr_class->dev_groups = bsr_dev_groups;
317
318	ret = alloc_chrdev_region(&bsr_dev, 0, BSR_MAX_DEVS, "bsr");
319	bsr_major = MAJOR(bsr_dev);
320	if (ret < 0) {
321		printk(KERN_ERR "alloc_chrdev_region() failed for bsr\n");
322		goto out_err_2;
323	}
324
325	if ((ret = bsr_create_devs(np)) < 0) {
 
326		np = NULL;
327		goto out_err_3;
328	}
329
330	return 0;
331
332 out_err_3:
333	unregister_chrdev_region(bsr_dev, BSR_MAX_DEVS);
334
335 out_err_2:
336	class_destroy(bsr_class);
337
338 out_err_1:
339	of_node_put(np);
340
341 out_err:
342
343	return ret;
344}
345
346static void __exit  bsr_exit(void)
347{
348
349	bsr_cleanup_devs();
350
351	if (bsr_class)
352		class_destroy(bsr_class);
353
354	if (bsr_major)
355		unregister_chrdev_region(MKDEV(bsr_major, 0), BSR_MAX_DEVS);
356}
357
358module_init(bsr_init);
359module_exit(bsr_exit);
360MODULE_LICENSE("GPL");
361MODULE_AUTHOR("Sonny Rao <sonnyrao@us.ibm.com>");