Aquaris-M10-4G/drivers/misc/mediatek/alsps/alsps.c

#include "inc/alsps.h"
#include "inc/aal_control.h"
struct alsps_context *alsps_context_obj = NULL;
struct platform_device *pltfm_dev;


static struct alsps_init_info *alsps_init_list[MAX_CHOOSE_ALSPS_NUM] = {0};

static bool alsps_misc_dev_init;

int als_data_report(struct input_dev *dev, int value, int status)
{
	struct alsps_context *cxt = NULL;

	cxt  = alsps_context_obj;
	/*ALSPS_LOG(" +als_data_report! %d, %d\n", value, status);*/
	/* force trigger data update after sensor enable. */
	if (cxt->is_get_valid_als_data_after_enable == false) {
		input_report_abs(dev, EVENT_TYPE_ALS_VALUE, value+1);
		cxt->is_get_valid_als_data_after_enable = true;
	}
	input_report_abs(dev, EVENT_TYPE_ALS_VALUE, value);
	input_report_abs(dev, EVENT_TYPE_ALS_STATUS, status);
	input_sync(dev);
	return 0;
}

int ps_data_report(struct input_dev *dev, int value, int status)
{
	/* ALSPS_LOG("+ps_data_report! %d, %d\n",value,status); */
	input_report_rel(dev, EVENT_TYPE_PS_VALUE, (value+1));
	input_report_rel(dev, EVENT_TYPE_PS_STATUS, status);
	input_sync(dev);
	return 0;
}

static void als_work_func(struct work_struct *work)
{
	struct alsps_context *cxt = NULL;
	int value, status;
	int64_t  nt;
	struct timespec time;
	int err;

	cxt  = alsps_context_obj;
	if (NULL == cxt->als_data.get_data) {
		ALSPS_ERR("alsps driver not register data path\n");
		return;
	}

	time.tv_sec = time.tv_nsec = 0;
	time = get_monotonic_coarse();
	nt = time.tv_sec*1000000000LL+time.tv_nsec;
	/* add wake lock to make sure data can be read before system suspend */
	err = cxt->als_data.get_data(&value, &status);
	if (err) {
		ALSPS_ERR("get alsps data fails!!\n");
		goto als_loop;
	} else {
		cxt->drv_data.als_data.values[0] = value;
		cxt->drv_data.als_data.status = status;
		cxt->drv_data.als_data.time = nt;
	}

	if (true ==  cxt->is_als_first_data_after_enable) {
		cxt->is_als_first_data_after_enable = false;
		/* filter -1 value */
		if (ALSPS_INVALID_VALUE == cxt->drv_data.als_data.values[0]) {
			ALSPS_LOG(" read invalid data\n");
			goto als_loop;
		}
	}
	ALSPS_LOG(" als data[%d]\n" , cxt->drv_data.als_data.values[0]);
	als_data_report(cxt->idev,
	cxt->drv_data.als_data.values[0],
	cxt->drv_data.als_data.status);

als_loop:
	if (true == cxt->is_als_polling_run)
		mod_timer(&cxt->timer_als, jiffies + atomic_read(&cxt->delay_als)/(1000/HZ));
}

static void ps_work_func(struct work_struct *work)
{

	struct alsps_context *cxt = NULL;
	int value, status;
	int64_t  nt;
	struct timespec time;
	int err = 0;

	cxt  = alsps_context_obj;
	if (NULL == cxt->ps_data.get_data) {
		ALSPS_ERR("alsps driver not register data path\n");
		return;
	}

	time.tv_sec = time.tv_nsec = 0;
	time = get_monotonic_coarse();
	nt = time.tv_sec*1000000000LL+time.tv_nsec;

	/* add wake lock to make sure data can be read before system suspend */
	err = cxt->ps_data.get_data(&value, &status);
	if (err) {
		ALSPS_ERR("get alsps data fails!!\n");
		goto ps_loop;
	} else {
		cxt->drv_data.ps_data.values[0] = value;
		cxt->drv_data.ps_data.status = status;
		cxt->drv_data.ps_data.time = nt;
	}

	if (true ==  cxt->is_ps_first_data_after_enable) {
		cxt->is_ps_first_data_after_enable = false;
		/* filter -1 value */
		if (ALSPS_INVALID_VALUE == cxt->drv_data.ps_data.values[0]) {
			ALSPS_LOG(" read invalid data\n");
			goto ps_loop;
		}
	}

	if (cxt->is_get_valid_ps_data_after_enable == false) {
		if (ALSPS_INVALID_VALUE != cxt->drv_data.ps_data.values[0])
			cxt->is_get_valid_ps_data_after_enable = true;
	}

	ps_data_report(cxt->idev,
	cxt->drv_data.ps_data.values[0],
	cxt->drv_data.ps_data.status);

ps_loop:
	if (true == cxt->is_ps_polling_run) {
		if (cxt->ps_ctl.is_polling_mode || (cxt->is_get_valid_ps_data_after_enable == false))
			mod_timer(&cxt->timer_ps, jiffies + atomic_read(&cxt->delay_ps)/(1000/HZ));
	}
}

