1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231 |
- #include <linux/acpi.h>
- #include <linux/delay.h>
- #include <linux/firmware.h>
- #include <linux/gpio/consumer.h>
- #include <linux/i2c.h>
- #include <linux/input.h>
- #include <linux/input/mt.h>
- #include <linux/interrupt.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/regulator/consumer.h>
- #include <linux/slab.h>
- #include <asm/unaligned.h>
- #define RM_BOOT_BLDR 0x02
- #define RM_BOOT_MAIN 0x03
- #define RM_CMD_BOOT_PAGE_WRT 0x0B
- #define RM_CMD_BOOT_WRT 0x11
- #define RM_CMD_BOOT_ACK 0x22
- #define RM_CMD_BOOT_CHK 0x33
- #define RM_CMD_BOOT_READ 0x44
- #define RM_BOOT_RDY 0xFF
- #define RM_CMD_QUERY_BANK 0x2B
- #define RM_CMD_DATA_BANK 0x4D
- #define RM_CMD_ENTER_SLEEP 0x4E
- #define RM_CMD_BANK_SWITCH 0xAA
- #define RM_RESET_MSG_ADDR 0x40000004
- #define RM_MAX_READ_SIZE 56
- #define RM_PACKET_CRC_SIZE 2
- #define RM_MAX_RETRIES 3
- #define RM_MAX_TOUCH_NUM 10
- #define RM_BOOT_DELAY_MS 100
- #define RM_CONTACT_STATE_POS 0
- #define RM_CONTACT_X_POS 1
- #define RM_CONTACT_Y_POS 3
- #define RM_CONTACT_PRESSURE_POS 5
- #define RM_CONTACT_WIDTH_X_POS 6
- #define RM_CONTACT_WIDTH_Y_POS 7
- #define RM_BL_WRT_CMD_SIZE 3
- #define RM_BL_WRT_PKG_SIZE 32
- #define RM_BL_WRT_LEN (RM_BL_WRT_PKG_SIZE + RM_BL_WRT_CMD_SIZE)
- #define RM_FW_PAGE_SIZE 128
- #define RM_MAX_FW_RETRIES 30
- #define RM_MAX_FW_SIZE 0xD000
- #define RM_POWERON_DELAY_USEC 500
- #define RM_RESET_DELAY_MSEC 50
- enum raydium_bl_cmd {
- BL_HEADER = 0,
- BL_PAGE_STR,
- BL_PKG_IDX,
- BL_DATA_STR,
- };
- enum raydium_bl_ack {
- RAYDIUM_ACK_NULL = 0,
- RAYDIUM_WAIT_READY,
- RAYDIUM_PATH_READY,
- };
- enum raydium_boot_mode {
- RAYDIUM_TS_MAIN = 0,
- RAYDIUM_TS_BLDR,
- };
- struct raydium_data_info {
- __le32 data_bank_addr;
- u8 pkg_size;
- u8 tp_info_size;
- };
- struct raydium_info {
- __le32 hw_ver;
- u8 main_ver;
- u8 sub_ver;
- __le16 ft_ver;
- u8 x_num;
- u8 y_num;
- __le16 x_max;
- __le16 y_max;
- u8 x_res;
- u8 y_res;
- };
- struct raydium_data {
- struct i2c_client *client;
- struct input_dev *input;
- struct regulator *avdd;
- struct regulator *vccio;
- struct gpio_desc *reset_gpio;
- struct raydium_info info;
- struct mutex sysfs_mutex;
- u8 *report_data;
- u32 data_bank_addr;
- u8 report_size;
- u8 contact_size;
- u8 pkg_size;
- enum raydium_boot_mode boot_mode;
- bool wake_irq_enabled;
- };
- static int raydium_i2c_send(struct i2c_client *client,
- u8 addr, const void *data, size_t len)
- {
- u8 *buf;
- int tries = 0;
- int ret;
- buf = kmalloc(len + 1, GFP_KERNEL);
- if (!buf)
- return -ENOMEM;
- buf[0] = addr;
- memcpy(buf + 1, data, len);
- do {
- ret = i2c_master_send(client, buf, len + 1);
- if (likely(ret == len + 1))
- break;
- msleep(20);
- } while (++tries < RM_MAX_RETRIES);
- kfree(buf);
- if (unlikely(ret != len + 1)) {
- if (ret >= 0)
- ret = -EIO;
- dev_err(&client->dev, "%s failed: %d\n", __func__, ret);
- return ret;
- }
- return 0;
- }
- static int raydium_i2c_read(struct i2c_client *client,
- u8 addr, void *data, size_t len)
- {
- struct i2c_msg xfer[] = {
- {
- .addr = client->addr,
- .len = 1,
- .buf = &addr,
- },
- {
- .addr = client->addr,
- .flags = I2C_M_RD,
- .len = len,
- .buf = data,
- }
- };
- int ret;
- ret = i2c_transfer(client->adapter, xfer, ARRAY_SIZE(xfer));
- if (unlikely(ret != ARRAY_SIZE(xfer)))
- return ret < 0 ? ret : -EIO;
- return 0;
- }
- static int raydium_i2c_read_message(struct i2c_client *client,
- u32 addr, void *data, size_t len)
- {
- __be32 be_addr;
- size_t xfer_len;
- int error;
- while (len) {
- xfer_len = min_t(size_t, len, RM_MAX_READ_SIZE);
- be_addr = cpu_to_be32(addr);
- error = raydium_i2c_send(client, RM_CMD_BANK_SWITCH,
- &be_addr, sizeof(be_addr));
- if (!error)
- error = raydium_i2c_read(client, addr & 0xff,
- data, xfer_len);
- if (error)
- return error;
- len -= xfer_len;
- data += xfer_len;
- addr += xfer_len;
- }
- return 0;
- }
- static int raydium_i2c_send_message(struct i2c_client *client,
- u32 addr, const void *data, size_t len)
- {
- __be32 be_addr = cpu_to_be32(addr);
- int error;
- error = raydium_i2c_send(client, RM_CMD_BANK_SWITCH,
- &be_addr, sizeof(be_addr));
- if (!error)
- error = raydium_i2c_send(client, addr & 0xff, data, len);
- return error;
- }
- static int raydium_i2c_sw_reset(struct i2c_client *client)
- {
- const u8 soft_rst_cmd = 0x01;
- int error;
- error = raydium_i2c_send_message(client, RM_RESET_MSG_ADDR,
- &soft_rst_cmd, sizeof(soft_rst_cmd));
- if (error) {
- dev_err(&client->dev, "software reset failed: %d\n", error);
- return error;
- }
- msleep(RM_RESET_DELAY_MSEC);
- return 0;
- }
- static int raydium_i2c_query_ts_info(struct raydium_data *ts)
- {
- struct i2c_client *client = ts->client;
- struct raydium_data_info data_info;
- __le32 query_bank_addr;
- int error, retry_cnt;
- for (retry_cnt = 0; retry_cnt < RM_MAX_RETRIES; retry_cnt++) {
- error = raydium_i2c_read(client, RM_CMD_DATA_BANK,
- &data_info, sizeof(data_info));
- if (error)
- continue;
-
- if (ts->report_data && ts->pkg_size != data_info.pkg_size) {
- dev_warn(&client->dev,
- "report size changes, was: %d, new: %d\n",
- ts->pkg_size, data_info.pkg_size);
- } else {
- ts->pkg_size = data_info.pkg_size;
- ts->report_size = ts->pkg_size - RM_PACKET_CRC_SIZE;
- }
- ts->contact_size = data_info.tp_info_size;
- ts->data_bank_addr = le32_to_cpu(data_info.data_bank_addr);
- dev_dbg(&client->dev,
- "data_bank_addr: %#08x, report_size: %d, contact_size: %d\n",
- ts->data_bank_addr, ts->report_size, ts->contact_size);
- error = raydium_i2c_read(client, RM_CMD_QUERY_BANK,
- &query_bank_addr,
- sizeof(query_bank_addr));
- if (error)
- continue;
- error = raydium_i2c_read_message(client,
- le32_to_cpu(query_bank_addr),
- &ts->info, sizeof(ts->info));
- if (error)
- continue;
- return 0;
- }
- dev_err(&client->dev, "failed to query device parameters: %d\n", error);
- return error;
- }
- static int raydium_i2c_check_fw_status(struct raydium_data *ts)
- {
- struct i2c_client *client = ts->client;
- static const u8 bl_ack = 0x62;
- static const u8 main_ack = 0x66;
- u8 buf[4];
- int error;
- error = raydium_i2c_read(client, RM_CMD_BOOT_READ, buf, sizeof(buf));
- if (!error) {
- if (buf[0] == bl_ack)
- ts->boot_mode = RAYDIUM_TS_BLDR;
- else if (buf[0] == main_ack)
- ts->boot_mode = RAYDIUM_TS_MAIN;
- return 0;
- }
- return error;
- }
- static int raydium_i2c_initialize(struct raydium_data *ts)
- {
- struct i2c_client *client = ts->client;
- int error, retry_cnt;
- for (retry_cnt = 0; retry_cnt < RM_MAX_RETRIES; retry_cnt++) {
-
- msleep(RM_BOOT_DELAY_MS);
- error = raydium_i2c_check_fw_status(ts);
- if (error) {
- dev_err(&client->dev,
- "failed to read 'hello' packet: %d\n", error);
- continue;
- }
- if (ts->boot_mode == RAYDIUM_TS_BLDR ||
- ts->boot_mode == RAYDIUM_TS_MAIN) {
- break;
- }
- }
- if (error)
- ts->boot_mode = RAYDIUM_TS_BLDR;
- if (ts->boot_mode == RAYDIUM_TS_BLDR) {
- ts->info.hw_ver = cpu_to_le32(0xffffffffUL);
- ts->info.main_ver = 0xff;
- ts->info.sub_ver = 0xff;
- } else {
- raydium_i2c_query_ts_info(ts);
- }
- return error;
- }
- static int raydium_i2c_bl_chk_state(struct i2c_client *client,
- enum raydium_bl_ack state)
- {
- static const u8 ack_ok[] = { 0xFF, 0x39, 0x30, 0x30, 0x54 };
- u8 rbuf[sizeof(ack_ok)];
- u8 retry;
- int error;
- for (retry = 0; retry < RM_MAX_FW_RETRIES; retry++) {
- switch (state) {
- case RAYDIUM_ACK_NULL:
- return 0;
- case RAYDIUM_WAIT_READY:
- error = raydium_i2c_read(client, RM_CMD_BOOT_CHK,
- &rbuf[0], 1);
- if (!error && rbuf[0] == RM_BOOT_RDY)
- return 0;
- break;
- case RAYDIUM_PATH_READY:
- error = raydium_i2c_read(client, RM_CMD_BOOT_CHK,
- rbuf, sizeof(rbuf));
- if (!error && !memcmp(rbuf, ack_ok, sizeof(ack_ok)))
- return 0;
- break;
- default:
- dev_err(&client->dev, "%s: invalid target state %d\n",
- __func__, state);
- return -EINVAL;
- }
- msleep(20);
- }
- return -ETIMEDOUT;
- }
- static int raydium_i2c_write_object(struct i2c_client *client,
- const void *data, size_t len,
- enum raydium_bl_ack state)
- {
- int error;
- error = raydium_i2c_send(client, RM_CMD_BOOT_WRT, data, len);
- if (error) {
- dev_err(&client->dev, "WRT obj command failed: %d\n",
- error);
- return error;
- }
- error = raydium_i2c_send(client, RM_CMD_BOOT_ACK, NULL, 0);
- if (error) {
- dev_err(&client->dev, "Ack obj command failed: %d\n", error);
- return error;
- }
- error = raydium_i2c_bl_chk_state(client, state);
- if (error) {
- dev_err(&client->dev, "BL check state failed: %d\n", error);
- return error;
- }
- return 0;
- }
- static int raydium_i2c_boot_trigger(struct i2c_client *client)
- {
- static const u8 cmd[7][6] = {
- { 0x08, 0x0C, 0x09, 0x00, 0x50, 0xD7 },
- { 0x08, 0x04, 0x09, 0x00, 0x50, 0xA5 },
- { 0x08, 0x04, 0x09, 0x00, 0x50, 0x00 },
- { 0x08, 0x04, 0x09, 0x00, 0x50, 0xA5 },
- { 0x08, 0x0C, 0x09, 0x00, 0x50, 0x00 },
- { 0x06, 0x01, 0x00, 0x00, 0x00, 0x00 },
- { 0x02, 0xA2, 0x00, 0x00, 0x00, 0x00 },
- };
- int i;
- int error;
- for (i = 0; i < 7; i++) {
- error = raydium_i2c_write_object(client, cmd[i], sizeof(cmd[i]),
- RAYDIUM_WAIT_READY);
- if (error) {
- dev_err(&client->dev,
- "boot trigger failed at step %d: %d\n",
- i, error);
- return error;
- }
- }
- return 0;
- }
- static int raydium_i2c_fw_trigger(struct i2c_client *client)
- {
- static const u8 cmd[5][11] = {
- { 0, 0x09, 0x71, 0x0C, 0x09, 0x00, 0x50, 0xD7, 0, 0, 0 },
- { 0, 0x09, 0x71, 0x04, 0x09, 0x00, 0x50, 0xA5, 0, 0, 0 },
- { 0, 0x09, 0x71, 0x04, 0x09, 0x00, 0x50, 0x00, 0, 0, 0 },
- { 0, 0x09, 0x71, 0x04, 0x09, 0x00, 0x50, 0xA5, 0, 0, 0 },
- { 0, 0x09, 0x71, 0x0C, 0x09, 0x00, 0x50, 0x00, 0, 0, 0 },
- };
- int i;
- int error;
- for (i = 0; i < 5; i++) {
- error = raydium_i2c_write_object(client, cmd[i], sizeof(cmd[i]),
- RAYDIUM_ACK_NULL);
- if (error) {
- dev_err(&client->dev,
- "fw trigger failed at step %d: %d\n",
- i, error);
- return error;
- }
- }
- return 0;
- }
- static int raydium_i2c_check_path(struct i2c_client *client)
- {
- static const u8 cmd[] = { 0x09, 0x00, 0x09, 0x00, 0x50, 0x10, 0x00 };
- int error;
- error = raydium_i2c_write_object(client, cmd, sizeof(cmd),
- RAYDIUM_PATH_READY);
- if (error) {
- dev_err(&client->dev, "check path command failed: %d\n", error);
- return error;
- }
- return 0;
- }
- static int raydium_i2c_enter_bl(struct i2c_client *client)
- {
- static const u8 cal_cmd[] = { 0x00, 0x01, 0x52 };
- int error;
- error = raydium_i2c_write_object(client, cal_cmd, sizeof(cal_cmd),
- RAYDIUM_ACK_NULL);
- if (error) {
- dev_err(&client->dev, "enter bl command failed: %d\n", error);
- return error;
- }
- msleep(RM_BOOT_DELAY_MS);
- return 0;
- }
- static int raydium_i2c_leave_bl(struct i2c_client *client)
- {
- static const u8 leave_cmd[] = { 0x05, 0x00 };
- int error;
- error = raydium_i2c_write_object(client, leave_cmd, sizeof(leave_cmd),
- RAYDIUM_ACK_NULL);
- if (error) {
- dev_err(&client->dev, "leave bl command failed: %d\n", error);
- return error;
- }
- msleep(RM_BOOT_DELAY_MS);
- return 0;
- }
- static int raydium_i2c_write_checksum(struct i2c_client *client,
- size_t length, u16 checksum)
- {
- u8 checksum_cmd[] = { 0x00, 0x05, 0x6D, 0x00, 0x00, 0x00, 0x00 };
- int error;
- put_unaligned_le16(length, &checksum_cmd[3]);
- put_unaligned_le16(checksum, &checksum_cmd[5]);
- error = raydium_i2c_write_object(client,
- checksum_cmd, sizeof(checksum_cmd),
- RAYDIUM_ACK_NULL);
- if (error) {
- dev_err(&client->dev, "failed to write checksum: %d\n",
- error);
- return error;
- }
- return 0;
- }
- static int raydium_i2c_disable_watch_dog(struct i2c_client *client)
- {
- static const u8 cmd[] = { 0x0A, 0xAA };
- int error;
- error = raydium_i2c_write_object(client, cmd, sizeof(cmd),
- RAYDIUM_WAIT_READY);
- if (error) {
- dev_err(&client->dev, "disable watchdog command failed: %d\n",
- error);
- return error;
- }
- return 0;
- }
- static int raydium_i2c_fw_write_page(struct i2c_client *client,
- u16 page_idx, const void *data, size_t len)
- {
- u8 buf[RM_BL_WRT_LEN];
- size_t xfer_len;
- int error;
- int i;
- BUILD_BUG_ON((RM_FW_PAGE_SIZE % RM_BL_WRT_PKG_SIZE) != 0);
- for (i = 0; i < RM_FW_PAGE_SIZE / RM_BL_WRT_PKG_SIZE; i++) {
- buf[BL_HEADER] = RM_CMD_BOOT_PAGE_WRT;
- buf[BL_PAGE_STR] = page_idx ? 0xff : 0;
- buf[BL_PKG_IDX] = i + 1;
- xfer_len = min_t(size_t, len, RM_BL_WRT_PKG_SIZE);
- memcpy(&buf[BL_DATA_STR], data, xfer_len);
- if (len < RM_BL_WRT_PKG_SIZE)
- memset(&buf[BL_DATA_STR + xfer_len], 0xff,
- RM_BL_WRT_PKG_SIZE - xfer_len);
- error = raydium_i2c_write_object(client, buf, RM_BL_WRT_LEN,
- RAYDIUM_WAIT_READY);
- if (error) {
- dev_err(&client->dev,
- "page write command failed for page %d, chunk %d: %d\n",
- page_idx, i, error);
- return error;
- }
- data += xfer_len;
- len -= xfer_len;
- }
- return error;
- }
- static u16 raydium_calc_chksum(const u8 *buf, u16 len)
- {
- u16 checksum = 0;
- u16 i;
- for (i = 0; i < len; i++)
- checksum += buf[i];
- return checksum;
- }
- static int raydium_i2c_do_update_firmware(struct raydium_data *ts,
- const struct firmware *fw)
- {
- struct i2c_client *client = ts->client;
- const void *data;
- size_t data_len;
- size_t len;
- int page_nr;
- int i;
- int error;
- u16 fw_checksum;
- if (fw->size == 0 || fw->size > RM_MAX_FW_SIZE) {
- dev_err(&client->dev, "Invalid firmware length\n");
- return -EINVAL;
- }
- error = raydium_i2c_check_fw_status(ts);
- if (error) {
- dev_err(&client->dev, "Unable to access IC %d\n", error);
- return error;
- }
- if (ts->boot_mode == RAYDIUM_TS_MAIN) {
- for (i = 0; i < RM_MAX_RETRIES; i++) {
- error = raydium_i2c_enter_bl(client);
- if (!error) {
- error = raydium_i2c_check_fw_status(ts);
- if (error) {
- dev_err(&client->dev,
- "unable to access IC: %d\n",
- error);
- return error;
- }
- if (ts->boot_mode == RAYDIUM_TS_BLDR)
- break;
- }
- }
- if (ts->boot_mode == RAYDIUM_TS_MAIN) {
- dev_err(&client->dev,
- "failed to jump to boot loader: %d\n",
- error);
- return -EIO;
- }
- }
- error = raydium_i2c_disable_watch_dog(client);
- if (error)
- return error;
- error = raydium_i2c_check_path(client);
- if (error)
- return error;
- error = raydium_i2c_boot_trigger(client);
- if (error) {
- dev_err(&client->dev, "send boot trigger fail: %d\n", error);
- return error;
- }
- msleep(RM_BOOT_DELAY_MS);
- data = fw->data;
- data_len = fw->size;
- page_nr = 0;
- while (data_len) {
- len = min_t(size_t, data_len, RM_FW_PAGE_SIZE);
- error = raydium_i2c_fw_write_page(client, page_nr++, data, len);
- if (error)
- return error;
- msleep(20);
- data += len;
- data_len -= len;
- }
- error = raydium_i2c_leave_bl(client);
- if (error) {
- dev_err(&client->dev,
- "failed to leave boot loader: %d\n", error);
- return error;
- }
- dev_dbg(&client->dev, "left boot loader mode\n");
- msleep(RM_BOOT_DELAY_MS);
- error = raydium_i2c_check_fw_status(ts);
- if (error) {
- dev_err(&client->dev,
- "failed to check fw status after write: %d\n",
- error);
- return error;
- }
- if (ts->boot_mode != RAYDIUM_TS_MAIN) {
- dev_err(&client->dev,
- "failed to switch to main fw after writing firmware: %d\n",
- error);
- return -EINVAL;
- }
- error = raydium_i2c_fw_trigger(client);
- if (error) {
- dev_err(&client->dev, "failed to trigger fw: %d\n", error);
- return error;
- }
- fw_checksum = raydium_calc_chksum(fw->data, fw->size);
- error = raydium_i2c_write_checksum(client, fw->size, fw_checksum);
- if (error)
- return error;
- return 0;
- }
- static int raydium_i2c_fw_update(struct raydium_data *ts)
- {
- struct i2c_client *client = ts->client;
- const struct firmware *fw = NULL;
- char *fw_file;
- int error;
- fw_file = kasprintf(GFP_KERNEL, "raydium_%#04x.fw",
- le32_to_cpu(ts->info.hw_ver));
- if (!fw_file)
- return -ENOMEM;
- dev_dbg(&client->dev, "firmware name: %s\n", fw_file);
- error = request_firmware(&fw, fw_file, &client->dev);
- if (error) {
- dev_err(&client->dev, "Unable to open firmware %s\n", fw_file);
- goto out_free_fw_file;
- }
- disable_irq(client->irq);
- error = raydium_i2c_do_update_firmware(ts, fw);
- if (error) {
- dev_err(&client->dev, "firmware update failed: %d\n", error);
- ts->boot_mode = RAYDIUM_TS_BLDR;
- goto out_enable_irq;
- }
- error = raydium_i2c_initialize(ts);
- if (error) {
- dev_err(&client->dev,
- "failed to initialize device after firmware update: %d\n",
- error);
- ts->boot_mode = RAYDIUM_TS_BLDR;
- goto out_enable_irq;
- }
- ts->boot_mode = RAYDIUM_TS_MAIN;
- out_enable_irq:
- enable_irq(client->irq);
- msleep(100);
- release_firmware(fw);
- out_free_fw_file:
- kfree(fw_file);
- return error;
- }
- static void raydium_mt_event(struct raydium_data *ts)
- {
- int i;
- for (i = 0; i < ts->report_size / ts->contact_size; i++) {
- u8 *contact = &ts->report_data[ts->contact_size * i];
- bool state = contact[RM_CONTACT_STATE_POS];
- u8 wx, wy;
- input_mt_slot(ts->input, i);
- input_mt_report_slot_state(ts->input, MT_TOOL_FINGER, state);
- if (!state)
- continue;
- input_report_abs(ts->input, ABS_MT_POSITION_X,
- get_unaligned_le16(&contact[RM_CONTACT_X_POS]));
- input_report_abs(ts->input, ABS_MT_POSITION_Y,
- get_unaligned_le16(&contact[RM_CONTACT_Y_POS]));
- input_report_abs(ts->input, ABS_MT_PRESSURE,
- contact[RM_CONTACT_PRESSURE_POS]);
- wx = contact[RM_CONTACT_WIDTH_X_POS];
- wy = contact[RM_CONTACT_WIDTH_Y_POS];
- input_report_abs(ts->input, ABS_MT_TOUCH_MAJOR, max(wx, wy));
- input_report_abs(ts->input, ABS_MT_TOUCH_MINOR, min(wx, wy));
- }
- input_mt_sync_frame(ts->input);
- input_sync(ts->input);
- }
- static irqreturn_t raydium_i2c_irq(int irq, void *_dev)
- {
- struct raydium_data *ts = _dev;
- int error;
- u16 fw_crc;
- u16 calc_crc;
- if (ts->boot_mode != RAYDIUM_TS_MAIN)
- goto out;
- error = raydium_i2c_read_message(ts->client, ts->data_bank_addr,
- ts->report_data, ts->pkg_size);
- if (error)
- goto out;
- fw_crc = get_unaligned_le16(&ts->report_data[ts->report_size]);
- calc_crc = raydium_calc_chksum(ts->report_data, ts->report_size);
- if (unlikely(fw_crc != calc_crc)) {
- dev_warn(&ts->client->dev,
- "%s: invalid packet crc %#04x vs %#04x\n",
- __func__, calc_crc, fw_crc);
- goto out;
- }
- raydium_mt_event(ts);
- out:
- return IRQ_HANDLED;
- }
- static ssize_t raydium_i2c_fw_ver_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct raydium_data *ts = i2c_get_clientdata(client);
- return sprintf(buf, "%d.%d\n", ts->info.main_ver, ts->info.sub_ver);
- }
- static ssize_t raydium_i2c_hw_ver_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct raydium_data *ts = i2c_get_clientdata(client);
- return sprintf(buf, "%#04x\n", le32_to_cpu(ts->info.hw_ver));
- }
- static ssize_t raydium_i2c_boot_mode_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct raydium_data *ts = i2c_get_clientdata(client);
- return sprintf(buf, "%s\n",
- ts->boot_mode == RAYDIUM_TS_MAIN ?
- "Normal" : "Recovery");
- }
- static ssize_t raydium_i2c_update_fw_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct raydium_data *ts = i2c_get_clientdata(client);
- int error;
- error = mutex_lock_interruptible(&ts->sysfs_mutex);
- if (error)
- return error;
- error = raydium_i2c_fw_update(ts);
- mutex_unlock(&ts->sysfs_mutex);
- return error ?: count;
- }
- static ssize_t raydium_i2c_calibrate_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct raydium_data *ts = i2c_get_clientdata(client);
- static const u8 cal_cmd[] = { 0x00, 0x01, 0x9E };
- int error;
- error = mutex_lock_interruptible(&ts->sysfs_mutex);
- if (error)
- return error;
- error = raydium_i2c_write_object(client, cal_cmd, sizeof(cal_cmd),
- RAYDIUM_WAIT_READY);
- if (error)
- dev_err(&client->dev, "calibrate command failed: %d\n", error);
- mutex_unlock(&ts->sysfs_mutex);
- return error ?: count;
- }
- static DEVICE_ATTR(fw_version, S_IRUGO, raydium_i2c_fw_ver_show, NULL);
- static DEVICE_ATTR(hw_version, S_IRUGO, raydium_i2c_hw_ver_show, NULL);
- static DEVICE_ATTR(boot_mode, S_IRUGO, raydium_i2c_boot_mode_show, NULL);
- static DEVICE_ATTR(update_fw, S_IWUSR, NULL, raydium_i2c_update_fw_store);
- static DEVICE_ATTR(calibrate, S_IWUSR, NULL, raydium_i2c_calibrate_store);
- static struct attribute *raydium_i2c_attributes[] = {
- &dev_attr_update_fw.attr,
- &dev_attr_boot_mode.attr,
- &dev_attr_fw_version.attr,
- &dev_attr_hw_version.attr,
- &dev_attr_calibrate.attr,
- NULL
- };
- static const struct attribute_group raydium_i2c_attribute_group = {
- .attrs = raydium_i2c_attributes,
- };
- static int raydium_i2c_power_on(struct raydium_data *ts)
- {
- int error;
- if (!ts->reset_gpio)
- return 0;
- gpiod_set_value_cansleep(ts->reset_gpio, 1);
- error = regulator_enable(ts->avdd);
- if (error) {
- dev_err(&ts->client->dev,
- "failed to enable avdd regulator: %d\n", error);
- goto release_reset_gpio;
- }
- error = regulator_enable(ts->vccio);
- if (error) {
- regulator_disable(ts->avdd);
- dev_err(&ts->client->dev,
- "failed to enable vccio regulator: %d\n", error);
- goto release_reset_gpio;
- }
- udelay(RM_POWERON_DELAY_USEC);
- release_reset_gpio:
- gpiod_set_value_cansleep(ts->reset_gpio, 0);
- if (error)
- return error;
- msleep(RM_RESET_DELAY_MSEC);
- return 0;
- }
- static void raydium_i2c_power_off(void *_data)
- {
- struct raydium_data *ts = _data;
- if (ts->reset_gpio) {
- gpiod_set_value_cansleep(ts->reset_gpio, 1);
- regulator_disable(ts->vccio);
- regulator_disable(ts->avdd);
- }
- }
- static int raydium_i2c_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
- {
- union i2c_smbus_data dummy;
- struct raydium_data *ts;
- int error;
- if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
- dev_err(&client->dev,
- "i2c check functionality error (need I2C_FUNC_I2C)\n");
- return -ENXIO;
- }
- ts = devm_kzalloc(&client->dev, sizeof(*ts), GFP_KERNEL);
- if (!ts)
- return -ENOMEM;
- mutex_init(&ts->sysfs_mutex);
- ts->client = client;
- i2c_set_clientdata(client, ts);
- ts->avdd = devm_regulator_get(&client->dev, "avdd");
- if (IS_ERR(ts->avdd)) {
- error = PTR_ERR(ts->avdd);
- if (error != -EPROBE_DEFER)
- dev_err(&client->dev,
- "Failed to get 'avdd' regulator: %d\n", error);
- return error;
- }
- ts->vccio = devm_regulator_get(&client->dev, "vccio");
- if (IS_ERR(ts->vccio)) {
- error = PTR_ERR(ts->vccio);
- if (error != -EPROBE_DEFER)
- dev_err(&client->dev,
- "Failed to get 'vccio' regulator: %d\n", error);
- return error;
- }
- ts->reset_gpio = devm_gpiod_get_optional(&client->dev, "reset",
- GPIOD_OUT_LOW);
- if (IS_ERR(ts->reset_gpio)) {
- error = PTR_ERR(ts->reset_gpio);
- if (error != -EPROBE_DEFER)
- dev_err(&client->dev,
- "failed to get reset gpio: %d\n", error);
- return error;
- }
- error = raydium_i2c_power_on(ts);
- if (error)
- return error;
- error = devm_add_action(&client->dev, raydium_i2c_power_off, ts);
- if (error) {
- dev_err(&client->dev,
- "failed to install power off action: %d\n", error);
- raydium_i2c_power_off(ts);
- return error;
- }
-
- if (i2c_smbus_xfer(client->adapter, client->addr, 0,
- I2C_SMBUS_READ, 0, I2C_SMBUS_BYTE, &dummy) < 0) {
- dev_err(&client->dev, "nothing at this address\n");
- return -ENXIO;
- }
- error = raydium_i2c_initialize(ts);
- if (error) {
- dev_err(&client->dev, "failed to initialize: %d\n", error);
- return error;
- }
- ts->report_data = devm_kmalloc(&client->dev,
- ts->pkg_size, GFP_KERNEL);
- if (!ts->report_data)
- return -ENOMEM;
- ts->input = devm_input_allocate_device(&client->dev);
- if (!ts->input) {
- dev_err(&client->dev, "Failed to allocate input device\n");
- return -ENOMEM;
- }
- ts->input->name = "Raydium Touchscreen";
- ts->input->id.bustype = BUS_I2C;
- input_set_abs_params(ts->input, ABS_MT_POSITION_X,
- 0, le16_to_cpu(ts->info.x_max), 0, 0);
- input_set_abs_params(ts->input, ABS_MT_POSITION_Y,
- 0, le16_to_cpu(ts->info.y_max), 0, 0);
- input_abs_set_res(ts->input, ABS_MT_POSITION_X, ts->info.x_res);
- input_abs_set_res(ts->input, ABS_MT_POSITION_Y, ts->info.y_res);
- input_set_abs_params(ts->input, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0);
- input_set_abs_params(ts->input, ABS_MT_PRESSURE, 0, 255, 0, 0);
- error = input_mt_init_slots(ts->input, RM_MAX_TOUCH_NUM,
- INPUT_MT_DIRECT | INPUT_MT_DROP_UNUSED);
- if (error) {
- dev_err(&client->dev,
- "failed to initialize MT slots: %d\n", error);
- return error;
- }
- error = input_register_device(ts->input);
- if (error) {
- dev_err(&client->dev,
- "unable to register input device: %d\n", error);
- return error;
- }
- error = devm_request_threaded_irq(&client->dev, client->irq,
- NULL, raydium_i2c_irq,
- IRQF_ONESHOT, client->name, ts);
- if (error) {
- dev_err(&client->dev, "Failed to register interrupt\n");
- return error;
- }
- error = devm_device_add_group(&client->dev,
- &raydium_i2c_attribute_group);
- if (error) {
- dev_err(&client->dev, "failed to create sysfs attributes: %d\n",
- error);
- return error;
- }
- return 0;
- }
- static void __maybe_unused raydium_enter_sleep(struct i2c_client *client)
- {
- static const u8 sleep_cmd[] = { 0x5A, 0xff, 0x00, 0x0f };
- int error;
- error = raydium_i2c_send(client, RM_CMD_ENTER_SLEEP,
- sleep_cmd, sizeof(sleep_cmd));
- if (error)
- dev_err(&client->dev,
- "sleep command failed: %d\n", error);
- }
- static int __maybe_unused raydium_i2c_suspend(struct device *dev)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct raydium_data *ts = i2c_get_clientdata(client);
-
- if (ts->boot_mode != RAYDIUM_TS_MAIN)
- return -EBUSY;
- disable_irq(client->irq);
- if (device_may_wakeup(dev)) {
- raydium_enter_sleep(client);
- ts->wake_irq_enabled = (enable_irq_wake(client->irq) == 0);
- } else {
- raydium_i2c_power_off(ts);
- }
- return 0;
- }
- static int __maybe_unused raydium_i2c_resume(struct device *dev)
- {
- struct i2c_client *client = to_i2c_client(dev);
- struct raydium_data *ts = i2c_get_clientdata(client);
- if (device_may_wakeup(dev)) {
- if (ts->wake_irq_enabled)
- disable_irq_wake(client->irq);
- raydium_i2c_sw_reset(client);
- } else {
- raydium_i2c_power_on(ts);
- raydium_i2c_initialize(ts);
- }
- enable_irq(client->irq);
- return 0;
- }
- static SIMPLE_DEV_PM_OPS(raydium_i2c_pm_ops,
- raydium_i2c_suspend, raydium_i2c_resume);
- static const struct i2c_device_id raydium_i2c_id[] = {
- { "raydium_i2c" , 0 },
- { "rm32380", 0 },
- { }
- };
- MODULE_DEVICE_TABLE(i2c, raydium_i2c_id);
- #ifdef CONFIG_ACPI
- static const struct acpi_device_id raydium_acpi_id[] = {
- { "RAYD0001", 0 },
- { }
- };
- MODULE_DEVICE_TABLE(acpi, raydium_acpi_id);
- #endif
- #ifdef CONFIG_OF
- static const struct of_device_id raydium_of_match[] = {
- { .compatible = "raydium,rm32380", },
- { }
- };
- MODULE_DEVICE_TABLE(of, raydium_of_match);
- #endif
- static struct i2c_driver raydium_i2c_driver = {
- .probe = raydium_i2c_probe,
- .id_table = raydium_i2c_id,
- .driver = {
- .name = "raydium_ts",
- .pm = &raydium_i2c_pm_ops,
- .acpi_match_table = ACPI_PTR(raydium_acpi_id),
- .of_match_table = of_match_ptr(raydium_of_match),
- },
- };
- module_i2c_driver(raydium_i2c_driver);
- MODULE_AUTHOR("Raydium");
- MODULE_DESCRIPTION("Raydium I2c Touchscreen driver");
- MODULE_LICENSE("GPL v2");
|