static int gp2a_opt_probe(struct platform_device *pdev)
{
struct gp2a_data *gp2a;
struct gp2a_platform_data *pdata = pdev->dev.platform_data;
u8 value = 0;
int err = 0;
printk(KERN_INFO"[GP2A] %s : probe start!\n", __func__);
if (!pdata) {
pr_err("%s: missing pdata!\n", __func__);
return err;
}
/*PROXY_EN*/
if (gpio_request(pdata ->power_gpio, "PROXY_EN")) {
printk(KERN_ERR "Request GPIO_%d failed!\n", pdata ->power_gpio);
}
if (pdata->gp2a_led_on)
pdata->gp2a_led_on(1);
if (pdata->gp2a_get_threshold) {
gp2a_update_threshold(pdata->gp2a_get_threshold(), false);
}
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL);
if (!gp2a) {
pr_err("kzalloc error\n");
return -ENOMEM;
}
gp2a->proximity_enabled = 0;
gp2a->pdata = pdata;
gp2a->light_enabled = 0;
gp2a->light_delay = SENSOR_DEFAULT_DELAY;
gp2a->testmode = 0;
gp2a->light_level_state = 0;
if (pdata->power_on) {
pdata->power_on(1);
msleep(5);
}
INIT_DELAYED_WORK(&gp2a->light_work, gp2a_work_func_light);
INIT_WORK(&gp2a->proximity_work, gp2a_work_func_prox);
/*misc device registration*/
err = misc_register(&gp2a_opt_misc_device);
if( err < 0 )
goto error_setup_reg_misc;
err = proximity_input_init(gp2a);
if (err < 0)
goto error_setup_reg_prox;
err = light_input_init(gp2a);
if (err < 0)
goto error_setup_reg_light;
err = sysfs_create_group(&gp2a->proximity_input_dev->dev.kobj,
&proximity_attribute_group);
if (err < 0)
goto err_sysfs_create_group_proximity;
err = sysfs_create_group(&gp2a->light_input_dev->dev.kobj,
&lightsensor_attribute_group);
if (err)
goto err_sysfs_create_group_light;
mutex_init(&gp2a->light_mutex);
mutex_init(&gp2a->data_mutex);
/* set platdata */
platform_set_drvdata(pdev, gp2a);
/* wake lock init */
wake_lock_init(&gp2a->prx_wake_lock, WAKE_LOCK_SUSPEND,
"prx_wake_lock");
/* init i2c */
err = opt_i2c_init();
if(err < 0)
{
pr_err("opt_probe failed : i2c_client is NULL\n");
goto err_no_device;
}
else
printk(KERN_INFO "[GP2A] opt_i2c_client : (0x%p)\n",opt_i2c_client);
/* GP2A Regs INIT SETTINGS and Check I2C communication */
value = 0x00;
err = opt_i2c_write((u8) (COMMAND1), &value); /* shutdown mode op[3]=0 */
if (err < 0) {
pr_err("%s failed : threre is no such device.\n", __func__);
goto err_no_device;
}
/* Setup irq */
err = gp2a_setup_irq(gp2a);
if (err) {
pr_err("%s: could not setup irq\n", __func__);
goto err_setup_irq;
}
/* set sysfs for proximity sensor */
gp2a->proximity_dev = device_create(sensors_class,
NULL, 0, NULL, "proximity_sensor");
if (IS_ERR(gp2a->proximity_dev)) {
pr_err("%s: could not create proximity_dev\n", __func__);
goto err_proximity_device_create;
}
gp2a->light_dev = device_create(sensors_class,
NULL, 0, NULL, "light_sensor");
if (IS_ERR(gp2a->light_dev)) {
pr_err("%s: could not create light_dev\n", __func__);
goto err_light_device_create;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_state) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_state.attr.name);
goto err_proximity_device_create_file1;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_prox_avg) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_avg.attr.name);
goto err_proximity_device_create_file2;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_proximity_enable) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_proximity_enable.attr.name);
goto err_proximity_device_create_file3;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_vendor) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_vendor.attr.name);
goto err_proximity_device_create_file4;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_name) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_name.attr.name);
goto err_proximity_device_create_file5;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_prox_cal) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_cal.attr.name);
goto err_proximity_device_create_file6;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_prox_offset_pass) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_offset_pass.attr.name);
goto err_proximity_device_create_file7;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_prox_thresh) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_thresh.attr.name);
goto err_proximity_device_create_file8;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_lux) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_lux.attr.name);
goto err_light_device_create_file1;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_light_enable) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_light_enable.attr.name);
goto err_light_device_create_file2;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_vendor) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_vendor.attr.name);
goto err_light_device_create_file3;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_name) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_name.attr.name);
goto err_light_device_create_file4;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_raw_data) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_raw_data.attr.name);
goto err_light_device_create_file5;
}
dev_set_drvdata(gp2a->proximity_dev, gp2a);
dev_set_drvdata(gp2a->light_dev, gp2a);
device_init_wakeup(&pdev->dev, 1);
if (pdata->gp2a_led_on) {
pdata->gp2a_led_on(0);
printk(KERN_INFO "[GP2A] gpio_get_value of GPIO(%d) is %d\n",pdata ->power_gpio,
gpio_get_value(pdata ->power_gpio));
}
/* set initial proximity value as 1 */
input_report_abs(gp2a->proximity_input_dev, ABS_DISTANCE, 1);
input_sync(gp2a->proximity_input_dev);
gp2a_opt_data = gp2a;
printk(KERN_INFO"[GP2A] %s : probe success!\n", __func__);
return 0;
err_light_device_create_file5:
device_remove_file(gp2a->light_dev, &dev_attr_name);
err_light_device_create_file4:
device_remove_file(gp2a->light_dev, &dev_attr_vendor);
err_light_device_create_file3:
device_remove_file(gp2a->light_dev, &dev_attr_light_enable);
err_light_device_create_file2:
device_remove_file(gp2a->light_dev, &dev_attr_lux);
err_light_device_create_file1:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_thresh);
err_proximity_device_create_file8:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_offset_pass);
err_proximity_device_create_file7:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_cal);
err_proximity_device_create_file6:
device_remove_file(gp2a->proximity_dev, &dev_attr_name);
err_proximity_device_create_file5:
device_remove_file(gp2a->proximity_dev, &dev_attr_vendor);
err_proximity_device_create_file4:
device_remove_file(gp2a->proximity_dev, &dev_attr_proximity_enable);
err_proximity_device_create_file3:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_avg);
err_proximity_device_create_file2:
device_remove_file(gp2a->proximity_dev, &dev_attr_state);
err_proximity_device_create_file1:
err_light_device_create:
device_destroy(sensors_class, 0);
err_proximity_device_create:
gpio_free(pdata->p_out);
err_setup_irq:
err_no_device:
wake_lock_destroy(&gp2a->prx_wake_lock);
mutex_destroy(&gp2a->light_mutex);
mutex_destroy(&gp2a->data_mutex);
sysfs_remove_group(&gp2a->light_input_dev->dev.kobj,
&lightsensor_attribute_group);
err_sysfs_create_group_light:
sysfs_remove_group(&gp2a->proximity_input_dev->dev.kobj,
&proximity_attribute_group);
err_sysfs_create_group_proximity:
input_unregister_device(gp2a->light_input_dev);
error_setup_reg_light:
input_unregister_device(gp2a->proximity_input_dev);
error_setup_reg_prox:
misc_deregister(&gp2a_opt_misc_device);
error_setup_reg_misc:
if (pdata->power_on)
pdata->power_on(0);
kfree(gp2a);
return err;
}
static int gp2a_opt_probe(struct platform_device *pdev)
{
struct gp2a_data *gp2a;
struct gp2a_platform_data *pdata = pdev->dev.platform_data;
u8 value = 0;
int err = 0;
gprintk("probe start!\n");
if (!pdata) {
pr_err("%s: missing pdata!\n", __func__);
return err;
}
if (!pdata->gp2a_led_on) {
pr_err("%s: incomplete pdata!\n", __func__);
return err;
}
/* gp2a power on */
pdata->gp2a_led_on(true);
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL);
if (!gp2a) {
pr_err("kzalloc error\n");
return -ENOMEM;
}
#ifdef CONFIG_SLP
gp2a->thresh_diff = DEFAULT_THRESHOLD_DIFF;
#endif
if (pdata->gp2a_get_threshold)
gp2a_update_threshold(gp2a, is_gp2a030a() ?
gp2a_original_image_030a : gp2a_original_image,
pdata->gp2a_get_threshold(&gp2a->thresh_diff), false);
else
gp2a->thresh_diff = DEFAULT_THRESHOLD_DIFF;
#ifdef GP2A_CALIBRATION
gp2a->default_threshold = (is_gp2a030a() ?
gp2a_original_image_030a[3][1] :
gp2a_original_image[3][1]);
#endif
proximity_enable = 0;
proximity_sensor_detection = 0;
proximity_avg_on = 0;
gp2a->enabled = 0;
gp2a->pdata = pdata;
/* prox_timer settings. we poll for prox_avg values using a timer. */
hrtimer_init(&gp2a->prox_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
gp2a->prox_poll_delay = ns_to_ktime(2000 * NSEC_PER_MSEC);
gp2a->prox_timer.function = gp2a_prox_timer_func;
gp2a->prox_wq = create_singlethread_workqueue("gp2a_prox_wq");
if (!gp2a->prox_wq) {
err = -ENOMEM;
pr_err("%s: could not create prox workqueue\n", __func__);
goto err_create_prox_workqueue;
}
INIT_WORK(&gp2a->work_prox, gp2a_work_func_prox_avg);
INIT_WORK(&gp2a->work, gp2a_work_func_prox);
err = proximity_input_init(gp2a);
if (err < 0)
goto error_setup_reg;
err = sysfs_create_group(&gp2a->input_dev->dev.kobj,
&proximity_attribute_group);
if (err < 0)
goto err_sysfs_create_group_proximity;
/* set platdata */
platform_set_drvdata(pdev, gp2a);
mutex_init(&gp2a->data_mutex);
/* wake lock init */
wake_lock_init(&gp2a->prx_wake_lock, WAKE_LOCK_SUSPEND,
"prx_wake_lock");
/* init i2c */
opt_i2c_init();
if (opt_i2c_client == NULL) {
pr_err("opt_probe failed : i2c_client is NULL\n");
goto err_no_device;
} else
pr_info("opt_i2c_client : (0x%p), address = %x\n",
opt_i2c_client, opt_i2c_client->addr);
/* GP2A Regs INIT SETTINGS and Check I2C communication */
value = 0x00;
/* shutdown mode op[3]=0 */
err = opt_i2c_write((u8) (COMMAND1), &value);
if (err < 0) {
pr_err("%s failed : threre is no such device.\n", __func__);
goto err_no_device;
}
/* Setup irq */
err = gp2a_setup_irq(gp2a);
if (err) {
pr_err("%s: could not setup irq\n", __func__);
goto err_setup_irq;
}
/* set sysfs for proximity sensor */
gp2a->proximity_dev = sensors_classdev_register("proximity_sensor");
if (IS_ERR(gp2a->proximity_dev)) {
pr_err("%s: could not create proximity_dev\n", __func__);
goto err_proximity_device_create;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_state) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_state.attr.name);
goto err_proximity_device_create_file1;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_prox_avg) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_avg.attr.name);
goto err_proximity_device_create_file2;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_prox_thresh) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_thresh.attr.name);
goto err_proximity_device_create_file3;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_vendor) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_vendor.attr.name);
goto err_proximity_device_create_file4;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_name) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_name.attr.name);
goto err_proximity_device_create_file5;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_raw_data) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_raw_data.attr.name);
goto err_proximity_device_create_file6;
}
#ifdef GP2A_CALIBRATION
if (device_create_file(gp2a->proximity_dev, &dev_attr_prox_cal) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_cal.attr.name);
goto err_proximity_device_create_file7;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_prox_diff) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_diff.attr.name);
goto err_proximity_device_create_file8;
}
#endif
#ifdef CONFIG_SLP
device_init_wakeup(gp2a->proximity_dev, true);
#endif
dev_set_drvdata(gp2a->proximity_dev, gp2a);
device_init_wakeup(&pdev->dev, 1);
gprintk("probe success!\n");
return 0;
#ifdef GP2A_CALIBRATION
err_proximity_device_create_file8:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_cal);
err_proximity_device_create_file7:
device_remove_file(gp2a->proximity_dev, &dev_attr_raw_data);
#endif
err_proximity_device_create_file6:
device_remove_file(gp2a->proximity_dev, &dev_attr_name);
err_proximity_device_create_file5:
device_remove_file(gp2a->proximity_dev, &dev_attr_vendor);
err_proximity_device_create_file4:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_thresh);
err_proximity_device_create_file3:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_avg);
err_proximity_device_create_file2:
device_remove_file(gp2a->proximity_dev, &dev_attr_state);
err_proximity_device_create_file1:
sensors_classdev_unregister(gp2a->proximity_dev);
err_proximity_device_create:
gpio_free(pdata->p_out);
err_setup_irq:
err_no_device:
sysfs_remove_group(&gp2a->input_dev->dev.kobj,
&proximity_attribute_group);
wake_lock_destroy(&gp2a->prx_wake_lock);
mutex_destroy(&gp2a->data_mutex);
err_sysfs_create_group_proximity:
input_unregister_device(gp2a->input_dev);
error_setup_reg:
destroy_workqueue(gp2a->prox_wq);
err_create_prox_workqueue:
kfree(gp2a);
return err;
}
static int gp2a_opt_probe( struct platform_device* pdev )
{
struct gp2a_data *gp2a;
u8 value;
int err = 0;
opt_power_init();
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data),GFP_KERNEL);
if(!gp2a)
{
pr_err("kzalloc error\n");
return -ENOMEM;
}
gp2a->enabled = 0;
gp2a->delay = SENSOR_DEFAULT_DELAY;
prox_data = gp2a;
mutex_init(&gp2a->enable_mutex);
mutex_init(&gp2a->data_mutex);
INIT_WORK(&gp2a->work, gp2a_work_func_prox);
err = proximity_input_init(gp2a);
if(err < 0) {
goto error_1;
}
err = sysfs_create_group(&gp2a->input_dev->dev.kobj,
&proximity_attribute_group);
if(err < 0)
{
goto error_2;
}
/* set platdata */
platform_set_drvdata(pdev, gp2a);
gp2a->uevent_kobj = &pdev->dev.kobj;
/* wake lock init */
wake_lock_init(&prx_wake_lock, WAKE_LOCK_SUSPEND, "prx_wake_lock");
/* init i2c */
opt_i2c_init();
if(opt_i2c_client == NULL)
{
pr_err("opt_probe failed : i2c_client is NULL\n");
return -ENODEV;
}
else
printk("opt_i2c_client : (0x%p)\n",opt_i2c_client);
/* GP2A Regs INIT SETTINGS */
#ifdef PROX_MODE_A
value = 0x00;
#else
value = 0x02;
#endif //PROX_MODE_A
opt_i2c_write((u8)(REGS_OPMOD),&value);
printk("gp2a_opt_probe is OK!!\n");
/* INT Settings */
err = request_threaded_irq( IRQ_GP2A_INT ,
NULL, gp2a_irq_handler, IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING , "proximity_int", gp2a);
if (err < 0) {
printk(KERN_ERR "failed to request proximity_irq\n");
goto error_2;
}
disable_irq(IRQ_GP2A_INT);
return 0;
error_2:
input_unregister_device(gp2a->input_dev);
input_free_device(gp2a->input_dev);
error_1:
kfree(gp2a);
return err;
}
static int gp2a_opt_probe(struct platform_device *pdev)
{
struct gp2a_data *gp2a;
u8 value;
int err = 0;
int wakeup = 0;
struct opt_gp2a_platform_data *pdata = pdev->dev.platform_data;
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL);
if (!gp2a) {
pr_err("kzalloc error\n");
return -ENOMEM;
}
gp2a->enabled = 0;
gp2a->delay = SENSOR_DEFAULT_DELAY;
if (pdata) {
if (pdata->power_on)
gp2a->power_on = pdata->power_on;
if (pdata->gp2a_led_on)
gp2a->gp2a_led_on = pdata->gp2a_led_on;
if (pdata->irq)
gp2a->irq = pdata->irq;
if (pdata->ps_status)
gp2a->ps_status = pdata->ps_status;
}
if (gp2a->power_on)
gp2a->power_on(1);
mutex_init(&gp2a->enable_mutex);
mutex_init(&gp2a->data_mutex);
wakeup = 1;
err = proximity_input_init(gp2a);
if (err < 0)
goto error_setup_reg;
err = sysfs_create_group(&gp2a->input_dev->dev.kobj,
&proximity_attribute_group);
if (err < 0)
goto err_sysfs_create_group_proximity;
/* set platdata */
platform_set_drvdata(pdev, gp2a);
gp2a->uevent_kobj = &pdev->dev.kobj;
spin_lock_init(&gp2a->prox_lock);
/* init i2c */
opt_i2c_init();
if (opt_i2c_client == NULL) {
pr_err("opt_probe failed : i2c_client is NULL\n");
return -ENODEV;
} else
printk(KERN_ERR "opt_i2c_client : (0x%p)\n", opt_i2c_client);
/* GP2A Regs INIT SETTINGS */
#ifdef PROX_MODE_A
value = 0x00;
#else
value = 0x02;
#endif
opt_i2c_write((u8)(REGS_OPMOD), &value);
/* INT Settings */
err = request_threaded_irq(gp2a->irq,
NULL, gp2a_irq_handler,
IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
"proximity_int", gp2a);
if (err < 0) {
printk(KERN_ERR "failed to request proximity_irq\n");
goto error_setup_reg;
}
disable_irq(gp2a->irq);
/* set sysfs for proximity sensor */
err = sensors_register(proximity_sensor_device, gp2a,
prox_sensor_attrs, "proximity_sensor");
if (err) {
printk(KERN_ERR "%s: cound not register barometer_sensor(%d).\n",
__func__, err);
goto err_sysfs_create_group_proximity;
}
device_init_wakeup(&pdev->dev, wakeup);
return 0;
dev_set_drvdata(gp2a->proximity_dev, gp2a);
err_sysfs_create_group_proximity:
input_unregister_device(gp2a->input_dev);
input_free_device(gp2a->input_dev);
error_setup_reg:
if (gp2a->power_on)
gp2a->power_on(0);
kfree(gp2a);
return err;
}
static int gp2a_opt_probe(struct platform_device *pdev)
{
struct gp2a_data *gp2a;
struct gp2a_platform_data *pdata = pdev->dev.platform_data;
u8 value = 0;
int err = 0;
pr_info("%s : probe start!\n", __func__);
if (!pdata) {
pr_err("%s: missing pdata!\n", __func__);
return err;
}
if (!pdata->gp2a_led_on) {
pr_err("%s: incomplete pdata!\n", __func__);
return err;
}
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL);
if (!gp2a) {
pr_err("kzalloc error\n");
return -ENOMEM;
}
gp2a->proximity_enabled = 0;
gp2a->pdata = pdata;
gp2a->light_enabled = 0;
gp2a->light_delay = SENSOR_DEFAULT_DELAY;
gp2a->testmode = 0;
gp2a->light_level_state = 0;
if (pdata->power_on)
pdata->power_on(1);
if (pdata->version) { /* GP2AP030 */
gp2a_original_image[1][1] = 0x1A;
gp2a_original_image[3][1] = 0x08;
gp2a_original_image[5][1] = 0x0A;
}
INIT_DELAYED_WORK(&gp2a->light_work, gp2a_work_func_light);
INIT_WORK(&gp2a->proximity_work, gp2a_work_func_prox);
err = proximity_input_init(gp2a);
if (err < 0)
goto error_setup_reg_prox;
err = light_input_init(gp2a);
if (err < 0)
goto error_setup_reg_light;
err = sysfs_create_group(&gp2a->proximity_input_dev->dev.kobj,
&proximity_attribute_group);
if (err < 0)
goto err_sysfs_create_group_proximity;
err = sysfs_create_group(&gp2a->light_input_dev->dev.kobj,
&lightsensor_attribute_group);
if (err)
goto err_sysfs_create_group_light;
mutex_init(&gp2a->light_mutex);
mutex_init(&gp2a->data_mutex);
/* set platdata */
platform_set_drvdata(pdev, gp2a);
/* wake lock init */
wake_lock_init(&gp2a->prx_wake_lock, WAKE_LOCK_SUSPEND,
"prx_wake_lock");
/* init i2c */
opt_i2c_init();
/* GP2A Regs INIT SETTINGS and Check I2C communication */
value = 0x00;
err = opt_i2c_write((u8) (COMMAND1), &value, pdata->addr,
pdata->adapt_num); /* shutdown mode op[3]=0 */
if (err < 0) {
pr_err("%s failed : threre is no such device.\n", __func__);
goto err_no_device;
}
/* Setup irq */
err = gp2a_setup_irq(gp2a);
if (err) {
pr_err("%s: could not setup irq\n", __func__);
goto err_setup_irq;
}
/* set sysfs for proximity sensor */
gp2a->proximity_dev = device_create(sensors_class,
NULL, 0, NULL, "proximity_sensor");
if (IS_ERR(gp2a->proximity_dev)) {
pr_err("%s: could not create proximity_dev\n", __func__);
goto err_proximity_device_create;
}
gp2a->light_dev = device_create(sensors_class,
NULL, 0, NULL, "light_sensor");
if (IS_ERR(gp2a->light_dev)) {
pr_err("%s: could not create light_dev\n", __func__);
goto err_light_device_create;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_state) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_state.attr.name);
goto err_proximity_device_create_file1;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_prox_avg) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_avg.attr.name);
goto err_proximity_device_create_file2;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_proximity_enable) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_proximity_enable.attr.name);
goto err_proximity_device_create_file3;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_vendor) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_vendor.attr.name);
goto err_proximity_device_create_file4;
}
if (device_create_file(gp2a->proximity_dev,
&dev_attr_name) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_name.attr.name);
goto err_proximity_device_create_file5;
}
if (device_create_file(gp2a->light_dev, &dev_attr_lux) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_lux.attr.name);
goto err_light_device_create_file1;
}
if (device_create_file(gp2a->light_dev, &dev_attr_light_enable) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_light_enable.attr.name);
goto err_light_device_create_file2;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_vendor) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_vendor.attr.name);
goto err_light_device_create_file3;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_name) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_name.attr.name);
goto err_light_device_create_file4;
}
if (device_create_file(gp2a->light_dev,
&dev_attr_raw_data) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_name.attr.name);
goto err_light_device_create_file5;
}
dev_set_drvdata(gp2a->proximity_dev, gp2a);
dev_set_drvdata(gp2a->light_dev, gp2a);
device_init_wakeup(&pdev->dev, 1);
pr_info("%s : probe success!\n", __func__);
return 0;
err_light_device_create_file5:
device_remove_file(gp2a->light_dev, &dev_attr_name);
err_light_device_create_file4:
device_remove_file(gp2a->light_dev, &dev_attr_vendor);
err_light_device_create_file3:
device_remove_file(gp2a->light_dev, &dev_attr_light_enable);
err_light_device_create_file2:
device_remove_file(gp2a->light_dev, &dev_attr_lux);
err_light_device_create_file1:
device_remove_file(gp2a->proximity_dev, &dev_attr_name);
err_proximity_device_create_file5:
device_remove_file(gp2a->proximity_dev, &dev_attr_vendor);
err_proximity_device_create_file4:
device_remove_file(gp2a->proximity_dev, &dev_attr_proximity_enable);
err_proximity_device_create_file3:
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_avg);
err_proximity_device_create_file2:
device_remove_file(gp2a->proximity_dev, &dev_attr_state);
err_proximity_device_create_file1:
err_light_device_create:
device_destroy(sensors_class, 0);
err_proximity_device_create:
gpio_free(pdata->p_out);
err_setup_irq:
err_no_device:
wake_lock_destroy(&gp2a->prx_wake_lock);
mutex_destroy(&gp2a->light_mutex);
mutex_destroy(&gp2a->data_mutex);
sysfs_remove_group(&gp2a->light_input_dev->dev.kobj,
&lightsensor_attribute_group);
err_sysfs_create_group_light:
sysfs_remove_group(&gp2a->proximity_input_dev->dev.kobj,
&proximity_attribute_group);
err_sysfs_create_group_proximity:
input_unregister_device(gp2a->light_input_dev);
error_setup_reg_light:
input_unregister_device(gp2a->proximity_input_dev);
error_setup_reg_prox:
if (pdata->power_on)
pdata->power_on(0);
kfree(gp2a);
return err;
}
static int gp2a_opt_probe(struct platform_device *pdev)
{
struct gp2a_data *gp2a;
struct gp2a_platform_data *pdata = pdev->dev.platform_data;
u8 value = 0;
int err = 0;
gprintk("probe start!\n");
if (!pdata) {
pr_err("%s: missing pdata!\n", __func__);
return err;
}
if (!pdata->gp2a_led_on) {
pr_err("%s: incomplete pdata!\n", __func__);
return err;
}
/* gp2a power on */
pdata->gp2a_led_on(true);
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL);
if (!gp2a) {
pr_err("kzalloc error\n");
return -ENOMEM;
}
proximity_enable = 0;
proximity_sensor_detection = 0;
proximity_avg_on = 0;
gp2a->enabled = 0;
gp2a->pdata = pdata;
/* prox_timer settings. we poll for prox_avg values using a timer. */
hrtimer_init(&gp2a->prox_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
gp2a->prox_poll_delay = ns_to_ktime(2000 * NSEC_PER_MSEC);
gp2a->prox_timer.function = gp2a_prox_timer_func;
gp2a->prox_wq = create_singlethread_workqueue("gp2a_prox_wq");
if (!gp2a->prox_wq) {
err = -ENOMEM;
pr_err("%s: could not create prox workqueue\n", __func__);
goto err_create_prox_workqueue;
}
INIT_WORK(&gp2a->work_prox, gp2a_work_func_prox_avg);
INIT_WORK(&gp2a->work, gp2a_work_func_prox);
err = proximity_input_init(gp2a);
if (err < 0)
goto error_setup_reg;
err = sysfs_create_group(&gp2a->input_dev->dev.kobj,
&proximity_attribute_group);
if (err < 0)
goto err_sysfs_create_group_proximity;
/* set platdata */
platform_set_drvdata(pdev, gp2a);
/* wake lock init */
wake_lock_init(&gp2a->prx_wake_lock, WAKE_LOCK_SUSPEND,
"prx_wake_lock");
/* init i2c */
opt_i2c_init();
if (opt_i2c_client == NULL) {
pr_err("opt_probe failed : i2c_client is NULL\n");
return -ENODEV;
} else
printk(KERN_INFO "opt_i2c_client : (0x%p), address = %x\n",
opt_i2c_client, opt_i2c_client->addr);
/* GP2A Regs INIT SETTINGS and Check I2C communication */
value = 0x00;
/* shutdown mode op[3]=0 */
err = opt_i2c_write((u8) (COMMAND1), &value);
if (err < 0) {
pr_err("%s failed : threre is no such device.\n", __func__);
goto err_no_device;
}
/* Setup irq */
err = gp2a_setup_irq(gp2a);
if (err) {
pr_err("%s: could not setup irq\n", __func__);
goto err_setup_irq;
}
/* set sysfs for proximity sensor */
gp2a->proximity_dev = sensors_classdev_register("proximity_sensor");
if (IS_ERR(gp2a->proximity_dev)) {
pr_err("%s: could not create proximity_dev\n", __func__);
goto err_proximity_device_create;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_state) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_state.attr.name);
goto err_proximity_device_create_file1;
}
if (device_create_file(gp2a->proximity_dev, &dev_attr_prox_avg) < 0) {
pr_err("%s: could not create device file(%s)!\n", __func__,
dev_attr_prox_avg.attr.name);
goto err_proximity_device_create_file2;
}
dev_set_drvdata(gp2a->proximity_dev, gp2a);
device_init_wakeup(&pdev->dev, 1);
gprintk("probe success!\n");
return 0;
err_proximity_device_create_file2:
device_remove_file(gp2a->proximity_dev, &dev_attr_state);
err_proximity_device_create_file1:
sensors_classdev_unregister(gp2a->proximity_dev);
err_proximity_device_create:
gpio_free(pdata->p_out);
err_setup_irq:
err_no_device:
sysfs_remove_group(&gp2a->input_dev->dev.kobj,
&proximity_attribute_group);
wake_lock_destroy(&gp2a->prx_wake_lock);
err_sysfs_create_group_proximity:
input_unregister_device(gp2a->input_dev);
error_setup_reg:
destroy_workqueue(gp2a->prox_wq);
err_create_prox_workqueue:
kfree(gp2a);
return err;
}
static int gp2a_opt_probe( struct platform_device* pdev )
{
struct gp2a_data *gp2a;
int irq;
int i;
int ret;
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data),GFP_KERNEL);
if(!gp2a)
{
pr_err("kzalloc error\n");
return -ENOMEM;
}
gprintk("in %s \n",__func__);
/* init i2c */
opt_i2c_init();
if(opt_i2c_client == NULL)
{
pr_err("opt_probe failed : i2c_client is NULL\n");
return -ENODEV;
}
/* hrtimer Settings */
hrtimer_init(&gp2a->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
gp2a->timer.function = gp2a_timer_func;
/* Input device Settings */
if(USE_INPUT_DEVICE)
{
gp2a->input_dev = input_allocate_device();
if (gp2a->input_dev == NULL)
{
pr_err("Failed to allocate input device\n");
return -ENOMEM;
}
gp2a->input_dev->name = "proximity";
set_bit(EV_SYN,gp2a->input_dev->evbit);
set_bit(EV_ABS,gp2a->input_dev->evbit);
input_set_abs_params(gp2a->input_dev, ABS_DISTANCE, 0, 1, 0, 0);
ret = input_register_device(gp2a->input_dev);
if (ret)
{
pr_err("Unable to register %s input device\n", gp2a->input_dev->name);
input_free_device(gp2a->input_dev);
kfree(gp2a);
return -1;
}
}
/* WORK QUEUE Settings */
gp2a_wq = create_singlethread_workqueue("gp2a_wq");
if (!gp2a_wq)
return -ENOMEM;
INIT_WORK(&gp2a->work_prox, gp2a_work_func_prox);
INIT_WORK(&gp2a->work_light, gp2a_work_func_light);
gprintk("Workqueue Settings complete\n");
/* misc device Settings */
ret = misc_register(&proximity_device);
if(ret) {
pr_err(KERN_ERR "misc_register failed \n");
}
/* wake lock init */
wake_lock_init(&prx_wake_lock, WAKE_LOCK_SUSPEND, "prx_wake_lock");
/* set platdata */
platform_set_drvdata(pdev, gp2a);
/* set sysfs for light sensor */
lightsensor_class = class_create(THIS_MODULE, "lightsensor");
if (IS_ERR(lightsensor_class))
pr_err("Failed to create class(lightsensor)!\n");
switch_cmd_dev = device_create_drvdata(lightsensor_class, NULL, 0, NULL, "switch_cmd");
if (IS_ERR(switch_cmd_dev))
pr_err("Failed to create device(switch_cmd_dev)!\n");
if (device_create_file(switch_cmd_dev, &dev_attr_lightsensor_file_cmd) < 0)
pr_err("Failed to create device file(%s)!\n", dev_attr_lightsensor_file_cmd.attr.name);
if (device_create_file(switch_cmd_dev, &dev_attr_lightsensor_file_state) < 0)
pr_err("Failed to create device file(%s)!\n", dev_attr_lightsensor_file_state.attr.name);
dev_set_drvdata(switch_cmd_dev,gp2a);
/* ktime init */
timeA = ktime_set(0,0);
timeB = ktime_set(0,0);
/* POWER On */
gpio_set_value(GPIO_LUM_PWM,GPIO_LEVEL_HIGH);
mdelay(100);
/* GP2A Regs INIT SETTINGS */
for(i=1;i<5;i++)
{
opt_i2c_write((u8)(i),&gp2a_original_image[i]);
}
mdelay(2);
/* INT Settings */
irq = IRQ_GP2A_INT;
gp2a->irq = -1;
ret = request_irq(irq, gp2a_irq_handler, 0, "gp2a_int", gp2a);
if (ret) {
pr_err("unable to request irq %d\n", irq);
return ret;
}
gp2a->irq = irq;
gprintk("INT Settings complete\n");
/* maintain power-down mode before using sensor */
gp2a_off(gp2a,ALL);
return 0;
}