static void als_poll(unsigned long data)
{
	struct alsps_context *obj = (struct alsps_context *)data;

	if ((obj != NULL) && (obj->is_als_polling_run))
		schedule_work(&obj->report_als);
}

static void ps_poll(unsigned long data)
{
	struct alsps_context *obj = (struct alsps_context *)data;

	if (obj != NULL)
		schedule_work(&obj->report_ps);
}

static struct alsps_context *alsps_context_alloc_object(void)
{
	struct alsps_context *obj = kzalloc(sizeof(*obj), GFP_KERNEL);

	ALSPS_LOG("alsps_context_alloc_object++++\n");
	if (!obj) {
		ALSPS_ERR("Alloc alsps object error!\n");
		return NULL;
	}
	atomic_set(&obj->delay_als, 200); /*5Hz, set work queue delay time 200ms */
	atomic_set(&obj->delay_ps, 200); /* 5Hz,  set work queue delay time 200ms */
	atomic_set(&obj->wake, 0);
	INIT_WORK(&obj->report_als, als_work_func);
	INIT_WORK(&obj->report_ps, ps_work_func);
	init_timer(&obj->timer_als);
	init_timer(&obj->timer_ps);
	obj->timer_als.expires	= jiffies + atomic_read(&obj->delay_als)/(1000/HZ);
	obj->timer_als.function	= als_poll;
	obj->timer_als.data	= (unsigned long)obj;

	obj->timer_ps.expires	= jiffies + atomic_read(&obj->delay_ps)/(1000/HZ);
	obj->timer_ps.function	= ps_poll;
	obj->timer_ps.data	= (unsigned long)obj;

	obj->is_als_first_data_after_enable = false;
	obj->is_als_polling_run = false;
	obj->is_ps_first_data_after_enable = false;
	obj->is_ps_polling_run = false;
	mutex_init(&obj->alsps_op_mutex);
	obj->is_als_batch_enable = false;/* for batch mode init */
	obj->is_ps_batch_enable = false;/* for batch mode init */

	ALSPS_LOG("alsps_context_alloc_object----\n");
	return obj;
}

static int als_real_enable(int enable)
{
	int err = 0;
	struct alsps_context *cxt = NULL;

	cxt = alsps_context_obj;
	if (1 == enable) {
		if (true == cxt->is_als_active_data || true == cxt->is_als_active_nodata) {
			err = cxt->als_ctl.enable_nodata(1);
			if (err)
				err = cxt->als_ctl.enable_nodata(1);
				if (err) {
					err = cxt->als_ctl.enable_nodata(1);
					if (err)
						ALSPS_ERR("alsps enable(%d) err 3 timers = %d\n", enable, err);
				}
			}
			ALSPS_LOG("alsps real enable\n");
	}

	if (0 == enable) {
		if (false == cxt->is_als_active_data && false == cxt->is_als_active_nodata) {
			ALSPS_LOG("AAL status is %d\n", aal_use);
			if (aal_use == 0) {
				err = cxt->als_ctl.enable_nodata(0);
				if (err)
					ALSPS_ERR("alsps enable(%d) err = %d\n", enable, err);

			}
			ALSPS_LOG("alsps real disable\n");
		}
	}

	return err;
}

static int als_enable_data(int enable)
{
	struct alsps_context *cxt = NULL;

	cxt = alsps_context_obj;
	if (NULL  == cxt->als_ctl.open_report_data) {
		ALSPS_ERR("no als control path\n");
		return -1;
	}

	if (1 == enable) {
		ALSPS_LOG("ALSPS enable data\n");
		cxt->is_als_active_data = true;
		cxt->is_als_first_data_after_enable = true;
		cxt->als_ctl.open_report_data(1);
		als_real_enable(enable);
		if (false == cxt->is_als_polling_run && cxt->is_als_batch_enable == false) {
			if (false == cxt->als_ctl.is_report_input_direct) {
				cxt->is_get_valid_als_data_after_enable = false;
				mod_timer(&cxt->timer_als, jiffies + atomic_read(&cxt->delay_als)/(1000/HZ));
				cxt->is_als_polling_run = true;
			}
		}
	}

	if (0 == enable) {
		ALSPS_LOG("ALSPS disable\n");
		cxt->is_als_active_data = false;
		cxt->als_ctl.open_report_data(0);
		if (true == cxt->is_als_polling_run) {
			if (false == cxt->als_ctl.is_report_input_direct) {
				cxt->is_als_polling_run = false;
				smp_mb();/* for memory barrier */
				del_timer_sync(&cxt->timer_als);
				smp_mb();/* for memory barrier */
				cancel_work_sync(&cxt->report_als);
				cxt->drv_data.als_data.values[0] = ALSPS_INVALID_VALUE;
			}
		}
		als_real_enable(enable);
	}
	return 0;
}

