123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698 |
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <linux/spi/spi.h>
- #include <linux/delay.h>
- #include <linux/input.h>
- #include <linux/types.h>
- #include <linux/of_gpio.h>
- #include <linux/platform_device.h>
- #include <linux/input/synaptics_dsx.h>
- #include "synaptics_dsx_core.h"
- #define SPI_READ 0x80
- #define SPI_WRITE 0x00
- static unsigned char *buf;
- static struct spi_transfer *xfer;
- #ifdef CONFIG_OF
- static int parse_dt(struct device *dev, struct synaptics_dsx_board_data *bdata)
- {
- int retval;
- u32 value;
- const char *name;
- struct property *prop;
- struct device_node *np = dev->of_node;
- bdata->irq_gpio = of_get_named_gpio_flags(np,
- "synaptics,irq-gpio", 0,
- (enum of_gpio_flags *)&bdata->irq_flags);
- retval = of_property_read_u32(np, "synaptics,irq-on-state",
- &value);
- if (retval < 0)
- bdata->irq_on_state = 0;
- else
- bdata->irq_on_state = value;
- retval = of_property_read_string(np, "synaptics,pwr-reg-name", &name);
- if (retval < 0)
- bdata->pwr_reg_name = NULL;
- else
- bdata->pwr_reg_name = name;
- retval = of_property_read_string(np, "synaptics,bus-reg-name", &name);
- if (retval < 0)
- bdata->bus_reg_name = NULL;
- else
- bdata->bus_reg_name = name;
- prop = of_find_property(np, "synaptics,power-gpio", NULL);
- if (prop && prop->length) {
- bdata->power_gpio = of_get_named_gpio_flags(np,
- "synaptics,power-gpio", 0, NULL);
- retval = of_property_read_u32(np, "synaptics,power-on-state",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,power-on-state property\n",
- __func__);
- return retval;
- }
- bdata->power_on_state = value;
- } else {
- bdata->power_gpio = -1;
- }
- prop = of_find_property(np, "synaptics,power-delay-ms", NULL);
- if (prop && prop->length) {
- retval = of_property_read_u32(np, "synaptics,power-delay-ms",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,power-delay-ms property\n",
- __func__);
- return retval;
- }
- bdata->power_delay_ms = value;
- } else {
- bdata->power_delay_ms = 0;
- }
- prop = of_find_property(np, "synaptics,reset-gpio", NULL);
- if (prop && prop->length) {
- bdata->reset_gpio = of_get_named_gpio_flags(np,
- "synaptics,reset-gpio", 0, NULL);
- retval = of_property_read_u32(np, "synaptics,reset-on-state",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,reset-on-state property\n",
- __func__);
- return retval;
- }
- bdata->reset_on_state = value;
- retval = of_property_read_u32(np, "synaptics,reset-active-ms",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,reset-active-ms property\n",
- __func__);
- return retval;
- }
- bdata->reset_active_ms = value;
- } else {
- bdata->reset_gpio = -1;
- }
- prop = of_find_property(np, "synaptics,reset-delay-ms", NULL);
- if (prop && prop->length) {
- retval = of_property_read_u32(np, "synaptics,reset-delay-ms",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,reset-delay-ms property\n",
- __func__);
- return retval;
- }
- bdata->reset_delay_ms = value;
- } else {
- bdata->reset_delay_ms = 0;
- }
- prop = of_find_property(np, "synaptics,byte-delay-us", NULL);
- if (prop && prop->length) {
- retval = of_property_read_u32(np, "synaptics,byte-delay-us",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,byte-delay-us property\n",
- __func__);
- return retval;
- }
- bdata->byte_delay_us = value;
- } else {
- bdata->byte_delay_us = 0;
- }
- prop = of_find_property(np, "synaptics,block-delay-us", NULL);
- if (prop && prop->length) {
- retval = of_property_read_u32(np, "synaptics,block-delay-us",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,block-delay-us property\n",
- __func__);
- return retval;
- }
- bdata->block_delay_us = value;
- } else {
- bdata->block_delay_us = 0;
- }
- prop = of_find_property(np, "synaptics,address-delay-us", NULL);
- if (prop && prop->length) {
- retval = of_property_read_u32(np, "synaptics,address-delay-us",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,address-delay-us property\n",
- __func__);
- return retval;
- }
- bdata->addr_delay_us = value;
- } else {
- bdata->addr_delay_us = 0;
- }
- prop = of_find_property(np, "synaptics,max-y-for-2d", NULL);
- if (prop && prop->length) {
- retval = of_property_read_u32(np, "synaptics,max-y-for-2d",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,max-y-for-2d property\n",
- __func__);
- return retval;
- }
- bdata->max_y_for_2d = value;
- } else {
- bdata->max_y_for_2d = -1;
- }
- prop = of_find_property(np, "synaptics,swap-axes", NULL);
- bdata->swap_axes = prop > 0 ? true : false;
- prop = of_find_property(np, "synaptics,x-flip", NULL);
- bdata->x_flip = prop > 0 ? true : false;
- prop = of_find_property(np, "synaptics,y-flip", NULL);
- bdata->y_flip = prop > 0 ? true : false;
- prop = of_find_property(np, "synaptics,ub-i2c-addr", NULL);
- if (prop && prop->length) {
- retval = of_property_read_u32(np, "synaptics,ub-i2c-addr",
- &value);
- if (retval < 0) {
- dev_err(dev, "%s: Unable to read synaptics,ub-i2c-addr property\n",
- __func__);
- return retval;
- }
- bdata->ub_i2c_addr = (unsigned short)value;
- } else {
- bdata->ub_i2c_addr = -1;
- }
- prop = of_find_property(np, "synaptics,cap-button-codes", NULL);
- if (prop && prop->length) {
- bdata->cap_button_map->map = devm_kzalloc(dev,
- prop->length,
- GFP_KERNEL);
- if (!bdata->cap_button_map->map)
- return -ENOMEM;
- bdata->cap_button_map->nbuttons = prop->length / sizeof(u32);
- retval = of_property_read_u32_array(np,
- "synaptics,cap-button-codes",
- bdata->cap_button_map->map,
- bdata->cap_button_map->nbuttons);
- if (retval < 0) {
- bdata->cap_button_map->nbuttons = 0;
- bdata->cap_button_map->map = NULL;
- }
- } else {
- bdata->cap_button_map->nbuttons = 0;
- bdata->cap_button_map->map = NULL;
- }
- prop = of_find_property(np, "synaptics,vir-button-codes", NULL);
- if (prop && prop->length) {
- bdata->vir_button_map->map = devm_kzalloc(dev,
- prop->length,
- GFP_KERNEL);
- if (!bdata->vir_button_map->map)
- return -ENOMEM;
- bdata->vir_button_map->nbuttons = prop->length / sizeof(u32);
- bdata->vir_button_map->nbuttons /= 5;
- retval = of_property_read_u32_array(np,
- "synaptics,vir-button-codes",
- bdata->vir_button_map->map,
- bdata->vir_button_map->nbuttons * 5);
- if (retval < 0) {
- bdata->vir_button_map->nbuttons = 0;
- bdata->vir_button_map->map = NULL;
- }
- } else {
- bdata->vir_button_map->nbuttons = 0;
- bdata->vir_button_map->map = NULL;
- }
- return 0;
- }
- #endif
- static int synaptics_rmi4_spi_alloc_buf(struct synaptics_rmi4_data *rmi4_data,
- unsigned int size, unsigned int count)
- {
- static unsigned int buf_size;
- static unsigned int xfer_count;
- if (size > buf_size) {
- if (buf_size)
- kfree(buf);
- buf = kmalloc(size, GFP_KERNEL);
- if (!buf) {
- dev_err(rmi4_data->pdev->dev.parent,
- "%s: Failed to alloc mem for buf\n",
- __func__);
- buf_size = 0;
- return -ENOMEM;
- }
- buf_size = size;
- }
- if (count > xfer_count) {
- if (xfer_count)
- kfree(xfer);
- xfer = kcalloc(count, sizeof(struct spi_transfer), GFP_KERNEL);
- if (!xfer) {
- dev_err(rmi4_data->pdev->dev.parent,
- "%s: Failed to alloc mem for xfer\n",
- __func__);
- xfer_count = 0;
- return -ENOMEM;
- }
- xfer_count = count;
- } else {
- memset(xfer, 0, count * sizeof(struct spi_transfer));
- }
- return 0;
- }
- static int synaptics_rmi4_spi_set_page(struct synaptics_rmi4_data *rmi4_data,
- unsigned short addr)
- {
- int retval;
- unsigned int index;
- unsigned int byte_count = PAGE_SELECT_LEN + 1;
- unsigned char page;
- struct spi_message msg;
- struct spi_device *spi = to_spi_device(rmi4_data->pdev->dev.parent);
- const struct synaptics_dsx_board_data *bdata =
- rmi4_data->hw_if->board_data;
- page = ((addr >> 8) & MASK_8BIT);
- if ((page >> 7) == (rmi4_data->current_page >> 7))
- return PAGE_SELECT_LEN;
- spi_message_init(&msg);
- retval = synaptics_rmi4_spi_alloc_buf(rmi4_data, byte_count,
- byte_count);
- if (retval < 0)
- return retval;
- buf[0] = SPI_WRITE;
- buf[1] = MASK_8BIT;
- buf[2] = page;
- if (bdata->byte_delay_us == 0) {
- xfer[0].len = byte_count;
- xfer[0].tx_buf = &buf[0];
- if (bdata->block_delay_us)
- xfer[0].delay_usecs = bdata->block_delay_us;
- spi_message_add_tail(&xfer[0], &msg);
- } else {
- for (index = 0; index < byte_count; index++) {
- xfer[index].len = 1;
- xfer[index].tx_buf = &buf[index];
- if (index == 1)
- xfer[index].delay_usecs = bdata->addr_delay_us;
- else
- xfer[index].delay_usecs = bdata->byte_delay_us;
- spi_message_add_tail(&xfer[index], &msg);
- }
- if (bdata->block_delay_us)
- xfer[index - 1].delay_usecs = bdata->block_delay_us;
- }
- retval = spi_sync(spi, &msg);
- if (retval == 0) {
- rmi4_data->current_page = page;
- retval = PAGE_SELECT_LEN;
- } else {
- dev_err(rmi4_data->pdev->dev.parent,
- "%s: Failed to complete SPI transfer, error = %d\n",
- __func__, retval);
- }
- return retval;
- }
- static int synaptics_rmi4_spi_read(struct synaptics_rmi4_data *rmi4_data,
- unsigned short addr, unsigned char *data, unsigned int length)
- {
- int retval;
- unsigned int index;
- unsigned int byte_count = length + ADDRESS_LEN;
- unsigned char txbuf[ADDRESS_LEN];
- struct spi_message msg;
- struct spi_device *spi = to_spi_device(rmi4_data->pdev->dev.parent);
- const struct synaptics_dsx_board_data *bdata =
- rmi4_data->hw_if->board_data;
- spi_message_init(&msg);
- txbuf[0] = (addr >> 8) | SPI_READ;
- txbuf[1] = addr & MASK_8BIT;
- mutex_lock(&rmi4_data->rmi4_io_ctrl_mutex);
- retval = synaptics_rmi4_spi_set_page(rmi4_data, addr);
- if (retval != PAGE_SELECT_LEN) {
- mutex_unlock(&rmi4_data->rmi4_io_ctrl_mutex);
- return -EIO;
- }
- if (bdata->byte_delay_us == 0) {
- retval = synaptics_rmi4_spi_alloc_buf(rmi4_data, length,
- 2);
- } else {
- retval = synaptics_rmi4_spi_alloc_buf(rmi4_data, length,
- byte_count);
- }
- if (retval < 0) {
- mutex_unlock(&rmi4_data->rmi4_io_ctrl_mutex);
- return retval;
- }
- if (bdata->byte_delay_us == 0) {
- xfer[0].len = ADDRESS_LEN;
- xfer[0].tx_buf = &txbuf[0];
- spi_message_add_tail(&xfer[0], &msg);
- xfer[1].len = length;
- xfer[1].rx_buf = &buf[0];
- if (bdata->block_delay_us)
- xfer[1].delay_usecs = bdata->block_delay_us;
- spi_message_add_tail(&xfer[1], &msg);
- } else {
- for (index = 0; index < byte_count; index++) {
- xfer[index].len = 1;
- if (index < ADDRESS_LEN)
- xfer[index].tx_buf = &txbuf[index];
- else
- xfer[index].rx_buf = &buf[index - ADDRESS_LEN];
- if (index == 1)
- xfer[index].delay_usecs = bdata->addr_delay_us;
- else
- xfer[index].delay_usecs = bdata->byte_delay_us;
- spi_message_add_tail(&xfer[index], &msg);
- }
- if (bdata->block_delay_us)
- xfer[index - 1].delay_usecs = bdata->block_delay_us;
- }
- retval = spi_sync(spi, &msg);
- if (retval == 0) {
- retval = secure_memcpy(data, length, buf, length, length);
- if (retval < 0) {
- dev_err(rmi4_data->pdev->dev.parent,
- "%s: Failed to copy data\n",
- __func__);
- } else {
- retval = length;
- }
- } else {
- dev_err(rmi4_data->pdev->dev.parent,
- "%s: Failed to complete SPI transfer, error = %d\n",
- __func__, retval);
- }
- mutex_unlock(&rmi4_data->rmi4_io_ctrl_mutex);
- return retval;
- }
- static int synaptics_rmi4_spi_write(struct synaptics_rmi4_data *rmi4_data,
- unsigned short addr, unsigned char *data, unsigned int length)
- {
- int retval;
- unsigned int index;
- unsigned int byte_count = length + ADDRESS_LEN;
- struct spi_message msg;
- struct spi_device *spi = to_spi_device(rmi4_data->pdev->dev.parent);
- const struct synaptics_dsx_board_data *bdata =
- rmi4_data->hw_if->board_data;
- spi_message_init(&msg);
- mutex_lock(&rmi4_data->rmi4_io_ctrl_mutex);
- retval = synaptics_rmi4_spi_set_page(rmi4_data, addr);
- if (retval != PAGE_SELECT_LEN) {
- mutex_unlock(&rmi4_data->rmi4_io_ctrl_mutex);
- return -EIO;
- }
- if (bdata->byte_delay_us == 0) {
- retval = synaptics_rmi4_spi_alloc_buf(rmi4_data, byte_count,
- 1);
- } else {
- retval = synaptics_rmi4_spi_alloc_buf(rmi4_data, byte_count,
- byte_count);
- }
- if (retval < 0) {
- mutex_unlock(&rmi4_data->rmi4_io_ctrl_mutex);
- return retval;
- }
- buf[0] = (addr >> 8) & ~SPI_READ;
- buf[1] = addr & MASK_8BIT;
- retval = secure_memcpy(&buf[ADDRESS_LEN],
- byte_count - ADDRESS_LEN, data, length, length);
- if (retval < 0) {
- dev_err(rmi4_data->pdev->dev.parent,
- "%s: Failed to copy data\n",
- __func__);
- mutex_unlock(&rmi4_data->rmi4_io_ctrl_mutex);
- return retval;
- }
- if (bdata->byte_delay_us == 0) {
- xfer[0].len = byte_count;
- xfer[0].tx_buf = &buf[0];
- if (bdata->block_delay_us)
- xfer[0].delay_usecs = bdata->block_delay_us;
- spi_message_add_tail(xfer, &msg);
- } else {
- for (index = 0; index < byte_count; index++) {
- xfer[index].len = 1;
- xfer[index].tx_buf = &buf[index];
- if (index == 1)
- xfer[index].delay_usecs = bdata->addr_delay_us;
- else
- xfer[index].delay_usecs = bdata->byte_delay_us;
- spi_message_add_tail(&xfer[index], &msg);
- }
- if (bdata->block_delay_us)
- xfer[index - 1].delay_usecs = bdata->block_delay_us;
- }
- retval = spi_sync(spi, &msg);
- if (retval == 0) {
- retval = length;
- } else {
- dev_err(rmi4_data->pdev->dev.parent,
- "%s: Failed to complete SPI transfer, error = %d\n",
- __func__, retval);
- }
- mutex_unlock(&rmi4_data->rmi4_io_ctrl_mutex);
- return retval;
- }
- static struct synaptics_dsx_bus_access bus_access = {
- .type = BUS_SPI,
- .read = synaptics_rmi4_spi_read,
- .write = synaptics_rmi4_spi_write,
- };
- static struct synaptics_dsx_hw_interface hw_if;
- static struct platform_device *synaptics_dsx_spi_device;
- static void synaptics_rmi4_spi_dev_release(struct device *dev)
- {
- kfree(synaptics_dsx_spi_device);
- }
- static int synaptics_rmi4_spi_probe(struct spi_device *spi)
- {
- int retval;
- if (spi->master->flags & SPI_MASTER_HALF_DUPLEX) {
- dev_err(&spi->dev,
- "%s: Full duplex not supported by host\n",
- __func__);
- return -EIO;
- }
- synaptics_dsx_spi_device = kzalloc(
- sizeof(struct platform_device),
- GFP_KERNEL);
- if (!synaptics_dsx_spi_device) {
- dev_err(&spi->dev,
- "%s: Failed to allocate memory for synaptics_dsx_spi_device\n",
- __func__);
- return -ENOMEM;
- }
- #ifdef CONFIG_OF
- if (spi->dev.of_node) {
- hw_if.board_data = devm_kzalloc(&spi->dev,
- sizeof(struct synaptics_dsx_board_data),
- GFP_KERNEL);
- if (!hw_if.board_data) {
- dev_err(&spi->dev,
- "%s: Failed to allocate memory for board data\n",
- __func__);
- return -ENOMEM;
- }
- hw_if.board_data->cap_button_map = devm_kzalloc(&spi->dev,
- sizeof(struct synaptics_dsx_button_map),
- GFP_KERNEL);
- if (!hw_if.board_data->cap_button_map) {
- dev_err(&spi->dev,
- "%s: Failed to allocate memory for 0D button map\n",
- __func__);
- return -ENOMEM;
- }
- hw_if.board_data->vir_button_map = devm_kzalloc(&spi->dev,
- sizeof(struct synaptics_dsx_button_map),
- GFP_KERNEL);
- if (!hw_if.board_data->vir_button_map) {
- dev_err(&spi->dev,
- "%s: Failed to allocate memory for virtual button map\n",
- __func__);
- return -ENOMEM;
- }
- parse_dt(&spi->dev, hw_if.board_data);
- }
- #else
- hw_if.board_data = spi->dev.platform_data;
- #endif
- hw_if.bus_access = &bus_access;
- spi->bits_per_word = 8;
- spi->mode = SPI_MODE_3;
- retval = spi_setup(spi);
- if (retval < 0) {
- dev_err(&spi->dev,
- "%s: Failed to perform SPI setup\n",
- __func__);
- return retval;
- }
- synaptics_dsx_spi_device->name = PLATFORM_DRIVER_NAME;
- synaptics_dsx_spi_device->id = 0;
- synaptics_dsx_spi_device->num_resources = 0;
- synaptics_dsx_spi_device->dev.parent = &spi->dev;
- synaptics_dsx_spi_device->dev.platform_data = &hw_if;
- synaptics_dsx_spi_device->dev.release = synaptics_rmi4_spi_dev_release;
- retval = platform_device_register(synaptics_dsx_spi_device);
- if (retval) {
- dev_err(&spi->dev,
- "%s: Failed to register platform device\n",
- __func__);
- return -ENODEV;
- }
- return 0;
- }
- static int synaptics_rmi4_spi_remove(struct spi_device *spi)
- {
- platform_device_unregister(synaptics_dsx_spi_device);
- return 0;
- }
- static const struct spi_device_id synaptics_rmi4_id_table[] = {
- {SPI_DRIVER_NAME, 0},
- {},
- };
- MODULE_DEVICE_TABLE(spi, synaptics_rmi4_id_table);
- #ifdef CONFIG_OF
- static const struct of_device_id synaptics_rmi4_of_match_table[] = {
- {
- .compatible = "synaptics,dsx-spi",
- },
- {},
- };
- MODULE_DEVICE_TABLE(of, synaptics_rmi4_of_match_table);
- #else
- #define synaptics_rmi4_of_match_table NULL
- #endif
- static struct spi_driver synaptics_rmi4_spi_driver = {
- .driver = {
- .name = SPI_DRIVER_NAME,
- .owner = THIS_MODULE,
- .of_match_table = synaptics_rmi4_of_match_table,
- },
- .probe = synaptics_rmi4_spi_probe,
- .remove = synaptics_rmi4_spi_remove,
- .id_table = synaptics_rmi4_id_table,
- };
- int synaptics_rmi4_bus_init(void)
- {
- return spi_register_driver(&synaptics_rmi4_spi_driver);
- }
- EXPORT_SYMBOL(synaptics_rmi4_bus_init);
- void synaptics_rmi4_bus_exit(void)
- {
- kfree(buf);
- kfree(xfer);
- spi_unregister_driver(&synaptics_rmi4_spi_driver);
- }
- EXPORT_SYMBOL(synaptics_rmi4_bus_exit);
- MODULE_AUTHOR("Synaptics, Inc.");
- MODULE_DESCRIPTION("Synaptics DSX SPI Bus Support Module");
- MODULE_LICENSE("GPL v2");
|