[PATCH] Staging: silabs si4455 serial driver

Info info at ministro.hu
Wed Dec 9 11:09:58 UTC 2020


This is a serial port driver for
Silicon Labs Si4455 Sub-GHz transciver.

Signed-off-by: József Horváth <info at ministro.hu>
---
 .../bindings/staging/serial/silabs,si4455.txt |   39 +
 drivers/staging/Kconfig                       |    2 +
 drivers/staging/Makefile                      |    1 +
 drivers/staging/si4455/Kconfig                |    8 +
 drivers/staging/si4455/Makefile               |    2 +
 drivers/staging/si4455/TODO                   |    3 +
 drivers/staging/si4455/si4455.c               | 1465 +++++++++++++++++
 drivers/staging/si4455/si4455_api.h           |   56 +
 8 files changed, 1576 insertions(+)
 create mode 100644
Documentation/devicetree/bindings/staging/serial/silabs,si4455.txt
 create mode 100644 drivers/staging/si4455/Kconfig
 create mode 100644 drivers/staging/si4455/Makefile
 create mode 100644 drivers/staging/si4455/TODO
 create mode 100644 drivers/staging/si4455/si4455.c
 create mode 100644 drivers/staging/si4455/si4455_api.h

diff --git
a/Documentation/devicetree/bindings/staging/serial/silabs,si4455.txt
b/Documentation/devicetree/bindings/staging/serial/silabs,si4455.txt
new file mode 100644
index 000000000000..abd659b7b952
--- /dev/null
+++ b/Documentation/devicetree/bindings/staging/serial/silabs,si4455.txt
@@ -0,0 +1,39 @@
+* Silicon Labs Si4455 EASY-TO-USE, LOW-CURRENT OOK/(G)FSK SUB-GHZ
TRANSCEIVER
+
+Required properties:
+- compatible: Should be one of the following:
+  - "silabs,si4455" for Silicon Labs Si4455-B1A or Si4455-C2A (driver
automatically detects the part info),
+  - "silabs,si4455b1a" for Silicon Labs Si4455-B1A,
+  - "silabs,si4455c2a" for Silicon Labs Si4455-C2A,
+- reg: SPI chip select number.
+- interrupts: Specifies the interrupt source of the parent interrupt
+  controller. The format of the interrupt specifier depends on the
+  parent interrupt controller.
+- clocks: phandle to the IC source clock (only external clock source
supported).
+- spi-max-frequency: maximum clock frequency on SPI port
+- shdn-gpios: gpio pin for SDN
+
+Example:
+
+/ {
+	clocks {
+                si4455_1_2_osc: si4455_1_2_osc {
+                        compatible = "fixed-clock";
+                        #clock-cells = <0>;
+                        clock-frequency  = <30000000>;
+                };
+	};
+};
+
+&spi0 {
+	si4455: si4455 at 0 {
+		compatible = "silabs,si4455";
+		reg = <0>;
+		clocks = <&si4455_1_2_osc>;
+		interrupt-parent = <&gpio>;
+		interrupts = <7 IRQ_TYPE_LEVEL_LOW>;
+                shdn-gpios = <&gpio 26 1>;
+                status = "okay";
+                spi-max-frequency = <3000000>;
+	};
+};
diff --git a/drivers/staging/Kconfig b/drivers/staging/Kconfig
index 9b7cb7c5766a..2cf0c9bfe878 100644
--- a/drivers/staging/Kconfig
+++ b/drivers/staging/Kconfig
@@ -118,4 +118,6 @@ source "drivers/staging/wfx/Kconfig"
 
 source "drivers/staging/hikey9xx/Kconfig"
 
+source "drivers/staging/si4455/Kconfig"
+
 endif # STAGING
diff --git a/drivers/staging/Makefile b/drivers/staging/Makefile
index 38226737c9f3..043c63287bc6 100644
--- a/drivers/staging/Makefile
+++ b/drivers/staging/Makefile
@@ -49,3 +49,4 @@ obj-$(CONFIG_QLGE)		+= qlge/
 obj-$(CONFIG_WIMAX)		+= wimax/
 obj-$(CONFIG_WFX)		+= wfx/
 obj-y				+= hikey9xx/