static int ps_real_enable(int enable)
{
	int err = 0;
	struct alsps_context *cxt = NULL;

	cxt = alsps_context_obj;
	if (1 == enable) {
		if (true == cxt->is_ps_active_data || true == cxt->is_ps_active_nodata) {
			err = cxt->ps_ctl.enable_nodata(1);
			if (err) {
				err = cxt->ps_ctl.enable_nodata(1);
				if (err) {
					err = cxt->ps_ctl.enable_nodata(1);
					if (err)
						ALSPS_ERR("ps enable(%d) err 3 timers = %d\n", enable, err);
				}
			}
			ALSPS_LOG("ps real enable\n");
		}
	}

	if (0 == enable) {
		if (false == cxt->is_ps_active_data && false == cxt->is_ps_active_nodata) {
			err = cxt->ps_ctl.enable_nodata(0);
			if (err)
				ALSPS_ERR("ps enable(%d) err = %d\n", enable, err);
			ALSPS_LOG("ps real disable\n");
		}
	}

	return err;
}

static int ps_enable_data(int enable)
{
	struct alsps_context *cxt = NULL;

	cxt = alsps_context_obj;
	if (NULL == cxt->ps_ctl.open_report_data) {
		ALSPS_ERR("no ps control path\n");
		return -1;
	}

	if (1 == enable) {
		ALSPS_LOG("PS enable data\n");
		cxt->is_ps_active_data = true;
		cxt->is_ps_first_data_after_enable = true;
		cxt->ps_ctl.open_report_data(1);
		ps_real_enable(enable);
		if (false == cxt->is_ps_polling_run && cxt->is_ps_batch_enable == false) {
			if (false == cxt->ps_ctl.is_report_input_direct) {
				mod_timer(&cxt->timer_ps, jiffies + atomic_read(&cxt->delay_ps)/(1000/HZ));
				cxt->is_ps_polling_run = true;
				cxt->is_get_valid_ps_data_after_enable = false;
			}
		}
	}

	if (0 == enable) {
		ALSPS_LOG("PS disable\n");
		cxt->is_ps_active_data = false;
		cxt->ps_ctl.open_report_data(0);
		if (true == cxt->is_ps_polling_run) {
			if (false == cxt->ps_ctl.is_report_input_direct) {
				cxt->is_ps_polling_run = false;
				smp_mb();/* for memory barrier*/
				del_timer_sync(&cxt->timer_ps);
				smp_mb();/* for memory barrier*/
				cancel_work_sync(&cxt->report_ps);
				cxt->drv_data.ps_data.values[0] = ALSPS_INVALID_VALUE;
			}
		}
		ps_real_enable(enable);
	}
	return 0;
}

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

	ALSPS_LOG("als_store_active buf=%s\n", buf);
	mutex_lock(&alsps_context_obj->alsps_op_mutex);
	cxt = alsps_context_obj;

	if (!strncmp(buf, "1", 1))
		als_enable_data(1);
	else if (!strncmp(buf, "0", 1))
		als_enable_data(0);
	else
		ALSPS_ERR(" alsps_store_active error !!\n");

	mutex_unlock(&alsps_context_obj->alsps_op_mutex);
	ALSPS_LOG(" alsps_store_active done\n");
	return count;
}
/*----------------------------------------------------------------------------*/
static ssize_t als_show_active(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	struct alsps_context *cxt = NULL;
	int div = 0;

	cxt = alsps_context_obj;
	div = cxt->als_data.vender_div;
	ALSPS_LOG("als vender_div value: %d\n", div);
	return snprintf(buf, PAGE_SIZE, "%d\n", div);
}

