Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <linux/init.h>
- #include <linux/module.h>
- #include <linux/kernel.h>
- #include <linux/fs.h>
- #include <linux/errno.h>
- #include <linux/types.h>
- #include <linux/fcntl.h>
- #include <linux/miscdevice.h>
- #include <linux/platform_device.h>
- #include <linux/delay.h>
- #include <linux/gpio.h>
- #include <mach/gpio.h>
- #include <mach/da8xx.h>
- #include <mach/mux.h>
- #include "misc.h"
- #define VERSION 0x0100
- #define DRV_NAME "misc"
- #define DEV_NAME DRV_NAME
- #define DEV_MAJOR 230
- #define USB_EN0 GPIO_TO_PIN(3, 1)
- #define USB_EN1 GPIO_TO_PIN(3, 0)
- #define USB_FLG0 GPIO_TO_PIN(3, 3)
- #define USB_FLG1 GPIO_TO_PIN(3, 2)
- #define AS_IN1 GPIO_TO_PIN(0, 10)
- #define AS_IN2 GPIO_TO_PIN(0, 11)
- #define DO0 GPIO_TO_PIN(5, 0)
- #define DO1 GPIO_TO_PIN(5, 1)
- #define DO2 GPIO_TO_PIN(5, 2)
- #define DO3 GPIO_TO_PIN(5, 3)
- #define DO4 GPIO_TO_PIN(5, 4)
- #define DO5 GPIO_TO_PIN(5, 5)
- #define DO6 GPIO_TO_PIN(5, 6)
- #define DO7 GPIO_TO_PIN(5, 7)
- #define DO8 GPIO_TO_PIN(5, 8)
- #define DO9 GPIO_TO_PIN(5, 9)
- #define DI0 GPIO_TO_PIN(1, 9)
- #define DI1 GPIO_TO_PIN(1, 10)
- #define DI2 GPIO_TO_PIN(1, 11)
- #define DI3 GPIO_TO_PIN(1, 12)
- #define DI4 GPIO_TO_PIN(1, 13)
- #define DI5 GPIO_TO_PIN(1, 14)
- #define DI6 GPIO_TO_PIN(8, 7)
- // MISC GPIO pins
- const short misc_pins[] = {
- DA850_GPIO3_0, DA850_GPIO3_1, DA850_GPIO3_2, DA850_GPIO3_3,
- DA850_GPIO0_10, DA850_GPIO0_11,
- DA850_GPIO5_0, /*DA850_GPIO5_1, DA850_GPIO5_2,*/ DA850_GPIO5_3,
- DA850_GPIO5_4, DA850_GPIO5_5, DA850_GPIO5_6, DA850_GPIO5_7,
- DA850_GPIO5_8, DA850_GPIO5_9,
- DA850_GPIO1_9, DA850_GPIO1_10, DA850_GPIO1_11, DA850_GPIO1_12,
- DA850_GPIO1_13, DA850_GPIO1_14, DA850_GPIO8_7,
- -1
- };
- static int misc_probe(struct device *dev)
- {
- printk(KERN_INFO "%s driver [ver : %04X]\n", DRV_NAME, VERSION);
- return 0;
- }
- static int misc_remove(struct device *dev)
- {
- return 0;
- }
- static int misc_open(struct inode *inode, struct file *filp)
- {
- return 0;
- }
- static ssize_t misc_read(struct file *filp, char *buf, size_t count, loff_t *f_pos)
- {
- return 0;
- }
- static ssize_t misc_write(struct file *filp, const char *buf, size_t count, loff_t *f_pos)
- {
- return 0;
- }
- static int misc_release(struct inode *inode, struct file *filp)
- {
- return 0;
- }
- static DEFINE_MUTEX(misc_mutex);
- static long misc_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
- {
- int err = 0,command_size;
- int return_value = 0;
- int ret = 0;
- int param = 0;
- if (_IOC_TYPE(cmd) != _MISC_MAGIC)
- {
- printk("misc_io diff magic code(in:%d, check:%d)\n",
- _IOC_TYPE(cmd), _MISC_MAGIC);
- return -EINVAL;
- }
- if(_IOC_NR(cmd) >= MISC_MAXNR)
- {
- printk("misc_io over maxnr (in:%d, max:%d)\n",
- _IOC_NR(cmd), MISC_MAXNR);
- return -EINVAL;
- }
- command_size = _IOC_SIZE(cmd);
- if(command_size) {
- if (_IOC_DIR(cmd) & _IOC_READ)
- err = !access_ok(VERIFY_WRITE, (void*) arg, command_size);
- else if (_IOC_DIR(cmd) & _IOC_WRITE)
- err = !access_ok(VERIFY_READ, (void*) arg, command_size);
- if (err)
- {
- printk("misc ioctl command_size error: %d\n", err);
- return err;
- }
- }
- mutex_lock(&misc_mutex);
- switch(cmd) {
- case SET_USB11_POWER:
- if (arg)
- gpio_set_value_cansleep(USB_EN1, 1);
- else
- gpio_set_value_cansleep(USB_EN1, 0);
- break;
- case GET_USB11_POWER:
- ret = gpio_get_value(USB_EN1);
- printk("get USB11 power: %d\n", ret);
- copy_to_user((int *)arg, &ret, sizeof(int));
- break;
- case SET_USB21_POWER:
- if (arg)
- gpio_set_value_cansleep(USB_EN0, 1);
- else
- gpio_set_value_cansleep(USB_EN0, 0);
- break;
- case GET_USB21_POWER:
- ret = gpio_get_value(USB_EN0);
- printk("get USB21 power: %d\n", ret);
- copy_to_user((int *)arg, &ret, sizeof(int));
- break;
- case GET_USB11_OVER_CURRENT:
- ret = gpio_get_value(USB_FLG1);
- printk("get USB11 error: %d\n", ret);
- copy_to_user((int *)arg, &ret, sizeof(int));
- break;
- case GET_USB21_OVER_CURRENT:
- ret = gpio_get_value(USB_FLG0);
- printk("get USB21 error %d\n", ret);
- copy_to_user((int *)arg, &ret, sizeof(int));
- break;
- case SET_ANALOG_SWITCH_CH:
- switch (arg)
- {
- case 1:
- gpio_set_value(AS_IN1, 1);
- gpio_set_value(AS_IN2, 0);
- break;
- case 2:
- gpio_set_value(AS_IN1, 0);
- gpio_set_value(AS_IN2, 1);
- break;
- case 3:
- gpio_set_value(AS_IN1, 1);
- gpio_set_value(AS_IN2, 1);
- break;
- default:
- gpio_set_value(AS_IN1, 0);
- gpio_set_value(AS_IN2, 0);
- break;
- }
- break;
- case GET_ANALOG_SWITCH_CH:
- ret =
- gpio_get_value(AS_IN2)*2 + gpio_get_value(AS_IN1);
- printk("get Analog switch: %d\n", ret);
- copy_to_user((int *)arg, &ret, sizeof(int));
- break;
- default:
- printk("Don't defiend command: %d\n", cmd);
- return_value = -EINVAL;
- }
- mutex_unlock(&misc_mutex);
- return return_value;
- }
- static struct file_operations misc_fops =
- {
- .owner = THIS_MODULE,
- .read = misc_read,
- .write = misc_write,
- .open = misc_open,
- .release = misc_release,
- .unlocked_ioctl = misc_ioctl,
- };
- static struct miscdevice misc_dev =
- {
- .minor = MISC_DYNAMIC_MINOR,
- .name = DEV_NAME,
- .fops = &misc_fops,
- };
- static int __init misc_init(void)
- {
- int ret;
- // PIN mux setting
- ret = davinci_cfg_reg_list(misc_pins);
- if (ret)
- printk("misc gpio pinmux setup failed: %d", ret);
- // Set gpio direction
- ret = gpio_request(USB_EN0, "usb_en0");
- if (ret)
- printk("Cannot request usb_en0 pin\n");
- gpio_direction_output(USB_EN0, 1);
- ret = gpio_request(USB_EN1, "usb_en1");
- if (ret)
- printk("Cannot request usb_en1 pin\n");
- gpio_direction_output(USB_EN1, 1);
- ret = gpio_request(USB_FLG0, "usb_flg0");
- if (ret)
- printk("Cannot request usb_flg0 pin\n");
- gpio_direction_input(USB_FLG0);
- ret = gpio_request(USB_FLG1, "usb_flg1");
- if (ret)
- printk("Cannot request usb_flg1 pin\n");
- gpio_direction_input(USB_FLG1);
- ret = gpio_request(AS_IN1, "as_in1");
- if (ret)
- printk("Cannot request as_in1 pin\n");
- gpio_direction_output(AS_IN1, 1);
- ret = gpio_request(AS_IN2, "as_in2");
- if (ret)
- printk("Cannot request as_in2 pin\n");
- gpio_direction_output(AS_IN2, 0);
- ret = gpio_request(DO0, "do0");
- if (ret)
- printk("Cannot requeset do0 pin\n");
- gpio_direction_output(DO0, 0);
- /*ret = gpio_request(DO1, "do1");
- if (ret)
- printk("Cannot request do1 pin\n");
- gpio_direction_output(DO1, 0);
- ret = gpio_request(DO2, "do2");
- if (ret)
- printk("Cannot request do2 pin\n");
- gpio_direction_output(DO2, 0);*/
- ret = gpio_request(DO3, "do3");
- if (ret)
- printk("Cannot request do3 pin\n");
- gpio_direction_output(DO3, 0);
- ret = gpio_request(DO4, "do4");
- if (ret)
- printk("Cannot request do4 pin\n");
- gpio_direction_output(DO4, 0);
- ret = gpio_request(DO5, "do5");
- if (ret)
- printk("Cannot request do5 pin\n");
- gpio_direction_output(DO5, 0);
- ret = gpio_request(DO6, "do6");
- if (ret)
- printk("Cannot request do6 pin\n");
- gpio_direction_output(DO6, 0);
- ret = gpio_request(DO7, "do7");
- if (ret)
- printk("Cannot request do7 pin\n");
- gpio_direction_output(DO7, 0);
- ret = gpio_request(DO8, "do8");
- if (ret)
- printk("Cannot request do8 pin\n");
- gpio_direction_output(DO8, 0);
- ret = gpio_request(DO9, "do9");
- if (ret)
- printk("Cannot request do9 pin\n");
- gpio_direction_output(DO9, 0);
- ret = gpio_request(DI0, "di0");
- if (ret)
- printk("Cannot request di0 pin\n");
- gpio_direction_input(DI0);
- ret = gpio_request(DI1, "di1");
- if (ret)
- printk("Cannot request di1 pin\n");
- gpio_direction_input(DI1);
- ret = gpio_request(DI2, "di2");
- if (ret)
- printk("Cannot request di2 pin\n");
- gpio_direction_input(DI2);
- ret = gpio_request(DI3, "di3");
- if (ret)
- printk("Cannot request di3 pin\n");
- gpio_direction_input(DI3);
- ret = gpio_request(DI4, "di4");
- if (ret)
- printk("Cannot request di4 pin\n");
- gpio_direction_input(DI4);
- ret = gpio_request(DI5, "di5");
- if (ret)
- printk("Cannot request di5 pin\n");
- gpio_direction_input(DI5);
- ret = gpio_request(DI6, "di6");
- if (ret)
- printk("Cannot request di6 pin\n");
- gpio_direction_input(DI6);
- // Register device driver
- ret = misc_register(&misc_dev);
- return ret;
- }
- static void __exit misc_exit(void)
- {
- misc_deregister(&misc_dev);
- }
- module_init(misc_init);
- module_exit(misc_exit);
- MODULE_AUTHOR("Lee, Inho");
- MODULE_DESCRIPTION("SMART-F1 Misc driver 1.0");
- MODULE_LICENSE("GPL");
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement