Aquaris-M10-4G/drivers/misc/mediatek/freefall_sensor/freefall.c

#include "freefall.h"

static struct freefall_context *freefall_context_obj;

static struct freefall_init_info *freefall_sensor_init = { 0 };	/* modified */

static void freefall_early_suspend(struct early_suspend *h);
static void freefall_late_resume(struct early_suspend *h);

static int resume_enable_status;
static struct wake_lock freefall_lock;
static void notify_freefall_timeout(unsigned long);

static struct freefall_context *freefall_context_alloc_object(void)
{
	struct freefall_context *obj = kzalloc(sizeof(*obj), GFP_KERNEL);

	FREEFALL_LOG("freefall_context_alloc_object++++\n");
	if (!obj) {
		FREEFALL_ERR("Alloc freefall object error!\n");
		return NULL;
	}
	atomic_set(&obj->wake, 0);
	mutex_init(&obj->freefall_op_mutex);

	FREEFALL_LOG("freefall_context_alloc_object----\n");
	return obj;
}

static void notify_freefall_timeout(unsigned long data)
{
	wake_unlock(&freefall_lock);
}

int freefall_notify(void)
{
	int err = 0;
	int value = 0;
	struct freefall_context *cxt = NULL;

	cxt = freefall_context_obj;
	FREEFALL_LOG("freefall_notify++++\n");

	value = 1;
	input_report_rel(cxt->idev, EVENT_TYPE_FREEFALL_VALUE, value);
	input_sync(cxt->idev);

	wake_lock(&freefall_lock);
	mod_timer(&cxt->notify_timer, jiffies + HZ / 5);

	return err;
}

static int freefall_real_enable(int enable)
{
	int err = 0;
	struct freefall_context *cxt = NULL;

	cxt = freefall_context_obj;
	if (FREEFALL_RESUME == enable)
		enable = resume_enable_status;

	if (1 == enable) {
		resume_enable_status = 1;
		if (atomic_read(&(freefall_context_obj->early_suspend)))
			return 0;

		if (false == cxt->is_active_data) {
			err = cxt->freefall_ctl.open_report_data(1);
			if (err) {
				err = cxt->freefall_ctl.open_report_data(1);
				if (err) {
					err = cxt->freefall_ctl.open_report_data(1);
					if (err) {
						GLG_ERR
						    ("enable_glance_gesture enable(%d) err 3 timers = %d\n",
						     enable, err);
						return err;
					}
				}
			}
			cxt->is_active_data = true;
			FREEFALL_LOG("enable_glance_gesture real enable\n");
		}
	} else if ((0 == enable) || (FREEFALL_SUSPEND == enable)) {
		if (0 == enable)
			resume_enable_status = 0;
		if (true == cxt->is_active_data) {
			err = cxt->freefall_ctl.open_report_data(0);
			if (err)
				GLG_ERR("enable_glance_gestureenable(%d) err = %d\n", enable, err);

			cxt->is_active_data = false;
			FREEFALL_LOG("enable_glance_gesture real disable\n");
		}
	}
	return err;
}

int freefall_enable_nodata(int enable)
{
	struct freefall_context *cxt = NULL;

	cxt = freefall_context_obj;
	if (NULL == cxt->freefall_ctl.open_report_data) {
		GLG_ERR("freefall_enable_nodata:freefall ctl path is NULL\n");
		return -1;
	}

	if (1 == enable)
		cxt->is_active_nodata = true;
	if (0 == enable)
		cxt->is_active_nodata = false;

	freefall_real_enable(enable);
	return 0;
}

static ssize_t freefall_show_enable_nodata(struct device *dev,
					   struct device_attribute *attr, char *buf)
{
	struct freefall_context *cxt = NULL;

	cxt = freefall_context_obj;

	FREEFALL_LOG("freefall active: %d\n", cxt->is_active_nodata);
	return snprintf(buf, PAGE_SIZE, "%d\n", cxt->is_active_nodata);
}