static ssize_t als_store_delay(struct device *dev, struct device_attribute *attr,
				  const char *buf, size_t count)
{
	int delay;
	int mdelay = 0;
	int ret = 0;
	struct alsps_context *cxt = NULL;

	mutex_lock(&alsps_context_obj->alsps_op_mutex);
	cxt = alsps_context_obj;
	if (NULL == cxt->als_ctl.set_delay) {
		ALSPS_LOG("als_ctl set_delay NULL\n");
		mutex_unlock(&alsps_context_obj->alsps_op_mutex);
		return count;
	}

	ret = kstrtoint(buf, 10, &delay);
	if (0 != ret) {
		ALSPS_ERR("invalid format!!\n");
		mutex_unlock(&alsps_context_obj->alsps_op_mutex);
		return count;
	}

	if (false == cxt->als_ctl.is_report_input_direct) {
		mdelay = (int)delay/1000/1000;
		atomic_set(&alsps_context_obj->delay_als, mdelay);
	}
	cxt->als_ctl.set_delay(delay);
	ALSPS_LOG(" als_delay %d ns\n", delay);
	mutex_unlock(&alsps_context_obj->alsps_op_mutex);
	return count;
}

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

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


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

	ALSPS_LOG("als_store_batch buf=%s\n", buf);
	mutex_lock(&alsps_context_obj->alsps_op_mutex);
	cxt = alsps_context_obj;
	if (cxt->als_ctl.is_support_batch) {
		if (!strncmp(buf, "1", 1)) {
			cxt->is_als_batch_enable = true;
			if (true == cxt->is_als_polling_run) {
				cxt->is_als_polling_run = false;
				del_timer_sync(&cxt->timer_als);
				cancel_work_sync(&cxt->report_als);
				cxt->drv_data.als_data.values[0] = ALSPS_INVALID_VALUE;
				cxt->drv_data.als_data.values[1] = ALSPS_INVALID_VALUE;
				cxt->drv_data.als_data.values[2] = ALSPS_INVALID_VALUE;
			}
		} else if (!strncmp(buf, "0", 1)) {
			cxt->is_als_batch_enable = false;
			if (false == cxt->is_als_polling_run) {
				if (false == cxt->als_ctl.is_report_input_direct) {
					cxt->is_get_valid_als_data_after_enable = false;
					mod_timer(&cxt->timer_als, jiffies + atomic_read(&cxt->delay_als)/(1000/HZ));
					cxt->is_als_polling_run = true;
				}
			}
		} else
			ALSPS_ERR(" als_store_batch error !!\n");
	} else
		ALSPS_LOG(" als_store_batch not supported\n");

	mutex_unlock(&alsps_context_obj->alsps_op_mutex);
	ALSPS_LOG(" als_store_batch done: %d\n", cxt->is_als_batch_enable);
	return count;
}

static ssize_t als_show_batch(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n", 0);
}

static ssize_t als_store_flush(struct device *dev, struct device_attribute *attr,
				  const char *buf, size_t count)
{
	return count;
}

static ssize_t als_show_flush(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n", 0);
}
/* need work around again */
static ssize_t als_show_devnum(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	unsigned int devnum;
	const char *devname = NULL;
	int ret;

	devname = dev_name(&alsps_context_obj->idev->dev);
	ret = sscanf(devname+5, "%d", &devnum);
	return snprintf(buf, PAGE_SIZE, "%d\n", devnum);
}
static ssize_t ps_store_active(struct device *dev, struct device_attribute *attr,
				  const char *buf, size_t count)
{
	struct alsps_context *cxt = NULL;

	ALSPS_LOG("ps_store_active buf=%s\n", buf);
	mutex_lock(&alsps_context_obj->alsps_op_mutex);
	cxt = alsps_context_obj;

	if (!strncmp(buf, "1", 1))
		ps_enable_data(1);
	else if (!strncmp(buf, "0", 1))
		ps_enable_data(0);
	else
		ALSPS_ERR(" ps_store_active error !!\n");

	mutex_unlock(&alsps_context_obj->alsps_op_mutex);
	ALSPS_LOG(" ps_store_active done\n");
	return count;
}
/*----------------------------------------------------------------------------*/
static ssize_t ps_show_active(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	struct alsps_context *cxt = NULL;
	int div = 0;

	cxt = alsps_context_obj;
	div = cxt->ps_data.vender_div;
	ALSPS_LOG("ps vender_div value: %d\n", div);
	return snprintf(buf, PAGE_SIZE, "%d\n", div);
}

