| lists.openwall.net | lists / announce owl-users owl-dev john-users john-dev passwdqc-users yescrypt popa3d-users / oss-security kernel-hardening musl sabotage tlsify passwords / crypt-dev xvendor / Bugtraq Full-Disclosure linux-kernel linux-netdev linux-ext4 linux-hardening linux-cve-announce PHC | |
|
Open Source and information security mailing list archives
| ||
|
Message-ID: <20210105102921.GA10736@dev>
Date: Tue, 5 Jan 2021 10:29:25 +0000
From: József Horváth <info@...istro.hu>
To: 'Greg Kroah-Hartman' <gregkh@...uxfoundation.org>,
'Rob Herring' <robh+dt@...nel.org>,
'Jiri Slaby' <jirislaby@...nel.org>,
'József Horváth' <info@...istro.hu>,
linux-serial@...r.kernel.org, devicetree@...r.kernel.org,
linux-kernel@...r.kernel.org
Subject: [PATCH v7,1/2] Serial: silabs si4455 serial driver
This is a serial port driver for
Silicon Labs Si4455 Sub-GHz transciver.
The goal of this driver is to removing wires
between central(linux) device and remote serial devices/sensors,
but keeping the original user software.
It represents regular serial interface for the user space.
Datasheet: https://www.silabs.com/documents/public/data-sheets/Si4455.pdf
Guide: https://github.com/dministro/linux-serial-si4455
Signed-off-by: Jozsef Horvath <info@...istro.hu>
---
changes v1:
- fixed: drivers: serial: si4455: coding style
- fixed: drivers: serial: si4455: error checking and order
- fixed: drivers: serial: si4455: remove unnecessary compatibility
strings from si4455_dt_ids
changes v2:
- fixed: drivers: serial: si4455: coding style
changes v3:
- fixed: drivers: serial: si4455: coding style
- fixed: drivers: serial: si4455: replace device configuration procedure
(SI4455_IOC_SEZC ioctl call) with request_firmware(...).
The firmware name comes from dt (silabs,ez-config)
- fixed: drivers: serial: si4455: replace transmit/receive channel
select (SI4455_IOC_STXC/SI4455_IOC_SRXC ioctl calls)
with sysfs entries (tx_channel, rx_channel).
Initial values comes from dt (silabs,tx-channel and silabs,rx-channel)
- fixed: drivers: serial: si4455: replace package size setting
(SI4455_IOC_SSIZ ioctl call) with sysfs entry (package_size).
Initial value comes from dt (silabs,package-size)
- fixed: drivers: serial: si4455: replace getting last rssi
(SI4455_IOC_GRSSI ioctl call) with sysfs entry (current_rssi)
- fixed: drivers: serial: si4455: remove si4455_api.h
and custom ioctl definitions
changes v5:
- fixed: drivers: serial: si4455: coding style
- fixed: drivers: serial: si4455: remove struct si4455_one,
members moved to struct si4455_port
- fixed: drivers: serial: si4455: fix line endings in dev_err and
dev_dbg messages
- fixed: drivers: serial: si4455: remove unnecessary else { ... }
- fixed: drivers: serial: si4455: refactor si4455_do_work(...),
xmit circular buffer handling and start tx moved to
si4455_start_tx_xmit(...)
- fixed: drivers: serial: si4455: refactor si4455_configure
- fixed: drivers: serial: si4455: refactor interrupt handling,
remove unnecessary wrapper
- fixed: drivers: serial: si4455: modem line(si4455_get_mctrl)
and tx buffer status(si4455_tx_empty) conditions and signaling
- fixed: drivers: serial: si4455: remove unsafe int to pointer conversion
changes v6:
- fixed: drivers: serial: si4455: illegal characters in
MODULE_AUTHOR("...") Reported-by: kernel test robot <lkp@...el.com>
changes v7:
- added: drivers: serial: si4455: variable packet length support
- added: drivers: serial: si4455: extended error handling
- added: dt: bindings: silabs,si4455: silabs,tx-timeout property definition
---
MAINTAINERS | 6 +
drivers/tty/serial/Kconfig | 8 +
drivers/tty/serial/Makefile | 1 +
drivers/tty/serial/si4455.c | 1721 +++++++++++++++++++++++++++++++++++
4 files changed, 1736 insertions(+)
create mode 100644 drivers/tty/serial/si4455.c
diff --git a/MAINTAINERS b/MAINTAINERS
index a008b70f3c16..ca6e32693a74 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -15952,6 +15952,12 @@ M: Jérôme Pouiller <jerome.pouiller@...abs.com>
S: Supported
F: drivers/staging/wfx/
+SILICON LABS SI4455 SERIAL DRIVER
+M: Jozsef Horvath <info@...istro.hu>
+S: Maintained
+F: Documentation/devicetree/bindings/serial/silabs,si4455.yaml
+F: drivers/tty/serial/si4455.c
+
SILICON MOTION SM712 FRAME BUFFER DRIVER
M: Sudip Mukherjee <sudipm.mukherjee@...il.com>
M: Teddy Wang <teddy.wang@...iconmotion.com>
diff --git a/drivers/tty/serial/Kconfig b/drivers/tty/serial/Kconfig
index 28f22e58639c..560aa311cd03 100644
--- a/drivers/tty/serial/Kconfig
+++ b/drivers/tty/serial/Kconfig
@@ -1583,6 +1583,14 @@ config SERIAL_MILBEAUT_USIO_CONSOLE
receives all kernel messages and warnings and which allows logins in
single user mode).
+config SERIAL_SI4455
+ tristate "Si4455 support"
+ depends on SPI
+ select SERIAL_CORE
+ help
+ This driver is for Silicon Labs's Si4455 Sub-GHz transciver.
+ Say 'Y' here if you wish to use it as serial port.
+
endmenu
config SERIAL_MCTRL_GPIO
diff --git a/drivers/tty/serial/Makefile b/drivers/tty/serial/Makefile
index caf167f0c10a..f01ff43db1d6 100644
--- a/drivers/tty/serial/Makefile
+++ b/drivers/tty/serial/Makefile
@@ -89,6 +89,7 @@ obj-$(CONFIG_SERIAL_MPS2_UART) += mps2-uart.o
obj-$(CONFIG_SERIAL_OWL) += owl-uart.o
obj-$(CONFIG_SERIAL_RDA) += rda-uart.o
obj-$(CONFIG_SERIAL_MILBEAUT_USIO) += milbeaut_usio.o
+obj-$(CONFIG_SERIAL_SI4455) += si4455.o
obj-$(CONFIG_SERIAL_SIFIVE) += sifive.o
# GPIOLIB helpers for modem control lines
diff --git a/drivers/tty/serial/si4455.c b/drivers/tty/serial/si4455.c
new file mode 100644
index 000000000000..615c783b7aa2
--- /dev/null
+++ b/drivers/tty/serial/si4455.c
@@ -0,0 +1,1721 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2020 József Horváth <info@...istro.hu>
+ *
+ */
+#include <linux/bitops.h>
+#include <linux/clk.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/gpio/driver.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/of_device.h>
+#include <linux/of_gpio.h>
+#include <linux/regmap.h>
+#include <linux/serial_core.h>
+#include <linux/serial.h>
+#include <linux/tty.h>
+#include <linux/tty_flip.h>
+#include <linux/spi/spi.h>
+#include <linux/uaccess.h>
+#include <linux/string.h>
+#include <linux/firmware.h>
+#include <linux/timer.h>
+#ifdef CONFIG_DEBUG_FS
+#include <linux/debugfs.h>
+#endif
+
+#define PORT_SI4455 1096
+#define SI4455_NAME "Si4455"
+#define SI4455_MAJOR 432
+#define SI4455_MINOR 567
+#define SI4455_UART_NRMAX 16
+#define SI4455_FIFO_SIZE 64
+
+#define SI4455_CMD_ID_EZCONFIG_CHECK 0x19
+#define SI4455_CMD_ID_PART_INFO 0x01
+#define SI4455_CMD_REPLY_COUNT_PART_INFO 9
+#define SI4455_CMD_ID_GET_INT_STATUS 0x20
+#define SI4455_CMD_REPLY_COUNT_GET_INT_STATUS 8
+#define SI4455_CMD_ID_FIFO_INFO 0x15
+#define SI4455_CMD_ARG_COUNT_FIFO_INFO 2
+#define SI4455_CMD_REPLY_COUNT_FIFO_INFO 2
+#define SI4455_CMD_FIFO_INFO_ARG_TX_BIT 0x01
+#define SI4455_CMD_FIFO_INFO_ARG_RX_BIT 0x02
+#define SI4455_CMD_ID_READ_CMD_BUFF 0x44
+#define SI4455_CMD_ID_READ_RX_FIFO 0x77
+#define SI4455_CMD_ID_WRITE_TX_FIFO 0x66
+#define SI4455_CMD_ID_START_RX 0x32
+#define SI4455_CMD_ARG_COUNT_START_RX 8
+#define SI4455_CMD_START_RX_RXTIMEOUT_STATE_RX 8
+#define SI4455_CMD_START_RX_RXVALID_STATE_SLEEP 1
+#define SI4455_CMD_START_RX_RXVALID_STATE_RX 8
+#define SI4455_CMD_START_RX_RXINVALID_STATE_RX 8
+#define SI4455_CMD_ID_START_TX 0x31
+#define SI4455_CMD_ARG_COUNT_START_TX 5
+#define SI4455_CMD_ID_CHANGE_STATE 0x34
+#define SI4455_CMD_ARG_COUNT_CHANGE_STATE 2
+#define SI4455_CMD_CHANGE_STATE_STATE_SLEEP 1
+#define SI4455_CMD_CHANGE_STATE_STATE_READY 3
+#define SI4455_CMD_CHANGE_STATE_STATE_RX 8
+#define SI4455_CMD_GET_CHIP_STATUS_ERROR_PEND_MASK 0x08
+#define SI4455_CMD_GET_CHIP_STATUS_ERROR_PEND_BIT 0x08
+#define SI4455_CMD_GET_INT_STATUS_RX_FIFO_AF_BIT 0x01
+#define SI4455_CMD_GET_INT_STATUS_TX_FIFO_AE_BIT 0x02
+#define SI4455_CMD_GET_INT_STATUS_PACKET_SENT_PEND_BIT 0x20
+#define SI4455_CMD_GET_INT_STATUS_PACKET_RX_PEND_BIT 0x10
+#define SI4455_CMD_GET_INT_STATUS_CRC_ERROR_BIT 0x08
+#define SI4455_CMD_GET_INT_STATUS_CHIP_RDY_BIT 0x04
+#define SI4455_CMD_GET_INT_STATUS_CMD_ERROR_BIT 0x08
+#define SI4455_CMD_GET_INT_STATUS_ST_CHANGED_BIT 0x10
+#define SI4455_CMD_GET_INT_STATUS_FIFO_UO_BIT 0x20
+#define SI4455_CMD_ID_GET_MODEM_STATUS 0x22
+#define SI4455_CMD_ARG_COUNT_GET_MODEM_STATUS 2
+#define SI4455_CMD_REPLY_COUNT_GET_MODEM_STATUS 8
+
+struct si4455_part_info {
+ u8 chip_rev;
+ u16 part;
+ u8 pbuild;
+ u16 id;
+ u8 customer;
+ u8 rom_id;
+ u8 bond;
+};
+
+struct si4455_int_status {
+ u8 int_pend;
+ u8 int_status;
+ u8 ph_pend;
+ u8 ph_status;
+ u8 modem_pend;
+ u8 modem_status;
+ u8 chip_pend;
+ u8 chip_status;
+};
+
+struct si4455_modem_status {
+ u8 modem_pend;
+ u8 modem_status;
+ u8 curr_rssi;
+ u8 latch_rssi;
+ u8 ant1_rssi;
+ u8 ant2_rssi;
+ u16 afc_freq_offset;
+};
+
+struct si4455_fifo_info {
+ u8 rx_fifo_count;
+ u8 tx_fifo_space;
+};
+
+struct si4455_port {
+ struct uart_port port;
+#ifdef CONFIG_DEBUG_FS
+ struct dentry *dbgfs_dir;
+#endif
+ struct work_struct tx_work;
+ struct work_struct tx_wd_work;
+ struct work_struct cts_wd_work;
+ struct timer_list tx_wd_timer;
+ struct timer_list cts_wd_timer;
+ struct mutex mutex; /* For syncing access to device */
+ struct gpio_desc *shdn_gpio;
+ struct si4455_part_info part_info;
+ struct si4455_modem_status modem_status;
+ u32 tx_channel;
+ u32 rx_channel;
+ u32 package_size;
+ u32 current_rssi;
+ u32 cts_error_count;
+ u32 tx_error_count;
+ int power_count;
+ u32 tx_wd_timeout;
+ u32 tx_pending_size;
+ char ez_fw_name[255];
+ bool connected;
+ bool suspended;
+ bool configured;
+ bool cts_error;
+ bool tx_pending;
+ bool rx_pending;
+};
+
+static struct uart_driver si4455_uart = {
+ .owner = THIS_MODULE,
+ .driver_name = SI4455_NAME,
+#ifdef CONFIG_DEVFS_FS
+ .dev_name = "ttySI%d",
+#else
+ .dev_name = "ttySI",
+#endif
+ .major = SI4455_MAJOR,
+ .minor = SI4455_MINOR,
+ .nr = SI4455_UART_NRMAX,
+};
+
+static DEFINE_MUTEX(si4455_ports_lock); /* race on probe */
+static DECLARE_BITMAP(si4455_port_lines, SI4455_UART_NRMAX);
+
+static int si4455_get_response(struct uart_port *port, int length, u8 *data)
+{
+ int ret;
+ u8 data_out[] = { SI4455_CMD_ID_READ_CMD_BUFF };
+ u8 *data_in;
+ struct spi_transfer xfer[2];
+ int timeout = 100;
+
+ if (length > 0 && !data)
+ return -EINVAL;
+
+ data_in = kzalloc(1 + length, GFP_KERNEL);
+ if (!data_in)
+ return -ENOMEM;
+
+ memset(&xfer, 0x00, sizeof(xfer));
+ xfer[0].tx_buf = data_out;
+ xfer[0].len = sizeof(data_out);
+ xfer[1].rx_buf = data_in;
+ xfer[1].len = 1 + length;
+
+ while (--timeout > 0) {
+ data_out[0] = SI4455_CMD_ID_READ_CMD_BUFF;
+ ret = spi_sync_transfer(to_spi_device(port->dev), xfer,
+ ARRAY_SIZE(xfer));
+ if (ret) {
+ dev_err(port->dev, "%s: spi_sync_transfer error (%i)\n", __func__, ret);
+ break;
+ }
+
+ if (data_in[0] == 0xFF) {
+ if (length > 0 && data)
+ memcpy(data, &data_in[1], length);
+
+ break;
+ }
+ usleep_range(100, 200);
+ }
+ if (!ret && timeout == 0) {
+ dev_err(port->dev, "%s: timeout\n", __func__);
+ ret = -EIO;
+ }
+ kfree(data_in);
+ return ret;
+}
+
+static int si4455_poll_cts(struct uart_port *port)
+{
+ int ret;
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ ret = si4455_get_response(port, 0, NULL);
+ if (ret == -EIO) {
+ s->cts_error_count++;
+ s->cts_error = true;
+ }
+ return ret;
+}
+
+static int si4455_send_command(struct uart_port *port, int length, u8 *data)
+{
+ int ret;
+
+ ret = si4455_poll_cts(port);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: si4455_poll_cts error (%i)\n", __func__, ret);
+ return ret;
+ }
+
+ ret = spi_write(to_spi_device(port->dev), data, length);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: spi_write error (%i)\n", __func__, ret);
+ }
+
+ return ret;
+}
+
+static int si4455_send_command_get_response(struct uart_port *port,
+ int out_length, u8 *data_out,
+ int in_length, u8 *data_in)
+{
+ int ret;
+
+ ret = si4455_send_command(port, out_length, data_out);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: si4455_send_command error (%i)\n", __func__, ret);
+ return ret;
+ }
+
+ return si4455_get_response(port, in_length, data_in);
+}
+
+static int si4455_read_data(struct uart_port *port, u8 command, bool poll,
+ int length, u8 *data)
+{
+ int ret = 0;
+ u8 data_out[] = { command };
+ struct spi_transfer xfer[] = {
+ {
+ .tx_buf = data_out,
+ .len = sizeof(data_out),
+ }, {
+ .rx_buf = data,
+ .len = length,
+ }
+ };
+
+ if (poll) {
+ ret = si4455_poll_cts(port);
+ if (ret)
+ return ret;
+ }
+
+ ret = spi_sync_transfer(to_spi_device(port->dev),
+ xfer,
+ ARRAY_SIZE(xfer));
+ if (ret) {
+ dev_err(port->dev,
+ "%s: spi_sync_transfer error (%i)\n", __func__, ret);
+ }
+
+ return ret;
+}
+
+static int si4455_write_data(struct uart_port *port, u8 command, bool poll,
+ int length, const u8 *data)
+{
+ int ret = 0;
+ u8 *data_out;
+
+ if (poll) {
+ ret = si4455_poll_cts(port);
+ if (ret)
+ return ret;
+ }
+
+ data_out = kzalloc(1 + length, GFP_KERNEL);
+ if (!data_out)
+ return -ENOMEM;
+
+ data_out[0] = command;
+ memcpy(&data_out[1], data, length);
+ ret = spi_write(to_spi_device(port->dev), data_out, 1 + length);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: spi_write error (%i)\n", __func__, ret);
+ }
+
+ kfree(data_out);
+
+ return ret;
+}
+
+static void si4455_set_power(struct si4455_port *priv, bool on)
+{
+ if (!priv->shdn_gpio)
+ return;
+
+ gpiod_direction_output(priv->shdn_gpio, 0);
+ if (on) {
+ usleep_range(14000, 15000);
+ gpiod_set_value(priv->shdn_gpio, 1);
+ usleep_range(14000, 15000);
+ }
+}
+
+static int si4455_s_power(struct device *dev, bool on)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ dev_dbg(dev, "%s(on=%d)\n", __func__, on);
+ if (s->power_count == !on)
+ si4455_set_power(s, on);
+ s->power_count += on ? 1 : -1;
+ WARN_ON(s->power_count < 0);
+
+ return 0;
+}
+
+static int si4455_get_part_info(struct uart_port *port,
+ struct si4455_part_info *result)
+{
+ int ret;
+ u8 data_out[] = { SI4455_CMD_ID_PART_INFO };
+ u8 data_in[SI4455_CMD_REPLY_COUNT_PART_INFO];
+
+ ret = si4455_send_command_get_response(port, sizeof(data_out), data_out,
+ sizeof(data_in), data_in);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: si4455_send_command_get_response error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ result->chip_rev = data_in[0];
+ memcpy(&result->part, &data_in[1], sizeof(result->part));
+ result->pbuild = data_in[3];
+ memcpy(&result->id, &data_in[4], sizeof(result->id));
+ result->customer = data_in[6];
+ result->rom_id = data_in[7];
+ result->bond = data_in[8];
+
+ return 0;
+}
+
+static int si4455_get_int_status(struct uart_port *port, u8 ph_clear,
+ u8 modem_clear, u8 chip_clear,
+ struct si4455_int_status *result)
+{
+ int ret;
+ u8 data_out[] = {
+ SI4455_CMD_ID_GET_INT_STATUS,
+ ph_clear,
+ modem_clear,
+ chip_clear
+ };
+ u8 data_in[SI4455_CMD_REPLY_COUNT_GET_INT_STATUS];
+
+ ret = si4455_send_command_get_response(port, sizeof(data_out), data_out,
+ sizeof(data_in), data_in);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: si4455_send_command_get_response error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ result->int_pend = data_in[0];
+ result->int_status = data_in[1];
+ result->ph_pend = data_in[2];
+ result->ph_status = data_in[3];
+ result->modem_pend = data_in[4];
+ result->modem_status = data_in[5];
+ result->chip_pend = data_in[6];
+ result->chip_status = data_in[7];
+
+ return 0;
+}
+
+static int si4455_get_modem_status(struct uart_port *port, u8 modem_clear,
+ struct si4455_modem_status *result)
+{
+ int ret;
+ u8 data_out[] = {
+ SI4455_CMD_ID_GET_MODEM_STATUS,
+ modem_clear,
+ };
+ u8 data_in[SI4455_CMD_REPLY_COUNT_GET_MODEM_STATUS];
+
+ ret = si4455_send_command_get_response(port, sizeof(data_out), data_out,
+ sizeof(data_in), data_in);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: si4455_send_command_get_response error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ result->modem_pend = data_in[0];
+ result->modem_status = data_in[1];
+ result->curr_rssi = data_in[2];
+ result->latch_rssi = data_in[3];
+ result->ant1_rssi = data_in[4];
+ result->ant2_rssi = data_in[5];
+ memcpy(&result->afc_freq_offset, &data_in[6],
+ sizeof(result->afc_freq_offset));
+
+ return 0;
+}
+
+static int si4455_fifo_info(struct uart_port *port, u8 fifo,
+ struct si4455_fifo_info *result)
+{
+ int ret;
+ u8 data_out[SI4455_CMD_ARG_COUNT_FIFO_INFO] = {
+ SI4455_CMD_ID_FIFO_INFO, fifo
+ };
+ u8 data_in[SI4455_CMD_REPLY_COUNT_FIFO_INFO] = { 0 };
+
+ ret = si4455_send_command_get_response(port, sizeof(data_out), data_out,
+ sizeof(data_in), data_in);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: si4455_send_command_get_response error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ result->rx_fifo_count = data_in[0];
+ result->tx_fifo_space = data_in[1];
+
+ return 0;
+}
+
+static int si4455_read_rx_fifo(struct uart_port *port, int length, u8 *data)
+{
+ return si4455_read_data(port, SI4455_CMD_ID_READ_RX_FIFO, false,
+ length, data);
+}
+
+static int si4455_write_tx_fifo(struct uart_port *port, int length, u8 *data)
+{
+ return si4455_write_data(port, SI4455_CMD_ID_WRITE_TX_FIFO, false,
+ length, data);
+}
+
+static int si4455_rx(struct uart_port *port, u32 channel, u8 condition,
+ u16 length, u8 next_state1, u8 next_state2,
+ u8 next_state3)
+{
+ u8 data_out[SI4455_CMD_ARG_COUNT_START_RX];
+
+ data_out[0] = SI4455_CMD_ID_START_RX;
+ data_out[1] = channel;
+ data_out[2] = condition;
+ data_out[3] = (u8)(length >> 8);
+ data_out[4] = (u8)(length);
+ data_out[5] = next_state1;
+ data_out[6] = next_state2;
+ data_out[7] = next_state3;
+
+ return si4455_send_command(port, SI4455_CMD_ARG_COUNT_START_RX,
+ data_out);
+}
+
+static int si4455_tx(struct uart_port *port, u8 channel, u8 condition,
+ u16 length)
+{
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+ u8 data_out[SI4455_CMD_ARG_COUNT_START_TX + 1];
+ u8 out_length = SI4455_CMD_ARG_COUNT_START_TX;
+
+ if (s->part_info.rom_id == 6)
+ out_length += 1;
+
+ data_out[0] = SI4455_CMD_ID_START_TX;
+ data_out[1] = channel;
+ data_out[2] = condition;
+ data_out[3] = (u8)(length >> 8);
+ data_out[4] = (u8)(length);
+ if (s->part_info.rom_id == 6)
+ data_out[5] = 0x44;
+
+ return si4455_send_command(port, out_length, data_out);
+}
+
+static int si4455_change_state(struct uart_port *port, u8 next_state1)
+{
+ u8 data_out[SI4455_CMD_ARG_COUNT_CHANGE_STATE];
+
+ dev_dbg(port->dev, "%s(%u)\n", __func__, next_state1);
+ data_out[0] = SI4455_CMD_ID_CHANGE_STATE;
+ data_out[1] = (u8)next_state1;
+
+ return si4455_send_command(port, SI4455_CMD_ARG_COUNT_CHANGE_STATE,
+ data_out);
+}
+
+static int si4455_begin_tx(struct uart_port *port, u32 channel, int length,
+ u8 *data)
+{
+ int ret = 0;
+ struct si4455_int_status int_status = { 0 };
+ struct si4455_fifo_info fifo_info = { 0 };
+
+ dev_dbg(port->dev, "%s(%u, %u)\n", __func__, channel, length);
+ if (length > SI4455_FIFO_SIZE || length < 0)
+ return -EINVAL;
+
+ ret = si4455_get_int_status(port, 0, 0, 0, &int_status);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_get_int_status error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ ret = si4455_fifo_info(port, SI4455_CMD_FIFO_INFO_ARG_TX_BIT,
+ &fifo_info);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_fifo_info error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ ret = si4455_write_tx_fifo(port, (u16)length, data);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_write_tx_fifo error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ ret = si4455_tx(port, channel, 0x10, length);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_tx error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+ dev_dbg(port->dev, "%s(): end\n", __func__);
+
+ return 0;
+}
+
+static int si4455_end_tx(struct uart_port *port)
+{
+ int ret = 0;
+ struct si4455_int_status int_status = { 0 };
+
+ dev_dbg(port->dev, "%s()\n", __func__);
+ ret = si4455_get_int_status(port, 0, 0, 0, &int_status);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_get_int_status error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+ dev_dbg(port->dev, "%s(): end\n", __func__);
+ return 0;
+}
+
+static int si4455_begin_rx(struct uart_port *port, u32 channel, u32 length)
+{
+ int ret = 0;
+ struct si4455_int_status int_status = { 0 };
+ struct si4455_fifo_info fifo_info = { 0 };
+
+ dev_dbg(port->dev, "%s(%u, %u)\n", __func__, channel, length);
+ ret = si4455_get_int_status(port, 0, 0, 0, &int_status);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_get_int_status error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ ret = si4455_fifo_info(port, SI4455_CMD_FIFO_INFO_ARG_RX_BIT,
+ &fifo_info);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_fifo_info error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ ret = si4455_rx(port, channel, 0x00, length,
+ SI4455_CMD_START_RX_RXTIMEOUT_STATE_RX,
+ SI4455_CMD_START_RX_RXVALID_STATE_RX,
+ SI4455_CMD_START_RX_RXINVALID_STATE_RX);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_rx error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+ dev_dbg(port->dev, "%s(): end\n", __func__);
+
+ return 0;
+}
+
+static int si4455_end_rx(struct uart_port *port, u32 length, u8 *data)
+{
+ return si4455_read_rx_fifo(port, length, data);
+}
+
+static int si4455_configure(struct uart_port *port, const u8 *configuration_data)
+{
+ int ret = 0;
+ u8 col;
+ u8 response;
+ u8 count;
+ u8 cmd;
+ struct si4455_int_status int_status = { 0 };
+ u8 radio_cmd[16];
+
+ /*
+ * While cycle as far as the pointer points to a command
+ */
+ while (*configuration_data != 0x00) {
+ /*
+ * Commands structure in the array:
+ * --------------------------------
+ * LEN | <LEN length of data>
+ */
+ count = *configuration_data++;
+ cmd = *configuration_data;
+ dev_dbg(port->dev, "%s: count (%u), cmd (%u)\n",
+ __func__, count, cmd);
+
+ if (count > 16 && count <= 128 && cmd == SI4455_CMD_ID_WRITE_TX_FIFO) {
+ /*
+ * Load array to the device
+ */
+ configuration_data++;
+ ret = si4455_write_data(port, SI4455_CMD_ID_WRITE_TX_FIFO,
+ true, count - 1, configuration_data);
+ if (ret) {
+ dev_err(port->dev, "%s: si4455_write_data error (%i)\n",
+ __func__, ret);
+ break;
+ }
+
+ /*
+ * Point to the next command
+ */
+ configuration_data += count - 1;
+
+ /*
+ * Continue command interpreter
+ */
+ continue;
+ } else if (count > 16) {
+ /*
+ * Number of command bytes exceeds
+ * maximal allowable length
+ */
+ ret = -EINVAL;
+ break;
+ }
+
+ for (col = 0u; col < count; col++) {
+ radio_cmd[col] = *configuration_data;
+ configuration_data++;
+ }
+
+ dev_dbg(port->dev, "%s: radio_cmd[0] (%u)\n", __func__, radio_cmd[0]);
+ ret = si4455_send_command_get_response(port, count, radio_cmd,
+ 1, &response);
+ if (ret) {
+ dev_err(port->dev,
+ "%s: si4455_send_command_get_response error (%i)\n",
+ __func__, ret);
+ break;
+ }
+
+ /*
+ * Check response byte of EZCONFIG_CHECK command
+ */
+ if (radio_cmd[0] == SI4455_CMD_ID_EZCONFIG_CHECK) {
+ if (response) {
+ /*
+ * Number of command bytes exceeds
+ * maximal allowable length
+ */
+ ret = -EIO;
+ dev_err(port->dev, "%s: EZConfig check error (%i)\n",
+ __func__, radio_cmd[0]);
+ break;
+ }
+ }
+
+ /*
+ * Get and clear all interrupts. An error has occurred...
+ */
+ si4455_get_int_status(port, 0, 0, 0, &int_status);
+ if (int_status.chip_pend
+ & SI4455_CMD_GET_CHIP_STATUS_ERROR_PEND_MASK) {
+ ret = -EIO;
+ dev_err(port->dev, "%s: chip error (%i)\n",
+ __func__, int_status.chip_pend);
+ break;
+ }
+ }
+
+ return ret;
+}
+
+static int si4455_re_configure(struct uart_port *port, const struct firmware *configuration)
+{
+ int ret = 0;
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ s->configured = 0;
+ if (s->power_count == 0)
+ si4455_s_power(port->dev, true);
+
+ ret = si4455_configure(port, configuration->data);
+ if (ret == 0) {
+ s->configured = true;
+ s->cts_error = false;
+ }
+ return ret;
+}
+
+static int si4455_start_tx_xmit(struct uart_port *port)
+{
+ int ret;
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+ struct circ_buf *xmit = &port->state->xmit;
+ u32 tx_pending;
+ u32 tx_to_end;
+ u8 *data;
+ u8 *payload;
+ u32 max_length;
+
+ dev_dbg(port->dev, "%s()\n", __func__);
+ tx_pending = uart_circ_chars_pending(xmit);
+ if (tx_pending == 0 || tx_pending < s->package_size)
+ return 0;
+
+ max_length = (s->package_size == 0) ? SI4455_FIFO_SIZE - 3 : s->package_size;
+ tx_pending = (tx_pending > max_length) ? max_length : tx_pending;
+ if (s->package_size == 0)
+ data = kzalloc(tx_pending + 1, GFP_KERNEL);
+ else
+ data = kzalloc(tx_pending, GFP_KERNEL);
+ if (!data)
+ return -ENOMEM;
+
+ if (s->package_size == 0) {
+ data[0] = tx_pending;
+ payload = &data[1];
+ } else {
+ payload = data;
+ }
+
+ tx_to_end = CIRC_CNT_TO_END(xmit->head, xmit->tail, UART_XMIT_SIZE);
+ if (tx_to_end < tx_pending) {
+ memcpy(payload, xmit->buf + xmit->tail, tx_to_end);
+ memcpy(&payload[tx_to_end], xmit->buf, tx_pending - tx_to_end);
+ } else {
+ memcpy(payload, xmit->buf + xmit->tail, tx_pending);
+ }
+
+ if (s->package_size == 0)
+ ret = si4455_begin_tx(port, s->tx_channel, tx_pending + 1, data);
+ else
+ ret = si4455_begin_tx(port, s->tx_channel, tx_pending, data);
+ if (!ret) {
+ s->tx_pending = true;
+ s->tx_pending_size = tx_pending;
+ uart_handle_cts_change(&s->port, 0);
+ mod_timer(&s->tx_wd_timer, jiffies + msecs_to_jiffies(s->tx_wd_timeout));
+ }
+
+ kfree(data);
+ dev_dbg(port->dev, "%s(): end\n", __func__);
+
+ return ret;
+}
+
+static int si4455_cancel_tx(struct uart_port *port)
+{
+ int ret = 0;
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ dev_dbg(port->dev, "%s()\n", __func__);
+ if (s->tx_pending) {
+ si4455_end_tx(port);
+ s->tx_pending = false;
+ s->tx_pending_size = 0;
+ uart_handle_cts_change(&s->port, TIOCM_CTS);
+ ret = si4455_change_state(port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ }
+ dev_dbg(port->dev, "%s(): end\n", __func__);
+ return ret;
+}
+
+static int si4455_do_work(struct uart_port *port)
+{
+ int ret = 0;
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+ struct circ_buf *xmit = &port->state->xmit;
+
+ mutex_lock(&s->mutex);
+ dev_dbg(port->dev, "%s(connected=%i, configured=%i, power_count=%i)\n",
+ __func__, s->connected, s->configured, s->power_count);
+ if (!s->suspended && s->connected && s->configured && s->power_count > 0) {
+ if (!(uart_circ_empty(xmit) || uart_tx_stopped(port) || s->tx_pending))
+ ret = si4455_start_tx_xmit(port);
+
+ if (!ret && !s->tx_pending)
+ ret = si4455_begin_rx(port, s->rx_channel, s->package_size);
+ }
+ dev_dbg(port->dev, "%s(connected=%i, configured=%i, power_count=%i): end\n",
+ __func__, s->connected, s->configured, s->power_count);
+ mutex_unlock(&s->mutex);
+ return ret;
+}
+
+static void si4455_handle_rx_pend(struct si4455_port *s, struct si4455_fifo_info *fifo_info)
+{
+ struct uart_port *port = &s->port;
+ u8 *data;
+ int sret = 0;
+ int i = 0;
+ u32 length;
+
+ dev_dbg(port->dev, "%s()\n", __func__);
+ length = (s->package_size == 0) ? fifo_info->rx_fifo_count : s->package_size;
+
+ data = kzalloc(length, GFP_KERNEL);
+ if (!data)
+ return;
+
+ sret = si4455_end_rx(port, length, data);
+ if (sret) {
+ dev_err(port->dev, "%s: si4455_end_rx error (%i)\n",
+ __func__, sret);
+ } else {
+ for (i = 0; i < length; i++) {
+ uart_insert_char(port, 0, 0, data[i], TTY_NORMAL);
+ port->icount.rx++;
+ }
+ tty_flip_buffer_push(&port->state->port);
+ }
+ kfree(data);
+ dev_dbg(port->dev, "%s(): end\n", __func__);
+}
+
+static void si4455_handle_tx_pend(struct si4455_port *s)
+{
+ struct uart_port *port = &s->port;
+ struct circ_buf *xmit = &port->state->xmit;
+ u32 sent;
+
+ dev_dbg(port->dev, "%s()\n", __func__);
+ if (s->tx_pending) {
+ sent = (s->package_size == 0) ? s->tx_pending_size
+ : s->package_size;
+ port->icount.tx += sent;
+ xmit->tail = (xmit->tail + sent) & (UART_XMIT_SIZE - 1);
+ si4455_end_tx(port);
+ s->tx_pending = 0;
+ s->tx_pending_size = 0;
+ uart_handle_cts_change(&s->port, TIOCM_CTS);
+ }
+ dev_dbg(port->dev, "%s(): end\n", __func__);
+}
+
+static irqreturn_t si4455_ist(int irq, void *dev_id)
+{
+ struct si4455_port *s = (struct si4455_port *)dev_id;
+ struct uart_port *port = &s->port;
+ int ret;
+ struct si4455_int_status int_status = { 0 };
+ struct si4455_fifo_info fifo_info = { 0 };
+ bool have_to_do = false;
+
+ if (s->suspended || !s->connected || !s->configured || s->power_count == 0)
+ return IRQ_NONE;
+
+ mutex_lock(&s->mutex);
+ ret = si4455_get_int_status(port, 0, 0, 0, &int_status);
+ if (ret) {
+ mutex_unlock(&s->mutex);
+ return IRQ_NONE;
+ }
+
+ dev_dbg(port->dev, "%s: int_pend: 0x%x\n", __func__, int_status.int_pend);
+ dev_dbg(port->dev, "%s: int_status: 0x%x\n", __func__, int_status.int_status);
+ dev_dbg(port->dev, "%s: ph_pend: 0x%x\n", __func__, int_status.ph_pend);
+ dev_dbg(port->dev, "%s: ph_status: 0x%x\n", __func__, int_status.ph_status);
+ dev_dbg(port->dev, "%s: modem_pend: 0x%x\n", __func__, int_status.modem_pend);
+ dev_dbg(port->dev, "%s: modem_status: 0x%x\n", __func__, int_status.modem_status);
+ dev_dbg(port->dev, "%s: chip_pend: 0x%x\n", __func__, int_status.chip_pend);
+ dev_dbg(port->dev, "%s: chip_status: 0x%x\n", __func__, int_status.chip_status);
+
+ if (int_status.chip_pend & SI4455_CMD_GET_CHIP_STATUS_ERROR_PEND_BIT) {
+ dev_err(port->dev, "%s: chip_pend:CMD_ERROR_PEND\n", __func__);
+ si4455_change_state(port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ si4455_fifo_info(&s->port, SI4455_CMD_FIFO_INFO_ARG_RX_BIT,
+ &fifo_info);
+ have_to_do = true;
+ } else if (int_status.ph_pend & SI4455_CMD_GET_INT_STATUS_PACKET_SENT_PEND_BIT) {
+ dev_dbg(port->dev, "%s: ph_pend:PACKET_SENT_PEND\n", __func__);
+ si4455_change_state(port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ si4455_handle_tx_pend(s);
+ have_to_do = true;
+ } else if (int_status.ph_pend & SI4455_CMD_GET_INT_STATUS_PACKET_RX_PEND_BIT) {
+ dev_dbg(port->dev, "%s: ph_pend:PACKET_RX_PEND\n", __func__);
+ si4455_get_modem_status(port, 0, &s->modem_status);
+ s->current_rssi = s->modem_status.curr_rssi;
+ si4455_change_state(port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ si4455_fifo_info(port, 0, &fifo_info);
+ si4455_handle_rx_pend(s, &fifo_info);
+ have_to_do = true;
+ } else if (int_status.ph_pend & SI4455_CMD_GET_INT_STATUS_CRC_ERROR_BIT) {
+ dev_dbg(port->dev, "%s: ph_pend:CRC_ERROR_PEND\n", __func__);
+ si4455_change_state(port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ si4455_fifo_info(&s->port, SI4455_CMD_FIFO_INFO_ARG_RX_BIT,
+ &fifo_info);
+ have_to_do = true;
+ }
+ mutex_unlock(&s->mutex);
+ if (have_to_do)
+ si4455_do_work(port);
+ return IRQ_HANDLED;
+}
+
+static void si4455_tx_wd_event(struct timer_list *t)
+{
+ struct si4455_port *s = from_timer(s, t, tx_wd_timer);
+
+ dev_dbg(s->port.dev, "%s\n", __func__);
+ if (s->tx_pending)
+ schedule_work(&s->tx_wd_work);
+}
+
+static void si4455_tx_wd_proc(struct work_struct *ws)
+{
+ struct si4455_port *s = container_of(ws, struct si4455_port, tx_wd_work);
+ bool have_to_work = false;
+
+ dev_dbg(s->port.dev, "%s\n", __func__);
+ mutex_lock(&s->mutex);
+ if (s->connected && s->tx_pending) {
+ si4455_cancel_tx(&s->port);
+ s->tx_error_count++;
+ have_to_work = true;
+ dev_err(s->port.dev,
+ "%s: curent transmit operation interrupted by wd timeout\n",
+ __func__);
+ }
+ mutex_unlock(&s->mutex);
+
+ if (have_to_work)
+ si4455_do_work(&s->port);
+
+ dev_dbg(s->port.dev, "%s: end\n", __func__);
+}
+
+static void si4455_cts_wd_event(struct timer_list *t)
+{
+ struct si4455_port *s = from_timer(s, t, cts_wd_timer);
+
+ if (s->cts_error)
+ schedule_work(&s->cts_wd_work);
+ else
+ mod_timer(&s->cts_wd_timer, jiffies + msecs_to_jiffies(100));
+}
+
+static void si4455_cts_wd_proc(struct work_struct *ws)
+{
+ struct si4455_port *s = container_of(ws, struct si4455_port, cts_wd_work);
+ const struct firmware *ez_fw = NULL;
+ bool have_to_work = false;
+ int ret;
+
+ dev_dbg(s->port.dev, "%s\n", __func__);
+ mutex_lock(&s->mutex);
+ if (s->cts_error) {
+ dev_err(s->port.dev, "%s: interface recovery\n", __func__);
+ ret = request_firmware(&ez_fw, s->ez_fw_name, s->port.dev);
+ if (ret) {
+ dev_err(s->port.dev, "%s: firmware(%s) request error (%i)\n",
+ __func__, s->ez_fw_name, ret);
+ } else {
+ si4455_s_power(s->port.dev, false);
+ ret = si4455_re_configure(&s->port, ez_fw);
+ release_firmware(ez_fw);
+ if (ret) {
+ dev_err(s->port.dev, "%s: device configuration error (%i)\n",
+ __func__, ret);
+ }
+ }
+ have_to_work = !ret;
+ }
+ if (s->connected)
+ mod_timer(&s->cts_wd_timer, jiffies + msecs_to_jiffies(100));
+ mutex_unlock(&s->mutex);
+
+ if (have_to_work)
+ si4455_do_work(&s->port);
+
+ dev_dbg(s->port.dev, "%s: end\n", __func__);
+}
+
+static void si4455_tx_proc(struct work_struct *ws)
+{
+ struct si4455_port *s = container_of(ws, struct si4455_port, tx_work);
+
+ si4455_do_work(&s->port);
+}
+
+static unsigned int si4455_tx_empty(struct uart_port *port)
+{
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ return s->tx_pending ? 0 : TIOCSER_TEMT;
+}
+
+static unsigned int si4455_get_mctrl(struct uart_port *port)
+{
+ int ret;
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ /*
+ * there is no a continuous real "carrier" like on phone line,
+ * but after configuration, the interface is ready to use the physical
+ * transport channel
+ */
+ ret = s->configured ? TIOCM_CAR | TIOCM_DSR : 0;
+ ret |= s->tx_pending ? 0 : TIOCM_CTS;
+
+ return ret;
+}
+
+static void si4455_set_mctrl(struct uart_port *port, unsigned int mctrl)
+{
+ dev_dbg(port->dev, "%s\n", __func__);
+}
+
+static void si4455_set_termios(struct uart_port *port, struct ktermios *termios,
+ struct ktermios *old)
+{
+ dev_dbg(port->dev, "%s\n", __func__);
+ dev_dbg(port->dev, "termios->c_iflag = 0x%x", termios->c_iflag);
+ dev_dbg(port->dev, "termios->c_oflag = 0x%x", termios->c_oflag);
+ dev_dbg(port->dev, "termios->c_cflag = 0x%x", termios->c_cflag);
+ dev_dbg(port->dev, "termios->c_lflag = 0x%x", termios->c_lflag);
+ dev_dbg(port->dev, "termios->c_ispeed = %u", termios->c_ispeed);
+ dev_dbg(port->dev, "termios->c_ospeed = %u", termios->c_ospeed);
+ if ((termios->c_cflag & CSIZE) != CS8)
+ dev_err(port->dev, "%s: CSIZE must be CS8\n", __func__);
+}
+
+static int si4455_startup(struct uart_port *port)
+{
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ dev_dbg(port->dev, "%s\n", __func__);
+ mutex_lock(&s->mutex);
+ s->tx_pending = false;
+ s->connected = true;
+ mod_timer(&s->cts_wd_timer, jiffies + msecs_to_jiffies(100));
+ mutex_unlock(&s->mutex);
+ return si4455_do_work(port);
+}
+
+static void si4455_shutdown(struct uart_port *port)
+{
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ dev_dbg(port->dev, "%s\n", __func__);
+ mutex_lock(&s->mutex);
+ del_timer_sync(&s->tx_wd_timer);
+ del_timer_sync(&s->cts_wd_timer);
+ s->connected = false;
+ si4455_change_state(&s->port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ mutex_unlock(&s->mutex);
+}
+
+static const char *si4455_type(struct uart_port *port)
+{
+ struct si4455_port *s = dev_get_drvdata(port->dev);
+
+ if (port->type != PORT_SI4455)
+ return NULL;
+ if (s->part_info.rom_id == 3)
+ return "SI4455-B1A";
+ else if (s->part_info.rom_id == 6)
+ return "SI4455-C2A";
+
+ return "SI4455(UNKNOWN-REV)";
+}
+
+static void si4455_config_port(struct uart_port *port, int flags)
+{
+ dev_dbg(port->dev, "%s\n", __func__);
+ if (flags & UART_CONFIG_TYPE)
+ port->type = PORT_SI4455;
+}
+
+static int si4455_verify_port(struct uart_port *port, struct serial_struct *s)
+{
+ if (s->type != PORT_UNKNOWN && s->type != PORT_SI4455)
+ return -EINVAL;
+
+ if (s->irq != port->irq)
+ return -EINVAL;
+
+ return 0;
+}
+
+static void si4455_start_tx(struct uart_port *port)
+{
+ struct si4455_port *s = container_of(port, struct si4455_port, port);
+
+ dev_dbg(port->dev, "%s\n", __func__);
+
+ schedule_work(&s->tx_work);
+}
+
+static void si4455_null_void(struct uart_port *port)
+{
+ /* Do nothing */
+}
+
+static const struct uart_ops si4455_ops = {
+ .tx_empty = si4455_tx_empty,
+ .set_mctrl = si4455_set_mctrl,/* required */
+ .get_mctrl = si4455_get_mctrl,
+ .stop_tx = si4455_null_void,
+ .start_tx = si4455_start_tx,
+ .stop_rx = si4455_null_void,
+ .startup = si4455_startup,
+ .shutdown = si4455_shutdown,
+ .set_termios = si4455_set_termios,/* required */
+ .type = si4455_type,
+ .release_port = si4455_null_void,
+ .config_port = si4455_config_port,
+ .verify_port = si4455_verify_port,
+};
+
+#ifdef CONFIG_DEBUG_FS
+static int si4455_debugfs_init(struct device *dev)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+ struct dentry *dbgfs_si_dir;
+ struct dentry *dbgfs_partinfo_dir;
+ struct dentry *dbgfs_entry;
+
+ s->dbgfs_dir = debugfs_create_dir(dev_name(dev), NULL);
+ if (IS_ERR(s->dbgfs_dir))
+ return PTR_ERR(s->dbgfs_dir);
+
+ dbgfs_si_dir = debugfs_create_dir("si4455", s->dbgfs_dir);
+ if (IS_ERR(dbgfs_si_dir))
+ return PTR_ERR(dbgfs_si_dir);
+
+ dbgfs_entry = debugfs_create_u32("cts_error_count", 0444,
+ dbgfs_si_dir, &s->cts_error_count);
+ if (IS_ERR(dbgfs_entry))
+ return PTR_ERR(dbgfs_entry);
+
+ dbgfs_entry = debugfs_create_u32("tx_error_count", 0444,
+ dbgfs_si_dir, &s->tx_error_count);
+ if (IS_ERR(dbgfs_entry))
+ return PTR_ERR(dbgfs_entry);
+
+ dbgfs_partinfo_dir = debugfs_create_dir("partinfo", dbgfs_si_dir);
+ if (IS_ERR(dbgfs_partinfo_dir))
+ return PTR_ERR(dbgfs_partinfo_dir);
+
+ dbgfs_entry = debugfs_create_u8("chip_rev", 0444,
+ dbgfs_partinfo_dir,
+ &s->part_info.chip_rev);
+ if (IS_ERR(dbgfs_entry))
+ return PTR_ERR(dbgfs_entry);
+
+ dbgfs_entry = debugfs_create_u8("rom_id", 0444,
+ dbgfs_partinfo_dir,
+ &s->part_info.rom_id);
+ if (IS_ERR(dbgfs_entry))
+ return PTR_ERR(dbgfs_entry);
+
+ dbgfs_entry = debugfs_create_u16("part", 0444,
+ dbgfs_partinfo_dir,
+ &s->part_info.part);
+ if (IS_ERR(dbgfs_entry))
+ return PTR_ERR(dbgfs_entry);
+
+ return 0;
+}
+
+static int si4455_debugfs_clear(struct device *dev)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ if (!IS_ERR_OR_NULL(s->dbgfs_dir))
+ debugfs_remove_recursive(s->dbgfs_dir);
+
+ return 0;
+}
+#else
+static int si4455_debugfs_init(struct device *dev)
+{
+ return 0;
+}
+
+static int si4455_debugfs_clear(struct device *dev)
+{
+ return 0;
+}
+#endif
+
+static int __maybe_unused si4455_suspend(struct device *dev)
+{
+ int ret;
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ dev_dbg(dev, "%s\n", __func__);
+ ret = si4455_cancel_tx(&s->port);
+ if (ret) {
+ dev_err(dev, "%s: si4455_cancel_tx error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ mutex_lock(&s->mutex);
+ ret = si4455_change_state(&s->port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ s->suspended = !ret;
+ mutex_unlock(&s->mutex);
+
+ if (ret) {
+ dev_err(dev, "%s: si4455_change_state error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+ return uart_suspend_port(&si4455_uart, &s->port);
+}
+
+static int __maybe_unused si4455_resume(struct device *dev)
+{
+ int ret;
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ dev_dbg(dev, "%s\n", __func__);
+ ret = uart_resume_port(&si4455_uart, &s->port);
+ if (ret) {
+ dev_err(dev, "%s: uart_resume_port error (%i)\n",
+ __func__, ret);
+ return ret;
+ }
+
+ s->suspended = false;
+
+ return si4455_do_work(&s->port);
+}
+
+static SIMPLE_DEV_PM_OPS(si4455_pm_ops, si4455_suspend, si4455_resume);
+
+static ssize_t package_size_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ return sprintf(buf, "%u\n", s->package_size);
+}
+
+static ssize_t package_size_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t count)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+ unsigned long val;
+ int ret;
+
+ ret = kstrtoul(buf, 10, &val);
+ if (ret)
+ return ret;
+
+ if (val > SI4455_FIFO_SIZE)
+ return -EINVAL;
+
+ s->package_size = val;
+ ret = si4455_do_work(&s->port);
+
+ return ret ? ret : count;
+}
+
+/*
+ * package_size: rw sysfs entry.
+ * Sets or returns the package size.
+ * The new value applied immediately.
+ * Variable package size (package_size == 0)
+ * currently not supported by driver.
+ */
+static DEVICE_ATTR_RW(package_size);
+
+static ssize_t rx_channel_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ return sprintf(buf, "%u\n", s->rx_channel);
+}
+
+static ssize_t rx_channel_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t count)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+ unsigned long val;
+ int ret;
+
+ ret = kstrtoul(buf, 10, &val);
+ if (ret)
+ return ret;
+
+ s->rx_channel = val;
+ ret = si4455_do_work(&s->port);
+
+ return ret ? ret : count;
+}
+
+/*
+ * rx_channel: rw sysfs entry.
+ * Sets or returns the receive channel index.
+ * The new value applied immediately.
+ */
+static DEVICE_ATTR_RW(rx_channel);
+
+static ssize_t tx_channel_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ return sprintf(buf, "%u\n", s->tx_channel);
+}
+
+static ssize_t tx_channel_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t count)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+ unsigned long val;
+ int ret;
+
+ ret = kstrtoul(buf, 10, &val);
+ if (ret)
+ return ret;
+
+ s->tx_channel = val;
+ ret = si4455_do_work(&s->port);
+
+ return ret ? ret : count;
+}
+
+/*
+ * tx_channel: rw sysfs entry.
+ * Sets or returns the transmit channel index.
+ * The new value will be used on next data transmit.
+ */
+static DEVICE_ATTR_RW(tx_channel);
+
+static ssize_t tx_timeout_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ return sprintf(buf, "%u\n", s->tx_wd_timeout);
+}
+
+static ssize_t tx_timeout_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t count)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+ unsigned long val;
+ int ret;
+
+ ret = kstrtoul(buf, 10, &val);
+ if (ret)
+ return ret;
+
+ s->tx_wd_timeout = val;
+ ret = si4455_do_work(&s->port);
+
+ return ret ? ret : count;
+}
+
+/*
+ * tx_timeout: rw sysfs entry.
+ * Sets or returns the transmit timeout.
+ * The new value will be used on next data transmit.
+ */
+static DEVICE_ATTR_RW(tx_timeout);
+
+static ssize_t current_rssi_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+
+ return sprintf(buf, "%u\n", s->current_rssi);
+}
+
+/*
+ * current_rssi: ro sysfs entry.
+ * Returns the latest rssi value measured by chip.
+ */
+static DEVICE_ATTR_RO(current_rssi);
+
+static struct attribute *si4455_attributes[] = {
+ &dev_attr_package_size.attr,
+ &dev_attr_rx_channel.attr,
+ &dev_attr_tx_channel.attr,
+ &dev_attr_tx_timeout.attr,
+ &dev_attr_current_rssi.attr,
+ NULL
+};
+
+static const struct attribute_group si4455_attr_group = {
+ .attrs = si4455_attributes,
+};
+
+static int si4455_probe(struct device *dev,
+ int irq)
+{
+ int ret;
+ struct si4455_port *s;
+ const void *of_ptr;
+ const struct firmware *ez_fw = NULL;
+ int line;
+
+ dev_dbg(dev, "%s\n", __func__);
+ /* Alloc port structure */
+ s = devm_kzalloc(dev, sizeof(*s), GFP_KERNEL);
+ if (!s)
+ return -ENOMEM;
+
+ dev_set_drvdata(dev, s);
+ mutex_init(&s->mutex);
+
+ /* Alloc port line */
+ line = find_first_zero_bit(si4455_port_lines, SI4455_UART_NRMAX);
+ if (line == SI4455_UART_NRMAX) {
+ dev_err(dev, "Unable to reguest port line index\n");
+ ret = -ERANGE;
+ goto out_generic;
+ }
+
+ s->shdn_gpio = devm_gpiod_get(dev, "shutdown", GPIOD_OUT_HIGH);
+ if (IS_ERR(s->shdn_gpio)) {
+ dev_err(dev, "Unable to reguest shdn gpio\n");
+ ret = -EINVAL;
+ goto out_generic;
+ }
+
+ of_ptr = of_get_property(dev->of_node, "silabs,package-size", NULL);
+ if (IS_ERR_OR_NULL(of_ptr)) {
+ dev_err(dev, "dt silabs,package-size property not present\n");
+ ret = -EINVAL;
+ goto out_generic;
+ }
+ s->package_size = be32_to_cpup(of_ptr);
+ if (s->package_size > SI4455_FIFO_SIZE) {
+ dev_err(dev, "dt silabs,package-size property maximum is %i\n", SI4455_FIFO_SIZE);
+ ret = -EINVAL;
+ goto out_generic;
+ }
+
+ of_ptr = of_get_property(dev->of_node, "silabs,tx-channel", NULL);
+ if (IS_ERR_OR_NULL(of_ptr)) {
+ dev_err(dev, "dt silabs,tx-channel property not present\n");
+ ret = -EINVAL;
+ goto out_generic;
+ }
+ s->tx_channel = be32_to_cpup(of_ptr);
+
+ of_ptr = of_get_property(dev->of_node, "silabs,rx-channel", NULL);
+ if (IS_ERR_OR_NULL(of_ptr)) {
+ dev_err(dev, "dt silabs,rx-channel property not present\n");
+ ret = -EINVAL;
+ goto out_generic;
+ }
+ s->rx_channel = be32_to_cpup(of_ptr);
+
+ of_ptr = of_get_property(dev->of_node, "silabs,tx-timeout", NULL);
+ if (IS_ERR_OR_NULL(of_ptr)) {
+ s->tx_wd_timeout = 100;
+ dev_warn(dev, "dt silabs,tx-timeout property not present\n");
+ } else {
+ s->tx_wd_timeout = be32_to_cpup(of_ptr);
+ }
+
+ of_ptr = of_get_property(dev->of_node, "firmware-name", NULL);
+ if (IS_ERR_OR_NULL(of_ptr)) {
+ dev_err(dev, "dt firmware-name property not present\n");
+ ret = -EINVAL;
+ goto out_generic;
+ }
+ strncpy(s->ez_fw_name, of_ptr, sizeof(s->ez_fw_name) - 1);
+
+ /* Initialize port data */
+ s->port.dev = dev;
+ s->port.line = line;
+ s->port.irq = irq;
+ s->port.type = PORT_SI4455;
+ s->port.fifosize = SI4455_FIFO_SIZE;
+ s->port.flags = UPF_FIXED_TYPE | UPF_LOW_LATENCY;
+ s->port.iotype = UPIO_PORT;
+ s->port.iobase = 1;
+ s->port.ops = &si4455_ops;
+
+ si4455_s_power(dev, true);
+
+ //detect
+ ret = si4455_get_part_info(&s->port, &s->part_info);
+ dev_dbg(dev, "si4455_get_part_info() = %i\n", ret);
+ if (ret == 0) {
+ dev_info(dev, "partInfo.chip_rev = %u\n", s->part_info.chip_rev);
+ dev_info(dev, "partInfo.part = %u\n", s->part_info.part);
+ dev_info(dev, "partInfo.pbuild = %u\n", s->part_info.pbuild);
+ dev_info(dev, "partInfo.id = %u\n", s->part_info.id);
+ dev_info(dev, "partInfo.customer = %u\n", s->part_info.customer);
+ dev_info(dev, "partInfo.rom_id = %u\n", s->part_info.rom_id);
+ dev_info(dev, "partInfo.bond = %u\n", s->part_info.bond);
+ if (s->part_info.part != 0x5544) {
+ dev_err(dev, "unknown part(%u) error\n", s->part_info.part);
+ ret = -ENODEV;
+ }
+ }
+
+ if (ret)
+ goto out_generic;
+
+ ret = request_firmware(&ez_fw, s->ez_fw_name, dev);
+ if (ret) {
+ dev_err(dev, "firmware(%s) request error (%i)\n", s->ez_fw_name, ret);
+ ret = -EINVAL;
+ goto out_generic;
+ }
+
+ ret = si4455_re_configure(&s->port, ez_fw);
+ release_firmware(ez_fw);
+ if (ret) {
+ dev_err(dev, "device configuration error (%i)\n", ret);
+ ret = -EINVAL;
+ goto out_generic;
+ }
+
+ ret = si4455_change_state(&s->port, SI4455_CMD_CHANGE_STATE_STATE_SLEEP);
+ if (ret) {
+ dev_err(dev, "device change state error (%i)\n", ret);
+ goto out_generic;
+ }
+
+ /* Initialize queue for start TX */
+ INIT_WORK(&s->tx_work, si4455_tx_proc);
+ /* Initialize queue for start TX watchdog */
+ INIT_WORK(&s->tx_wd_work, si4455_tx_wd_proc);
+ /* Initialize queue for start TX watchdog */
+ INIT_WORK(&s->cts_wd_work, si4455_cts_wd_proc);
+ /* Initialize timer for protecting and recovering tx_pending */
+ timer_setup(&s->tx_wd_timer, si4455_tx_wd_event, 0);
+ /* Initialize timer for recovering interface */
+ timer_setup(&s->cts_wd_timer, si4455_cts_wd_event, 0);
+
+ /* Register port */
+ ret = uart_add_one_port(&si4455_uart, &s->port);
+ if (ret) {
+ s->port.dev = NULL;
+ goto out_uart;
+ }
+
+ set_bit(line, si4455_port_lines);
+ s->port.line = line;
+
+ ret = sysfs_create_group(&dev->kobj, &si4455_attr_group);
+ if (ret) {
+ dev_err(dev, "sysfs_create_group error (%i)\n", ret);
+ goto out_uart;
+ }
+
+ ret = si4455_debugfs_init(dev);
+ if (ret) {
+ si4455_debugfs_clear(dev);
+ dev_err(dev, "si4455_debugfs_init error (%i)\n", ret);
+ goto out_uart;
+ }
+
+ /* Setup interrupt */
+ ret = devm_request_threaded_irq(dev, irq, NULL, si4455_ist,
+ IRQF_ONESHOT | IRQF_SHARED,
+ dev_name(dev), s);
+
+ if (!ret)
+ return 0;
+
+ dev_err(dev, "Unable to reguest IRQ %i\n", irq);
+ sysfs_remove_group(&dev->kobj, &si4455_attr_group);
+
+out_uart:
+ uart_remove_one_port(&si4455_uart, &s->port);
+ clear_bit(line, si4455_port_lines);
+out_generic:
+ mutex_destroy(&s->mutex);
+ si4455_s_power(dev, false);
+
+ return ret;
+}
+
+static int si4455_remove(struct device *dev)
+{
+ struct si4455_port *s = dev_get_drvdata(dev);
+ int line = s->port.line;
+
+ cancel_work_sync(&s->tx_work);
+ sysfs_remove_group(&dev->kobj, &si4455_attr_group);
+ si4455_debugfs_clear(dev);
+ uart_remove_one_port(&si4455_uart, &s->port);
+ mutex_destroy(&s->mutex);
+ clear_bit(line, si4455_port_lines);
+
+ return 0;
+}
+
+static const struct of_device_id __maybe_unused si4455_dt_ids[] = {
+ { .compatible = "silabs,si4455" },
+ { }
+};
+MODULE_DEVICE_TABLE(of, si4455_dt_ids);
+
+static int si4455_spi_probe(struct spi_device *spi)
+{
+ int ret;
+ const struct of_device_id *of_id;
+
+ /* Setup SPI bus */
+ spi->bits_per_word = 8;
+ spi->mode = SPI_MODE_0;
+ ret = spi_setup(spi);
+ if (ret)
+ return ret;
+
+ if (spi->dev.of_node) {
+ of_id = of_match_device(si4455_dt_ids, &spi->dev);
+ if (!of_id)
+ return -ENODEV;
+ }
+
+ mutex_lock(&si4455_ports_lock);
+ ret = si4455_probe(&spi->dev, spi->irq);
+ mutex_unlock(&si4455_ports_lock);
+ return ret;
+}
+
+static int si4455_spi_remove(struct spi_device *spi)
+{
+ int ret;
+
+ mutex_lock(&si4455_ports_lock);
+ ret = si4455_remove(&spi->dev);
+ mutex_unlock(&si4455_ports_lock);
+ return ret;
+}
+
+static struct spi_driver si4455_spi_driver = {
+ .driver = {
+ .name = SI4455_NAME,
+ .of_match_table = of_match_ptr(si4455_dt_ids),
+ .pm = &si4455_pm_ops,
+ },
+ .probe = si4455_spi_probe,
+ .remove = si4455_spi_remove,
+};
+
+static int __init si4455_uart_init(void)
+{
+ int ret;
+
+ bitmap_zero(si4455_port_lines, SI4455_UART_NRMAX);
+
+ ret = uart_register_driver(&si4455_uart);
+ if (ret)
+ return ret;
+
+ return spi_register_driver(&si4455_spi_driver);
+}
+module_init(si4455_uart_init);
+
+static void __exit si4455_uart_exit(void)
+{
+ spi_unregister_driver(&si4455_spi_driver);
+ uart_unregister_driver(&si4455_uart);
+}
+module_exit(si4455_uart_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Jozsef Horvath <info@...istro.hu>");
+MODULE_DESCRIPTION("Si4455 serial driver");
--
2.17.1
Powered by blists - more mailing lists