static ssize_t freefall_store_enable_nodata(struct device *dev, struct device_attribute *attr,
					    const char *buf, size_t count)
{
	struct freefall_context *cxt = NULL;

	FREEFALL_LOG("freefall_store_enable nodata buf=%s\n", buf);
	mutex_lock(&freefall_context_obj->freefall_op_mutex);
	cxt = freefall_context_obj;
	if (NULL == cxt->freefall_ctl.open_report_data) {
		FREEFALL_LOG("freefall_ctl enable nodata NULL\n");
		mutex_unlock(&freefall_context_obj->freefall_op_mutex);
		return count;
	}
	if (!strncmp(buf, "1", 1))
		freefall_enable_nodata(1);
	else if (!strncmp(buf, "0", 1))
		freefall_enable_nodata(0);
	else
		GLG_ERR(" freefall_store enable nodata cmd error !!\n");

	mutex_unlock(&freefall_context_obj->freefall_op_mutex);
	return count;
}

static ssize_t freefall_store_active(struct device *dev, struct device_attribute *attr,
				     const char *buf, size_t count)
{
	struct freefall_context *cxt = NULL;
	int res = 0;
	int en = 0;

	FREEFALL_LOG("freefall_store_active buf=%s\n", buf);
	mutex_lock(&freefall_context_obj->freefall_op_mutex);

	cxt = freefall_context_obj;

	res = kstrtoint(buf, 10, &en);
	if (res != 0)
		FREEFALL_LOG(" freefall_store_active param error: res = %d\n", res);

	FREEFALL_LOG(" freefall_store_active en=%d\n", en);
	if (1 == en)
		freefall_real_enable(1);
	else if (0 == en)
		freefall_real_enable(0);
	else
		FREEFALL_ERR(" freefall_store_active error !!\n");

	mutex_unlock(&freefall_context_obj->freefall_op_mutex);
	FREEFALL_LOG(" freefall_store_active done\n");
	return count;
}

/*----------------------------------------------------------------------------*/
static ssize_t freefall_show_active(struct device *dev, struct device_attribute *attr, char *buf)
{
	struct freefall_context *cxt = NULL;

	cxt = freefall_context_obj;
	FREEFALL_LOG("freefall active: %d\n", cxt->is_active_data);
	return snprintf(buf, PAGE_SIZE, "%d\n", cxt->is_active_data);
}

static ssize_t freefall_store_delay(struct device *dev, struct device_attribute *attr, char *buf)
{
	int len = 0;

	FREEFALL_LOG(" not support now\n");
	return len;
}


static ssize_t freefall_show_delay(struct device *dev, struct device_attribute *attr, char *buf)
{
	int len = 0;

	FREEFALL_LOG(" not support now\n");
	return len;
}


static ssize_t freefall_store_batch(struct device *dev, struct device_attribute *attr,
				    const char *buf, size_t count)
{
	int len = 0;

	FREEFALL_LOG(" not support now\n");
	return len;
}

static ssize_t freefall_show_batch(struct device *dev, struct device_attribute *attr, char *buf)
{
	int len = 0;

	FREEFALL_LOG(" not support now\n");
	return len;
}

static ssize_t freefall_store_flush(struct device *dev, struct device_attribute *attr,
				    const char *buf, size_t count)
{
	int len = 0;

	FREEFALL_LOG(" not support now\n");
	return len;
}

static ssize_t freefall_show_flush(struct device *dev, struct device_attribute *attr, char *buf)
{
	int len = 0;

	FREEFALL_LOG(" not support now\n");
	return len;
}

static ssize_t freefall_show_devnum(struct device *dev, struct device_attribute *attr, char *buf)
{
	char *devname = NULL;

	devname = dev_name(&freefall_context_obj->idev->dev);
	return snprintf(buf, PAGE_SIZE, "%s\n", devname + 5);	/* TODO: why +5? */
}

