mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-28 11:18:45 +07:00
c2433827c1
Instead of installing custom devm cleanup action to remove attribute groups on failure, let's use the dedicated devm API. Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
1504 lines
37 KiB
C
1504 lines
37 KiB
C
/*
|
|
* Cypress APA trackpad with I2C interface
|
|
*
|
|
* Author: Dudley Du <dudl@cypress.com>
|
|
* Further cleanup and restructuring by:
|
|
* Daniel Kurtz <djkurtz@chromium.org>
|
|
* Benson Leung <bleung@chromium.org>
|
|
*
|
|
* Copyright (C) 2011-2015 Cypress Semiconductor, Inc.
|
|
* Copyright (C) 2011-2012 Google, Inc.
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file COPYING in the main directory of this archive for
|
|
* more details.
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/input.h>
|
|
#include <linux/input/mt.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/acpi.h>
|
|
#include <linux/of.h>
|
|
#include "cyapa.h"
|
|
|
|
|
|
#define CYAPA_ADAPTER_FUNC_NONE 0
|
|
#define CYAPA_ADAPTER_FUNC_I2C 1
|
|
#define CYAPA_ADAPTER_FUNC_SMBUS 2
|
|
#define CYAPA_ADAPTER_FUNC_BOTH 3
|
|
|
|
#define CYAPA_FW_NAME "cyapa.bin"
|
|
|
|
const char product_id[] = "CYTRA";
|
|
|
|
static int cyapa_reinitialize(struct cyapa *cyapa);
|
|
|
|
bool cyapa_is_pip_bl_mode(struct cyapa *cyapa)
|
|
{
|
|
if (cyapa->gen == CYAPA_GEN6 && cyapa->state == CYAPA_STATE_GEN6_BL)
|
|
return true;
|
|
|
|
if (cyapa->gen == CYAPA_GEN5 && cyapa->state == CYAPA_STATE_GEN5_BL)
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
bool cyapa_is_pip_app_mode(struct cyapa *cyapa)
|
|
{
|
|
if (cyapa->gen == CYAPA_GEN6 && cyapa->state == CYAPA_STATE_GEN6_APP)
|
|
return true;
|
|
|
|
if (cyapa->gen == CYAPA_GEN5 && cyapa->state == CYAPA_STATE_GEN5_APP)
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static bool cyapa_is_bootloader_mode(struct cyapa *cyapa)
|
|
{
|
|
if (cyapa_is_pip_bl_mode(cyapa))
|
|
return true;
|
|
|
|
if (cyapa->gen == CYAPA_GEN3 &&
|
|
cyapa->state >= CYAPA_STATE_BL_BUSY &&
|
|
cyapa->state <= CYAPA_STATE_BL_ACTIVE)
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static inline bool cyapa_is_operational_mode(struct cyapa *cyapa)
|
|
{
|
|
if (cyapa_is_pip_app_mode(cyapa))
|
|
return true;
|
|
|
|
if (cyapa->gen == CYAPA_GEN3 && cyapa->state == CYAPA_STATE_OP)
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
/* Returns 0 on success, else negative errno on failure. */
|
|
static ssize_t cyapa_i2c_read(struct cyapa *cyapa, u8 reg, size_t len,
|
|
u8 *values)
|
|
{
|
|
struct i2c_client *client = cyapa->client;
|
|
struct i2c_msg msgs[] = {
|
|
{
|
|
.addr = client->addr,
|
|
.flags = 0,
|
|
.len = 1,
|
|
.buf = ®,
|
|
},
|
|
{
|
|
.addr = client->addr,
|
|
.flags = I2C_M_RD,
|
|
.len = len,
|
|
.buf = values,
|
|
},
|
|
};
|
|
int ret;
|
|
|
|
ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
|
|
|
|
if (ret != ARRAY_SIZE(msgs))
|
|
return ret < 0 ? ret : -EIO;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* cyapa_i2c_write - Execute i2c block data write operation
|
|
* @cyapa: Handle to this driver
|
|
* @ret: Offset of the data to written in the register map
|
|
* @len: number of bytes to write
|
|
* @values: Data to be written
|
|
*
|
|
* Return negative errno code on error; return zero when success.
|
|
*/
|
|
static int cyapa_i2c_write(struct cyapa *cyapa, u8 reg,
|
|
size_t len, const void *values)
|
|
{
|
|
struct i2c_client *client = cyapa->client;
|
|
char buf[32];
|
|
int ret;
|
|
|
|
if (len > sizeof(buf) - 1)
|
|
return -ENOMEM;
|
|
|
|
buf[0] = reg;
|
|
memcpy(&buf[1], values, len);
|
|
|
|
ret = i2c_master_send(client, buf, len + 1);
|
|
if (ret != len + 1)
|
|
return ret < 0 ? ret : -EIO;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u8 cyapa_check_adapter_functionality(struct i2c_client *client)
|
|
{
|
|
u8 ret = CYAPA_ADAPTER_FUNC_NONE;
|
|
|
|
if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
|
|
ret |= CYAPA_ADAPTER_FUNC_I2C;
|
|
if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA |
|
|
I2C_FUNC_SMBUS_BLOCK_DATA |
|
|
I2C_FUNC_SMBUS_I2C_BLOCK))
|
|
ret |= CYAPA_ADAPTER_FUNC_SMBUS;
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Query device for its current operating state.
|
|
*/
|
|
static int cyapa_get_state(struct cyapa *cyapa)
|
|
{
|
|
u8 status[BL_STATUS_SIZE];
|
|
u8 cmd[32];
|
|
/* The i2c address of gen4 and gen5 trackpad device must be even. */
|
|
bool even_addr = ((cyapa->client->addr & 0x0001) == 0);
|
|
bool smbus = false;
|
|
int retries = 2;
|
|
int error;
|
|
|
|
cyapa->state = CYAPA_STATE_NO_DEVICE;
|
|
|
|
/*
|
|
* Get trackpad status by reading 3 registers starting from 0.
|
|
* If the device is in the bootloader, this will be BL_HEAD.
|
|
* If the device is in operation mode, this will be the DATA regs.
|
|
*
|
|
*/
|
|
error = cyapa_i2c_reg_read_block(cyapa, BL_HEAD_OFFSET, BL_STATUS_SIZE,
|
|
status);
|
|
|
|
/*
|
|
* On smbus systems in OP mode, the i2c_reg_read will fail with
|
|
* -ETIMEDOUT. In this case, try again using the smbus equivalent
|
|
* command. This should return a BL_HEAD indicating CYAPA_STATE_OP.
|
|
*/
|
|
if (cyapa->smbus && (error == -ETIMEDOUT || error == -ENXIO)) {
|
|
if (!even_addr)
|
|
error = cyapa_read_block(cyapa,
|
|
CYAPA_CMD_BL_STATUS, status);
|
|
smbus = true;
|
|
}
|
|
|
|
if (error != BL_STATUS_SIZE)
|
|
goto error;
|
|
|
|
/*
|
|
* Detect trackpad protocol based on characteristic registers and bits.
|
|
*/
|
|
do {
|
|
cyapa->status[REG_OP_STATUS] = status[REG_OP_STATUS];
|
|
cyapa->status[REG_BL_STATUS] = status[REG_BL_STATUS];
|
|
cyapa->status[REG_BL_ERROR] = status[REG_BL_ERROR];
|
|
|
|
if (cyapa->gen == CYAPA_GEN_UNKNOWN ||
|
|
cyapa->gen == CYAPA_GEN3) {
|
|
error = cyapa_gen3_ops.state_parse(cyapa,
|
|
status, BL_STATUS_SIZE);
|
|
if (!error)
|
|
goto out_detected;
|
|
}
|
|
if (cyapa->gen == CYAPA_GEN_UNKNOWN ||
|
|
cyapa->gen == CYAPA_GEN6 ||
|
|
cyapa->gen == CYAPA_GEN5) {
|
|
error = cyapa_pip_state_parse(cyapa,
|
|
status, BL_STATUS_SIZE);
|
|
if (!error)
|
|
goto out_detected;
|
|
}
|
|
/* For old Gen5 trackpads detecting. */
|
|
if ((cyapa->gen == CYAPA_GEN_UNKNOWN ||
|
|
cyapa->gen == CYAPA_GEN5) &&
|
|
!smbus && even_addr) {
|
|
error = cyapa_gen5_ops.state_parse(cyapa,
|
|
status, BL_STATUS_SIZE);
|
|
if (!error)
|
|
goto out_detected;
|
|
}
|
|
|
|
/*
|
|
* Write 0x00 0x00 to trackpad device to force update its
|
|
* status, then redo the detection again.
|
|
*/
|
|
if (!smbus) {
|
|
cmd[0] = 0x00;
|
|
cmd[1] = 0x00;
|
|
error = cyapa_i2c_write(cyapa, 0, 2, cmd);
|
|
if (error)
|
|
goto error;
|
|
|
|
msleep(50);
|
|
|
|
error = cyapa_i2c_read(cyapa, BL_HEAD_OFFSET,
|
|
BL_STATUS_SIZE, status);
|
|
if (error)
|
|
goto error;
|
|
}
|
|
} while (--retries > 0 && !smbus);
|
|
|
|
goto error;
|
|
|
|
out_detected:
|
|
if (cyapa->state <= CYAPA_STATE_BL_BUSY)
|
|
return -EAGAIN;
|
|
return 0;
|
|
|
|
error:
|
|
return (error < 0) ? error : -EAGAIN;
|
|
}
|
|
|
|
/*
|
|
* Poll device for its status in a loop, waiting up to timeout for a response.
|
|
*
|
|
* When the device switches state, it usually takes ~300 ms.
|
|
* However, when running a new firmware image, the device must calibrate its
|
|
* sensors, which can take as long as 2 seconds.
|
|
*
|
|
* Note: The timeout has granularity of the polling rate, which is 100 ms.
|
|
*
|
|
* Returns:
|
|
* 0 when the device eventually responds with a valid non-busy state.
|
|
* -ETIMEDOUT if device never responds (too many -EAGAIN)
|
|
* -EAGAIN if bootload is busy, or unknown state.
|
|
* < 0 other errors
|
|
*/
|
|
int cyapa_poll_state(struct cyapa *cyapa, unsigned int timeout)
|
|
{
|
|
int error;
|
|
int tries = timeout / 100;
|
|
|
|
do {
|
|
error = cyapa_get_state(cyapa);
|
|
if (!error && cyapa->state > CYAPA_STATE_BL_BUSY)
|
|
return 0;
|
|
|
|
msleep(100);
|
|
} while (tries--);
|
|
|
|
return (error == -EAGAIN || error == -ETIMEDOUT) ? -ETIMEDOUT : error;
|
|
}
|
|
|
|
/*
|
|
* Check if device is operational.
|
|
*
|
|
* An operational device is responding, has exited bootloader, and has
|
|
* firmware supported by this driver.
|
|
*
|
|
* Returns:
|
|
* -ENODEV no device
|
|
* -EBUSY no device or in bootloader
|
|
* -EIO failure while reading from device
|
|
* -ETIMEDOUT timeout failure for bus idle or bus no response
|
|
* -EAGAIN device is still in bootloader
|
|
* if ->state = CYAPA_STATE_BL_IDLE, device has invalid firmware
|
|
* -EINVAL device is in operational mode, but not supported by this driver
|
|
* 0 device is supported
|
|
*/
|
|
static int cyapa_check_is_operational(struct cyapa *cyapa)
|
|
{
|
|
int error;
|
|
|
|
error = cyapa_poll_state(cyapa, 4000);
|
|
if (error)
|
|
return error;
|
|
|
|
switch (cyapa->gen) {
|
|
case CYAPA_GEN6:
|
|
cyapa->ops = &cyapa_gen6_ops;
|
|
break;
|
|
case CYAPA_GEN5:
|
|
cyapa->ops = &cyapa_gen5_ops;
|
|
break;
|
|
case CYAPA_GEN3:
|
|
cyapa->ops = &cyapa_gen3_ops;
|
|
break;
|
|
default:
|
|
return -ENODEV;
|
|
}
|
|
|
|
error = cyapa->ops->operational_check(cyapa);
|
|
if (!error && cyapa_is_operational_mode(cyapa))
|
|
cyapa->operational = true;
|
|
else
|
|
cyapa->operational = false;
|
|
|
|
return error;
|
|
}
|
|
|
|
|
|
/*
|
|
* Returns 0 on device detected, negative errno on no device detected.
|
|
* And when the device is detected and operational, it will be reset to
|
|
* full power active mode automatically.
|
|
*/
|
|
static int cyapa_detect(struct cyapa *cyapa)
|
|
{
|
|
struct device *dev = &cyapa->client->dev;
|
|
int error;
|
|
|
|
error = cyapa_check_is_operational(cyapa);
|
|
if (error) {
|
|
if (error != -ETIMEDOUT && error != -ENODEV &&
|
|
cyapa_is_bootloader_mode(cyapa)) {
|
|
dev_warn(dev, "device detected but not operational\n");
|
|
return 0;
|
|
}
|
|
|
|
dev_err(dev, "no device detected: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cyapa_open(struct input_dev *input)
|
|
{
|
|
struct cyapa *cyapa = input_get_drvdata(input);
|
|
struct i2c_client *client = cyapa->client;
|
|
struct device *dev = &client->dev;
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
if (cyapa->operational) {
|
|
/*
|
|
* though failed to set active power mode,
|
|
* but still may be able to work in lower scan rate
|
|
* when in operational mode.
|
|
*/
|
|
error = cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_FULL_ACTIVE, 0, CYAPA_PM_ACTIVE);
|
|
if (error) {
|
|
dev_warn(dev, "set active power failed: %d\n", error);
|
|
goto out;
|
|
}
|
|
} else {
|
|
error = cyapa_reinitialize(cyapa);
|
|
if (error || !cyapa->operational) {
|
|
error = error ? error : -EAGAIN;
|
|
goto out;
|
|
}
|
|
}
|
|
|
|
enable_irq(client->irq);
|
|
if (!pm_runtime_enabled(dev)) {
|
|
pm_runtime_set_active(dev);
|
|
pm_runtime_enable(dev);
|
|
}
|
|
|
|
pm_runtime_get_sync(dev);
|
|
pm_runtime_mark_last_busy(dev);
|
|
pm_runtime_put_sync_autosuspend(dev);
|
|
out:
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return error;
|
|
}
|
|
|
|
static void cyapa_close(struct input_dev *input)
|
|
{
|
|
struct cyapa *cyapa = input_get_drvdata(input);
|
|
struct i2c_client *client = cyapa->client;
|
|
struct device *dev = &cyapa->client->dev;
|
|
|
|
mutex_lock(&cyapa->state_sync_lock);
|
|
|
|
disable_irq(client->irq);
|
|
if (pm_runtime_enabled(dev))
|
|
pm_runtime_disable(dev);
|
|
pm_runtime_set_suspended(dev);
|
|
|
|
if (cyapa->operational)
|
|
cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_OFF, 0, CYAPA_PM_DEACTIVE);
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
}
|
|
|
|
static int cyapa_create_input_dev(struct cyapa *cyapa)
|
|
{
|
|
struct device *dev = &cyapa->client->dev;
|
|
struct input_dev *input;
|
|
int error;
|
|
|
|
if (!cyapa->physical_size_x || !cyapa->physical_size_y)
|
|
return -EINVAL;
|
|
|
|
input = devm_input_allocate_device(dev);
|
|
if (!input) {
|
|
dev_err(dev, "failed to allocate memory for input device.\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
input->name = CYAPA_NAME;
|
|
input->phys = cyapa->phys;
|
|
input->id.bustype = BUS_I2C;
|
|
input->id.version = 1;
|
|
input->id.product = 0; /* Means any product in eventcomm. */
|
|
input->dev.parent = &cyapa->client->dev;
|
|
|
|
input->open = cyapa_open;
|
|
input->close = cyapa_close;
|
|
|
|
input_set_drvdata(input, cyapa);
|
|
|
|
__set_bit(EV_ABS, input->evbit);
|
|
|
|
/* Finger position */
|
|
input_set_abs_params(input, ABS_MT_POSITION_X, 0, cyapa->max_abs_x, 0,
|
|
0);
|
|
input_set_abs_params(input, ABS_MT_POSITION_Y, 0, cyapa->max_abs_y, 0,
|
|
0);
|
|
input_set_abs_params(input, ABS_MT_PRESSURE, 0, cyapa->max_z, 0, 0);
|
|
if (cyapa->gen > CYAPA_GEN3) {
|
|
input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0);
|
|
input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 255, 0, 0);
|
|
/*
|
|
* Orientation is the angle between the vertical axis and
|
|
* the major axis of the contact ellipse.
|
|
* The range is -127 to 127.
|
|
* the positive direction is clockwise form the vertical axis.
|
|
* If the ellipse of contact degenerates into a circle,
|
|
* orientation is reported as 0.
|
|
*
|
|
* Also, for Gen5 trackpad the accurate of this orientation
|
|
* value is value + (-30 ~ 30).
|
|
*/
|
|
input_set_abs_params(input, ABS_MT_ORIENTATION,
|
|
-127, 127, 0, 0);
|
|
}
|
|
if (cyapa->gen >= CYAPA_GEN5) {
|
|
input_set_abs_params(input, ABS_MT_WIDTH_MAJOR, 0, 255, 0, 0);
|
|
input_set_abs_params(input, ABS_MT_WIDTH_MINOR, 0, 255, 0, 0);
|
|
input_set_abs_params(input, ABS_DISTANCE, 0, 1, 0, 0);
|
|
}
|
|
|
|
input_abs_set_res(input, ABS_MT_POSITION_X,
|
|
cyapa->max_abs_x / cyapa->physical_size_x);
|
|
input_abs_set_res(input, ABS_MT_POSITION_Y,
|
|
cyapa->max_abs_y / cyapa->physical_size_y);
|
|
|
|
if (cyapa->btn_capability & CAPABILITY_LEFT_BTN_MASK)
|
|
__set_bit(BTN_LEFT, input->keybit);
|
|
if (cyapa->btn_capability & CAPABILITY_MIDDLE_BTN_MASK)
|
|
__set_bit(BTN_MIDDLE, input->keybit);
|
|
if (cyapa->btn_capability & CAPABILITY_RIGHT_BTN_MASK)
|
|
__set_bit(BTN_RIGHT, input->keybit);
|
|
|
|
if (cyapa->btn_capability == CAPABILITY_LEFT_BTN_MASK)
|
|
__set_bit(INPUT_PROP_BUTTONPAD, input->propbit);
|
|
|
|
/* Handle pointer emulation and unused slots in core */
|
|
error = input_mt_init_slots(input, CYAPA_MAX_MT_SLOTS,
|
|
INPUT_MT_POINTER | INPUT_MT_DROP_UNUSED);
|
|
if (error) {
|
|
dev_err(dev, "failed to initialize MT slots: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
/* Register the device in input subsystem */
|
|
error = input_register_device(input);
|
|
if (error) {
|
|
dev_err(dev, "failed to register input device: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
cyapa->input = input;
|
|
return 0;
|
|
}
|
|
|
|
static void cyapa_enable_irq_for_cmd(struct cyapa *cyapa)
|
|
{
|
|
struct input_dev *input = cyapa->input;
|
|
|
|
if (!input || !input->users) {
|
|
/*
|
|
* When input is NULL, TP must be in deep sleep mode.
|
|
* In this mode, later non-power I2C command will always failed
|
|
* if not bring it out of deep sleep mode firstly,
|
|
* so must command TP to active mode here.
|
|
*/
|
|
if (!input || cyapa->operational)
|
|
cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_FULL_ACTIVE, 0, CYAPA_PM_ACTIVE);
|
|
/* Gen3 always using polling mode for command. */
|
|
if (cyapa->gen >= CYAPA_GEN5)
|
|
enable_irq(cyapa->client->irq);
|
|
}
|
|
}
|
|
|
|
static void cyapa_disable_irq_for_cmd(struct cyapa *cyapa)
|
|
{
|
|
struct input_dev *input = cyapa->input;
|
|
|
|
if (!input || !input->users) {
|
|
if (cyapa->gen >= CYAPA_GEN5)
|
|
disable_irq(cyapa->client->irq);
|
|
if (!input || cyapa->operational)
|
|
cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_OFF, 0, CYAPA_PM_ACTIVE);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* cyapa_sleep_time_to_pwr_cmd and cyapa_pwr_cmd_to_sleep_time
|
|
*
|
|
* These are helper functions that convert to and from integer idle
|
|
* times and register settings to write to the PowerMode register.
|
|
* The trackpad supports between 20ms to 1000ms scan intervals.
|
|
* The time will be increased in increments of 10ms from 20ms to 100ms.
|
|
* From 100ms to 1000ms, time will be increased in increments of 20ms.
|
|
*
|
|
* When Idle_Time < 100, the format to convert Idle_Time to Idle_Command is:
|
|
* Idle_Command = Idle Time / 10;
|
|
* When Idle_Time >= 100, the format to convert Idle_Time to Idle_Command is:
|
|
* Idle_Command = Idle Time / 20 + 5;
|
|
*/
|
|
u8 cyapa_sleep_time_to_pwr_cmd(u16 sleep_time)
|
|
{
|
|
u16 encoded_time;
|
|
|
|
sleep_time = clamp_val(sleep_time, 20, 1000);
|
|
encoded_time = sleep_time < 100 ? sleep_time / 10 : sleep_time / 20 + 5;
|
|
return (encoded_time << 2) & PWR_MODE_MASK;
|
|
}
|
|
|
|
u16 cyapa_pwr_cmd_to_sleep_time(u8 pwr_mode)
|
|
{
|
|
u8 encoded_time = pwr_mode >> 2;
|
|
|
|
return (encoded_time < 10) ? encoded_time * 10
|
|
: (encoded_time - 5) * 20;
|
|
}
|
|
|
|
/* 0 on driver initialize and detected successfully, negative on failure. */
|
|
static int cyapa_initialize(struct cyapa *cyapa)
|
|
{
|
|
int error = 0;
|
|
|
|
cyapa->state = CYAPA_STATE_NO_DEVICE;
|
|
cyapa->gen = CYAPA_GEN_UNKNOWN;
|
|
mutex_init(&cyapa->state_sync_lock);
|
|
|
|
/*
|
|
* Set to hard code default, they will be updated with trackpad set
|
|
* default values after probe and initialized.
|
|
*/
|
|
cyapa->suspend_power_mode = PWR_MODE_SLEEP;
|
|
cyapa->suspend_sleep_time =
|
|
cyapa_pwr_cmd_to_sleep_time(cyapa->suspend_power_mode);
|
|
|
|
/* ops.initialize() is aimed to prepare for module communications. */
|
|
error = cyapa_gen3_ops.initialize(cyapa);
|
|
if (!error)
|
|
error = cyapa_gen5_ops.initialize(cyapa);
|
|
if (!error)
|
|
error = cyapa_gen6_ops.initialize(cyapa);
|
|
if (error)
|
|
return error;
|
|
|
|
error = cyapa_detect(cyapa);
|
|
if (error)
|
|
return error;
|
|
|
|
/* Power down the device until we need it. */
|
|
if (cyapa->operational)
|
|
cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_OFF, 0, CYAPA_PM_ACTIVE);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int cyapa_reinitialize(struct cyapa *cyapa)
|
|
{
|
|
struct device *dev = &cyapa->client->dev;
|
|
struct input_dev *input = cyapa->input;
|
|
int error;
|
|
|
|
if (pm_runtime_enabled(dev))
|
|
pm_runtime_disable(dev);
|
|
|
|
/* Avoid command failures when TP was in OFF state. */
|
|
if (cyapa->operational)
|
|
cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_FULL_ACTIVE, 0, CYAPA_PM_ACTIVE);
|
|
|
|
error = cyapa_detect(cyapa);
|
|
if (error)
|
|
goto out;
|
|
|
|
if (!input && cyapa->operational) {
|
|
error = cyapa_create_input_dev(cyapa);
|
|
if (error) {
|
|
dev_err(dev, "create input_dev instance failed: %d\n",
|
|
error);
|
|
goto out;
|
|
}
|
|
}
|
|
|
|
out:
|
|
if (!input || !input->users) {
|
|
/* Reset to power OFF state to save power when no user open. */
|
|
if (cyapa->operational)
|
|
cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_OFF, 0, CYAPA_PM_DEACTIVE);
|
|
} else if (!error && cyapa->operational) {
|
|
/*
|
|
* Make sure only enable runtime PM when device is
|
|
* in operational mode and input->users > 0.
|
|
*/
|
|
pm_runtime_set_active(dev);
|
|
pm_runtime_enable(dev);
|
|
|
|
pm_runtime_get_sync(dev);
|
|
pm_runtime_mark_last_busy(dev);
|
|
pm_runtime_put_sync_autosuspend(dev);
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
static irqreturn_t cyapa_irq(int irq, void *dev_id)
|
|
{
|
|
struct cyapa *cyapa = dev_id;
|
|
struct device *dev = &cyapa->client->dev;
|
|
int error;
|
|
|
|
if (device_may_wakeup(dev))
|
|
pm_wakeup_event(dev, 0);
|
|
|
|
/* Interrupt event can be caused by host command to trackpad device. */
|
|
if (cyapa->ops->irq_cmd_handler(cyapa)) {
|
|
/*
|
|
* Interrupt event maybe from trackpad device input reporting.
|
|
*/
|
|
if (!cyapa->input) {
|
|
/*
|
|
* Still in probing or in firmware image
|
|
* updating or reading.
|
|
*/
|
|
cyapa->ops->sort_empty_output_data(cyapa,
|
|
NULL, NULL, NULL);
|
|
goto out;
|
|
}
|
|
|
|
if (cyapa->operational) {
|
|
error = cyapa->ops->irq_handler(cyapa);
|
|
|
|
/*
|
|
* Apply runtime power management to touch report event
|
|
* except the events caused by the command responses.
|
|
* Note:
|
|
* It will introduce about 20~40 ms additional delay
|
|
* time in receiving for first valid touch report data.
|
|
* The time is used to execute device runtime resume
|
|
* process.
|
|
*/
|
|
pm_runtime_get_sync(dev);
|
|
pm_runtime_mark_last_busy(dev);
|
|
pm_runtime_put_sync_autosuspend(dev);
|
|
}
|
|
|
|
if (!cyapa->operational || error) {
|
|
if (!mutex_trylock(&cyapa->state_sync_lock)) {
|
|
cyapa->ops->sort_empty_output_data(cyapa,
|
|
NULL, NULL, NULL);
|
|
goto out;
|
|
}
|
|
cyapa_reinitialize(cyapa);
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
}
|
|
}
|
|
|
|
out:
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/*
|
|
**************************************************************
|
|
* sysfs interface
|
|
**************************************************************
|
|
*/
|
|
#ifdef CONFIG_PM_SLEEP
|
|
static ssize_t cyapa_show_suspend_scanrate(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
u8 pwr_cmd;
|
|
u16 sleep_time;
|
|
int len;
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
pwr_cmd = cyapa->suspend_power_mode;
|
|
sleep_time = cyapa->suspend_sleep_time;
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
|
|
switch (pwr_cmd) {
|
|
case PWR_MODE_BTN_ONLY:
|
|
len = scnprintf(buf, PAGE_SIZE, "%s\n", BTN_ONLY_MODE_NAME);
|
|
break;
|
|
|
|
case PWR_MODE_OFF:
|
|
len = scnprintf(buf, PAGE_SIZE, "%s\n", OFF_MODE_NAME);
|
|
break;
|
|
|
|
default:
|
|
len = scnprintf(buf, PAGE_SIZE, "%u\n",
|
|
cyapa->gen == CYAPA_GEN3 ?
|
|
cyapa_pwr_cmd_to_sleep_time(pwr_cmd) :
|
|
sleep_time);
|
|
break;
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
static ssize_t cyapa_update_suspend_scanrate(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
u16 sleep_time;
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
if (sysfs_streq(buf, BTN_ONLY_MODE_NAME)) {
|
|
cyapa->suspend_power_mode = PWR_MODE_BTN_ONLY;
|
|
} else if (sysfs_streq(buf, OFF_MODE_NAME)) {
|
|
cyapa->suspend_power_mode = PWR_MODE_OFF;
|
|
} else if (!kstrtou16(buf, 10, &sleep_time)) {
|
|
cyapa->suspend_sleep_time = min_t(u16, sleep_time, 1000);
|
|
cyapa->suspend_power_mode =
|
|
cyapa_sleep_time_to_pwr_cmd(cyapa->suspend_sleep_time);
|
|
} else {
|
|
count = -EINVAL;
|
|
}
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(suspend_scanrate_ms, S_IRUGO|S_IWUSR,
|
|
cyapa_show_suspend_scanrate,
|
|
cyapa_update_suspend_scanrate);
|
|
|
|
static struct attribute *cyapa_power_wakeup_entries[] = {
|
|
&dev_attr_suspend_scanrate_ms.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group cyapa_power_wakeup_group = {
|
|
.name = power_group_name,
|
|
.attrs = cyapa_power_wakeup_entries,
|
|
};
|
|
|
|
static void cyapa_remove_power_wakeup_group(void *data)
|
|
{
|
|
struct cyapa *cyapa = data;
|
|
|
|
sysfs_unmerge_group(&cyapa->client->dev.kobj,
|
|
&cyapa_power_wakeup_group);
|
|
}
|
|
|
|
static int cyapa_prepare_wakeup_controls(struct cyapa *cyapa)
|
|
{
|
|
struct i2c_client *client = cyapa->client;
|
|
struct device *dev = &client->dev;
|
|
int error;
|
|
|
|
if (device_can_wakeup(dev)) {
|
|
error = sysfs_merge_group(&dev->kobj,
|
|
&cyapa_power_wakeup_group);
|
|
if (error) {
|
|
dev_err(dev, "failed to add power wakeup group: %d\n",
|
|
error);
|
|
return error;
|
|
}
|
|
|
|
error = devm_add_action(dev,
|
|
cyapa_remove_power_wakeup_group, cyapa);
|
|
if (error) {
|
|
cyapa_remove_power_wakeup_group(cyapa);
|
|
dev_err(dev, "failed to add power cleanup action: %d\n",
|
|
error);
|
|
return error;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#else
|
|
static inline int cyapa_prepare_wakeup_controls(struct cyapa *cyapa)
|
|
{
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_PM_SLEEP */
|
|
|
|
#ifdef CONFIG_PM
|
|
static ssize_t cyapa_show_rt_suspend_scanrate(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
u8 pwr_cmd;
|
|
u16 sleep_time;
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
pwr_cmd = cyapa->runtime_suspend_power_mode;
|
|
sleep_time = cyapa->runtime_suspend_sleep_time;
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
|
|
return scnprintf(buf, PAGE_SIZE, "%u\n",
|
|
cyapa->gen == CYAPA_GEN3 ?
|
|
cyapa_pwr_cmd_to_sleep_time(pwr_cmd) :
|
|
sleep_time);
|
|
}
|
|
|
|
static ssize_t cyapa_update_rt_suspend_scanrate(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
u16 time;
|
|
int error;
|
|
|
|
if (buf == NULL || count == 0 || kstrtou16(buf, 10, &time)) {
|
|
dev_err(dev, "invalid runtime suspend scanrate ms parameter\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* When the suspend scanrate is changed, pm_runtime_get to resume
|
|
* a potentially suspended device, update to the new pwr_cmd
|
|
* and then pm_runtime_put to suspend into the new power mode.
|
|
*/
|
|
pm_runtime_get_sync(dev);
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
cyapa->runtime_suspend_sleep_time = min_t(u16, time, 1000);
|
|
cyapa->runtime_suspend_power_mode =
|
|
cyapa_sleep_time_to_pwr_cmd(cyapa->runtime_suspend_sleep_time);
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
|
|
pm_runtime_put_sync_autosuspend(dev);
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(runtime_suspend_scanrate_ms, S_IRUGO|S_IWUSR,
|
|
cyapa_show_rt_suspend_scanrate,
|
|
cyapa_update_rt_suspend_scanrate);
|
|
|
|
static struct attribute *cyapa_power_runtime_entries[] = {
|
|
&dev_attr_runtime_suspend_scanrate_ms.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group cyapa_power_runtime_group = {
|
|
.name = power_group_name,
|
|
.attrs = cyapa_power_runtime_entries,
|
|
};
|
|
|
|
static void cyapa_remove_power_runtime_group(void *data)
|
|
{
|
|
struct cyapa *cyapa = data;
|
|
|
|
sysfs_unmerge_group(&cyapa->client->dev.kobj,
|
|
&cyapa_power_runtime_group);
|
|
}
|
|
|
|
static int cyapa_start_runtime(struct cyapa *cyapa)
|
|
{
|
|
struct device *dev = &cyapa->client->dev;
|
|
int error;
|
|
|
|
cyapa->runtime_suspend_power_mode = PWR_MODE_IDLE;
|
|
cyapa->runtime_suspend_sleep_time =
|
|
cyapa_pwr_cmd_to_sleep_time(cyapa->runtime_suspend_power_mode);
|
|
|
|
error = sysfs_merge_group(&dev->kobj, &cyapa_power_runtime_group);
|
|
if (error) {
|
|
dev_err(dev,
|
|
"failed to create power runtime group: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
error = devm_add_action(dev, cyapa_remove_power_runtime_group, cyapa);
|
|
if (error) {
|
|
cyapa_remove_power_runtime_group(cyapa);
|
|
dev_err(dev,
|
|
"failed to add power runtime cleanup action: %d\n",
|
|
error);
|
|
return error;
|
|
}
|
|
|
|
/* runtime is enabled until device is operational and opened. */
|
|
pm_runtime_set_suspended(dev);
|
|
pm_runtime_use_autosuspend(dev);
|
|
pm_runtime_set_autosuspend_delay(dev, AUTOSUSPEND_DELAY);
|
|
|
|
return 0;
|
|
}
|
|
#else
|
|
static inline int cyapa_start_runtime(struct cyapa *cyapa)
|
|
{
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_PM */
|
|
|
|
static ssize_t cyapa_show_fm_ver(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
int error;
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
error = scnprintf(buf, PAGE_SIZE, "%d.%d\n", cyapa->fw_maj_ver,
|
|
cyapa->fw_min_ver);
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return error;
|
|
}
|
|
|
|
static ssize_t cyapa_show_product_id(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
int size;
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
size = scnprintf(buf, PAGE_SIZE, "%s\n", cyapa->product_id);
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return size;
|
|
}
|
|
|
|
static int cyapa_firmware(struct cyapa *cyapa, const char *fw_name)
|
|
{
|
|
struct device *dev = &cyapa->client->dev;
|
|
const struct firmware *fw;
|
|
int error;
|
|
|
|
error = request_firmware(&fw, fw_name, dev);
|
|
if (error) {
|
|
dev_err(dev, "Could not load firmware from %s: %d\n",
|
|
fw_name, error);
|
|
return error;
|
|
}
|
|
|
|
error = cyapa->ops->check_fw(cyapa, fw);
|
|
if (error) {
|
|
dev_err(dev, "Invalid CYAPA firmware image: %s\n",
|
|
fw_name);
|
|
goto done;
|
|
}
|
|
|
|
/*
|
|
* Resume the potentially suspended device because doing FW
|
|
* update on a device not in the FULL mode has a chance to
|
|
* fail.
|
|
*/
|
|
pm_runtime_get_sync(dev);
|
|
|
|
/* Require IRQ support for firmware update commands. */
|
|
cyapa_enable_irq_for_cmd(cyapa);
|
|
|
|
error = cyapa->ops->bl_enter(cyapa);
|
|
if (error) {
|
|
dev_err(dev, "bl_enter failed, %d\n", error);
|
|
goto err_detect;
|
|
}
|
|
|
|
error = cyapa->ops->bl_activate(cyapa);
|
|
if (error) {
|
|
dev_err(dev, "bl_activate failed, %d\n", error);
|
|
goto err_detect;
|
|
}
|
|
|
|
error = cyapa->ops->bl_initiate(cyapa, fw);
|
|
if (error) {
|
|
dev_err(dev, "bl_initiate failed, %d\n", error);
|
|
goto err_detect;
|
|
}
|
|
|
|
error = cyapa->ops->update_fw(cyapa, fw);
|
|
if (error) {
|
|
dev_err(dev, "update_fw failed, %d\n", error);
|
|
goto err_detect;
|
|
}
|
|
|
|
err_detect:
|
|
cyapa_disable_irq_for_cmd(cyapa);
|
|
pm_runtime_put_noidle(dev);
|
|
|
|
done:
|
|
release_firmware(fw);
|
|
return error;
|
|
}
|
|
|
|
static ssize_t cyapa_update_fw_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
char fw_name[NAME_MAX];
|
|
int ret, error;
|
|
|
|
if (count >= NAME_MAX) {
|
|
dev_err(dev, "File name too long\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
memcpy(fw_name, buf, count);
|
|
if (fw_name[count - 1] == '\n')
|
|
fw_name[count - 1] = '\0';
|
|
else
|
|
fw_name[count] = '\0';
|
|
|
|
if (cyapa->input) {
|
|
/*
|
|
* Force the input device to be registered after the firmware
|
|
* image is updated, so if the corresponding parameters updated
|
|
* in the new firmware image can taken effect immediately.
|
|
*/
|
|
input_unregister_device(cyapa->input);
|
|
cyapa->input = NULL;
|
|
}
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error) {
|
|
/*
|
|
* Whatever, do reinitialize to try to recover TP state to
|
|
* previous state just as it entered fw update entrance.
|
|
*/
|
|
cyapa_reinitialize(cyapa);
|
|
return error;
|
|
}
|
|
|
|
error = cyapa_firmware(cyapa, fw_name);
|
|
if (error)
|
|
dev_err(dev, "firmware update failed: %d\n", error);
|
|
else
|
|
dev_dbg(dev, "firmware update successfully done.\n");
|
|
|
|
/*
|
|
* Re-detect trackpad device states because firmware update process
|
|
* will reset trackpad device into bootloader mode.
|
|
*/
|
|
ret = cyapa_reinitialize(cyapa);
|
|
if (ret) {
|
|
dev_err(dev, "failed to re-detect after updated: %d\n", ret);
|
|
error = error ? error : ret;
|
|
}
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
|
|
return error ? error : count;
|
|
}
|
|
|
|
static ssize_t cyapa_calibrate_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
if (cyapa->operational) {
|
|
cyapa_enable_irq_for_cmd(cyapa);
|
|
error = cyapa->ops->calibrate_store(dev, attr, buf, count);
|
|
cyapa_disable_irq_for_cmd(cyapa);
|
|
} else {
|
|
error = -EBUSY; /* Still running in bootloader mode. */
|
|
}
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return error < 0 ? error : count;
|
|
}
|
|
|
|
static ssize_t cyapa_show_baseline(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
ssize_t error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
if (cyapa->operational) {
|
|
cyapa_enable_irq_for_cmd(cyapa);
|
|
error = cyapa->ops->show_baseline(dev, attr, buf);
|
|
cyapa_disable_irq_for_cmd(cyapa);
|
|
} else {
|
|
error = -EBUSY; /* Still running in bootloader mode. */
|
|
}
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return error;
|
|
}
|
|
|
|
static char *cyapa_state_to_string(struct cyapa *cyapa)
|
|
{
|
|
switch (cyapa->state) {
|
|
case CYAPA_STATE_BL_BUSY:
|
|
return "bootloader busy";
|
|
case CYAPA_STATE_BL_IDLE:
|
|
return "bootloader idle";
|
|
case CYAPA_STATE_BL_ACTIVE:
|
|
return "bootloader active";
|
|
case CYAPA_STATE_GEN5_BL:
|
|
case CYAPA_STATE_GEN6_BL:
|
|
return "bootloader";
|
|
case CYAPA_STATE_OP:
|
|
case CYAPA_STATE_GEN5_APP:
|
|
case CYAPA_STATE_GEN6_APP:
|
|
return "operational"; /* Normal valid state. */
|
|
default:
|
|
return "invalid mode";
|
|
}
|
|
}
|
|
|
|
static ssize_t cyapa_show_mode(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
int size;
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
size = scnprintf(buf, PAGE_SIZE, "gen%d %s\n",
|
|
cyapa->gen, cyapa_state_to_string(cyapa));
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return size;
|
|
}
|
|
|
|
static DEVICE_ATTR(firmware_version, S_IRUGO, cyapa_show_fm_ver, NULL);
|
|
static DEVICE_ATTR(product_id, S_IRUGO, cyapa_show_product_id, NULL);
|
|
static DEVICE_ATTR(update_fw, S_IWUSR, NULL, cyapa_update_fw_store);
|
|
static DEVICE_ATTR(baseline, S_IRUGO, cyapa_show_baseline, NULL);
|
|
static DEVICE_ATTR(calibrate, S_IWUSR, NULL, cyapa_calibrate_store);
|
|
static DEVICE_ATTR(mode, S_IRUGO, cyapa_show_mode, NULL);
|
|
|
|
static struct attribute *cyapa_sysfs_entries[] = {
|
|
&dev_attr_firmware_version.attr,
|
|
&dev_attr_product_id.attr,
|
|
&dev_attr_update_fw.attr,
|
|
&dev_attr_baseline.attr,
|
|
&dev_attr_calibrate.attr,
|
|
&dev_attr_mode.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group cyapa_sysfs_group = {
|
|
.attrs = cyapa_sysfs_entries,
|
|
};
|
|
|
|
static void cyapa_disable_regulator(void *data)
|
|
{
|
|
struct cyapa *cyapa = data;
|
|
|
|
regulator_disable(cyapa->vcc);
|
|
}
|
|
|
|
static int cyapa_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *dev_id)
|
|
{
|
|
struct device *dev = &client->dev;
|
|
struct cyapa *cyapa;
|
|
u8 adapter_func;
|
|
union i2c_smbus_data dummy;
|
|
int error;
|
|
|
|
adapter_func = cyapa_check_adapter_functionality(client);
|
|
if (adapter_func == CYAPA_ADAPTER_FUNC_NONE) {
|
|
dev_err(dev, "not a supported I2C/SMBus adapter\n");
|
|
return -EIO;
|
|
}
|
|
|
|
/* Make sure there is something at this address */
|
|
if (i2c_smbus_xfer(client->adapter, client->addr, 0,
|
|
I2C_SMBUS_READ, 0, I2C_SMBUS_BYTE, &dummy) < 0)
|
|
return -ENODEV;
|
|
|
|
cyapa = devm_kzalloc(dev, sizeof(struct cyapa), GFP_KERNEL);
|
|
if (!cyapa)
|
|
return -ENOMEM;
|
|
|
|
/* i2c isn't supported, use smbus */
|
|
if (adapter_func == CYAPA_ADAPTER_FUNC_SMBUS)
|
|
cyapa->smbus = true;
|
|
|
|
cyapa->client = client;
|
|
i2c_set_clientdata(client, cyapa);
|
|
sprintf(cyapa->phys, "i2c-%d-%04x/input0", client->adapter->nr,
|
|
client->addr);
|
|
|
|
cyapa->vcc = devm_regulator_get(dev, "vcc");
|
|
if (IS_ERR(cyapa->vcc)) {
|
|
error = PTR_ERR(cyapa->vcc);
|
|
dev_err(dev, "failed to get vcc regulator: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
error = regulator_enable(cyapa->vcc);
|
|
if (error) {
|
|
dev_err(dev, "failed to enable regulator: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
error = devm_add_action(dev, cyapa_disable_regulator, cyapa);
|
|
if (error) {
|
|
cyapa_disable_regulator(cyapa);
|
|
dev_err(dev, "failed to add disable regulator action: %d\n",
|
|
error);
|
|
return error;
|
|
}
|
|
|
|
error = cyapa_initialize(cyapa);
|
|
if (error) {
|
|
dev_err(dev, "failed to detect and initialize tp device.\n");
|
|
return error;
|
|
}
|
|
|
|
error = devm_device_add_group(dev, &cyapa_sysfs_group);
|
|
if (error) {
|
|
dev_err(dev, "failed to create sysfs entries: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
error = cyapa_prepare_wakeup_controls(cyapa);
|
|
if (error) {
|
|
dev_err(dev, "failed to prepare wakeup controls: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
error = cyapa_start_runtime(cyapa);
|
|
if (error) {
|
|
dev_err(dev, "failed to start pm_runtime: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
error = devm_request_threaded_irq(dev, client->irq,
|
|
NULL, cyapa_irq,
|
|
IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
|
|
"cyapa", cyapa);
|
|
if (error) {
|
|
dev_err(dev, "failed to request threaded irq: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
/* Disable IRQ until the device is opened */
|
|
disable_irq(client->irq);
|
|
|
|
/*
|
|
* Register the device in the input subsystem when it's operational.
|
|
* Otherwise, keep in this driver, so it can be be recovered or updated
|
|
* through the sysfs mode and update_fw interfaces by user or apps.
|
|
*/
|
|
if (cyapa->operational) {
|
|
error = cyapa_create_input_dev(cyapa);
|
|
if (error) {
|
|
dev_err(dev, "create input_dev instance failed: %d\n",
|
|
error);
|
|
return error;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __maybe_unused cyapa_suspend(struct device *dev)
|
|
{
|
|
struct i2c_client *client = to_i2c_client(dev);
|
|
struct cyapa *cyapa = i2c_get_clientdata(client);
|
|
u8 power_mode;
|
|
int error;
|
|
|
|
error = mutex_lock_interruptible(&cyapa->state_sync_lock);
|
|
if (error)
|
|
return error;
|
|
|
|
/*
|
|
* Runtime PM is enable only when device is in operational mode and
|
|
* users in use, so need check it before disable it to
|
|
* avoid unbalance warning.
|
|
*/
|
|
if (pm_runtime_enabled(dev))
|
|
pm_runtime_disable(dev);
|
|
disable_irq(client->irq);
|
|
|
|
/*
|
|
* Set trackpad device to idle mode if wakeup is allowed,
|
|
* otherwise turn off.
|
|
*/
|
|
if (cyapa->operational) {
|
|
power_mode = device_may_wakeup(dev) ? cyapa->suspend_power_mode
|
|
: PWR_MODE_OFF;
|
|
error = cyapa->ops->set_power_mode(cyapa, power_mode,
|
|
cyapa->suspend_sleep_time, CYAPA_PM_SUSPEND);
|
|
if (error)
|
|
dev_err(dev, "suspend set power mode failed: %d\n",
|
|
error);
|
|
}
|
|
|
|
/*
|
|
* Disable proximity interrupt when system idle, want true touch to
|
|
* wake the system.
|
|
*/
|
|
if (cyapa->dev_pwr_mode != PWR_MODE_OFF)
|
|
cyapa->ops->set_proximity(cyapa, false);
|
|
|
|
if (device_may_wakeup(dev))
|
|
cyapa->irq_wake = (enable_irq_wake(client->irq) == 0);
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return 0;
|
|
}
|
|
|
|
static int __maybe_unused cyapa_resume(struct device *dev)
|
|
{
|
|
struct i2c_client *client = to_i2c_client(dev);
|
|
struct cyapa *cyapa = i2c_get_clientdata(client);
|
|
int error;
|
|
|
|
mutex_lock(&cyapa->state_sync_lock);
|
|
|
|
if (device_may_wakeup(dev) && cyapa->irq_wake) {
|
|
disable_irq_wake(client->irq);
|
|
cyapa->irq_wake = false;
|
|
}
|
|
|
|
/*
|
|
* Update device states and runtime PM states.
|
|
* Re-Enable proximity interrupt after enter operational mode.
|
|
*/
|
|
error = cyapa_reinitialize(cyapa);
|
|
if (error)
|
|
dev_warn(dev, "failed to reinitialize TP device: %d\n", error);
|
|
|
|
enable_irq(client->irq);
|
|
|
|
mutex_unlock(&cyapa->state_sync_lock);
|
|
return 0;
|
|
}
|
|
|
|
static int __maybe_unused cyapa_runtime_suspend(struct device *dev)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
int error;
|
|
|
|
error = cyapa->ops->set_power_mode(cyapa,
|
|
cyapa->runtime_suspend_power_mode,
|
|
cyapa->runtime_suspend_sleep_time,
|
|
CYAPA_PM_RUNTIME_SUSPEND);
|
|
if (error)
|
|
dev_warn(dev, "runtime suspend failed: %d\n", error);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __maybe_unused cyapa_runtime_resume(struct device *dev)
|
|
{
|
|
struct cyapa *cyapa = dev_get_drvdata(dev);
|
|
int error;
|
|
|
|
error = cyapa->ops->set_power_mode(cyapa,
|
|
PWR_MODE_FULL_ACTIVE, 0, CYAPA_PM_RUNTIME_RESUME);
|
|
if (error)
|
|
dev_warn(dev, "runtime resume failed: %d\n", error);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops cyapa_pm_ops = {
|
|
SET_SYSTEM_SLEEP_PM_OPS(cyapa_suspend, cyapa_resume)
|
|
SET_RUNTIME_PM_OPS(cyapa_runtime_suspend, cyapa_runtime_resume, NULL)
|
|
};
|
|
|
|
static const struct i2c_device_id cyapa_id_table[] = {
|
|
{ "cyapa", 0 },
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, cyapa_id_table);
|
|
|
|
#ifdef CONFIG_ACPI
|
|
static const struct acpi_device_id cyapa_acpi_id[] = {
|
|
{ "CYAP0000", 0 }, /* Gen3 trackpad with 0x67 I2C address. */
|
|
{ "CYAP0001", 0 }, /* Gen5 trackpad with 0x24 I2C address. */
|
|
{ "CYAP0002", 0 }, /* Gen6 trackpad with 0x24 I2C address. */
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(acpi, cyapa_acpi_id);
|
|
#endif
|
|
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id cyapa_of_match[] = {
|
|
{ .compatible = "cypress,cyapa" },
|
|
{ /* sentinel */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, cyapa_of_match);
|
|
#endif
|
|
|
|
static struct i2c_driver cyapa_driver = {
|
|
.driver = {
|
|
.name = "cyapa",
|
|
.pm = &cyapa_pm_ops,
|
|
.acpi_match_table = ACPI_PTR(cyapa_acpi_id),
|
|
.of_match_table = of_match_ptr(cyapa_of_match),
|
|
},
|
|
|
|
.probe = cyapa_probe,
|
|
.id_table = cyapa_id_table,
|
|
};
|
|
|
|
module_i2c_driver(cyapa_driver);
|
|
|
|
MODULE_DESCRIPTION("Cypress APA I2C Trackpad Driver");
|
|
MODULE_AUTHOR("Dudley Du <dudl@cypress.com>");
|
|
MODULE_LICENSE("GPL");
|