static ssize_t ps_store_delay(struct device *dev, struct device_attribute *attr,
				  const char *buf, size_t count)
{
	int delay;
	int mdelay = 0;
	int ret = 0;
	struct alsps_context *cxt = NULL;

	mutex_lock(&alsps_context_obj->alsps_op_mutex);
	cxt = alsps_context_obj;
	if (NULL == cxt->ps_ctl.set_delay) {
		ALSPS_LOG("ps_ctl set_delay NULL\n");
		mutex_unlock(&alsps_context_obj->alsps_op_mutex);
		return count;
	}

	ret = kstrtoint(buf, 10, &delay);
	if (0 != ret) {
		ALSPS_ERR("invalid format!!\n");
		mutex_unlock(&alsps_context_obj->alsps_op_mutex);
		return count;
	}

	if (false == cxt->ps_ctl.is_report_input_direct) {
		mdelay = (int)delay/1000/1000;
		atomic_set(&alsps_context_obj->delay_ps, mdelay);
	}

	cxt->ps_ctl.set_delay(delay);
	ALSPS_LOG(" ps_delay %d ns\n", delay);
	mutex_unlock(&alsps_context_obj->alsps_op_mutex);

	return count;
}

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

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


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

	ALSPS_LOG("ps_store_batch buf=%s\n", buf);
	mutex_lock(&alsps_context_obj->alsps_op_mutex);
	cxt = alsps_context_obj;
	if (cxt->ps_ctl.is_support_batch) {
		if (!strncmp(buf, "1", 1)) {
			cxt->is_ps_batch_enable = true;
			if (true == cxt->is_ps_polling_run) {
				cxt->is_ps_polling_run = false;
				del_timer_sync(&cxt->timer_ps);
				cancel_work_sync(&cxt->report_ps);
				cxt->drv_data.ps_data.values[0] = ALSPS_INVALID_VALUE;
				cxt->drv_data.ps_data.values[1] = ALSPS_INVALID_VALUE;
				cxt->drv_data.ps_data.values[2] = ALSPS_INVALID_VALUE;
			}
		} else if (!strncmp(buf, "0", 1)) {
			cxt->is_ps_batch_enable = false;
			if (false == cxt->is_ps_polling_run) {
				if (false == cxt->ps_ctl.is_report_input_direct) {
					mod_timer(&cxt->timer_ps, jiffies + atomic_read(&cxt->delay_ps)/(1000/HZ));
					cxt->is_ps_polling_run = true;
					cxt->is_get_valid_ps_data_after_enable = false;
				}
			}
		} else
			ALSPS_ERR(" ps_store_batch error !!\n");
	} else
		ALSPS_LOG(" ps_store_batch not supported\n");

	mutex_unlock(&alsps_context_obj->alsps_op_mutex);
	ALSPS_LOG(" ps_store_batch done: %d\n", cxt->is_ps_batch_enable);
	return count;

}

static ssize_t ps_show_batch(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n", 0);
}

static ssize_t ps_store_flush(struct device *dev, struct device_attribute *attr,
				  const char *buf, size_t count)
{
	return count;
}

static ssize_t ps_show_flush(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n", 0);
}
/* need work around again */
static ssize_t ps_show_devnum(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	unsigned int devnum;
	const char *devname = NULL;
	int ret;

	devname = dev_name(&alsps_context_obj->idev->dev);
	ret = sscanf(devname+5, "%d", &devnum);
	return snprintf(buf, PAGE_SIZE, "%d\n", devnum);
}
static int als_ps_remove(struct platform_device *pdev)
{
	ALSPS_LOG("als_ps_remove\n");
	return 0;
}

static int als_ps_probe(struct platform_device *pdev)
{
	ALSPS_LOG("als_ps_probe\n");
	pltfm_dev = pdev;
	return 0;
}

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

static struct platform_driver als_ps_driver = {
	.probe	  = als_ps_probe,
	.remove	 = als_ps_remove,
	.driver = {

		.name  = "als_ps",
	#ifdef CONFIG_OF
		.of_match_table = als_ps_of_match,
		#endif
	}
};

static int alsps_real_driver_init(void)
{
	int i = 0;
	int err = 0;

	ALSPS_LOG(" alsps_real_driver_init +\n");
	for (i = 0; i < MAX_CHOOSE_ALSPS_NUM; i++) {
		ALSPS_LOG("alsps_real_driver_init i=%d\n", i);
		if (0 != alsps_init_list[i]) {
			ALSPS_LOG(" alsps try to init driver %s\n", alsps_init_list[i]->name);
			err = alsps_init_list[i]->init();
			if (0 == err) {
				ALSPS_LOG(" alsps real driver %s probe ok\n", alsps_init_list[i]->name);
				break;
			}
		}
	}

	if (i == MAX_CHOOSE_ALSPS_NUM) {
		ALSPS_LOG(" alsps_real_driver_init fail\n");
		err =  -1;
	}

	return err;
}

