Moved, renamed, and deleted files

The original directory structure was scattered and unorganized.
Changes are basically to make it look like kernel structure.

5 files changed, 561 insertions, 0 deletions

diff --git a/drivers/char/wmt_vibrate/Makefile b/drivers/char/wmt_vibrate/Makefile
new file mode 100755
index 00000000..2d5c1f04
--- /dev/null
+++ b/drivers/char/wmt_vibrate/Makefile
@@ -0,0 +1,4 @@
+#
+# Makefile for the kernel  device drivers.
+#
+obj-$(CONFIG_WMT_VIBRATOR) += wmt_vibrate.o
\ No newline at end of file
diff --git a/drivers/char/wmt_vibrate/readme.txt b/drivers/char/wmt_vibrate/readme.txt
new file mode 100755
index 00000000..e94fc6de
--- /dev/null
+++ b/drivers/char/wmt_vibrate/readme.txt
@@ -0,0 +1,5 @@
+Use GPIO1 to control motor

+

+setenv vibratorset D8110024,D8110054,D8110084,1

+

+

diff --git a/drivers/char/wmt_vibrate/timed_output.h b/drivers/char/wmt_vibrate/timed_output.h
new file mode 100755
index 00000000..ec907ab2
--- /dev/null
+++ b/drivers/char/wmt_vibrate/timed_output.h
@@ -0,0 +1,37 @@
+/* include/linux/timed_output.h
+ *
+ * Copyright (C) 2008 Google, Inc.
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * 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.
+ *
+*/
+
+#ifndef _LINUX_TIMED_OUTPUT_H
+#define _LINUX_TIMED_OUTPUT_H
+
+struct timed_output_dev {
+	const char	*name;
+
+	/* enable the output and set the timer */
+	void	(*enable)(struct timed_output_dev *sdev, int timeout);
+
+	/* returns the current number of milliseconds remaining on the timer */
+	int		(*get_time)(struct timed_output_dev *sdev);
+
+	/* private data */
+	struct device	*dev;
+	int		index;
+	int		state;
+};
+
+extern int timed_output_dev_register(struct timed_output_dev *dev);
+extern void timed_output_dev_unregister(struct timed_output_dev *dev);
+
+#endif
diff --git a/drivers/char/wmt_vibrate/wmt_vibrate.c b/drivers/char/wmt_vibrate/wmt_vibrate.c
new file mode 100755
index 00000000..4181d7a9
--- /dev/null
+++ b/drivers/char/wmt_vibrate/wmt_vibrate.c
@@ -0,0 +1,480 @@
+/*++
+
+	Some descriptions of such software. Copyright (c) 2010  WonderMedia Technologies, Inc.
+
+	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, see <http://www.gnu.org/licenses/>.
+
+	WonderMedia Technologies, Inc.
+	2010-2-26, HangYan, ShenZhen
+--*/
+
+#include <linux/module.h>
+#include <linux/input.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/err.h>
+#include <linux/platform_device.h>
+#include <linux/device.h>
+#include <linux/stat.h>
+#include <linux/workqueue.h>
+#include <asm/uaccess.h>
+#include <asm/io.h>
+#include <asm/system.h>
+#include <asm/mach-types.h>
+#include <mach/hardware.h>
+
+#include "wmt_vibrate.h"
+#include "timed_output.h"
+
+/* Constant Macro */
+#define WMT_VIBRATE_DEVICE_NAME "wmt_vibrate"
+#define WMT_VIBRATE_MAJOR 37
+//#define WMT_VIBRATE_MINOR 0
+//#define WMT_VIBRATE_DELAY 250 //ms
+static int WMT_VIBRATE_DELAY = 90;
+/*************************Function declare************************************/
+static void enable_timedoutput(struct timed_output_dev *sdev, int timeout);
+static int gettime_timedoutput(struct timed_output_dev *sdev);
+
+//#define DEBUG
+#ifdef DEBUG
+#define vibrate_dbg(fmt, args...) printk(KERN_ALERT "[%s]: " fmt, __FUNCTION__ , ## args)
+#else
+#define vibrate_dbg(fmt, args...)
+#endif
+
+static struct timer_list vibrate_timer;
+
+/************************Data type and local variable****************/
+struct vibrate_device {
+	int vibratile; // 0: shouldn't vibrate, 1:should vibrate
+	struct mutex mlock;
+	struct class* dev_class;
+	struct device *device;
+	unsigned int vibtimeout;
+	struct work_struct	work;
+	struct timed_output_dev vibtimedev;
+	/* setting attributy */
+	int name;
+	int active;
+	unsigned int bmp;
+	unsigned int ctraddr;
+	unsigned int ocaddr;
+	unsigned int odaddr;
+	unsigned int bitx;
+};
+
+static struct vibrate_device l_vibratedev = {
+	.vibratile = 0,
+	.dev_class = NULL,
+	.device = NULL,
+	.vibtimeout = 0,
+	.vibtimedev = {
+		.name = "vibrator",
+		.enable = enable_timedoutput,
+		.get_time = gettime_timedoutput,
+	},
+	/* default reg setting: Use GPIO1 to control motor */
+	.name = 1,
+	.active = 1,
+	.bmp = 0x2,
+	.ctraddr = GPIO_BASE_ADDR + 0x40,
+	.ocaddr = GPIO_BASE_ADDR + 0x80,
+	.odaddr = GPIO_BASE_ADDR + 0xc0,
+};
+
+
+/************************Function implement*******************/
+static void wmt_disable_vibrator(unsigned long unused)
+{
+	if (l_vibratedev.active == 0)
+		REG32_VAL(l_vibratedev.odaddr) |= l_vibratedev.bmp;
+	else
+		REG32_VAL(l_vibratedev.odaddr) &= ~l_vibratedev.bmp;
+}
+
+static void enable_timedoutput(struct timed_output_dev *sdev, int timeout)
+{
+	/*
+	mutex_lock(&l_vibratedev.mlock);
+	l_vibratedev.vibtimeout = timeout;
+	mutex_unlock(&l_vibratedev.mlock);
+	//wakeup work to vibrate
+	if (l_vibratedev.vibtimeout)
+		schedule_work(&l_vibratedev.work);
+	*/
+	if (0 == timeout)
+	{
+		// Don't vibrate
+		return;
+	}
+	del_timer_sync(&vibrate_timer);
+
+	if (l_vibratedev.active == 0)
+		REG32_VAL(l_vibratedev.odaddr) &= ~l_vibratedev.bmp; /* low active */
+	else
+		REG32_VAL(l_vibratedev.odaddr) |= l_vibratedev.bmp; /* high active */
+
+	if (timeout < WMT_VIBRATE_DELAY)
+	{
+		timeout = WMT_VIBRATE_DELAY;
+	}
+	mod_timer(&vibrate_timer,  jiffies +  msecs_to_jiffies(timeout));
+}
+
+static int gettime_timedoutput(struct timed_output_dev *sdev)
+{
+	return l_vibratedev.vibtimeout;
+}
+
+void wmt_do_vibrate(void)
+{
+	unsigned int vibtime = 0;
+
+	REG32_VAL(l_vibratedev.ctraddr) |= l_vibratedev.bmp;
+	REG32_VAL(l_vibratedev.ocaddr) |= l_vibratedev.bmp;
+
+	if (l_vibratedev.active == 0)
+		REG32_VAL(l_vibratedev.odaddr) &= ~l_vibratedev.bmp; /* low active */
+	else
+		REG32_VAL(l_vibratedev.odaddr) |= l_vibratedev.bmp; /* high active */
+	// delay
+	if (l_vibratedev.vibtimeout < WMT_VIBRATE_DELAY)
+	{
+		vibtime = WMT_VIBRATE_DELAY;
+	} else
+	{
+		vibtime = l_vibratedev.vibtimeout;
+	}
+	msleep(vibtime);
+	if (l_vibratedev.active == 0)
+		REG32_VAL(l_vibratedev.odaddr) |= l_vibratedev.bmp;
+	else
+		REG32_VAL(l_vibratedev.odaddr) &= ~l_vibratedev.bmp;
+}
+
+
+// return 0: unvibratile, 1: vibratile
+int wmt_is_vibratile(void)
+{
+	return l_vibratedev.vibratile;
+}
+
+static int wmt_vibrate_release(struct inode *inode, struct file *file)
+{
+	return 0;
+}
+
+static int wmt_vibrate_open(struct inode *inode, struct file *file)
+{
+	return 0;
+}
+
+static long wmt_vibrate_ioctl(struct file *fp,
+			     unsigned int cmd, unsigned long arg)
+{
+	int ret = 0;
+	void __user *argp = (void __user *)arg;
+	u8 val8;
+
+	mutex_lock(&l_vibratedev.mlock);
+	switch (cmd) {
+	case WMT_VIBRATE_ENABLE:
+		if (copy_from_user(&val8, argp, sizeof(val8))) {
+			ret = -EFAULT;
+			break;
+		}
+		l_vibratedev.vibratile= (val8 != 0)? 1:0;
+		/*
+		if (l_vibratedev.vibratile != 0){
+			wmt_do_vibrate();
+		}
+		*/
+		break;
+	default:
+		ret = -EINVAL;
+	}
+	mutex_unlock(&l_vibratedev.mlock);
+	return ret;
+}
+
+static const struct file_operations vibrate_fops = {
+	.owner		= THIS_MODULE,
+	.open		= wmt_vibrate_open,
+	.release	= wmt_vibrate_release,
+	.unlocked_ioctl = wmt_vibrate_ioctl,
+};
+
+/*
+static int __devinit wmt_vibrate_probe(struct platform_device *dev)
+{
+}
+
+static int __devexit wmt_vibrate_remove(struct platform_device *dev)
+{
+	return 0;
+}
+
+static void wmt_vibrate_shutdown(struct platform_device *dev)
+{
+}
+
+*/
+
+static void vibrate_gpio_init(void)
+{
+	REG32_VAL(l_vibratedev.ctraddr) |= l_vibratedev.bmp;
+	REG32_VAL(l_vibratedev.ocaddr) |= l_vibratedev.bmp;
+	if (l_vibratedev.active == 0)
+		REG32_VAL(l_vibratedev.odaddr) |= l_vibratedev.bmp;
+	else
+		REG32_VAL(l_vibratedev.odaddr) &= ~l_vibratedev.bmp;
+}
+
+#ifdef CONFIG_PM
+static int wmt_vibrate_suspend(struct platform_device *dev, pm_message_t state)
+{
+	return 0;
+}
+
+static int wmt_vibrate_resume(struct platform_device *dev)
+{
+	vibrate_gpio_init();
+	return 0;
+}
+#else
+#define wmt_vibrate_suspend	NULL
+#define wmt_vibrate_resume	NULL
+#endif
+
+
+static struct platform_driver vibrate_driver = {
+	.driver		= {
+		.name	= WMT_VIBRATE_DEVICE_NAME,
+		.owner	= THIS_MODULE,
+	},
+	//.probe		= wmt_vibrate_probe,
+	//.remove		= __devexit_p(wmt_vibrate_remove),
+	//.shutdown	= wmt_vibrate_shutdown,
+	.suspend	= wmt_vibrate_suspend,
+	.resume		= wmt_vibrate_resume,
+};
+
+static struct platform_device *vibrate_platform_device;
+
+/*
+static ssize_t show_classname(struct class *class, char *buf)
+{
+	return sprintf(buf, "%s\n", WMT_VIBRATE_DEVICE_NAME);
+}
+
+static CLASS_ATTR(vibrate, 0777, show_classname, NULL);
+*/
+
+//static struct class_attribute cls_attrs = __ATTR(WMT_VIBRATE_DEVICE_NAME, 0777, NULL, NULL);
+
+// dev_attr_wmt_vibrate
+
+/*
+static ssize_t show_vibtime(struct device *dev, struct device_attribute *attr,
+			  char *buf)
+{
+
+	return sprintf(buf, "%dms\n", l_vibratedev.vibtimeout);
+}
+
+static ssize_t set_vibtime(struct device *dev, struct device_attribute *attr,
+			  const char *buf, size_t count)
+{
+	unsigned long val;
+
+	if (strict_strtoul(buf, 10, &val) != 0)
+	{
+		return count;
+	}
+	return count;
+}
+
+static DEVICE_ATTR(vibtimeout, 0666, show_devname, NULL);
+*/
+
+static void vib_work_handler(struct work_struct *work)
+{
+	wmt_do_vibrate();
+}
+
+extern int wmt_getsyspara(char *varname, unsigned char *varval, int *varlen);
+static int get_vibratorset(void* param)
+{
+	char buf[128];
+	unsigned int ubootval[6];
+	int ret = 0;
+	int varlen = 127;
+
+	/* read the paraqm from */
+	memset(buf ,0, sizeof(buf));
+	memset(ubootval, 0, sizeof(ubootval));
+	if (wmt_getsyspara("wmt.vibrate.time", buf, &varlen)) {
+		//printk(KERN_WARNING "wmt.gpo.vibrator isn't set in u-boot env! -> Use default\n");
+		//return -1;
+		WMT_VIBRATE_DELAY = 90;
+	} else {
+		sscanf(buf, "%d", &WMT_VIBRATE_DELAY);
+	}
+	memset(buf ,0, sizeof(buf));
+	if (wmt_getsyspara("wmt.gpo.vibrator", buf, &varlen)) {
+		printk(KERN_WARNING "wmt.gpo.vibrator isn't set in u-boot env! -> Use default\n");
+		return -1;
+	}
+	ret = sscanf(buf, "%x:%x:%x:%x:%x:%x",
+				       &ubootval[0],
+				       &ubootval[1],
+				       &ubootval[2],
+				       &ubootval[3],
+				       &ubootval[4],
+				       &ubootval[5]);
+	if (ret != 6) {
+		printk(KERN_ERR "wmt.gpo.vibrator format is incorrect in u-boot\n");
+		return -2;
+	}
+	vibrate_dbg("wmt.gpo.vibrator = %x:%x:%x:%x:%x:%x\n",
+		ubootval[0],
+		ubootval[1],
+		ubootval[2],
+		ubootval[3],
+		ubootval[4],
+		ubootval[5]);
+	l_vibratedev.name = ubootval[0];
+	l_vibratedev.active = ubootval[1];
+	l_vibratedev.bmp = ubootval[2];
+	l_vibratedev.ctraddr = ubootval[3] + WMT_MMAP_OFFSET;
+	l_vibratedev.ocaddr = ubootval[4] + WMT_MMAP_OFFSET;
+	l_vibratedev.odaddr = ubootval[5] + WMT_MMAP_OFFSET;
+	return 0;
+}
+
+static int __init wmt_vibrate_init(void)
+{
+	int error = 0;
+
+	/* get vibrator setting */
+	if (get_vibratorset(&l_vibratedev) < 0)
+	{
+		printk(KERN_ERR "Wrong vabrating u-boot parameter!\n");
+		return -EINVAL;
+	}
+
+	vibrate_gpio_init();
+
+	/* other initial */
+	mutex_init(&l_vibratedev.mlock);
+	//INIT_WORK(&l_vibratedev.work, vib_work_handler);
+	setup_timer(&vibrate_timer, wmt_disable_vibrator, 0);
+
+	/* register char device */
+	if (register_chrdev (WMT_VIBRATE_MAJOR, WMT_VIBRATE_DEVICE_NAME, &vibrate_fops)) {
+		printk (KERN_ERR "wmt vibrate: unable to get major %d\n", WMT_VIBRATE_MAJOR);
+		error = -EIO;
+		goto initend;
+	}
+	/* (mknod /dev/wmt_vibrate c 37 0) */
+	l_vibratedev.dev_class = class_create(THIS_MODULE, WMT_VIBRATE_DEVICE_NAME);
+	if (IS_ERR(l_vibratedev.dev_class))
+	{
+		error = PTR_ERR(l_vibratedev.dev_class);
+		printk(KERN_ERR "Can't class_create vibrate device !!\n");
+		goto initend1;
+	}
+	/*
+	if (class_create_file(l_vibratedev.dev_class, &class_attr_vibrate) < 0)
+	{
+		printk(KERN_ERR "Can't add class attr !\n");
+		return -1;
+	}
+	*/
+
+	l_vibratedev.device = device_create(l_vibratedev.dev_class, NULL, MKDEV(WMT_VIBRATE_MAJOR, 0), NULL, WMT_VIBRATE_DEVICE_NAME);
+    if (IS_ERR(l_vibratedev.device))
+    {
+    	error = PTR_ERR(l_vibratedev.device);
+    	printk(KERN_ERR "Failed to create device %s !!!",WMT_VIBRATE_DEVICE_NAME);
+    	goto initend2;
+    }
+    /*
+    if (device_create_file(l_vibratedev.device, &dev_attr_vibrate))
+    {
+    	printk(KERN_ERR "Can't add device attr!!!\n");
+    	return -1;
+    }
+    */
+
+	/* create '/sys/class/timed_output/vibrator/enable' */
+	if ((error = timed_output_dev_register(&l_vibratedev.vibtimedev)) != 0)
+	{
+		goto initend3;
+	}
+
+	error = platform_driver_register(&vibrate_driver);
+	if (error)
+		goto exit_timed_unregsiter;
+
+	vibrate_platform_device = platform_device_alloc(WMT_VIBRATE_DEVICE_NAME, -1);
+	if (!vibrate_platform_device) {
+		error = -ENOMEM;
+		printk(KERN_ERR "Can't alloc vibrate_platform_device!!!\n");
+		goto initend4;
+	}
+
+	error = platform_device_add(vibrate_platform_device);
+	if (error)
+		goto initend5;
+
+	printk(KERN_ALERT"WMT vibrater driver load successfully!\n");
+	return 0;
+
+initend5:
+	platform_device_put(vibrate_platform_device);
+initend4:
+	platform_driver_unregister(&vibrate_driver);
+exit_timed_unregsiter:
+	timed_output_dev_unregister(&l_vibratedev.vibtimedev);
+initend3:
+	device_destroy(l_vibratedev.dev_class, MKDEV(WMT_VIBRATE_MAJOR, 0));
+initend2:
+	class_destroy(l_vibratedev.dev_class);
+initend1:
+	unregister_chrdev(WMT_VIBRATE_MAJOR, WMT_VIBRATE_DEVICE_NAME);
+initend:
+	return error;
+}
+
+static void __exit wmt_vibrate_exit(void)
+{
+	platform_device_unregister(vibrate_platform_device);
+	platform_driver_unregister(&vibrate_driver);
+	timed_output_dev_unregister(&l_vibratedev.vibtimedev);
+	device_destroy(l_vibratedev.dev_class, MKDEV(WMT_VIBRATE_MAJOR, 0));
+    class_destroy(l_vibratedev.dev_class);
+	unregister_chrdev(WMT_VIBRATE_MAJOR, WMT_VIBRATE_DEVICE_NAME);
+
+	printk(KERN_ALERT "WMT vibrate driver is removed.\n");
+}
+
+module_init(wmt_vibrate_init);
+module_exit(wmt_vibrate_exit);
+
+
+EXPORT_SYMBOL(wmt_do_vibrate);
+EXPORT_SYMBOL(wmt_is_vibratile);
+
+MODULE_DESCRIPTION("Vibrate Device driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/char/wmt_vibrate/wmt_vibrate.h b/drivers/char/wmt_vibrate/wmt_vibrate.h
new file mode 100755
index 00000000..ad57a673
--- /dev/null
+++ b/drivers/char/wmt_vibrate/wmt_vibrate.h
@@ -0,0 +1,35 @@
+/*++
+
+	Some descriptions of such software. Copyright (c) 2010  WonderMedia Technologies, Inc.
+
+	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, see <http://www.gnu.org/licenses/>.
+
+	WonderMedia Technologies, Inc.
+	2010-2-26, HangYan, ShenZhen
+--*/
+
+#ifndef __WMT_VIBRATE_DRIVER__
+#define __WMT_VIBRATE_DRIVER__
+
+#include <linux/types.h>
+
+/*******************io ctrl commands*****************************/
+
+#define WMT_VIBRATE_IOCTL_MAGIC '7'
+#define WMT_VIBRATE_ENABLE    _IOW(WMT_VIBRATE_IOCTL_MAGIC, 0, unsigned char)  // 0:disable, 1:enable
+
+
+
+
+
+
+#endif
+