static int freefall_remove(struct platform_device *pdev)
{
	FREEFALL_LOG("freefall_remove\n");
	return 0;
}

static int freefall_probe(struct platform_device *pdev)
{
	FREEFALL_LOG("freefall_probe\n");
	return 0;
}

#ifdef CONFIG_OF
static const struct of_device_id freefall_of_match[] = {
	{.compatible = "mediatek,freefall_sensor",},
	{},
};
#endif

static struct platform_driver freefall_driver = {
	.probe = freefall_probe,
	.remove = freefall_remove,
	.driver = {
		   .name = "freefall_sensor",
#ifdef CONFIG_OF
		   .of_match_table = freefall_of_match,
#endif
		   }
};

static int freefall_real_driver_init(void)
{
	int err = 0;

	FREEFALL_LOG(" freefall_real_driver_init +\n");
	if (0 != freefall_sensor_init) {
		FREEFALL_LOG(" freefall try to init driver %s\n", freefall_sensor_init->name);
		err = freefall_sensor_init->init();
		if (0 == err) {
			FREEFALL_LOG(" freefall real driver %s probe ok\n",
				     freefall_sensor_init->name);
		}
	}
	wake_lock_init(&freefall_lock, WAKE_LOCK_SUSPEND, "freefall wakelock");
	init_timer(&freefall_context_obj->notify_timer);
	freefall_context_obj->notify_timer.expires = HZ / 5;	/* 200 ms */
	freefall_context_obj->notify_timer.function = notify_freefall_timeout;
	freefall_context_obj->notify_timer.data = (unsigned long)freefall_context_obj;

	return err;
}

int freefall_driver_add(struct freefall_init_info *obj)
{
	int err = 0;

	FREEFALL_FUN();
	FREEFALL_LOG("register glance_gesture driver for the first time\n");
	if (platform_driver_register(&freefall_driver))
		GLG_ERR("failed to register gensor driver already exist\n");

	if (NULL == freefall_sensor_init) {
		obj->platform_diver_addr = &freefall_driver;
		freefall_sensor_init = obj;
	}

	if (NULL == freefall_sensor_init) {
		GLG_ERR("GLG driver add err\n");
		err = -1;
	}

	return err;
} EXPORT_SYMBOL_GPL(freefall_driver_add);

static int freefall_misc_init(struct freefall_context *cxt)
{
	int err = 0;
	/* kernel-3.10\include\linux\Miscdevice.h */
	/* use MISC_DYNAMIC_MINOR exceed 64 */
	cxt->mdev.minor = M_GLG_MISC_MINOR;
	cxt->mdev.name = GLG_MISC_DEV_NAME;
	err = misc_register(&cxt->mdev);
	if (err)
		GLG_ERR("unable to register freefall misc device!!\n");

	return err;
}

static void freefall_input_destroy(struct freefall_context *cxt)
{
	struct input_dev *dev = cxt->idev;

	input_unregister_device(dev);
	input_free_device(dev);
}

static int freefall_input_init(struct freefall_context *cxt)
{
	struct input_dev *dev;
	int err = 0;

	dev = input_allocate_device();
	if (NULL == dev)
		return -ENOMEM;

	dev->name = GLG_INPUTDEV_NAME;
	input_set_capability(dev, EV_REL, EVENT_TYPE_FREEFALL_VALUE);

	input_set_drvdata(dev, cxt);
	set_bit(EV_REL, dev->evbit);
	err = input_register_device(dev);
	if (err < 0) {
		input_free_device(dev);
		return err;
	}
	cxt->idev = dev;

	return 0;
}

DEVICE_ATTR(freefallenablenodata, S_IWUSR | S_IRUGO, freefall_show_enable_nodata,
	    freefall_store_enable_nodata);