int alsps_driver_add(struct alsps_init_info *obj)
{
	int err = 0;
	int i = 0;

	ALSPS_FUN();
	if (!obj) {
		ALSPS_ERR("ALSPS driver add fail, alsps_init_info is NULL\n");
		return -1;
	}

	for (i = 0; i < MAX_CHOOSE_ALSPS_NUM; i++) {
		if ((i == 0) && (NULL == alsps_init_list[0])) {
			ALSPS_LOG("register alsps driver for the first time\n");
			if (platform_driver_register(&als_ps_driver))
				ALSPS_ERR("failed to register alsps driver already exist\n");
		}

		if (NULL == alsps_init_list[i]) {
			obj->platform_diver_addr = &als_ps_driver;
			alsps_init_list[i] = obj;
			break;
		}
	}
	if (i >= MAX_CHOOSE_ALSPS_NUM) {
		ALSPS_ERR("ALSPS driver add err\n");
		err =  -1;
	}

	return err;
}
EXPORT_SYMBOL_GPL(alsps_driver_add);
struct platform_device *get_alsps_platformdev(void)
{
	return pltfm_dev;
}


int ps_report_interrupt_data(int value)
{
	struct alsps_context *cxt = NULL;
	/* int err =0; */
	cxt = alsps_context_obj;

	if (cxt->is_get_valid_ps_data_after_enable == false) {
		if (ALSPS_INVALID_VALUE != value) {
			cxt->is_get_valid_ps_data_after_enable = true;
			smp_mb();/*for memory barriier*/
			del_timer_sync(&cxt->timer_ps);
			smp_mb();/*for memory barriier*/
			cancel_work_sync(&cxt->report_ps);
		}
	}

	if (cxt->is_ps_batch_enable == false)
		ps_data_report(cxt->idev, value, 3);

	return 0;
}
/*----------------------------------------------------------------------------*/
EXPORT_SYMBOL_GPL(ps_report_interrupt_data);

static int alsps_misc_init(struct alsps_context *cxt)
{
	int err = 0;

	cxt->mdev.minor = MISC_DYNAMIC_MINOR;
	cxt->mdev.name  = ALSPS_MISC_DEV_NAME;
	err = misc_register(&cxt->mdev);
	if (err)
		ALSPS_ERR("unable to register alsps misc device!!\n");

	return err;
}


static int alsps_input_init(struct alsps_context *cxt)
{
	struct input_dev *dev;
	int err = 0;

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

	dev->name = ALSPS_INPUTDEV_NAME;
	set_bit(EV_REL, dev->evbit);
	set_bit(EV_SYN, dev->evbit);
	input_set_capability(dev, EV_REL, EVENT_TYPE_PS_VALUE);
	input_set_capability(dev, EV_REL, EVENT_TYPE_PS_STATUS);
	input_set_capability(dev, EV_ABS, EVENT_TYPE_ALS_VALUE);
	input_set_capability(dev, EV_ABS, EVENT_TYPE_ALS_STATUS);
	input_set_abs_params(dev, EVENT_TYPE_ALS_VALUE, ALSPS_VALUE_MIN, ALSPS_VALUE_MAX, 0, 0);
	input_set_abs_params(dev, EVENT_TYPE_ALS_STATUS, ALSPS_STATUS_MIN, ALSPS_STATUS_MAX, 0, 0);
	input_set_drvdata(dev, cxt);

	err = input_register_device(dev);
	if (err < 0) {
		input_free_device(dev);
		return err;
	}
	cxt->idev = dev;

	return 0;
}

DEVICE_ATTR(alsactive,		S_IWUSR | S_IRUGO, als_show_active, als_store_active);
DEVICE_ATTR(alsdelay,		S_IWUSR | S_IRUGO, als_show_delay,  als_store_delay);
DEVICE_ATTR(alsbatch,		S_IWUSR | S_IRUGO, als_show_batch,  als_store_batch);
DEVICE_ATTR(alsflush,		S_IWUSR | S_IRUGO, als_show_flush,  als_store_flush);
DEVICE_ATTR(alsdevnum,		S_IWUSR | S_IRUGO, als_show_devnum,  NULL);
DEVICE_ATTR(psactive,		S_IWUSR | S_IRUGO, ps_show_active, ps_store_active);
DEVICE_ATTR(psdelay,		S_IWUSR | S_IRUGO, ps_show_delay,  ps_store_delay);
DEVICE_ATTR(psbatch,		S_IWUSR | S_IRUGO, ps_show_batch,  ps_store_batch);
DEVICE_ATTR(psflush,		S_IWUSR | S_IRUGO, ps_show_flush,  ps_store_flush);
DEVICE_ATTR(psdevnum,		S_IWUSR | S_IRUGO, ps_show_devnum,  NULL);

