Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit e9a9ff83 authored by Bingzhe Cai's avatar Bingzhe Cai
Browse files

input: sensors: register wake-up interface for MPU6050 



Sensor class enable_wakeup interface is to provide user space
interface to configure sensor to work on wake-up mode. This change
add MPU6050 wake-up callback function and register it to sensor
class.

Change-Id: If84ec2cd008c8cd1161b94de227aa1a3b45621a6
Signed-off-by: default avatarBingzhe Cai <bingzhec@codeaurora.org>
parent 7776d50b

drivers/input/misc/mpu6050.c

+19 −1
Original line number Original line Diff line number Diff line
@@ -133,6 +133,7 @@ struct mpu6050_sensor { 
	u32 gyro_poll_ms;

	u32 gyro_poll_ms;

	u32 accel_poll_ms;

	u32 accel_poll_ms;

	bool use_poll;

	bool use_poll;

	bool wakeup_en;





	/* power control */

	/* power control */

	struct regulator *vlogic;

	struct regulator *vlogic;
@@ -1534,6 +1535,21 @@ static int mpu6050_accel_cdev_poll_delay(struct sensors_classdev *sensors_cdev, 
	return mpu6050_accel_set_poll_delay(sensor, delay_ms);

	return mpu6050_accel_set_poll_delay(sensor, delay_ms);

}

}





static int mpu6050_accel_cdev_enable_wakeup(

			struct sensors_classdev *sensors_cdev,

			unsigned int enable)

{

	struct mpu6050_sensor *sensor = container_of(sensors_cdev,

			struct mpu6050_sensor, accel_cdev);



	if (sensor->use_poll)

		return -ENODEV;



	sensor->wakeup_en = enable;

	return 0;

}





/**

/**

 * mpu6050_accel_attr_get_polling_delay - get the sampling rate

 * mpu6050_accel_attr_get_polling_delay - get the sampling rate

 */

 */
@@ -2220,6 +2236,8 @@ static int mpu6050_probe(struct i2c_client *client, 
	sensor->accel_cdev.delay_msec = sensor->accel_poll_ms;

	sensor->accel_cdev.delay_msec = sensor->accel_poll_ms;

	sensor->accel_cdev.sensors_enable = mpu6050_accel_cdev_enable;

	sensor->accel_cdev.sensors_enable = mpu6050_accel_cdev_enable;

	sensor->accel_cdev.sensors_poll_delay = mpu6050_accel_cdev_poll_delay;

	sensor->accel_cdev.sensors_poll_delay = mpu6050_accel_cdev_poll_delay;

	sensor->accel_cdev.sensors_enable_wakeup =

					mpu6050_accel_cdev_enable_wakeup;

	ret = sensors_classdev_register(&client->dev, &sensor->accel_cdev);

	ret = sensors_classdev_register(&client->dev, &sensor->accel_cdev);

	if (ret) {

	if (ret) {

		dev_err(&client->dev,

		dev_err(&client->dev,
@@ -2330,7 +2348,7 @@ static int mpu6050_suspend(struct device *dev) 
	int ret = 0;

	int ret = 0;





	mutex_lock(&sensor->op_lock);

	mutex_lock(&sensor->op_lock);

	if (sensor->cfg.accel_enable && !sensor->use_poll) {

	if (sensor->cfg.accel_enable && sensor->wakeup_en) {

		/* keep accel on and config motion detection wakeup */

		/* keep accel on and config motion detection wakeup */

		ret = mpu6050_set_interrupt(sensor,

		ret = mpu6050_set_interrupt(sensor,

				BIT_DATA_RDY_EN, false);

				BIT_DATA_RDY_EN, false);