DEVICE_ATTR(freefallactive, S_IWUSR | S_IRUGO, freefall_show_active, freefall_store_active);
DEVICE_ATTR(freefalldelay, S_IWUSR | S_IRUGO, freefall_show_delay, freefall_store_delay);
DEVICE_ATTR(freefallbatch, S_IWUSR | S_IRUGO, freefall_show_batch, freefall_store_batch);
DEVICE_ATTR(freefallflush, S_IWUSR | S_IRUGO, freefall_show_flush, freefall_store_flush);
DEVICE_ATTR(freefalldevnum, S_IWUSR | S_IRUGO, freefall_show_devnum, NULL);


static struct attribute *freefall_attributes[] = {
	&dev_attr_freefallenablenodata.attr,
	&dev_attr_freefallactive.attr,
	&dev_attr_freefalldelay.attr,
	&dev_attr_freefallbatch.attr,
	&dev_attr_freefallflush.attr,
	&dev_attr_freefalldevnum.attr,
	NULL
};

static struct attribute_group freefall_attribute_group = {
	.attrs = freefall_attributes
};

int freefall_register_data_path(struct freefall_data_path *data)
{
	struct freefall_context *cxt = NULL;

	cxt = freefall_context_obj;
	cxt->freefall_data.get_data = data->get_data;
	if (NULL == cxt->freefall_data.get_data) {
		FREEFALL_LOG("freefall register data path fail\n");
		return -1;
	}
	return 0;
}

int freefall_register_control_path(struct freefall_control_path *ctl)
{
	struct freefall_context *cxt = NULL;
	int err = 0;

	cxt = freefall_context_obj;
/* cxt->freefall_ctl.enable = ctl->enable; */
/* cxt->freefall_ctl.enable_nodata = ctl->enable_nodata; */
	cxt->freefall_ctl.open_report_data = ctl->open_report_data;

	if (NULL == cxt->freefall_ctl.open_report_data) {
		FREEFALL_LOG("freefall register control path fail\n");
		return -1;
	}
	/* add misc dev for sensor hal control cmd */
	err = freefall_misc_init(freefall_context_obj);
	if (err) {
		GLG_ERR("unable to register freefall misc device!!\n");
		return -2;
	}
	err = sysfs_create_group(&freefall_context_obj->mdev.this_device->kobj,
				 &freefall_attribute_group);
	if (err < 0) {
		GLG_ERR("unable to create freefall attribute file\n");
		return -3;
	}
	kobject_uevent(&freefall_context_obj->mdev.this_device->kobj, KOBJ_ADD);
	return 0;
}

static int freefall_probe(struct platform_device *pdev)
{
	int err;

	FREEFALL_LOG("+++++++++++++freefall_probe!!\n");

	freefall_context_obj = freefall_context_alloc_object();
	if (!freefall_context_obj) {
		err = -ENOMEM;
		GLG_ERR("unable to allocate devobj!\n");
		goto exit_alloc_data_failed;
	}
	/* init real freefall driver */
	err = freefall_real_driver_init();
	if (err) {
		GLG_ERR("freefall real driver init fail\n");
		goto real_driver_init_fail;
	}
	/* init input dev */
	err = freefall_input_init(freefall_context_obj);
	if (err) {
		GLG_ERR("unable to register freefall input device!\n");
		goto exit_alloc_input_dev_failed;
	}
#if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND)
	atomic_set(&(freefall_context_obj->early_suspend), 0);
	freefall_context_obj->early_drv.level = EARLY_SUSPEND_LEVEL_STOP_DRAWING - 1,
	    freefall_context_obj->early_drv.suspend = freefall_early_suspend,
	    freefall_context_obj->early_drv.resume = freefall_late_resume,
	    register_early_suspend(&freefall_context_obj->early_drv);
#endif				/* #if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND) */

	FREEFALL_LOG("----freefall_probe OK !!\n");
	return 0;

	if (err) {
		GLG_ERR("sysfs node creation error\n");
		freefall_input_destroy(freefall_context_obj);
	}
real_driver_init_fail:
exit_alloc_input_dev_failed:
	kfree(freefall_context_obj);
exit_alloc_data_failed:
	FREEFALL_LOG("----freefall_probe fail !!!\n");
	return err;
}