static struct attribute *alsps_attributes[] = {
	&dev_attr_alsactive.attr,
	&dev_attr_alsdelay.attr,
	&dev_attr_alsbatch.attr,
	&dev_attr_alsflush.attr,
	&dev_attr_alsdevnum.attr,
	&dev_attr_psactive.attr,
	&dev_attr_psdelay.attr,
	&dev_attr_psbatch.attr,
	&dev_attr_psflush.attr,
	&dev_attr_psdevnum.attr,
	NULL
};

static struct attribute_group alsps_attribute_group = {
	.attrs = alsps_attributes
};

int als_register_data_path(struct als_data_path *data)
{
	struct alsps_context *cxt = NULL;
	/* int err =0; */
	cxt = alsps_context_obj;
	cxt->als_data.get_data = data->get_data;
	cxt->als_data.vender_div = data->vender_div;
	cxt->als_data.als_get_raw_data = data->als_get_raw_data;
	ALSPS_LOG("alsps register data path vender_div: %d\n", cxt->als_data.vender_div);
	if (NULL == cxt->als_data.get_data) {
		ALSPS_LOG("als register data path fail\n");
		return -1;
	}
	return 0;
}

int ps_register_data_path(struct ps_data_path *data)
{
	struct alsps_context *cxt = NULL;
/* int err =0; */
	cxt = alsps_context_obj;
	cxt->ps_data.get_data = data->get_data;
	cxt->ps_data.vender_div = data->vender_div;
	cxt->ps_data.ps_get_raw_data = data->ps_get_raw_data;
	ALSPS_LOG("alsps register data path vender_div: %d\n", cxt->ps_data.vender_div);
	if (NULL == cxt->ps_data.get_data) {
		ALSPS_LOG("ps register data path fail\n");
		return -1;
	}
	return 0;
}

int als_register_control_path(struct als_control_path *ctl)
{
	struct alsps_context *cxt = NULL;
	int err = 0;

	cxt = alsps_context_obj;
	cxt->als_ctl.set_delay = ctl->set_delay;
	cxt->als_ctl.open_report_data = ctl->open_report_data;
	cxt->als_ctl.enable_nodata = ctl->enable_nodata;
	cxt->als_ctl.is_support_batch = ctl->is_support_batch;
	cxt->als_ctl.is_report_input_direct = ctl->is_report_input_direct;
	cxt->als_ctl.is_use_common_factory = ctl->is_use_common_factory;

	if (NULL == cxt->als_ctl.set_delay || NULL == cxt->als_ctl.open_report_data
		|| NULL == cxt->als_ctl.enable_nodata) {
		ALSPS_LOG("als register control path fail\n");
		return -1;
	}

	if (!alsps_misc_dev_init) {
		/* add misc dev for sensor hal control cmd */
		err = alsps_misc_init(alsps_context_obj);
		if (err) {
			ALSPS_ERR("unable to register alsps misc device!!\n");
			return -2;
		}
		err = sysfs_create_group(&alsps_context_obj->mdev.this_device->kobj,
				&alsps_attribute_group);
		if (err < 0) {
			ALSPS_ERR("unable to create alsps attribute file\n");
			return -3;
		}
		kobject_uevent(&alsps_context_obj->mdev.this_device->kobj, KOBJ_ADD);
		alsps_misc_dev_init = true;
	}
	return 0;
}

