void cma3000_resume(struct cma3000_accl_data *data)
{
mutex_lock(&data->mutex);
if (data->suspended && data->opened)
cma3000_poweron(data);
data->suspended = false;
mutex_unlock(&data->mutex);
}
static int cma3000_open(struct input_dev *input_dev)
{
struct cma3000_accl_data *data = input_get_drvdata(input_dev);
mutex_lock(&data->mutex);
if (!data->suspended)
cma3000_poweron(data);
data->opened = true;
mutex_unlock(&data->mutex);
return 0;
}
int cma3000_init(struct cma3000_accl_data *data)
{
int ret = 0, fuzz_x, fuzz_y, fuzz_z, g_range;
uint32_t irqflags;
uint8_t ctrl;
INIT_DELAYED_WORK(&data->input_work, cma3000_input_work_func);
if (data->client->dev.platform_data == NULL) {
dev_err(&data->client->dev, "platform data not found\n");
goto err_op2_failed;
}
memcpy(&(data->pdata), data->client->dev.platform_data,
sizeof(struct cma3000_platform_data));
ret = cma3000_reset(data);
if (ret)
goto err_op2_failed;
ret = cma3000_read(data, CMA3000_REVID, "Revid");
if (ret < 0)
goto err_op2_failed;
pr_info("CMA3000 Acclerometer : Revision %x\n", ret);
/* Bring it out of default power down state */
ret = cma3000_poweron(data);
if (ret < 0)
goto err_op2_failed;
data->req_poll_rate = data->pdata.def_poll_rate;
fuzz_x = data->pdata.fuzz_x;
fuzz_y = data->pdata.fuzz_y;
fuzz_z = data->pdata.fuzz_z;
g_range = data->pdata.g_range;
irqflags = data->pdata.irqflags;
data->input_dev = input_allocate_device();
if (data->input_dev == NULL) {
ret = -ENOMEM;
dev_err(&data->client->dev,
"Failed to allocate input device\n");
goto err_op2_failed;
}
data->input_dev->name = "cma3000-acclerometer";
#ifdef CONFIG_INPUT_CMA3000_I2C
data->input_dev->id.bustype = BUS_I2C;
#endif
__set_bit(EV_ABS, data->input_dev->evbit);
__set_bit(EV_MSC, data->input_dev->evbit);
input_set_abs_params(data->input_dev, ABS_X, -g_range,
g_range, fuzz_x, 0);
input_set_abs_params(data->input_dev, ABS_Y, -g_range,
g_range, fuzz_y, 0);
input_set_abs_params(data->input_dev, ABS_Z, -g_range,
g_range, fuzz_z, 0);
input_set_abs_params(data->input_dev, ABS_MISC, 0,
1, 0, 0);
ret = input_register_device(data->input_dev);
if (ret) {
dev_err(&data->client->dev,
"Unable to register input device\n");
goto err_op2_failed;
}
mutex_init(&data->mutex);
if (data->client->irq) {
ret = request_irq(data->client->irq, cma3000_isr,
irqflags | IRQF_ONESHOT,
data->client->name, data);
if (ret < 0) {
dev_err(&data->client->dev,
"request_threaded_irq failed\n");
goto err_op1_failed;
}
} else {
/*There is no IRQ set, disable IRQ on CMA*/
ctrl = cma3000_read(data, CMA3000_CTRL, "Status");
ctrl |= 0x1;
cma3000_set(data, CMA3000_CTRL, ctrl, "Disable IRQ");
}
ret = sysfs_create_group(&data->client->dev.kobj, &cma3000_attr_group);
if (ret) {
dev_err(&data->client->dev,
"failed to create sysfs entries\n");
goto err_op1_failed;
}
cma3000_set_mode(data, CMAMODE_POFF);
return 0;
err_op1_failed:
mutex_destroy(&data->mutex);
input_unregister_device(data->input_dev);
err_op2_failed:
if (data != NULL) {
if (data->input_dev != NULL)
input_free_device(data->input_dev);
}
return ret;
}
