-/*\r
- * Virtual device node for event injector of emulator\r
- *\r
- * Copyright (c) 2011 - 2012 Samsung Electronics Co., Ltd. All rights reserved.\r
- *\r
- * Contact:\r
- * Sungmin Ha <sungmin82.ha@samsung.com>\r
- *\r
- * This program is free software; you can redistribute it and/or\r
- * modify it under the terms of the GNU General Public License\r
- * as published by the Free Software Foundation; either version 2\r
- * of the License, or (at your option) any later version.\r
- *\r
- * This program is distributed in the hope that it will be useful,\r
- * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
- * GNU General Public License for more details.\r
- *\r
- * You should have received a copy of the GNU General Public License\r
- * along with this program; if not, write to the Free Software\r
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.\r
- *\r
- * Contributors:\r
- * - S-Core Co., Ltd\r
- */\r
-\r
-#include <linux/kernel.h>\r
-#include <linux/module.h>\r
-#include <linux/device.h>\r
-#include <linux/platform_device.h>\r
-#include <linux/slab.h>\r
-\r
-static char mode[1024];\r
-static char file0[1024];\r
-static char file1[1024];\r
-\r
-u64 file0_mask = 0x0000000000000000;\r
-u64 file1_mask = 0x0000000000000001;\r
-\r
-struct my_data {\r
- int no;\r
- char test[50];\r
-};\r
-\r
-static ssize_t show_mode(struct device *dev, \r
- struct device_attribute *attr, char *buf) \r
-{\r
- printk("[%s] \n", __FUNCTION__);\r
- return snprintf(buf, PAGE_SIZE, "%s", mode);\r
-}\r
-\r
-static ssize_t store_mode(struct device *dev, \r
- struct device_attribute *attr, const char *buf, size_t count) \r
-{\r
- printk("[%s] \n", __FUNCTION__);\r
- sscanf(buf, "%s", mode);\r
- return strnlen(buf, PAGE_SIZE);\r
-}\r
-\r
-static ssize_t show_file(struct device *dev, \r
- struct device_attribute *attr, char *buf) \r
-{\r
- ssize_t ret = 0;\r
- printk("[%s] \n", __FUNCTION__);\r
- if(*(dev->dma_mask) == file0_mask) {\r
- ret = snprintf(buf, PAGE_SIZE, "%s", file0);\r
- } else {\r
- ret = snprintf(buf, PAGE_SIZE, "%s", file1);\r
- }\r
-\r
- return ret;\r
-}\r
-\r
-static ssize_t store_file(struct device *dev, \r
- struct device_attribute *attr, const char *buf, size_t count) \r
-{\r
- size_t ret;\r
- printk("[%s]\n", __FUNCTION__);\r
- if(*(dev->dma_mask) == file0_mask) {\r
- sscanf(buf, "%s", file0);\r
- } else {\r
- sscanf(buf, "%s", file1);\r
- }\r
- \r
- ret = strnlen(buf, PAGE_SIZE);\r
- if(ret == 0) {\r
- return 1;\r
- } else {\r
- return strnlen(buf, PAGE_SIZE);\r
- }\r
-}\r
-\r
-static DEVICE_ATTR(mode, S_IRUGO | S_IWUSR, show_mode, store_mode);\r
-static DEVICE_ATTR(file, S_IRUGO | S_IWUSR, show_file, store_file);\r
-\r
-static int sysfs_lun0_create_file(struct device *dev) \r
-{\r
- int result = 0;\r
-\r
- printk("[%d] [%s] \n", __LINE__, __FUNCTION__);\r
-\r
- result = device_create_file(dev, &dev_attr_mode);\r
- if (result){\r
- printk("[%d] [%s] error \n", __LINE__, __FUNCTION__);\r
- return result;\r
- }\r
-\r
- result = device_create_file(dev, &dev_attr_file);\r
- if (result){\r
- printk("[%d] [%s] error \n", __LINE__, __FUNCTION__);\r
- return result;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static int sysfs_lun1_create_file(struct device *dev) \r
-{\r
- int result = 0;\r
-\r
- printk("[%d] [%s] \n", __LINE__, __FUNCTION__);\r
-\r
- result = device_create_file(dev, &dev_attr_file);\r
- if (result){\r
- printk("[%d] [%s] error \n", __LINE__, __FUNCTION__);\r
- return result;\r
- }\r
-\r
- return 0;\r
-}\r
-\r
-static void sysfs_test_dev_release(struct device *dev) {}\r
-static void sysfs_test_dev_release_lun0(struct device *dev) {}\r
-\r
-static struct platform_device the_pdev = {\r
- .name = "usb_mass_storage",\r
- .id = -1,\r
- .dev = {\r
- .release = sysfs_test_dev_release,\r
- }\r
-};\r
-\r
-static struct platform_device the_pdev_sub1 = {\r
- .name = "lun0",\r
- .id = -1, \r
- .dev = {\r
- .release = sysfs_test_dev_release_lun0,\r
- .parent = &the_pdev.dev,\r
- .dma_mask = &file0_mask,\r
- }\r
-};\r
-\r
-static struct platform_device the_pdev_sub2 = {\r
- .name = "lun1",\r
- .id = -1, \r
- .dev = {\r
- .release = sysfs_test_dev_release_lun0,\r
- .parent = &the_pdev.dev,\r
- .dma_mask = &file1_mask,\r
- }\r
-};\r
-\r
-static int __init sysfs_test_init(void) \r
-{\r
- int err = 0;\r
- struct my_data *data;\r
-\r
- printk("[%s] \n", __FUNCTION__);\r
-\r
- memset(mode, 0, sizeof(mode));\r
- memset(file0, 0, sizeof(file0));\r
- memset(file1, 0, sizeof(file1));\r
-\r
- err = platform_device_register(&the_pdev);\r
- if (err) {\r
- printk("platform_device_register error\n");\r
- return err;\r
- }\r
-\r
- err = platform_device_register(&the_pdev_sub1);\r
- if (err) {\r
- printk("platform_device_register error\n");\r
- return err;\r
- }\r
-\r
- err = platform_device_register(&the_pdev_sub2);\r
- if (err) {\r
- printk("platform_device_register error\n");\r
- return err;\r
- }\r
-\r
- data = kzalloc(sizeof(struct my_data), GFP_KERNEL);\r
- if (!data) {\r
- printk("[%s] kzalloc error\n", __FUNCTION__);\r
- err = -ENOMEM;\r
- platform_device_unregister(&the_pdev);\r
- return err;\r
- }\r
-\r
- dev_set_drvdata(&the_pdev.dev, (void*)data);\r
- dev_set_drvdata(&the_pdev_sub1.dev, (void*)data);\r
- dev_set_drvdata(&the_pdev_sub2.dev, (void*)data);\r
-\r
- err = sysfs_lun0_create_file(&the_pdev_sub1.dev);\r
- if (err) {\r
- printk("sysfs_create_file error\n");\r
- kfree(data);\r
- }\r
- \r
- err = sysfs_lun1_create_file(&the_pdev_sub2.dev);\r
- if (err) {\r
- printk("sysfs_create_file error\n");\r
- kfree(data);\r
- }\r
- \r
- return 0;\r
-}\r
-\r
-static void __exit sysfs_test_exit(void) \r
-{\r
- void *data = dev_get_drvdata(&the_pdev.dev);\r
-\r
- printk("[%s] \n", __FUNCTION__);\r
-\r
- kfree(data);\r
- platform_device_unregister(&the_pdev_sub2);\r
- platform_device_unregister(&the_pdev_sub1);\r
- platform_device_unregister(&the_pdev);\r
-}\r
-\r
-module_init(sysfs_test_init);\r
-module_exit(sysfs_test_exit);\r
-\r
-\r
-MODULE_LICENSE("GPL");\r
-\r
-\r
+/*
+ * Virtual device node for event injector of emulator
+ *
+ * Copyright (c) 2011 - 2013 Samsung Electronics Co., Ltd. All rights reserved.
+ *
+ * Contact:
+ * SooYoung Ha <yoosah.ha@samsung.com>
+ * JinHyung Choi <jinhyung2.choi@samsung.com>
+ * Sungmin Ha <sungmin82.ha@samsung.com>
+ * YeongKyoon Lee <yeongkyoon.lee@samsung.com
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
+ *
+ * Contributors:
+ * - S-Core Co., Ltd
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/device.h>
+#include <linux/platform_device.h>
+#include <linux/slab.h>
+
+static char mode[1024];
+static char file0[1024];
+static char file1[1024];
+
+u64 file0_mask = 0x0000000000000000;
+u64 file1_mask = 0x0000000000000001;
+
+struct usb_storage_data {
+ int no;
+ char buffer[50];
+};
+
+#define DEVICE_NAME "usb_mass_storage"
+#define SUB_DEVICE0_NAME "lun0"
+#define SUB_DEVICE1_NAME "lun1"
+
+#define USB_STORAGE_DEBUG
+
+#ifdef USB_STORAGE_DEBUG
+#define DLOG(level, fmt, ...) \
+ printk(level "maru_%s: " fmt, DEVICE_NAME, ##__VA_ARGS__)
+#else
+// do nothing
+#define DLOG(level, fmt, ...)
+#endif
+
+static void __exit maru_usb_mass_storage_sysfs_exit(void);
+
+static ssize_t show_mode(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ DLOG(KERN_INFO, "get mode: %s\n", mode);
+ return snprintf(buf, PAGE_SIZE, "%s", mode);
+}
+
+static ssize_t store_mode(struct device *dev,
+ struct device_attribute *attr, const char *buf, size_t count)
+{
+ sscanf(buf, "%s", mode);
+ DLOG(KERN_INFO, "set mode: %s\n", mode);
+
+ return strnlen(buf, PAGE_SIZE);
+}
+
+static ssize_t show_file(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ ssize_t ret = 0;
+
+ if (*(dev->dma_mask) == file0_mask) {
+ DLOG(KERN_INFO, "get file0: %s\n", file0);
+ ret = snprintf(buf, PAGE_SIZE, "%s", file0);
+ } else {
+ DLOG(KERN_INFO, "get file1: %s\n", file1);
+ ret = snprintf(buf, PAGE_SIZE, "%s", file1);
+ }
+
+ return ret;
+}
+
+static ssize_t store_file(struct device *dev,
+ struct device_attribute *attr, const char *buf, size_t count)
+{
+ size_t ret;
+
+ if (*(dev->dma_mask) == file0_mask) {
+ sscanf(buf, "%s", file0);
+ DLOG(KERN_INFO, "set file0: %s\n", file0);
+ } else {
+ sscanf(buf, "%s", file1);
+ DLOG(KERN_INFO, "set file1: %s\n", file1);
+ }
+
+ ret = strnlen(buf, PAGE_SIZE);
+ if (ret == 0) {
+ return 1;
+ } else {
+ return strnlen(buf, PAGE_SIZE);
+ }
+}
+
+static DEVICE_ATTR(mode, S_IRUGO | S_IWUSR, show_mode, store_mode);
+static DEVICE_ATTR(file, S_IRUGO | S_IWUSR, show_file, store_file);
+
+static int sysfs_lun0_create_file(struct device *dev)
+{
+ int result = 0;
+
+ DLOG(KERN_INFO, "sysfs_create_lun0_file\n");
+
+ result = device_create_file(dev, &dev_attr_mode);
+ if (result){
+ DLOG(KERN_ERR, "failed to create lun0 mode\n");
+ return result;
+ }
+
+ result = device_create_file(dev, &dev_attr_file);
+ if (result){
+ DLOG(KERN_ERR, "failed to create lun0 file\n");
+ return result;
+ }
+
+ return 0;
+}
+
+static int sysfs_lun1_create_file(struct device *dev)
+{
+ int result = 0;
+
+ DLOG(KERN_INFO, "sysfs_create_lun1_file\n");
+
+ result = device_create_file(dev, &dev_attr_file);
+ if (result){
+ DLOG(KERN_ERR, "failed to create lun1 file\n");
+ return result;
+ }
+
+ return 0;
+}
+
+static void maru_usb_mass_storage_sysfs_dev_release(struct device *dev)
+{
+ DLOG(KERN_INFO, "sysfs_dev_release\n");
+}
+
+static void maru_usb_mass_storage_sysfs_dev_release_lun0(struct device *dev)
+{
+ DLOG(KERN_INFO, "sysfs_dev_release_lun0\n");
+}
+
+static struct platform_device the_pdev = {
+ .name = DEVICE_NAME,
+ .id = -1,
+ .dev = {
+ .release = maru_usb_mass_storage_sysfs_dev_release,
+ }
+};
+
+static struct platform_device the_pdev_sub1 = {
+ .name = SUB_DEVICE0_NAME,
+ .id = -1,
+ .dev = {
+ .release = maru_usb_mass_storage_sysfs_dev_release_lun0,
+ .parent = &the_pdev.dev,
+ .dma_mask = &file0_mask,
+ }
+};
+
+static struct platform_device the_pdev_sub2 = {
+ .name = SUB_DEVICE1_NAME,
+ .id = -1,
+ .dev = {
+ .release = maru_usb_mass_storage_sysfs_dev_release_lun0,
+ .parent = &the_pdev.dev,
+ .dma_mask = &file1_mask,
+ }
+};
+
+static int __init maru_usb_mass_storage_sysfs_init(void)
+{
+ int err = 0;
+ struct usb_storage_data *data;
+
+ DLOG(KERN_INFO, "sysfs_init\n");
+
+ memset(mode, 0, sizeof(mode));
+ memset(file0, 0, sizeof(file0));
+ memset(file1, 0, sizeof(file1));
+
+ err = platform_device_register(&the_pdev);
+ if (err) {
+ DLOG(KERN_ERR, "platform_device_register failure for device\n");
+ return err;
+ }
+
+ err = platform_device_register(&the_pdev_sub1);
+ if (err) {
+ DLOG(KERN_ERR, "platform_device_register failure for sub_device0\n");
+ platform_device_unregister(&the_pdev);
+ return err;
+ }
+
+ err = platform_device_register(&the_pdev_sub2);
+ if (err) {
+ DLOG(KERN_ERR, "platform_device_register failure for sub_device1\n");
+ platform_device_unregister(&the_pdev_sub1);
+ platform_device_unregister(&the_pdev);
+ return err;
+ }
+
+ data = kzalloc(sizeof(struct usb_storage_data), GFP_KERNEL);
+ if (!data) {
+ DLOG(KERN_ERR, "kzalloc failure\n");
+ platform_device_unregister(&the_pdev);
+ return ENOMEM;
+ }
+
+ dev_set_drvdata(&the_pdev.dev, (void*)data);
+ dev_set_drvdata(&the_pdev_sub1.dev, (void*)data);
+ dev_set_drvdata(&the_pdev_sub2.dev, (void*)data);
+
+ err = sysfs_lun0_create_file(&the_pdev_sub1.dev);
+ if (err) {
+ DLOG(KERN_ERR, "sysfs_create_lun0_file failure\n");
+ platform_device_unregister(&the_pdev_sub1);
+ platform_device_unregister(&the_pdev);
+ kfree(data);
+ return err;
+ }
+
+ err = sysfs_lun1_create_file(&the_pdev_sub2.dev);
+ if (err) {
+ DLOG(KERN_ERR, "sysfs_create_lun1_file failure\n");
+ maru_usb_mass_storage_sysfs_exit();
+ return err;
+ }
+
+ return 0;
+}
+
+static void __exit maru_usb_mass_storage_sysfs_exit(void)
+{
+ void *data = dev_get_drvdata(&the_pdev.dev);
+
+ DLOG(KERN_INFO, "sysfs_exit\n");
+
+ if (data) {
+ kfree(data);
+ }
+ platform_device_unregister(&the_pdev_sub2);
+ platform_device_unregister(&the_pdev_sub1);
+ platform_device_unregister(&the_pdev);
+}
+
+module_init(maru_usb_mass_storage_sysfs_init);
+module_exit(maru_usb_mass_storage_sysfs_exit);
+
+MODULE_LICENSE("GPL");
projects / sdk / emulator / emulator-kernel.git / commitdiff