+obj-$(CONFIG_SERIAL_SI4455)	+= si4455/
diff --git a/drivers/staging/si4455/Kconfig b/drivers/staging/si4455/Kconfig
new file mode 100644
index 000000000000..666f726f2583
--- /dev/null
+++ b/drivers/staging/si4455/Kconfig
@@ -0,0 +1,8 @@
+# SPDX-License-Identifier: GPL-2.0
+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.
diff --git a/drivers/staging/si4455/Makefile
b/drivers/staging/si4455/Makefile
new file mode 100644
index 000000000000..1a6474673509
--- /dev/null
+++ b/drivers/staging/si4455/Makefile
@@ -0,0 +1,2 @@
+# SPDX-License-Identifier: GPL-2.0
+obj-$(CONFIG_SERIAL_SI4455) := si4455.o
diff --git a/drivers/staging/si4455/TODO b/drivers/staging/si4455/TODO
new file mode 100644
index 000000000000..aee5c7613b31
--- /dev/null
+++ b/drivers/staging/si4455/TODO
@@ -0,0 +1,3 @@
+TODO:
+        - add variable packet length support
+        - add firmware patching support in case of Si4455-C2A
diff --git a/drivers/staging/si4455/si4455.c
b/drivers/staging/si4455/si4455.c
new file mode 100644
index 000000000000..15f45f19ffdb
--- /dev/null
+++ b/drivers/staging/si4455/si4455.c
@@ -0,0 +1,1465 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2020 József Horváth <info at ministro.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 "si4455_api.h"
+
+#define PORT_SI4455						1096
+#define SI4455_NAME						"si4455"
+#define SI4455_MAJOR						432
+#define SI4455_MINOR						567
+#define SI4455_UART_NRMAX					1
+#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_ARG_RXTIMEOUT_STATE_ENUM_RX		8
+#define SI4455_CMD_START_RX_ARG_RXVALID_STATE_ENUM_RX		8
+#define SI4455_CMD_START_RX_ARG_RXINVALID_STATE_ENUM_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_ARG_NEW_STATE_ENUM_READY	3
+#define SI4455_CMD_GET_CHIP_STATUS_REP_CMD_ERROR_PEND_MASK	0x08
+#define SI4455_CMD_GET_CHIP_STATUS_REP_CMD_ERROR_PEND_BIT	0x08
+#define SI4455_CMD_GET_INT_STATUS_REP_PACKET_SENT_PEND_BIT	0x20
+#define SI4455_CMD_GET_INT_STATUS_REP_PACKET_RX_PEND_BIT	0x10
+#define SI4455_CMD_GET_INT_STATUS_REP_CRC_ERROR_BIT		0x08
+#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				CHIPREV;
+	u16				PART;
+	u8				PBUILD;
+	u16				ID;
+	u8				CUSTOMER;
+	u8				ROMID;
+	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_one {
+	struct uart_port		port;
+	struct work_struct		tx_work;
+};
+
+struct si4455_port {
+	struct mutex			mutex;
+	int				power_count;
+	struct gpio_desc		*shdn_gpio;
+	struct si4455_part_info		part_info;
+	struct si4455_modem_status	modem_status;
+	struct si4455_iocbuff		configuration;
+	struct si4455_iocbuff		patch;
+	u32				tx_channel;
+	u32				rx_channel;
+	u32				package_size;
+	bool				configured;
+	bool				tx_pending;
+	bool				rx_pending;
+	u32				current_rssi;
+	struct si4455_one		one;
+};
+
+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 int si4455_get_response(struct uart_port *port,
+				int length,
+				u8 *data);
+static int si4455_send_command(struct uart_port *port,
+				int length,
+				u8 *data);
+static int si4455_send_command_get_response(struct uart_port *port,
+						int outLength,
+						u8 *outData,
+						int inLength,
+						u8 *inData);
+static int si4455_read_data(struct uart_port *port,
+				u8 command,
+				int pollCts,
+				int length,
+				u8 *data);
+static int si4455_write_data(struct uart_port *port,
+				u8 command,
+				int pollCts,
+				int length,
+				u8 *data);
+static int si4455_poll_cts(struct uart_port *port);
+static void si4455_set_power(struct si4455_port *priv,
+				int on);
+static int si4455_get_part_info(struct uart_port *port,
+				struct si4455_part_info *result);
+
+static int si4455_get_response(struct uart_port *port,
+				int length,
+				u8 *data)
+{
+	int ret = -EIO;
+	u8 dataOut[] = { SI4455_CMD_ID_READ_CMD_BUFF };
+	u8 *dataIn = devm_kzalloc(port->dev, 1 + length, GFP_KERNEL);
+	struct spi_transfer xfer[] = {
+		{
+			.tx_buf = dataOut,
+			.len = sizeof(dataOut),
+		}, {
+			.rx_buf = dataIn,
+			.len = 1 + length,
+		}
+	};
+	int errCnt = 10000;
+
+	while (errCnt > 0) {
+		dataOut[0] = SI4455_CMD_ID_READ_CMD_BUFF;
+		ret = spi_sync_transfer(to_spi_device(port->dev),
+					xfer,
+					ARRAY_SIZE(xfer));
+		if (ret == 0) {
+			if (dataIn[0] == 0xFF) {
+				if ((length > 0) && (data != NULL)) {
+					memcpy(data, &dataIn[1], length);
+				} else {
+					if (length > 0)
+						ret = -EINVAL;
+				}
+				break;
+			}
+			usleep_range(100, 200);
+		} else {
+			break;
+		}
+		errCnt--;
+	}
+	if (errCnt == 0) {
+		dev_err(port->dev, "si4455_poll_cts:errCnt==%i", errCnt);
+		ret = -EIO;
+	}
+	if (dataIn != NULL)
+		devm_kfree(port->dev, dataIn);
+	return ret;
+}
+
+static int si4455_send_command(struct uart_port *port,
+				int length,
+				u8 *data)
+{
+	int ret;
+
+	ret = si4455_poll_cts(port);
+	if (ret == 0) {
+		ret = spi_write(to_spi_device(port->dev), data, length);
+		if (ret) {
+			dev_err(port->dev,
+				"%s: spi_write error(%i)",
+				__func__,
+				ret);
+		}
+	} else {
+		dev_err(port->dev,
+			"%s: si4455_poll_cts error(%i)",
+			__func__,
+			ret);
+	}
+	return ret;
+}
+
+static int si4455_send_command_get_response(struct uart_port *port,
+						int outLength,
+						u8 *outData,
+						int inLength,
+						u8 *inData)
+{
+	int ret;
+
+	ret = si4455_send_command(port, outLength, outData);
+	if (!ret) {
+		ret = si4455_get_response(port, inLength, inData);
+	} else {
+		dev_err(port->dev,
+			"%s: si4455_send_command error(%i)",
+			__func__,
+			ret);
+	}
+	return ret;
+}
+
+static int si4455_read_data(struct uart_port *port,
+				u8 command,
+				int pollCts,
+				int length,
+				u8 *data)
+{
+	int ret = 0;
+	u8 dataOut[] = { command };
+	struct spi_transfer xfer[] = {
+		{
+			.tx_buf = dataOut,
+			.len = sizeof(dataOut),
+		}, {
+			.rx_buf = data,
+			.len = length,
+		}
+	};
+
+	if (pollCts)
+		ret = si4455_poll_cts(port);
+
+	if (ret == 0) {
+		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)",
+				__func__,
+				ret);
+		}
+	}
+	return ret;
+}
+
+static int si4455_write_data(struct uart_port *port,
+				u8 command,
+				int pollCts,
+				int length,
+				u8 *data)
+{
+	int ret = 0;
+	u8 *dataOut = NULL;
+
+	if (pollCts)
+		ret = si4455_poll_cts(port);
+
+	if (ret == 0) {
+		dataOut = devm_kzalloc(port->dev, 1 + length, GFP_KERNEL);
+		if (dataOut != NULL) {
+			dataOut[0] = command;
+			memcpy(&dataOut[1], data, length);
+			ret = spi_write(to_spi_device(port->dev),
+					dataOut,
+					1 + length);
+			if (ret) {
+				dev_err(port->dev,
+					"%s: spi_write error(%i)",
+					__func__,
+					ret);
+			}
+		} else {
+			dev_err(port->dev,
+				"%s: devm_kzalloc error",
+				__func__);
+			ret = -ENOMEM;
+		}
+	}
+	if (dataOut != NULL)
+		devm_kfree(port->dev, dataOut);
+
+	return ret;
+}
+
+static int si4455_poll_cts(struct uart_port *port)
+{
+	return si4455_get_response(port, 0, NULL);
+}
+
+static void si4455_set_power(struct si4455_port *priv,
+				int on)
+{
+	if (priv->shdn_gpio) {
+		if (on) {
+			gpiod_direction_output(priv->shdn_gpio, 0);
+			usleep_range(4000, 5000);
+			gpiod_set_value(priv->shdn_gpio, 1);
+			usleep_range(4000, 5000);
+		} else {
+			gpiod_direction_output(priv->shdn_gpio, 0);
+		}
+	}
+}
+
+static int si4455_s_power(struct device *dev,
+				int 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 dataOut[] = { SI4455_CMD_ID_PART_INFO };
+	u8 dataIn[SI4455_CMD_REPLY_COUNT_PART_INFO];
+
+	ret = si4455_send_command_get_response(port,
+						sizeof(dataOut),
+						dataOut,
+						sizeof(dataIn),
+						dataIn);
+	if (ret == 0) {
+		result->CHIPREV = dataIn[0];
+		memcpy(&result->PART, &dataIn[1], sizeof(result->PART));
+		result->PBUILD = dataIn[3];
+		memcpy(&result->ID, &dataIn[4], sizeof(result->ID));
+		result->CUSTOMER = dataIn[6];
+		result->ROMID = dataIn[7];
+		result->BOND = dataIn[8];
+	} else {
+		dev_err(port->dev,
+			"%s: si4455_send_command_get_response error(%i)",
+			__func__,
+			ret);
+	}
+	return ret;
+}
+
+static int si4455_get_int_status(struct uart_port *port,
+					u8 phClear,
+					u8 modemClear,
+					u8 chipClear,
+					struct si4455_int_status *result)
+{
+	int ret;
+	u8 dataOut[] = {
+		SI4455_CMD_ID_GET_INT_STATUS,
+		phClear,
+		modemClear,
+		chipClear
+	};
+	u8 dataIn[SI4455_CMD_REPLY_COUNT_GET_INT_STATUS];
+
+	ret = si4455_send_command_get_response(port,
+						sizeof(dataOut),
+						dataOut,
+						sizeof(dataIn),
+						dataIn);
+	if (ret == 0) {
+		result->INT_PEND       = dataIn[0];
+		result->INT_STATUS     = dataIn[1];
+		result->PH_PEND        = dataIn[2];
+		result->PH_STATUS      = dataIn[3];
+		result->MODEM_PEND     = dataIn[4];
+		result->MODEM_STATUS   = dataIn[5];
+		result->CHIP_PEND      = dataIn[6];
+		result->CHIP_STATUS    = dataIn[7];
+	} else {
+		dev_err(port->dev,
+			"%s: si4455_send_command_get_response error(%i)",
+			__func__,
+			ret);
+	}
+	return ret;
+}
+
+static int si4455_get_modem_status(struct uart_port *port,
+					u8 modemClear,
+					struct si4455_modem_status *result)
+{
+	int ret;
+	u8 dataOut[] = {
+		SI4455_CMD_ID_GET_MODEM_STATUS,
+		modemClear,
+	};
+	u8 dataIn[SI4455_CMD_REPLY_COUNT_GET_MODEM_STATUS];
+
+	ret = si4455_send_command_get_response(port,
+						sizeof(dataOut),
+						dataOut,
+						sizeof(dataIn),
+						dataIn);
+	if (ret == 0) {
+		result->MODEM_PEND      = dataIn[0];
+		result->MODEM_STATUS    = dataIn[1];
+		result->CURR_RSSI       = dataIn[2];
+		result->LATCH_RSSI      = dataIn[3];
+		result->ANT1_RSSI       = dataIn[4];
+		result->ANT2_RSSI       = dataIn[5];
+		memcpy(&result->AFC_FREQ_OFFSET,
+			&dataIn[6],
+			sizeof(result->AFC_FREQ_OFFSET));
+	} else {
+		dev_err(port->dev,
+			"%s: si4455_send_command_get_response error(%i)",
+			__func__,
+			ret);
+	}
+	return ret;
+}
+
+static int si4455_fifo_info(struct uart_port *port,
+				u8 fifo,
+				struct si4455_fifo_info *result)
+{
+	int ret = 0;
+	u8 dataOut[SI4455_CMD_ARG_COUNT_FIFO_INFO] = {
+		SI4455_CMD_ID_FIFO_INFO, fifo
+	};
+	u8 dataIn[SI4455_CMD_REPLY_COUNT_FIFO_INFO] = { 0 };
+
+	ret = si4455_send_command_get_response(port,
+						sizeof(dataOut),
+						dataOut,
+						sizeof(dataIn),
+						dataIn);
+	if (ret == 0) {
+		result->RX_FIFO_COUNT  = dataIn[0];
+		result->TX_FIFO_SPACE  = dataIn[1];
+	} else {
+		dev_err(port->dev,
+			"%s: si4455_send_command_get_response error(%i)",
+			__func__,
+			ret);
+	}
+	return ret;
+}
+
+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,
+				0,
+				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,
+					0,
+					length,
+					data);
+}
+
+static int si4455_rx(struct uart_port *port,
+			u32 channel,
+			u8 condition,
+			u16 length,
+			u8 nextState1,
+			u8 nextState2,
+			u8 nextState3)
+{
+	u8 dataOut[SI4455_CMD_ARG_COUNT_START_RX];
+
+	dataOut[0] = SI4455_CMD_ID_START_RX;
+	dataOut[1] = channel;
+	dataOut[2] = condition;
+	dataOut[3] = (u8)(length >> 8);
+	dataOut[4] = (u8)(length);
+	dataOut[5] = nextState1;
+	dataOut[6] = nextState2;
+	dataOut[7] = nextState3;
+
+	return si4455_send_command(port,
+					SI4455_CMD_ARG_COUNT_START_RX,
+					dataOut);
+}
+
+static int si4455_tx(struct uart_port *port,
+			u8 channel,
+			u8 condition,
+			u16 length)
+{
+	u8 dataOut[/*6*/ SI4455_CMD_ARG_COUNT_START_TX];
+
+	dataOut[0] = SI4455_CMD_ID_START_TX;
+	dataOut[1] = channel;
+	dataOut[2] = condition;
+	dataOut[3] = (u8)(length >> 8);
+	dataOut[4] = (u8)(length);
+	/*TODO: radioCmd[5] = 0x44; in case of rev c2a*/
+
+	return si4455_send_command(port,
+					/*6*/ SI4455_CMD_ARG_COUNT_START_TX,
+					dataOut);
+}
+
+static int si4455_change_state(struct uart_port *port,
+				u8 nextState1)
+{
+	u8 dataOut[SI4455_CMD_ARG_COUNT_CHANGE_STATE];
+
+	dataOut[0] = SI4455_CMD_ID_CHANGE_STATE;
+	dataOut[1] = (u8)nextState1;
+
+	return si4455_send_command(port,
+					SI4455_CMD_ARG_COUNT_CHANGE_STATE,
+					dataOut);
+}
+
+static int si4455_begin_tx(struct uart_port *port,
+				u32 channel,
+				int length,
+				u8 *data)
+{
+	int ret = 0;
+	struct si4455_int_status intStatus = { 0 };
+	struct si4455_fifo_info fifoInfo = { 0 };
+
+	dev_dbg(port->dev, "%s(%u, %u)", __func__, channel, length);
+	if ((length > SI4455_FIFO_SIZE) || (length < 0))
+		ret = -EINVAL;
+
+	if (ret == 0) {
+		ret = si4455_change_state(port,
+			SI4455_CMD_CHANGE_STATE_ARG_NEW_STATE_ENUM_READY);
+		if (ret) {
+			dev_err(port->dev,
+				"%s: si4455_change_state error(%i)",
+				__func__,
+				ret);
+			goto end;
+		}
+		ret = si4455_get_int_status(port, 0, 0, 0, &intStatus);
+		if (ret) {
+			dev_err(port->dev,
+				"%s: si4455_get_int_status error(%i)",
+				__func__,
+				ret);
+			goto end;
+		}
+		ret = si4455_fifo_info(port,
+					SI4455_CMD_FIFO_INFO_ARG_TX_BIT,
+					&fifoInfo);
+		if (ret) {
+			dev_err(port->dev,
+				"%s: si4455_fifo_info error(%i)",
+				__func__,
+				ret);
+			goto end;
+		}
+		ret = si4455_write_tx_fifo(port, (u16)length, data);
+		if (ret) {
+			dev_err(port->dev,
+				"%s: si4455_write_tx_fifo error(%i)",
+				__func__,
+				ret);
+			goto end;
+		}
+		ret = si4455_tx(port,
+				(u8)channel,
+				0x30,
+				(u16)length);
+		if (ret) {
+			dev_err(port->dev,
+				"%s: si4455_tx error(%i)",
+				__func__,
+				ret);
+			goto end;
+		}
+	}
+end:
+	return ret;
+}
+
+static int si4455_end_tx(struct uart_port *port)
+{
+	int ret = 0;
+	struct si4455_int_status intStatus = { 0 };
+
+	ret = si4455_change_state(port,
+			SI4455_CMD_CHANGE_STATE_ARG_NEW_STATE_ENUM_READY);
+	if (ret) {
+		dev_err(port->dev,
+			"%s: si4455_change_state error(%i)",
+			__func__,
+			ret);
+		goto end;
+	}
+	ret = si4455_get_int_status(port, 0, 0, 0, &intStatus);
+	if (ret) {
+		dev_err(port->dev,
+			"%s: si4455_get_int_status error(%i)",
+			__func__,
+			ret);
+		goto end;
+	}
+end:
+	return ret;
+}
+
+static int si4455_begin_rx(struct uart_port *port,
+				u32 channel,
+				u32 length)
+{
+	int ret = 0;
+	struct si4455_int_status intStatus = { 0 };
+	struct si4455_fifo_info fifoInfo = { 0 };
+
+	dev_dbg(port->dev, "%s(%u, %u)", __func__, channel, length);
+	ret = si4455_get_int_status(port, 0, 0, 0, &intStatus);
+	if (ret) {
+		dev_err(port->dev,
+			"%s: si4455_get_int_status error(%i)",
+			__func__,
+			ret);
+		goto end;
+	}
+	ret = si4455_fifo_info(port,
+				SI4455_CMD_FIFO_INFO_ARG_RX_BIT,
+				&fifoInfo);
+	if (ret) {
+		dev_err(port->dev,
+			"%s: si4455_fifo_info error(%i)",
+			__func__,
+			ret);
+		goto end;
+	}
+	ret = si4455_rx(port,
+			channel,
+			0x00,
+			length,
+			SI4455_CMD_START_RX_ARG_RXTIMEOUT_STATE_ENUM_RX,
+			SI4455_CMD_START_RX_ARG_RXVALID_STATE_ENUM_RX,
+			SI4455_CMD_START_RX_ARG_RXINVALID_STATE_ENUM_RX);
+	if (ret) {
+		dev_err(port->dev,
+			"%s: si4455_rx error(%i)",
+			__func__,
+			ret);
+		goto end;
+	}
+end:
+	return ret;
+}
+
+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,
+				u8 *configurationData)
+{
+	int ret = 0;
+	u8 col;
+	u8 response;
+	u8 numOfBytes;
+	struct si4455_int_status intStatus = { 0 };
+	u8 radioCmd[16u];
+
+	/* While cycle as far as the pointer points to a command */
+	while (*configurationData != 0x00) {
+		/* Commands structure in the array:
+		 * --------------------------------
+		 * LEN | <LEN length of data>
+		 */
+		numOfBytes = *configurationData++;
+		dev_dbg(port->dev,
+			"%s: numOfBytes(%u)",
+			__func__,
+			numOfBytes);
+		if (numOfBytes > 16u) {
+			/* Initial configuration of Si4x55 */
+			if (SI4455_CMD_ID_WRITE_TX_FIFO
+				 == *configurationData) {
+				if (numOfBytes > 128u) {
+					/* Number of command bytes exceeds
+					 * maximal allowable length
+					 */
+					dev_err(port->dev,
+						"%s: command length
error(%i)",
+						__func__,
+						numOfBytes);
+					ret = -EINVAL;
+					break;
+				}
+
+				/* Load array to the device */
+				configurationData++;
+				ret = si4455_write_data(port,
+						SI4455_CMD_ID_WRITE_TX_FIFO,
+						1,
+						numOfBytes - 1,
+						configurationData);
+				if (ret) {
+					dev_err(port->dev,
+						"%s: si4455_write_data
error(%i)",
+						__func__,
+						ret);
+					break;
+				}
+
+				/* Point to the next command */
+				configurationData += numOfBytes - 1;
+
+				/* Continue command interpreter */
+				continue;
+			} else {
+				/* Number of command bytes exceeds
+				 * maximal allowable length
+				 */
+				ret = -EINVAL;
+				break;
+			}
+		}
+
+		for (col = 0u; col < numOfBytes; col++) {
+			radioCmd[col] = *configurationData;
+			configurationData++;
+		}
+
+		dev_dbg(port->dev,
+			"%s: radioCmd[0](%u)",
+			__func__,
+			radioCmd[0]);
+		ret = si4455_send_command_get_response(port,
+							numOfBytes,
+							radioCmd,
+							1,
+							&response);
+		if (ret) {
+			dev_err(port->dev,
+				"%s: si4455_send_command_get_response
error(%i)",
+				__func__,
+				ret);
+			break;
+		}
+
+		/* Check response byte of EZCONFIG_CHECK command */
+		if (radioCmd[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)",
+					__func__,
+					radioCmd[0]);
+				break;
+			}
+		}
+
+		/* Get and clear all interrupts.  An error has occurred...
*/
+		si4455_get_int_status(port, 0, 0, 0, &intStatus);
+		if (intStatus.CHIP_PEND
+			&
SI4455_CMD_GET_CHIP_STATUS_REP_CMD_ERROR_PEND_MASK) {
+			ret = -EIO;
+			dev_err(port->dev,
+				"%s: chip error(%i)",
+				__func__,
+				intStatus.CHIP_PEND);
+			break;
+		}
+	}
+
+	return ret;
+}
+
+static int si4455_re_configure(struct uart_port *port)
+{
+	int ret = 0;
+	struct si4455_port *s = dev_get_drvdata(port->dev);
+
+	mutex_lock(&s->mutex);
+	s->configured = 0;
+	if (s->power_count > 0)
+		si4455_s_power(port->dev, 0);
+
+	si4455_s_power(port->dev, 1);
+	if (s->configuration.length > 0) {
+		ret = si4455_configure(port, s->configuration.data);
+		if (ret == 0)
+			s->configured = 1;
+
+	}
+	mutex_unlock(&s->mutex);
+	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;
+	unsigned int tx_pending = 0;
+	unsigned int tx_to_end = 0;
+	u8 *data = NULL;
+
+	mutex_lock(&s->mutex);
+	if (s->configured && (s->power_count > 0)) {
+		if (!(uart_circ_empty(xmit)
+			|| uart_tx_stopped(port)
+			|| s->tx_pending)) {
+			tx_pending = uart_circ_chars_pending(xmit);
+			if (s->package_size > 0) {
+				if (tx_pending >= s->package_size) {
+					tx_pending = s->package_size;
+					data = devm_kzalloc(port->dev,
+						s->package_size,
+						GFP_KERNEL);
+					tx_to_end =
CIRC_CNT_TO_END(xmit->head,
+								xmit->tail,
+
UART_XMIT_SIZE);
+					if (tx_to_end < tx_pending) {
+						memcpy(data,
+							xmit->buf +
xmit->tail,
+							tx_to_end);
+						memcpy(data,
+							xmit->buf,
+							tx_pending -
tx_to_end);
+					} else {
+						memcpy(data,
+							xmit->buf +
xmit->tail,
+							tx_pending);
+					}
+					if (si4455_begin_tx(port,
+							s->tx_channel,
+							tx_pending,
+							data) == 0) {
+						s->tx_pending = true;
+					}
+					devm_kfree(port->dev, data);
+				}
+			} else {
+				//TODO: variable packet length
+			}
+		}
+		if (!s->tx_pending) {
+			if (s->package_size > 0) {
+				ret = si4455_begin_rx(port,
+							s->rx_channel,
+							s->package_size);
+			} else {
+				//TODO: variable packet length
+			}
+		}
+	}
+	mutex_unlock(&s->mutex);
+	return ret;
+}
+
+static void si4455_handle_rx_pend(struct si4455_port *s)
+{
+	struct uart_port *port = &s->one.port;
+	u8 *data = NULL;
+	int sret = 0;
+	int i = 0;
+
+	if (s->package_size > 0) {
+		data = devm_kzalloc(port->dev,
+					s->package_size,
+					GFP_KERNEL);
+		sret = si4455_end_rx(port,
+				s->package_size,
+				data);
+		if (sret == 0) {
+			for (i = 0; i < s->package_size; i++) {
+				uart_insert_char(port,
+					0,
+					0,
+					data[i],
+					TTY_NORMAL);
+				port->icount.rx++;
+			}
+			tty_flip_buffer_push(&port->state->port);
+		} else {
+			dev_err(port->dev,
+				"%s: si4455_end_rx error(%i)",
+				__func__,
+				sret);
+		}
+		devm_kfree(port->dev, data);
+	} else {
+		//TODO: variable packet length
+	}
+}
+
+static void si4455_handle_tx_pend(struct si4455_port *s)
+{
+	struct uart_port *port = &s->one.port;
+	struct circ_buf *xmit = &port->state->xmit;
+
+	if (s->tx_pending) {
+		if (s->package_size) {
+			port->icount.tx += s->package_size;
+			xmit->tail = (xmit->tail + s->package_size)
+					& (UART_XMIT_SIZE - 1);
+		} else {
+			//TODO: variable packet length
+		}
+		si4455_end_tx(port);
+		s->tx_pending = 0;
+	}
+}
+
+static irqreturn_t si4455_port_irq(struct si4455_port *s)
+{
+	struct uart_port *port = &s->one.port;
+	irqreturn_t ret = IRQ_NONE;
+	struct si4455_int_status intStatus = { 0 };
+	struct si4455_fifo_info fifoInfo = { 0 };
+
+	mutex_lock(&s->mutex);
+	if (s->configured && (s->power_count > 0)) {
+		if (!si4455_get_int_status(port, 0, 0, 0, &intStatus)) {
+			si4455_get_modem_status(port, 0, &s->modem_status);
+			if (intStatus.CHIP_PEND
+			& SI4455_CMD_GET_CHIP_STATUS_REP_CMD_ERROR_PEND_BIT)
{
+				dev_err(port->dev,
+					"%s: CHIP_STATUS:CMD_ERROR_PEND",
+					__func__);
+			} else if (intStatus.PH_PEND
+			&
SI4455_CMD_GET_INT_STATUS_REP_PACKET_SENT_PEND_BIT) {
+				dev_dbg(port->dev,
+					"%s: PH_STATUS:PACKET_SENT_PEND",
+					__func__);
+				si4455_handle_tx_pend(s);
+			} else if (intStatus.PH_PEND
+			& SI4455_CMD_GET_INT_STATUS_REP_PACKET_RX_PEND_BIT)
{
+				dev_dbg(port->dev,
+					"%s: PH_STATUS:PACKET_RX_PEND",
+					__func__);
+				s->current_rssi = s->modem_status.CURR_RSSI;
+				si4455_fifo_info(port, 0, &fifoInfo);
+				si4455_handle_rx_pend(s);
+			} else if (intStatus.PH_PEND
+			& SI4455_CMD_GET_INT_STATUS_REP_CRC_ERROR_BIT) {
+				dev_dbg(port->dev,
+					"%s: PH_STATUS:CRC_ERROR_PEND",
+					__func__);
+			}
+			ret = IRQ_HANDLED;
+		}
+	} else {
+		ret = IRQ_HANDLED;
+	}
+	mutex_unlock(&s->mutex);
+	si4455_do_work(port);
+	return ret;
+}
+
+static irqreturn_t si4455_ist(int irq,
+				void *dev_id)
+{
+	struct si4455_port *s = (struct si4455_port *)dev_id;
+	bool handled = false;
+
+	if (si4455_port_irq(s) == IRQ_HANDLED)
+		handled = true;
+
+	return IRQ_RETVAL(handled);
+}
+
+static void si4455_tx_proc(struct work_struct *ws)
+{
+	struct si4455_one *one = container_of(ws,
+					struct si4455_one,
+					tx_work);
+
+	si4455_do_work(&one->port);
+}
+
+static unsigned int si4455_tx_empty(struct uart_port *port)
+{
+	return TIOCSER_TEMT;
+}
+
+static unsigned int si4455_get_mctrl(struct uart_port *port)
+{
+	dev_dbg(port->dev, "%s", __func__);
+	return TIOCM_DSR | TIOCM_CAR;
+}
+
+static void si4455_set_mctrl(struct uart_port *port,
+				unsigned int mctrl)
+{
+	dev_dbg(port->dev, "%s", __func__);
+}
+
+static void si4455_break_ctl(struct uart_port *port,
+				int break_state)
+{
+	dev_dbg(port->dev, "%s", __func__);
+}
+
+static void si4455_set_termios(struct uart_port *port,
+				struct ktermios *termios,
+				struct ktermios *old)
+{
+	dev_dbg(port->dev, "%s", __func__);
+}
+
+static int si4455_rs485_config(struct uart_port *port,
+				struct serial_rs485 *rs485)
+{
+	dev_dbg(port->dev, "%s", __func__);
+
+	return 0;
+}
+
+static int si4455_startup(struct uart_port *port)
+{
+	dev_dbg(port->dev, "%s", __func__);
+	si4455_s_power(port->dev, 1);
+	return 0;
+}
+
+static void si4455_shutdown(struct uart_port *port)
+{
+	dev_dbg(port->dev, "%s", __func__);
+	si4455_s_power(port->dev, 0);
+}
+
+static const char *si4455_type(struct uart_port *port)
+{
+	struct si4455_port *s = dev_get_drvdata(port->dev);
+
+	if (port->type == PORT_SI4455) {
+		if (s->part_info.ROMID == 3)
+			return "SI4455-B1A";
+		else if (s->part_info.ROMID == 6)
+			return "SI4455-C2A";
+
+	}
+	return NULL;
+}
+
+static int si4455_request_port(struct uart_port *port)
+{
+	/* Do nothing */
+	dev_dbg(port->dev, "%s", __func__);
+	return 0;
+}
+
+static void si4455_config_port(struct uart_port *port,
+				int flags)
+{
+	dev_dbg(port->dev, "%s", __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_one *one = container_of(port,
+					struct si4455_one,
+					port);
+
+	dev_dbg(port->dev, "%s", __func__);
+
+	if (!work_pending(&one->tx_work))
+		schedule_work(&one->tx_work);
+
+}
+
+static int si4455_ioctl(struct uart_port *port,
+			unsigned int cmd,
+			unsigned long arg)
+{
+	struct si4455_port *s = dev_get_drvdata(port->dev);
+	int ret = 0;
+
+	dev_dbg(port->dev, "%s(%u)", __func__, cmd);
+	switch (cmd) {
+	case SI4455_IOC_SEZC:
+	memcpy(&s->configuration, (void *)arg, sizeof(s->configuration));
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_SEZC, length(%i)",
+		__func__,
+		cmd,
+		s->configuration.length);
+	ret = si4455_re_configure(port);
+	break;
+	case SI4455_IOC_CEZC:
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_CEZC",
+		__func__,
+		cmd);
+	memset(&s->configuration, 0x00, sizeof(s->configuration));
+	ret = si4455_re_configure(port);
+	break;
+	case SI4455_IOC_SEZP:
+	memcpy(&s->patch, (void *)arg, sizeof(s->patch));
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_SEZP, length(%i)",
+		__func__,
+		cmd,
+		s->configuration.length);
+	break;
+	case SI4455_IOC_CEZP:
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_CEZP",
+		__func__,
+		cmd);
+	memset(&s->patch, 0x00, sizeof(s->patch));
+	break;
+	case SI4455_IOC_STXC:
+	s->tx_channel = *((u32 *)arg);
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_STXC, tx_channel(%i)",
+		__func__,
+		cmd,
+		s->tx_channel);
+	break;
+	case SI4455_IOC_GTXC:
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_GTXC",
+		__func__,
+		cmd);
+	*((u32 *)arg) = s->tx_channel;
+	break;
+	case SI4455_IOC_SRXC:
+	s->rx_channel = *((u32 *)arg);
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_SRXC, rx_channel(%i)",
+		__func__,
+		cmd,
+		s->rx_channel);
+	break;
+	case SI4455_IOC_GRXC:
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_GRXC",
+		__func__,
+		cmd);
+	*((u32 *)arg) = s->rx_channel;
+	break;
+	case SI4455_IOC_SSIZ:
+	s->package_size = *((u32 *)arg);
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_SSIZ, package_size(%i)",
+		__func__,
+		cmd,
+		s->package_size);
+	break;
+	case SI4455_IOC_GSIZ:
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_GSIZ",
+		__func__,
+		cmd);
+	*((u32 *)arg) = s->package_size;
+	break;
+	case SI4455_IOC_GRSSI:
+	dev_dbg(port->dev,
+		"%s(%u): SI4455_IOC_GRSSI",
+		__func__,
+		cmd);
+	*((u32 *)arg) = s->current_rssi;
+	break;
+	default:
+		ret = -ENOIOCTLCMD;
+	break;
+	}
+
+	if (ret == 0)
+		si4455_do_work(port);
+
+	return ret;
+}
+
+
+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,
+	.get_mctrl		= si4455_get_mctrl,
+	.stop_tx		= si4455_null_void,
+	.start_tx		= si4455_start_tx,
+	.stop_rx		= si4455_null_void,
+	.break_ctl		= si4455_break_ctl,
+	.startup		= si4455_startup,
+	.shutdown		= si4455_shutdown,
+	.set_termios		= si4455_set_termios,
+	.type			= si4455_type,
+	.request_port		= si4455_request_port,
+	.release_port		= si4455_null_void,
+	.config_port		= si4455_config_port,
+	.verify_port		= si4455_verify_port,
+	.ioctl			= si4455_ioctl,
+};
+
+static int __maybe_unused si4455_suspend(struct device *dev)
+{
+	struct si4455_port *s = dev_get_drvdata(dev);
+
+	uart_suspend_port(&si4455_uart, &s->one.port);
+	return 0;
+}
+
+static int __maybe_unused si4455_resume(struct device *dev)
+{
+	struct si4455_port *s = dev_get_drvdata(dev);
+
+	uart_resume_port(&si4455_uart, &s->one.port);
+
+	return 0;
+}
+
+static SIMPLE_DEV_PM_OPS(si4455_pm_ops, si4455_suspend, si4455_resume);
+
+static int si4455_probe(struct device *dev,
+			int irq)
+{
+	int ret;
+	struct si4455_port *s;
+
+	/* Alloc port structure */
+	dev_dbg(dev, "%s\n", __func__);
+	s = devm_kzalloc(dev, sizeof(*s), GFP_KERNEL);
+	if (!s) {
+		dev_err(dev, "Error allocating port structure\n");
+		return -ENOMEM;
+	}
+
+	dev_set_drvdata(dev, s);
+	mutex_init(&s->mutex);
+
+	s->shdn_gpio = devm_gpiod_get(dev, "shdn", GPIOD_OUT_HIGH);
+	if (IS_ERR(s->shdn_gpio)) {
+		dev_err(dev, "Unable to reguest shdn gpio\n");
+		ret = -EINVAL;
+		goto out_generic;
+	}
+
+	/* Initialize port data */
+	s->one.port.dev	= dev;
+	s->one.port.line = 0;
+	s->one.port.irq	= irq;
+	s->one.port.type	= PORT_SI4455;
+	s->one.port.fifosize	= SI4455_FIFO_SIZE;
+	s->one.port.flags	= UPF_FIXED_TYPE | UPF_LOW_LATENCY;
+	s->one.port.iotype	= UPIO_PORT;
+	s->one.port.iobase	= 0x00;
+	s->one.port.membase	= (void __iomem *)~0;
+	s->one.port.rs485_config = si4455_rs485_config;
+	s->one.port.ops	= &si4455_ops;
+
+	si4455_s_power(dev, 1);
+
+	//detect
+	ret = si4455_get_part_info(&s->one.port, &s->part_info);
+	dev_dbg(dev, "si4455_get_part_info()==%i", ret);
+	if (ret == 0) {
+		dev_dbg(dev, "partInfo.CHIPREV= %u", s->part_info.CHIPREV);
+		dev_dbg(dev, "partInfo.PART= %u", s->part_info.PART);
+		dev_dbg(dev, "partInfo.PBUILD= %u", s->part_info.PBUILD);
+		dev_dbg(dev, "partInfo.ID= %u", s->part_info.ID);
+		dev_dbg(dev, "partInfo.CUSTOMER= %u",
s->part_info.CUSTOMER);
+		dev_dbg(dev, "partInfo.ROMID= %u", s->part_info.ROMID);
+		dev_dbg(dev, "partInfo.BOND= %u", s->part_info.BOND);
+		if (s->part_info.PART != 0x5544) {
+			dev_err(dev, "PART(%u) error", s->part_info.PART);
+			ret = -ENODEV;
+		}
+	}
+	si4455_s_power(dev, 0);
+	if (ret)
+		goto out_generic;
+
+	/* Initialize queue for start TX */
+	INIT_WORK(&s->one.tx_work, si4455_tx_proc);
+
+	/* Register port */
+	ret = uart_add_one_port(&si4455_uart, &s->one.port);
+	if (ret) {
+		s->one.port.dev = NULL;
+		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);
+
+out_uart:
+	uart_remove_one_port(&si4455_uart, &s->one.port);
+out_generic:
+	mutex_destroy(&s->mutex);
+
+	return ret;
+}
+
+static int si4455_remove(struct device *dev)
+{
+	struct si4455_port *s = dev_get_drvdata(dev);
+
+	cancel_work_sync(&s->one.tx_work);
+	uart_remove_one_port(&si4455_uart, &s->one.port);
+
+	mutex_destroy(&s->mutex);
+
+	return 0;
+}
+
+static const struct of_device_id __maybe_unused si4455_dt_ids[] = {
+	{ .compatible = "silabs,si4455" },
+	{ .compatible = "silabs,si4455b1a" },
+	{ .compatible = "silabs,si4455c2a" },
+	{ }
+};
+MODULE_DEVICE_TABLE(of, si4455_dt_ids);
+
+static int si4455_spi_probe(struct spi_device *spi)
+{
+	int ret;
+
+	/* Setup SPI bus */
+	spi->bits_per_word	= 8;
+	spi->mode		    = SPI_MODE_0;
+	spi->max_speed_hz   = 100000;
+	ret = spi_setup(spi);
+	if (ret)
+		return ret;
+
+	if (spi->dev.of_node) {
+		const struct of_device_id *of_id
+			= of_match_device(si4455_dt_ids, &spi->dev);
+		if (!of_id)
+			return -ENODEV;
+
+	}
+
+	return si4455_probe(&spi->dev, spi->irq);
+}
+
+static int si4455_spi_remove(struct spi_device *spi)
+{
+	return si4455_remove(&spi->dev);
+}
+
+static const struct spi_device_id si4455_id_table[] = {
+	{ "si4455b1a" },
+	{ }
+};
+MODULE_DEVICE_TABLE(spi, si4455_id_table);
+
+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,
+	.id_table		= si4455_id_table,
+};
+
+static int __init si4455_uart_init(void)
+{
+	int ret;
+
+	ret = uart_register_driver(&si4455_uart);
+	if (ret)
+		return ret;
+	spi_register_driver(&si4455_spi_driver);
+
+	return 0;
+}
+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("József Horváth <info at ministro.hu>");
+MODULE_DESCRIPTION("SI4455 serial driver");
diff --git a/drivers/staging/si4455/si4455_api.h
b/drivers/staging/si4455/si4455_api.h
new file mode 100644
index 000000000000..9b046bd006cf
--- /dev/null
+++ b/drivers/staging/si4455/si4455_api.h
@@ -0,0 +1,56 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2020 József Horváth <info at ministro.hu>
+ *
+ */
+#ifndef SI4455_API_H_
+#define SI4455_API_H_
+
+struct si4455_iocbuff {
+	uint32_t	length;
+	uint8_t		data[4096];
+};
+
+#define BASE_TTYIOC_PRIVATE		0xA0
+/* Set EZConfig.
+ * After this ioctl call, the driver restarts the si4455,
+ * then apply the new configuration and patch.
+ */
+#define SI4455_IOC_SEZC		_IOW('T', \
+					BASE_TTYIOC_PRIVATE + 0x01, \
+					struct si4455_iocbuff)
+/* Clear driver EZConfig.
+ * After this ioctl call, the driver restarts the si4455,
+ * then apply the new configuration and patch.
+ */
+#define SI4455_IOC_CEZC		_IO('T', BASE_TTYIOC_PRIVATE + 0x02)
+/* Set radio patch.
+ * After this ioctl call, the driver restarts the si4455,
+ * then apply the new configuration and patch.
+ * This ioctl code is for future use only. Not implemented yet.
+ */
+#define SI4455_IOC_SEZP		_IOW('T', \
+					BASE_TTYIOC_PRIVATE + 0x03, \
+					struct si4455_iocbuff)
+/* Clear radio patch.
+ * After this ioctl call, the driver restarts the si4455,
+ * then apply the new configuration and patch.
+ * This ioctl code is for future use only. Not implemented yet.
+ */
+#define SI4455_IOC_CEZP		_IO('T', BASE_TTYIOC_PRIVATE + 0x04)
+/* Get transmit channel. */
+#define SI4455_IOC_GTXC		_IOR('T', BASE_TTYIOC_PRIVATE +
0x11, uint32_t)
+/* Set transmit channel. */
+#define SI4455_IOC_STXC		_IOW('T', BASE_TTYIOC_PRIVATE +
0x12, uint32_t)
+/* Get receive channel. */
+#define SI4455_IOC_GRXC		_IOR('T', BASE_TTYIOC_PRIVATE +
0x13, uint32_t)
+/* Set receive channel. */
+#define SI4455_IOC_SRXC		_IOW('T', BASE_TTYIOC_PRIVATE +
0x14, uint32_t)
+/* Get fixed length package size. */
+#define SI4455_IOC_GSIZ		_IOR('T', BASE_TTYIOC_PRIVATE +
0x15, uint32_t)
+/* Set fixed length package size. */
+#define SI4455_IOC_SSIZ		_IOW('T', BASE_TTYIOC_PRIVATE +
0x16, uint32_t)
+/* Get last rssi value. */
+#define SI4455_IOC_GRSSI	_IOR('T', BASE_TTYIOC_PRIVATE + 0x20,
uint32_t)
+
+#endif
-- 
2.17.1






More information about the devel mailing list