/* * Samsung Mobile VE Group. * * drivers/gpio/secgpio_dvs.c * * Drivers for samsung gpio debugging & verification. * * Copyright (C) 2013, Samsung Electronics. * * 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 #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /*sys fs*/ struct class *secgpio_dvs_class; EXPORT_SYMBOL(secgpio_dvs_class); struct device *secgpio_dotest; EXPORT_SYMBOL(secgpio_dotest); /* extern GPIOMAP_RESULT GpioMap_result; */ static struct gpio_dvs *gdvs_info; static ssize_t gpioinit_check_show( struct device *dev, struct device_attribute *attr, char *buf); static ssize_t gpiosleep_check_show( struct device *dev, struct device_attribute *attr, char *buf); static ssize_t check_init_detail_show( struct device *dev, struct device_attribute *attr, char *buf); static ssize_t check_sleep_detail_show( struct device *dev, struct device_attribute *attr, char *buf); static ssize_t secgpio_ctrl_file_write( struct device *dev, struct device_attribute *attr, const char *buf, size_t size); static ssize_t checked_sleepGPIO_show( struct device *dev, struct device_attribute *attr, char *buf); static ssize_t secgpio_read_request_gpio( struct device *dev, struct device_attribute *attr, char *buf); static ssize_t secgpio_write_request_gpio( struct device *dev, struct device_attribute *attr, const char *buf, size_t size); static DEVICE_ATTR_RO(gpioinit_check); static DEVICE_ATTR_RO(gpiosleep_check); static DEVICE_ATTR_RO(check_init_detail); static DEVICE_ATTR_RO(check_sleep_detail); static DEVICE_ATTR_RO(checked_sleepGPIO); static DEVICE_ATTR(secgpio_ctrl, 0220, NULL, secgpio_ctrl_file_write); static DEVICE_ATTR(check_requested_gpio, 0664, secgpio_read_request_gpio, secgpio_write_request_gpio); static struct attribute *secgpio_dvs_attributes[] = { &dev_attr_gpioinit_check.attr, &dev_attr_gpiosleep_check.attr, &dev_attr_check_init_detail.attr, &dev_attr_check_sleep_detail.attr, &dev_attr_secgpio_ctrl.attr, &dev_attr_checked_sleepGPIO.attr, &dev_attr_check_requested_gpio.attr, NULL, }; static struct attribute_group secgpio_dvs_attr_group = { .attrs = secgpio_dvs_attributes, }; static int atoi(const char *str) { int result = 0; int count = 0; if (str == NULL) return -EIO; while (str[count] != 0 /* NULL */ && str[count] >= '0' && str[count] <= '9') { result = result * 10 + str[count] - '0'; ++count; } return result; } static char * strtok_r(char *s, const char *delim, char **last) { char *spanp; int c, sc; char *tok; if (s == NULL) { s = *last; if (s == NULL) return NULL; } /* * Skip (span) leading delimiters (s += strspn(s, delim), sort of). */ cont: c = *s++; for (spanp = (char *)delim; (sc = *spanp++) != 0;) { if (c == sc) goto cont; } if (c == 0) { /* no non-delimiter characters */ *last = NULL; return NULL; } tok = s - 1; /* * Scan token (scan for delimiters: s += strcspn(s, delim), sort of). * Note that delim must have one NUL; we stop if we see that, too. */ for (;;) { c = *s++; spanp = (char *)delim; do { sc = *spanp++; if (sc == c) { if (c == 0) s = NULL; else s[-1] = 0; *last = s; return tok; } } while (sc != 0); } /* NOTREACHED */ } static char * strtok(char *s, const char *delim) { static char *last; return strtok_r(s, delim, &last); } static ssize_t gpioinit_check_show( struct device *dev, struct device_attribute *attr, char *buf) { int i = 0; char temp_buf[20]; struct gpio_dvs *gdvs = dev_get_drvdata(dev); for (i = 0; i < gdvs->count; i++) { memset(temp_buf, 0, sizeof(char)*20); snprintf(temp_buf, 20, "%x ", gdvs->result->init[i]); strlcat(buf, temp_buf, PAGE_SIZE); } return strlen(buf); } static ssize_t gpiosleep_check_show( struct device *dev, struct device_attribute *attr, char *buf) { int i = 0; char temp_buf[20]; struct gpio_dvs *gdvs = dev_get_drvdata(dev); for (i = 0; i < gdvs->count; i++) { memset(temp_buf, 0, sizeof(char)*20); snprintf(temp_buf, 20, "%x ", gdvs->result->sleep[i]); strlcat(buf, temp_buf, PAGE_SIZE); } return strlen(buf); } static ssize_t check_init_detail_show( struct device *dev, struct device_attribute *attr, char *buf) { int i = 0; char temp_buf[20]; struct gpio_dvs *gdvs = dev_get_drvdata(dev); if (gdvs_info && gdvs_info->check_gpio_status) gdvs_info->check_gpio_status(PHONE_INIT); for (i = 0; i < gdvs->count; i++) { memset(temp_buf, 0, sizeof(char)*20); snprintf(temp_buf, 20, "GI[%d] - %x\n ", i, gdvs->result->init[i]); strlcat(buf, temp_buf, PAGE_SIZE); } return strlen(buf); } static ssize_t check_sleep_detail_show( struct device *dev, struct device_attribute *attr, char *buf) { int i = 0; char temp_buf[20]; struct gpio_dvs *gdvs = dev_get_drvdata(dev); for (i = 0; i < gdvs->count; i++) { memset(temp_buf, 0, sizeof(char)*20); snprintf(temp_buf, 20, "GS[%d] - %x\n ", i, gdvs->result->sleep[i]); strlcat(buf, temp_buf, PAGE_SIZE); } return strlen(buf); } static ssize_t secgpio_ctrl_file_write( struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { char *token = NULL; char comp[] = ","; int gpio_ctrl[3] = {0,}, num = 0; char temp_buf[50]; pr_info("[secgpio_dvs] GPIO onoff buf = %s\n", buf); memset(temp_buf, 0, 50); strlcpy(temp_buf, buf, 50); token = strtok(temp_buf, comp); for (num = 0; num < 3; num++) { if (token != NULL) { pr_info("[secgpio_dvs] GPIO Control TOKEN = %s\n", token); gpio_ctrl[num] = atoi(token); token = strtok(NULL, comp); } pr_info("[secgpio_dvs] GPIO Control[%d] = %d\n", num, gpio_ctrl[num]); } /* * gpio_ctrl[0] = IN/OUT, gpio_ctrl[1] = GPIO NUMBER, * gpio_ctrl[2] = L/H */ if (gpio_ctrl[0] == 1) { gpio_request(gpio_ctrl[1], "gpio_input_test_on"); gpio_direction_input(gpio_ctrl[1]); gpio_free(gpio_ctrl[1]); } else { gpio_request(gpio_ctrl[1], "gpio_output_test_on"); gpio_direction_output(gpio_ctrl[1], 1); gpio_free(gpio_ctrl[1]); if (gpio_ctrl[2] == 1) { gpio_request(gpio_ctrl[1], "gpio_set_value_on"); gpio_set_value(gpio_ctrl[1], 1); gpio_free(gpio_ctrl[1]); } else if (gpio_ctrl[2] == 0) { gpio_request(gpio_ctrl[1], "gpio_set_value_off"); gpio_set_value(gpio_ctrl[1], 0); gpio_free(gpio_ctrl[1]); } } return size; } static ssize_t checked_sleepGPIO_show( struct device *dev, struct device_attribute *attr, char *buf) { struct gpio_dvs *gdvs = dev_get_drvdata(dev); if (gdvs->check_sleep) return snprintf(buf, PAGE_SIZE, "1"); else return snprintf(buf, PAGE_SIZE, "0"); } static int requested_gpio; static ssize_t secgpio_read_request_gpio( struct device *dev, struct device_attribute *attr, char *buf) { int ret, val = -1; pr_err("%s: gpio[%d]\n", __func__, requested_gpio); ret = gpio_direction_input(requested_gpio); if (ret) { pr_err("%s: gpio_direction_input failed\n", __func__); goto gpio_read_failed; } val = gpio_get_value(requested_gpio); if (val < 0) pr_err("%s: gpio_get_value failed\n", __func__); gpio_read_failed: return snprintf(buf, PAGE_SIZE, "GPIO[%d] : [%d]", requested_gpio, val); } static ssize_t secgpio_write_request_gpio( struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { int gpionum, ret; ret = kstrtoint(buf, 10, &gpionum); if (ret) { pr_info("[secgpio_dvs]%s: fail to read input value\n", __func__); return size; } requested_gpio = gpionum; pr_info("[secgpio_dvs]%s: requested_gpio: [%d]\n", __func__, gpionum); return size; } void gpio_dvs_check_initgpio(void) { if (gdvs_info && gdvs_info->check_gpio_status) gdvs_info->check_gpio_status(PHONE_INIT); } void gpio_dvs_check_sleepgpio(void) { if (unlikely(!gdvs_info->check_sleep)) { gdvs_info->check_gpio_status(PHONE_SLEEP); gdvs_info->check_sleep = true; } } static int secgpio_dvs_probe(struct platform_device *pdev) { int ret = 0; struct class *secgpio_dvs_class; struct device *secgpio_dotest; struct gpio_dvs *gdvs = dev_get_platdata(&pdev->dev); pr_info("[secgpio_dvs] %s has been created!!!\n", __func__); secgpio_dvs_class = class_create(THIS_MODULE, "secgpio_check"); if (IS_ERR(secgpio_dvs_class)) { ret = PTR_ERR(secgpio_dvs_class); pr_err("Failed to create class(secgpio_check_all)"); goto fail_out; } secgpio_dotest = device_create(secgpio_dvs_class, NULL, 0, NULL, "secgpio_check_all"); if (IS_ERR(secgpio_dotest)) { ret = PTR_ERR(secgpio_dotest); pr_err("Failed to create device(secgpio_check_all)"); goto fail1; } dev_set_drvdata(secgpio_dotest, gdvs); gdvs_info = gdvs; ret = sysfs_create_group(&secgpio_dotest->kobj, &secgpio_dvs_attr_group); if (ret) { pr_err("Failed to create sysfs group"); goto fail2; } return ret; fail2: device_destroy(secgpio_dvs_class, 0); fail1: class_destroy(secgpio_dvs_class); fail_out: if (ret) pr_err(" (err = %d)!\n", ret); return ret; } static int secgpio_dvs_remove(struct platform_device *pdev) { return 0; } static struct platform_driver secgpio_dvs = { .probe = secgpio_dvs_probe, .remove = secgpio_dvs_remove, .driver = { .name = "secgpio_dvs", .owner = THIS_MODULE, }, }; static int __init secgpio_dvs_init(void) { int ret; ret = platform_driver_register(&secgpio_dvs); pr_info("[secgpio_dvs] %s has been initialized!!!\n", __func__); if (ret) pr_err(" (err = %d)!\n", ret); return ret; } static void __exit secgpio_dvs_exit(void) { platform_driver_unregister(&secgpio_dvs); } module_init(secgpio_dvs_init); module_exit(secgpio_dvs_exit); MODULE_DESCRIPTION("Samsung GPIO debugging and verification"); MODULE_LICENSE("GPL v2");