72 lines
		
	
	
	
		
			1.6 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			72 lines
		
	
	
	
		
			1.6 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * arch/arm/common/bL_switcher_dummy_if.c -- b.L switcher dummy interface | ||
|  |  * | ||
|  |  * Created by:	Nicolas Pitre, November 2012 | ||
|  |  * Copyright:	(C) 2012-2013  Linaro Limited | ||
|  |  * | ||
|  |  * Dummy interface to user space for debugging purpose only. | ||
|  |  * | ||
|  |  * This program is free software; you can redistribute it and/or modify | ||
|  |  * it under the terms of the GNU General Public License version 2 as | ||
|  |  * published by the Free Software Foundation. | ||
|  |  */ | ||
|  | 
 | ||
|  | #include <linux/init.h>
 | ||
|  | #include <linux/module.h>
 | ||
|  | #include <linux/fs.h>
 | ||
|  | #include <linux/miscdevice.h>
 | ||
|  | #include <asm/uaccess.h>
 | ||
|  | #include <asm/bL_switcher.h>
 | ||
|  | 
 | ||
|  | static ssize_t bL_switcher_write(struct file *file, const char __user *buf, | ||
|  | 			size_t len, loff_t *pos) | ||
|  | { | ||
|  | 	unsigned char val[3]; | ||
|  | 	unsigned int cpu, cluster; | ||
|  | 	int ret; | ||
|  | 
 | ||
|  | 	pr_debug("%s\n", __func__); | ||
|  | 
 | ||
|  | 	if (len < 3) | ||
|  | 		return -EINVAL; | ||
|  | 
 | ||
|  | 	if (copy_from_user(val, buf, 3)) | ||
|  | 		return -EFAULT; | ||
|  | 
 | ||
|  | 	/* format: <cpu#>,<cluster#> */ | ||
|  | 	if (val[0] < '0' || val[0] > '9' || | ||
|  | 	    val[1] != ',' || | ||
|  | 	    val[2] < '0' || val[2] > '1') | ||
|  | 		return -EINVAL; | ||
|  | 
 | ||
|  | 	cpu = val[0] - '0'; | ||
|  | 	cluster = val[2] - '0'; | ||
|  | 	ret = bL_switch_request(cpu, cluster); | ||
|  | 
 | ||
|  | 	return ret ? : len; | ||
|  | } | ||
|  | 
 | ||
|  | static const struct file_operations bL_switcher_fops = { | ||
|  | 	.write		= bL_switcher_write, | ||
|  | 	.owner	= THIS_MODULE, | ||
|  | }; | ||
|  | 
 | ||
|  | static struct miscdevice bL_switcher_device = { | ||
|  | 	MISC_DYNAMIC_MINOR, | ||
|  | 	"b.L_switcher", | ||
|  | 	&bL_switcher_fops | ||
|  | }; | ||
|  | 
 | ||
|  | static int __init bL_switcher_dummy_if_init(void) | ||
|  | { | ||
|  | 	return misc_register(&bL_switcher_device); | ||
|  | } | ||
|  | 
 | ||
|  | static void __exit bL_switcher_dummy_if_exit(void) | ||
|  | { | ||
|  | 	misc_deregister(&bL_switcher_device); | ||
|  | } | ||
|  | 
 | ||
|  | module_init(bL_switcher_dummy_if_init); | ||
|  | module_exit(bL_switcher_dummy_if_exit); |