int ps_register_control_path(struct ps_control_path *ctl)
{
	struct alsps_context *cxt = NULL;
	int err = 0;

	cxt = alsps_context_obj;
	cxt->ps_ctl.set_delay = ctl->set_delay;
	cxt->ps_ctl.open_report_data = ctl->open_report_data;
	cxt->ps_ctl.enable_nodata = ctl->enable_nodata;
	cxt->ps_ctl.is_support_batch = ctl->is_support_batch;
	cxt->ps_ctl.is_report_input_direct = ctl->is_report_input_direct;
	cxt->ps_ctl.ps_calibration = ctl->ps_calibration;
	cxt->ps_ctl.ps_threshold_setting = ctl->ps_threshold_setting;
	cxt->ps_ctl.is_use_common_factory = ctl->is_use_common_factory;
	cxt->ps_ctl.is_polling_mode = ctl->is_polling_mode;

	if (NULL == cxt->ps_ctl.set_delay || NULL == cxt->ps_ctl.open_report_data
		|| NULL == cxt->ps_ctl.enable_nodata) {
		ALSPS_LOG("ps register control path fail\n");
		return -1;
	}

	if (!alsps_misc_dev_init) {
		/* add misc dev for sensor hal control cmd */
		err = alsps_misc_init(alsps_context_obj);
		if (err) {
			ALSPS_ERR("unable to register alsps misc device!!\n");
			return -2;
		}
		err = sysfs_create_group(&alsps_context_obj->mdev.this_device->kobj,
				&alsps_attribute_group);
		if (err < 0) {
			ALSPS_ERR("unable to create alsps attribute file\n");
			return -3;
		}
		kobject_uevent(&alsps_context_obj->mdev.this_device->kobj, KOBJ_ADD);
		alsps_misc_dev_init = true;
	}
	return 0;
}


/* AAL functions**************************************** */
int alsps_aal_enable(int enable)
{
	int ret = 0;
	struct alsps_context *cxt = NULL;

	if (!alsps_context_obj) {
		ALSPS_ERR("null pointer of alsps_context_obj!!\n");
		return -1;
	}

	if (alsps_context_obj->als_ctl.enable_nodata == NULL) {
		ALSPS_ERR("alsps context obj not exsit in alsps_aal_enable\n");
		return -1;
	}
	cxt = alsps_context_obj;

	if (enable == 1) {
		if (alsps_context_obj->is_als_active_data == false)
			ret = cxt->als_ctl.enable_nodata(enable);
	} else if (enable == 0) {
		if (alsps_context_obj->is_als_active_data == false)
			ret = cxt->als_ctl.enable_nodata(enable);
	}

	return ret;
}

int alsps_aal_get_status(void)
{
	return 0;
}

int alsps_aal_get_data(void)
{
	int ret = 0;
	struct alsps_context *cxt = NULL;
	int value = 0;
	int status = 0;

	if (!alsps_context_obj) {
		ALSPS_ERR("alsps_context_obj null pointer!!\n");
		return -1;
	}

	if (alsps_context_obj->als_data.get_data == NULL) {
		ALSPS_ERR("aal:get_data not exsit\n");
		return -1;
	}

	cxt = alsps_context_obj;
	ret = cxt->als_data.get_data(&value, &status);
	if (ret < 0)
		return -1;

	return value;
}
/* *************************************************** */

static int alsps_probe(void)
{
	int err;

	ALSPS_LOG("+++++++++++++alsps_probe!!\n");
	alsps_context_obj = alsps_context_alloc_object();
	if (!alsps_context_obj) {
		err = -ENOMEM;
		ALSPS_ERR("unable to allocate devobj!\n");
		goto exit_alloc_data_failed;
	}
	/* init real alspseleration driver */
	err = alsps_real_driver_init();
	if (err) {
		ALSPS_ERR("alsps real driver init fail\n");
		goto real_driver_init_fail;
	}
	/* init alsps common factory mode misc device */
	err = alsps_factory_device_init();
	if (err)
		ALSPS_ERR("alsps factory device already registed\n");
	/* init input dev */
	err = alsps_input_init(alsps_context_obj);
	if (err) {
		ALSPS_ERR("unable to register alsps input device!\n");
		goto exit_alloc_input_dev_failed;
	}
	ALSPS_LOG("----alsps_probe OK !!\n");
	return 0;

real_driver_init_fail:
exit_alloc_input_dev_failed:
	kfree(alsps_context_obj);
	alsps_context_obj = NULL;
exit_alloc_data_failed:
	ALSPS_ERR("----alsps_probe fail !!!\n");
	return err;
}

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

	ALSPS_FUN(f);
	input_unregister_device(alsps_context_obj->idev);
	sysfs_remove_group(&alsps_context_obj->idev->dev.kobj,
				&alsps_attribute_group);

	err = misc_deregister(&alsps_context_obj->mdev);
	if (err)
		ALSPS_ERR("misc_deregister fail: %d\n", err);
	kfree(alsps_context_obj);

	return 0;
}

static int __init alsps_init(void)
{
	ALSPS_FUN();

	if (alsps_probe()) {
		ALSPS_ERR("failed to register alsps driver\n");
		return -ENODEV;
	}

	return 0;
}

static void __exit alsps_exit(void)
{
	alsps_remove();
	platform_driver_unregister(&als_ps_driver);

}
late_initcall(alsps_init);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("ALSPS device driver");
MODULE_AUTHOR("Mediatek");