From nobody Wed Feb 11 04:27:42 2026 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 1F3B6C76196 for ; Sun, 2 Apr 2023 20:10:50 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230470AbjDBUKs (ORCPT ); Sun, 2 Apr 2023 16:10:48 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:45402 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S230331AbjDBUK1 (ORCPT ); Sun, 2 Apr 2023 16:10:27 -0400 Received: from mail-ed1-x52a.google.com (mail-ed1-x52a.google.com [IPv6:2a00:1450:4864:20::52a]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 2BC69CC05 for ; Sun, 2 Apr 2023 13:10:24 -0700 (PDT) Received: by mail-ed1-x52a.google.com with SMTP id eg48so109411485edb.13 for ; Sun, 02 Apr 2023 13:10:24 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=amarulasolutions.com; s=google; t=1680466222; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=JemIGhtdjG/TbtBcp8w+D7hK3pU2u0hM7wK5kdSBVec=; b=g9Tvx9lk/kHdQLQp48PShBumMe3X49wtUtPqxvPzc7nR+W4VM4FWh2CQSmNU4uuTH+ lKJoyCf9HKJHTs56uWU6Svf3cMFt4oieNoXsEW4o/NOK9rPLtJNw5OHDu9N4bb0Syw/3 L/J0LajmMQUGAQ7ZD14NR4xh8y6o1jJU0qikE= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; t=1680466222; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=JemIGhtdjG/TbtBcp8w+D7hK3pU2u0hM7wK5kdSBVec=; b=sQ3mSFfzJoydZKbXzylEidj5VjPHtyNaC9sr4jblbWKFAKYNar75ciUtOWzSAPkRUd Z+ep7Tz/neJQOQQy/Nj2yQnCQSu2kAkyiRVD4m6gH9ueeRsbJUMt2s/m+Y5tsuva7ipF 1f0W0uM6uydSeVcBfl7VR8dq3owv1mUV75QBuPj0gNkkCmuYfaRa+z0T7vLjHqA7utfN nwsNuhopmUti3kuBizrZzlyZHQ26viPbk1HTtLgzmgqbfLAN+/uEfEDB/ug2Ag9WHiS2 PBGoPQQI/xc9T4DAdXwkT69EJkmjOyq0URzMzWU7wUPxhZT23HLXBeNRzxH2lkipXbju PJIA== X-Gm-Message-State: AAQBX9fG9cPq3Th5rr9mNFjoKYFEhRKcAiohbvSA913Nrc0YgRkbeOlv P9bhiM+a3pQPRIZ6x2p9etoKZEipRbxDW4rRuJw= X-Google-Smtp-Source: AKy350YtG/43aQpznLS/lp3ljrl1GhQjLftorm/6C/YcYs2+SdFGqTFD6TqO50Jj7ygDmq+R0u0qug== X-Received: by 2002:a05:6402:450:b0:4fa:e8f3:9685 with SMTP id p16-20020a056402045000b004fae8f39685mr31991889edw.28.1680466222111; Sun, 02 Apr 2023 13:10:22 -0700 (PDT) Received: from dario-ThinkPad-T14s-Gen-2i.homenet.telecomitalia.it (host-95-248-31-153.retail.telecomitalia.it. [95.248.31.153]) by smtp.gmail.com with ESMTPSA id gl18-20020a170906e0d200b00924d38bbdc0sm3553127ejb.105.2023.04.02.13.10.20 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Sun, 02 Apr 2023 13:10:21 -0700 (PDT) From: Dario Binacchi To: linux-kernel@vger.kernel.org Cc: michael@amarulasolutions.com, linux-amarula@amarulasolutions.com, Dario Binacchi , Dmitry Torokhov , Jonathan Cameron , Oliver Graute , =?UTF-8?q?Uwe=20Kleine-K=C3=B6nig?= , Wolfram Sang , linux-input@vger.kernel.org Subject: [PATCH 7/9] Input: edt-ft5x06 - convert to use regmap API Date: Sun, 2 Apr 2023 22:09:49 +0200 Message-Id: <20230402200951.1032513-8-dario.binacchi@amarulasolutions.com> X-Mailer: git-send-email 2.32.0 In-Reply-To: <20230402200951.1032513-1-dario.binacchi@amarulasolutions.com> References: <20230402200951.1032513-1-dario.binacchi@amarulasolutions.com> MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org It replaces custom read/write functions with regmap API, making the driver code more generic. Signed-off-by: Dario Binacchi --- drivers/input/touchscreen/edt-ft5x06.c | 424 +++++++++++++------------ 1 file changed, 214 insertions(+), 210 deletions(-) diff --git a/drivers/input/touchscreen/edt-ft5x06.c b/drivers/input/touchsc= reen/edt-ft5x06.c index 89958881fca1..8aae4c1e6b73 100644 --- a/drivers/input/touchscreen/edt-ft5x06.c +++ b/drivers/input/touchscreen/edt-ft5x06.c @@ -3,6 +3,7 @@ * Copyright (C) 2012 Simon Budig, * Daniel Wagener (M09 firmware support) * Lothar Wa=C3=9Fmann (DT support) + * Dario Binacchi (regmap support) */ =20 /* @@ -26,6 +27,7 @@ #include #include #include +#include #include #include #include @@ -115,6 +117,8 @@ struct edt_ft5x06_ts_data { struct gpio_desc *reset_gpio; struct gpio_desc *wake_gpio; =20 + struct regmap *regmap; + #if defined(CONFIG_DEBUG_FS) struct dentry *debug_dir; u8 *raw_buffer; @@ -145,37 +149,10 @@ struct edt_i2c_chip_data { int max_support_points; }; =20 -static int edt_ft5x06_ts_readwrite(struct i2c_client *client, - u16 wr_len, u8 *wr_buf, - u16 rd_len, u8 *rd_buf) -{ - struct i2c_msg wrmsg[2]; - int i =3D 0; - int ret; - - if (wr_len) { - wrmsg[i].addr =3D client->addr; - wrmsg[i].flags =3D 0; - wrmsg[i].len =3D wr_len; - wrmsg[i].buf =3D wr_buf; - i++; - } - if (rd_len) { - wrmsg[i].addr =3D client->addr; - wrmsg[i].flags =3D I2C_M_RD; - wrmsg[i].len =3D rd_len; - wrmsg[i].buf =3D rd_buf; - i++; - } - - ret =3D i2c_transfer(client->adapter, wrmsg, i); - if (ret < 0) - return ret; - if (ret !=3D i) - return -EIO; - - return 0; -} +static const struct regmap_config edt_ft5x06_i2c_regmap_config =3D { + .reg_bits =3D 8, + .val_bits =3D 8, +}; =20 static bool edt_ft5x06_ts_check_crc(struct edt_ft5x06_ts_data *tsdata, u8 *buf, int buflen) @@ -197,6 +174,127 @@ static bool edt_ft5x06_ts_check_crc(struct edt_ft5x06= _ts_data *tsdata, return true; } =20 +static int edt_M06_i2c_read(void *context, const void *reg_buf, size_t reg= _size, + void *val_buf, size_t val_size) +{ + struct device *dev =3D context; + struct i2c_client *i2c =3D to_i2c_client(dev); + struct edt_ft5x06_ts_data *tsdata =3D i2c_get_clientdata(i2c); + struct i2c_msg xfer[2]; + bool reg_read =3D false; + u8 addr; + u8 wlen; + u8 wbuf[4], rbuf[3]; + int ret; + + addr =3D *((u8 *)reg_buf); + wbuf[0] =3D addr; + switch (addr) { + case 0xf5: + wlen =3D 3; + wbuf[0] =3D 0xf5; + wbuf[1] =3D 0xe; + wbuf[2] =3D *((u8 *)val_buf); + break; + case 0xf9: + wlen =3D 1; + break; + default: + wlen =3D 2; + reg_read =3D true; + wbuf[0] =3D M06_REG_CMD(tsdata->factory_mode); + wbuf[1] =3D M06_REG_ADDR(tsdata->factory_mode, addr); + wbuf[1] |=3D tsdata->factory_mode ? 0x80 : 0x40; + } + + xfer[0].addr =3D i2c->addr; + xfer[0].flags =3D 0; + xfer[0].len =3D wlen; + xfer[0].buf =3D wbuf; + + xfer[1].addr =3D i2c->addr; + xfer[1].flags =3D I2C_M_RD; + xfer[1].len =3D reg_read ? 2 : val_size; + xfer[1].buf =3D reg_read ? rbuf : val_buf; + + ret =3D i2c_transfer(i2c->adapter, xfer, 2); + if (ret !=3D 2) { + if (ret < 0) + return ret; + + return -EIO; + } + + if (addr =3D=3D 0xf9) { + u8 *buf =3D (u8 *)val_buf; + + if (buf[0] !=3D 0xaa || buf[1] !=3D 0xaa || + buf[2] !=3D val_size) { + tsdata->header_errors++; + dev_err_ratelimited(dev, + "Unexpected header: %02x%02x%02x\n", + buf[0], buf[1], buf[2]); + return -EIO; + } + + if (!edt_ft5x06_ts_check_crc(tsdata, val_buf, val_size)) + return -EIO; + } else if (reg_read) { + u8 crc =3D wbuf[0] ^ wbuf[1] ^ rbuf[0]; + + if (crc !=3D rbuf[1]) { + dev_err(dev, "crc error: 0x%02x expected, got 0x%02x\n", + crc, rbuf[1]); + return -EIO; + } + + *((u8 *)val_buf) =3D rbuf[0]; + } + + return 0; +} + +static int edt_M06_i2c_write(void *context, const void *data, size_t count) +{ + struct device *dev =3D context; + struct i2c_client *i2c =3D to_i2c_client(dev); + struct edt_ft5x06_ts_data *tsdata =3D i2c_get_clientdata(i2c); + u8 addr, val; + u8 wbuf[4]; + struct i2c_msg xfer; + int ret; + + addr =3D *((u8 *)data); + val =3D *((u8 *)data + 1); + + wbuf[0] =3D M06_REG_CMD(tsdata->factory_mode); + wbuf[1] =3D M06_REG_ADDR(tsdata->factory_mode, addr); + wbuf[2] =3D val; + wbuf[3] =3D wbuf[0] ^ wbuf[1] ^ wbuf[2]; + + xfer.addr =3D i2c->addr; + xfer.flags =3D 0; + xfer.len =3D 4; + xfer.buf =3D wbuf; + + ret =3D i2c_transfer(i2c->adapter, &xfer, 1); + if (ret !=3D 1) { + if (ret < 0) + return ret; + + return -EIO; + } + + return 0; +} + +static const struct regmap_config edt_M06_i2c_regmap_config =3D { + .reg_bits =3D 8, + .val_bits =3D 8, + .read =3D edt_M06_i2c_read, + .write =3D edt_M06_i2c_write, +}; + static irqreturn_t edt_ft5x06_ts_isr(int irq, void *dev_id) { struct edt_ft5x06_ts_data *tsdata =3D dev_id; @@ -232,30 +330,13 @@ static irqreturn_t edt_ft5x06_ts_isr(int irq, void *d= ev_id) memset(rdbuf, 0, sizeof(rdbuf)); datalen =3D tplen * tsdata->max_support_points + offset + crclen; =20 - error =3D edt_ft5x06_ts_readwrite(tsdata->client, - sizeof(cmd), &cmd, - datalen, rdbuf); + error =3D regmap_bulk_read(tsdata->regmap, cmd, rdbuf, datalen); if (error) { dev_err_ratelimited(dev, "Unable to fetch data, error: %d\n", error); goto out; } =20 - /* M09/M12 does not send header or CRC */ - if (tsdata->version =3D=3D EDT_M06) { - if (rdbuf[0] !=3D 0xaa || rdbuf[1] !=3D 0xaa || - rdbuf[2] !=3D datalen) { - tsdata->header_errors++; - dev_err_ratelimited(dev, - "Unexpected header: %02x%02x%02x!\n", - rdbuf[0], rdbuf[1], rdbuf[2]); - goto out; - } - - if (!edt_ft5x06_ts_check_crc(tsdata, rdbuf, datalen)) - goto out; - } - for (i =3D 0; i < tsdata->max_support_points; i++) { u8 *buf =3D &rdbuf[i * tplen + offset]; =20 @@ -290,79 +371,6 @@ static irqreturn_t edt_ft5x06_ts_isr(int irq, void *de= v_id) return IRQ_HANDLED; } =20 -static int edt_ft5x06_register_write(struct edt_ft5x06_ts_data *tsdata, - u8 addr, u8 value) -{ - u8 wrbuf[4]; - - switch (tsdata->version) { - case EDT_M06: - wrbuf[0] =3D M06_REG_CMD(tsdata->factory_mode); - wrbuf[1] =3D M06_REG_ADDR(tsdata->factory_mode, addr); - wrbuf[2] =3D value; - wrbuf[3] =3D wrbuf[0] ^ wrbuf[1] ^ wrbuf[2]; - return edt_ft5x06_ts_readwrite(tsdata->client, 4, - wrbuf, 0, NULL); - - case EDT_M09: - case EDT_M12: - case EV_FT: - case GENERIC_FT: - wrbuf[0] =3D addr; - wrbuf[1] =3D value; - - return edt_ft5x06_ts_readwrite(tsdata->client, 2, - wrbuf, 0, NULL); - - default: - return -EINVAL; - } -} - -static int edt_ft5x06_register_read(struct edt_ft5x06_ts_data *tsdata, - u8 addr) -{ - u8 wrbuf[2], rdbuf[2], crc; - int error; - - switch (tsdata->version) { - case EDT_M06: - wrbuf[0] =3D M06_REG_CMD(tsdata->factory_mode); - wrbuf[1] =3D M06_REG_ADDR(tsdata->factory_mode, addr); - wrbuf[1] |=3D tsdata->factory_mode ? 0x80 : 0x40; - - error =3D edt_ft5x06_ts_readwrite(tsdata->client, 2, wrbuf, 2, - rdbuf); - if (error) - return error; - - crc =3D wrbuf[0] ^ wrbuf[1] ^ rdbuf[0]; - if (crc !=3D rdbuf[1]) { - dev_err(&tsdata->client->dev, - "crc error: 0x%02x expected, got 0x%02x\n", - crc, rdbuf[1]); - return -EIO; - } - break; - - case EDT_M09: - case EDT_M12: - case EV_FT: - case GENERIC_FT: - wrbuf[0] =3D addr; - error =3D edt_ft5x06_ts_readwrite(tsdata->client, 1, - wrbuf, 1, rdbuf); - if (error) - return error; - break; - - default: - return -EINVAL; - } - - return rdbuf[0]; -} - struct edt_ft5x06_attribute { struct device_attribute dattr; size_t field_offset; @@ -396,7 +404,7 @@ static ssize_t edt_ft5x06_setting_show(struct device *d= ev, struct edt_ft5x06_attribute *attr =3D container_of(dattr, struct edt_ft5x06_attribute, dattr); u8 *field =3D (u8 *)tsdata + attr->field_offset; - int val; + unsigned int val; size_t count =3D 0; int error =3D 0; u8 addr; @@ -429,9 +437,8 @@ static ssize_t edt_ft5x06_setting_show(struct device *d= ev, } =20 if (addr !=3D NO_REGISTER) { - val =3D edt_ft5x06_register_read(tsdata, addr); - if (val < 0) { - error =3D val; + error =3D regmap_read(tsdata->regmap, addr, &val); + if (error) { dev_err(&tsdata->client->dev, "Failed to fetch attribute %s, error %d\n", dattr->attr.name, error); @@ -504,7 +511,7 @@ static ssize_t edt_ft5x06_setting_store(struct device *= dev, } =20 if (addr !=3D NO_REGISTER) { - error =3D edt_ft5x06_register_write(tsdata, addr, val); + error =3D regmap_write(tsdata->regmap, addr, val); if (error) { dev_err(&tsdata->client->dev, "Failed to update attribute %s, error: %d\n", @@ -605,23 +612,19 @@ static const struct attribute_group edt_ft5x06_attr_g= roup =3D { static void edt_ft5x06_restore_reg_parameters(struct edt_ft5x06_ts_data *t= sdata) { struct edt_reg_addr *reg_addr =3D &tsdata->reg_addr; + struct regmap *regmap =3D tsdata->regmap; =20 - edt_ft5x06_register_write(tsdata, reg_addr->reg_threshold, - tsdata->threshold); - edt_ft5x06_register_write(tsdata, reg_addr->reg_gain, - tsdata->gain); + regmap_write(regmap, reg_addr->reg_threshold, tsdata->threshold); + regmap_write(regmap, reg_addr->reg_gain, tsdata->gain); if (reg_addr->reg_offset !=3D NO_REGISTER) - edt_ft5x06_register_write(tsdata, reg_addr->reg_offset, - tsdata->offset); + regmap_write(regmap, reg_addr->reg_offset, tsdata->offset); if (reg_addr->reg_offset_x !=3D NO_REGISTER) - edt_ft5x06_register_write(tsdata, reg_addr->reg_offset_x, - tsdata->offset_x); + regmap_write(regmap, reg_addr->reg_offset_x, tsdata->offset_x); if (reg_addr->reg_offset_y !=3D NO_REGISTER) - edt_ft5x06_register_write(tsdata, reg_addr->reg_offset_y, - tsdata->offset_y); + regmap_write(regmap, reg_addr->reg_offset_y, tsdata->offset_y); if (reg_addr->reg_report_rate !=3D NO_REGISTER) - edt_ft5x06_register_write(tsdata, reg_addr->reg_report_rate, - tsdata->report_rate); + regmap_write(regmap, reg_addr->reg_report_rate, + tsdata->report_rate); } =20 #ifdef CONFIG_DEBUG_FS @@ -629,7 +632,7 @@ static int edt_ft5x06_factory_mode(struct edt_ft5x06_ts= _data *tsdata) { struct i2c_client *client =3D tsdata->client; int retries =3D EDT_SWITCH_MODE_RETRIES; - int ret; + unsigned int val; int error; =20 if (tsdata->version !=3D EDT_M06) { @@ -651,7 +654,7 @@ static int edt_ft5x06_factory_mode(struct edt_ft5x06_ts= _data *tsdata) } =20 /* mode register is 0x3c when in the work mode */ - error =3D edt_ft5x06_register_write(tsdata, WORK_REGISTER_OPMODE, 0x03); + error =3D regmap_write(tsdata->regmap, WORK_REGISTER_OPMODE, 0x03); if (error) { dev_err(&client->dev, "failed to switch to factory mode, error %d\n", error); @@ -662,8 +665,9 @@ static int edt_ft5x06_factory_mode(struct edt_ft5x06_ts= _data *tsdata) do { mdelay(EDT_SWITCH_MODE_DELAY); /* mode register is 0x01 when in factory mode */ - ret =3D edt_ft5x06_register_read(tsdata, FACTORY_REGISTER_OPMODE); - if (ret =3D=3D 0x03) + error =3D regmap_read(tsdata->regmap, FACTORY_REGISTER_OPMODE, + &val); + if (!error && val =3D=3D 0x03) break; } while (--retries > 0); =20 @@ -689,11 +693,11 @@ static int edt_ft5x06_work_mode(struct edt_ft5x06_ts_= data *tsdata) { struct i2c_client *client =3D tsdata->client; int retries =3D EDT_SWITCH_MODE_RETRIES; - int ret; + unsigned int val; int error; =20 /* mode register is 0x01 when in the factory mode */ - error =3D edt_ft5x06_register_write(tsdata, FACTORY_REGISTER_OPMODE, 0x1); + error =3D regmap_write(tsdata->regmap, FACTORY_REGISTER_OPMODE, 0x1); if (error) { dev_err(&client->dev, "failed to switch to work mode, error: %d\n", error); @@ -705,8 +709,8 @@ static int edt_ft5x06_work_mode(struct edt_ft5x06_ts_da= ta *tsdata) do { mdelay(EDT_SWITCH_MODE_DELAY); /* mode register is 0x01 when in factory mode */ - ret =3D edt_ft5x06_register_read(tsdata, WORK_REGISTER_OPMODE); - if (ret =3D=3D 0x01) + error =3D regmap_read(tsdata->regmap, WORK_REGISTER_OPMODE, &val); + if (!error && val =3D=3D 0x01) break; } while (--retries > 0); =20 @@ -765,10 +769,10 @@ static ssize_t edt_ft5x06_debugfs_raw_data_read(struc= t file *file, struct edt_ft5x06_ts_data *tsdata =3D file->private_data; struct i2c_client *client =3D tsdata->client; int retries =3D EDT_RAW_DATA_RETRIES; - int val, i, error; + unsigned int val; + int i, error; size_t read =3D 0; int colbytes; - char wrbuf[3]; u8 *rdbuf; =20 if (*off < 0 || *off >=3D tsdata->raw_bufsize) @@ -781,7 +785,7 @@ static ssize_t edt_ft5x06_debugfs_raw_data_read(struct = file *file, goto out; } =20 - error =3D edt_ft5x06_register_write(tsdata, 0x08, 0x01); + error =3D regmap_write(tsdata->regmap, 0x08, 0x01); if (error) { dev_err(&client->dev, "failed to write 0x08 register, error %d\n", error); @@ -790,18 +794,18 @@ static ssize_t edt_ft5x06_debugfs_raw_data_read(struc= t file *file, =20 do { usleep_range(EDT_RAW_DATA_DELAY, EDT_RAW_DATA_DELAY + 100); - val =3D edt_ft5x06_register_read(tsdata, 0x08); - if (val < 1) + error =3D regmap_read(tsdata->regmap, 0x08, &val); + if (error) { + dev_err(&client->dev, + "failed to read 0x08 register, error %d\n", + error); + goto out; + } + + if (val =3D=3D 1) break; } while (--retries > 0); =20 - if (val < 0) { - error =3D val; - dev_err(&client->dev, - "failed to read 0x08 register, error %d\n", error); - goto out; - } - if (retries =3D=3D 0) { dev_err(&client->dev, "timed out waiting for register to settle\n"); @@ -812,13 +816,9 @@ static ssize_t edt_ft5x06_debugfs_raw_data_read(struct= file *file, rdbuf =3D tsdata->raw_buffer; colbytes =3D tsdata->num_y * sizeof(u16); =20 - wrbuf[0] =3D 0xf5; - wrbuf[1] =3D 0x0e; for (i =3D 0; i < tsdata->num_x; i++) { - wrbuf[2] =3D i; /* column index */ - error =3D edt_ft5x06_ts_readwrite(tsdata->client, - sizeof(wrbuf), wrbuf, - colbytes, rdbuf); + rdbuf[0] =3D i; /* column index */ + error =3D regmap_bulk_read(tsdata->regmap, 0xf5, rdbuf, colbytes); if (error) goto out; =20 @@ -894,8 +894,7 @@ static int edt_ft5x06_ts_identify(struct i2c_client *cl= ient, * to have garbage in there */ memset(rdbuf, 0, sizeof(rdbuf)); - error =3D edt_ft5x06_ts_readwrite(client, 1, "\xBB", - EDT_NAME_LEN - 1, rdbuf); + error =3D regmap_bulk_read(tsdata->regmap, 0xBB, rdbuf, EDT_NAME_LEN - 1); if (error) return error; =20 @@ -917,6 +916,14 @@ static int edt_ft5x06_ts_identify(struct i2c_client *c= lient, *p++ =3D '\0'; strscpy(model_name, rdbuf + 1, EDT_NAME_LEN); strscpy(fw_version, p ? p : "", EDT_NAME_LEN); + + regmap_exit(tsdata->regmap); + tsdata->regmap =3D regmap_init_i2c(client, + &edt_M06_i2c_regmap_config); + if (IS_ERR(tsdata->regmap)) { + dev_err(&client->dev, "regmap allocation failed\n"); + return PTR_ERR(tsdata->regmap); + } } else if (!strncasecmp(rdbuf, "EP0", 3)) { tsdata->version =3D EDT_M12; =20 @@ -943,15 +950,13 @@ static int edt_ft5x06_ts_identify(struct i2c_client *= client, */ tsdata->version =3D GENERIC_FT; =20 - error =3D edt_ft5x06_ts_readwrite(client, 1, "\xA6", - 2, rdbuf); + error =3D regmap_bulk_read(tsdata->regmap, 0xA6, rdbuf, 2); if (error) return error; =20 strscpy(fw_version, rdbuf, 2); =20 - error =3D edt_ft5x06_ts_readwrite(client, 1, "\xA8", - 1, rdbuf); + error =3D regmap_bulk_read(tsdata->regmap, 0xA8, rdbuf, 1); if (error) return error; =20 @@ -980,8 +985,7 @@ static int edt_ft5x06_ts_identify(struct i2c_client *cl= ient, break; case 0x59: /* Evervision Display with FT5xx6 TS */ tsdata->version =3D EV_FT; - error =3D edt_ft5x06_ts_readwrite(client, 1, "\x53", - 1, rdbuf); + error =3D regmap_bulk_read(tsdata->regmap, 0x53, rdbuf, 1); if (error) return error; strscpy(fw_version, rdbuf, 1); @@ -1003,42 +1007,40 @@ static void edt_ft5x06_ts_get_defaults(struct devic= e *dev, struct edt_ft5x06_ts_data *tsdata) { struct edt_reg_addr *reg_addr =3D &tsdata->reg_addr; + struct regmap *regmap =3D tsdata->regmap; u32 val; int error; =20 error =3D device_property_read_u32(dev, "threshold", &val); if (!error) { - edt_ft5x06_register_write(tsdata, reg_addr->reg_threshold, val); + regmap_write(regmap, reg_addr->reg_threshold, val); tsdata->threshold =3D val; } =20 error =3D device_property_read_u32(dev, "gain", &val); if (!error) { - edt_ft5x06_register_write(tsdata, reg_addr->reg_gain, val); + regmap_write(regmap, reg_addr->reg_gain, val); tsdata->gain =3D val; } =20 error =3D device_property_read_u32(dev, "offset", &val); if (!error) { if (reg_addr->reg_offset !=3D NO_REGISTER) - edt_ft5x06_register_write(tsdata, - reg_addr->reg_offset, val); + regmap_write(regmap, reg_addr->reg_offset, val); tsdata->offset =3D val; } =20 error =3D device_property_read_u32(dev, "offset-x", &val); if (!error) { if (reg_addr->reg_offset_x !=3D NO_REGISTER) - edt_ft5x06_register_write(tsdata, - reg_addr->reg_offset_x, val); + regmap_write(regmap, reg_addr->reg_offset_x, val); tsdata->offset_x =3D val; } =20 error =3D device_property_read_u32(dev, "offset-y", &val); if (!error) { if (reg_addr->reg_offset_y !=3D NO_REGISTER) - edt_ft5x06_register_write(tsdata, - reg_addr->reg_offset_y, val); + regmap_write(regmap, reg_addr->reg_offset_y, val); tsdata->offset_y =3D val; } } @@ -1046,33 +1048,30 @@ static void edt_ft5x06_ts_get_defaults(struct devic= e *dev, static void edt_ft5x06_ts_get_parameters(struct edt_ft5x06_ts_data *tsdata) { struct edt_reg_addr *reg_addr =3D &tsdata->reg_addr; + struct regmap *regmap =3D tsdata->regmap; + unsigned int val; =20 - tsdata->threshold =3D edt_ft5x06_register_read(tsdata, - reg_addr->reg_threshold); - tsdata->gain =3D edt_ft5x06_register_read(tsdata, reg_addr->reg_gain); + regmap_read(regmap, reg_addr->reg_threshold, &tsdata->threshold); + regmap_read(regmap, reg_addr->reg_gain, &tsdata->gain); if (reg_addr->reg_offset !=3D NO_REGISTER) - tsdata->offset =3D - edt_ft5x06_register_read(tsdata, reg_addr->reg_offset); + regmap_read(regmap, reg_addr->reg_offset, &tsdata->offset); if (reg_addr->reg_offset_x !=3D NO_REGISTER) - tsdata->offset_x =3D - edt_ft5x06_register_read(tsdata, - reg_addr->reg_offset_x); + regmap_read(regmap, reg_addr->reg_offset_x, &tsdata->offset_x); if (reg_addr->reg_offset_y !=3D NO_REGISTER) - tsdata->offset_y =3D - edt_ft5x06_register_read(tsdata, - reg_addr->reg_offset_y); + regmap_read(regmap, reg_addr->reg_offset_y, &tsdata->offset_y); if (reg_addr->reg_report_rate !=3D NO_REGISTER) - tsdata->report_rate =3D - edt_ft5x06_register_read(tsdata, - reg_addr->reg_report_rate); + regmap_read(regmap, reg_addr->reg_report_rate, + &tsdata->report_rate); tsdata->num_x =3D EDT_DEFAULT_NUM_X; - if (reg_addr->reg_num_x !=3D NO_REGISTER) - tsdata->num_x =3D edt_ft5x06_register_read(tsdata, - reg_addr->reg_num_x); + if (reg_addr->reg_num_x !=3D NO_REGISTER) { + if (!regmap_read(regmap, reg_addr->reg_num_x, &val)) + tsdata->num_x =3D val; + } tsdata->num_y =3D EDT_DEFAULT_NUM_Y; - if (reg_addr->reg_num_y !=3D NO_REGISTER) - tsdata->num_y =3D edt_ft5x06_register_read(tsdata, - reg_addr->reg_num_y); + if (reg_addr->reg_num_y !=3D NO_REGISTER) { + if (!regmap_read(regmap, reg_addr->reg_num_y, &val)) + tsdata->num_y =3D val; + } } =20 static void edt_ft5x06_ts_set_regs(struct edt_ft5x06_ts_data *tsdata) @@ -1142,7 +1141,7 @@ static int edt_ft5x06_ts_probe(struct i2c_client *cli= ent) const struct i2c_device_id *id =3D i2c_client_get_device_id(client); const struct edt_i2c_chip_data *chip_data; struct edt_ft5x06_ts_data *tsdata; - u8 buf[2] =3D { 0xfc, 0x00 }; + unsigned int val; struct input_dev *input; unsigned long irq_flags; int error; @@ -1156,6 +1155,12 @@ static int edt_ft5x06_ts_probe(struct i2c_client *cl= ient) return -ENOMEM; } =20 + tsdata->regmap =3D regmap_init_i2c(client, &edt_ft5x06_i2c_regmap_config); + if (IS_ERR(tsdata->regmap)) { + dev_err(&client->dev, "regmap allocation failed\n"); + return PTR_ERR(tsdata->regmap); + } + chip_data =3D device_get_match_data(&client->dev); if (!chip_data) chip_data =3D (const struct edt_i2c_chip_data *)id->driver_data; @@ -1258,6 +1263,7 @@ static int edt_ft5x06_ts_probe(struct i2c_client *cli= ent) tsdata->client =3D client; tsdata->input =3D input; tsdata->factory_mode =3D false; + i2c_set_clientdata(client, tsdata); =20 error =3D edt_ft5x06_ts_identify(client, tsdata); if (error) { @@ -1269,7 +1275,7 @@ static int edt_ft5x06_ts_probe(struct i2c_client *cli= ent) * Dummy read access. EP0700MLP1 returns bogus data on the first * register read access and ignores writes. */ - edt_ft5x06_ts_readwrite(tsdata->client, 2, buf, 2, buf); + regmap_read(tsdata->regmap, 0x00, &val); =20 edt_ft5x06_ts_set_regs(tsdata); edt_ft5x06_ts_get_defaults(&client->dev, tsdata); @@ -1291,9 +1297,8 @@ static int edt_ft5x06_ts_probe(struct i2c_client *cli= ent) if (tsdata->version =3D=3D EDT_M06) tsdata->report_rate /=3D 10; =20 - edt_ft5x06_register_write(tsdata, - tsdata->reg_addr.reg_report_rate, - tsdata->report_rate); + regmap_write(tsdata->regmap, tsdata->reg_addr.reg_report_rate, + tsdata->report_rate); } =20 dev_dbg(&client->dev, @@ -1318,8 +1323,6 @@ static int edt_ft5x06_ts_probe(struct i2c_client *cli= ent) return error; } =20 - i2c_set_clientdata(client, tsdata); - irq_flags =3D irq_get_trigger_type(client->irq); if (irq_flags =3D=3D IRQF_TRIGGER_NONE) irq_flags =3D IRQF_TRIGGER_FALLING; @@ -1357,6 +1360,7 @@ static void edt_ft5x06_ts_remove(struct i2c_client *c= lient) struct edt_ft5x06_ts_data *tsdata =3D i2c_get_clientdata(client); =20 edt_ft5x06_ts_teardown_debugfs(tsdata); + regmap_exit(tsdata->regmap); } =20 static int edt_ft5x06_ts_suspend(struct device *dev) @@ -1373,8 +1377,8 @@ static int edt_ft5x06_ts_suspend(struct device *dev) return 0; =20 /* Enter hibernate mode. */ - ret =3D edt_ft5x06_register_write(tsdata, PMOD_REGISTER_OPMODE, - PMOD_REGISTER_HIBERNATE); + ret =3D regmap_write(tsdata->regmap, PMOD_REGISTER_OPMODE, + PMOD_REGISTER_HIBERNATE); if (ret) dev_warn(dev, "Failed to set hibernate mode\n"); =20 --=20 2.32.0