static int freefall_remove(struct platform_device *pdev)
{
	int err = 0;

	GLG_FUN();
	input_unregister_device(freefall_context_obj->idev);
	sysfs_remove_group(&freefall_context_obj->idev->dev.kobj, &freefall_attribute_group);

	err = misc_deregister(&freefall_context_obj->mdev);
	if (err)
		GLG_ERR("misc_deregister fail: %d\n", err);

	kfree(freefall_context_obj);
	return 0;
}

static void freefall_early_suspend(struct early_suspend *h)
{
	atomic_set(&(freefall_context_obj->early_suspend), 1);
	if (!atomic_read(&freefall_context_obj->wake))	/* not wake up, disable in early suspend */
		freefall_real_enable(GLG_SUSPEND);

	FREEFALL_LOG(" freefall_early_suspend ok------->hwm_obj->early_suspend=%d\n",
		     atomic_read(&(freefall_context_obj->early_suspend)));
}

/*----------------------------------------------------------------------------*/
static void freefall_late_resume(struct early_suspend *h)
{
	atomic_set(&(freefall_context_obj->early_suspend), 0);
	if (!atomic_read(&freefall_context_obj->wake) && resume_enable_status)
		freefall_real_enable(GLG_RESUME);

	FREEFALL_LOG(" freefall_late_resume ok------->hwm_obj->early_suspend=%d\n",
		     atomic_read(&(freefall_context_obj->early_suspend)));
}

#if !defined(CONFIG_HAS_EARLYSUSPEND) || !defined(USE_EARLY_SUSPEND)
static int freefall_suspend(struct platform_device *dev, pm_message_t state)
{
	atomic_set(&(freefall_context_obj->suspend), 1);
	if (!atomic_read(&freefall_context_obj->wake))
		freefall_real_enable(GLG_SUSPEND);

	FREEFALL_LOG(" freefall_suspend ok------->hwm_obj->suspend=%d\n",
		     atomic_read(&(freefall_context_obj->suspend)));
	return 0;
}

/*----------------------------------------------------------------------------*/
static int freefall_resume(struct platform_device *dev)
{
	atomic_set(&(freefall_context_obj->suspend), 0);
	if (!atomic_read(&freefall_context_obj->wake) && resume_enable_status)
		freefall_real_enable(GLG_RESUME);

	FREEFALL_LOG(" freefall_resume ok------->hwm_obj->suspend=%d\n",
		     atomic_read(&(freefall_context_obj->suspend)));
	return 0;
}
#endif				/* #if !defined(CONFIG_HAS_EARLYSUSPEND) || !defined(USE_EARLY_SUSPEND) */

#ifdef CONFIG_OF
static const struct of_device_id m_freefall_pl_of_match[] = {
	{.compatible = "mediatek,m_freefall_pl",},
	{},
};
#endif

static struct platform_driver freefall_driver = {
	.probe = freefall_probe,
	.remove = freefall_remove,
#if !defined(CONFIG_HAS_EARLYSUSPEND) || !defined(USE_EARLY_SUSPEND)
	.suspend = freefall_suspend,
	.resume = freefall_resume,
#endif
	.driver = {
		   .name = GLG_FREEFALL_DEV_NAME,
#ifdef CONFIG_OF
		   .of_match_table = m_freefall_pl_of_match,
#endif
		   }
};

static int __init freefall_init(void)
{
	GLG_FUN();

	if (platform_driver_register(&freefall_driver)) {
		GLG_ERR("failed to register freefall driver\n");
		return -ENODEV;
	}

	return 0;
}

static void __exit freefall_exit(void)
{
	platform_driver_unregister(&freefall_driver);
	platform_driver_unregister(&freefall_driver);
}

late_initcall(freefall_init);
/* module_init(freefall_init); */
/* module_exit(freefall_exit); */
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("GLG device driver");
MODULE_AUTHOR("Mediatek");