On Wed, Dec 09, 2020 at 03:42:06PM +0300, Dan Carpenter wrote: > Change the From email header to say your name. > > The patch is corrupted and can't be applied. Please read the first > paragraphs of Documentation/process/email-clients.rst > > This driver is pretty small and it might be easier to clean it up first > before merging it into staging. Run checkpatch.pl --strict on the > driver. > > > --- /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@xxxxxxxxxxx> > > + * > > + */ > > +#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 > > These names are unreadably long and just make the code messy. > > > +#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; > > Also the huge gap between the type and the struct member makes it > hard to read. > > u8 chip_rev; > u16 part; > u8 pbuild; > > etc. > > > +}; > > + > > +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; > > +}; > > Since the struct is not defined by the spec then don't bother aligning > the members. It just makes changing the code complicated because you > have to re-align stuff. Just put a single space between the type and > the name. > > > > + > > +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); > > Remove unecessary declarations like this. > > > +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; > > Remove unecessary initializations. It disables static checkers' ability > to find uninitialized variable bugs so it leads to bugs. > > > + u8 dataOut[] = { SI4455_CMD_ID_READ_CMD_BUFF }; > > + u8 *dataIn = devm_kzalloc(port->dev, 1 + length, GFP_KERNEL); > > Never put functions which can fail in the declaration block. It leads > to "forgot to check for NULL bugs" which is the case here. > > Don't use devm_ for this. It has a different lifetime. Use normal > kzalloc(). > > > + struct spi_transfer xfer[] = { > > + { > > + .tx_buf = dataOut, > > + .len = sizeof(dataOut), > > + }, { > > + .rx_buf = dataIn, > > + .len = 1 + length, > > + } > > + }; > > + int errCnt = 10000; > > + > > + while (errCnt > 0) { > > while (--cnt > 9) { > > > + dataOut[0] = SI4455_CMD_ID_READ_CMD_BUFF; > > + ret = spi_sync_transfer(to_spi_device(port->dev), > > + xfer, > > + ARRAY_SIZE(xfer)); > > + if (ret == 0) { > > Always do Error Handling as opposed to success handling. > > if (ret) > break; > > > + 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 = si4455_poll_cts(port); > if (ret) { > dev_err(port->dev, "%s: si4455_poll_cts error(%i)", __func__, > ret); > return ret; > } > > All the checks need to be reversed. The printk only needs two lines. > > > > + 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 (poll) { > ret = si4455_poll_cts(port); > if (ret) > return ret; > } > > > + > > + 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); > > Use vanilla kzalloc(). > > > + 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) { > > Reverse this test: > > if (!priv->shdn_gpio) > return; > > > + 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); > > This can fit on two lines: > > 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); > > No need to cast this. > > > + if (ret) { > > + dev_err(port->dev, > > + "%s: si4455_write_tx_fifo error(%i)", > > + __func__, > > + ret); > > + goto end; > > Just return directly. Do nothing gotos just end up introducing "Forgot > to set the error code" bugs. > > > + } > > + 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__); > > +} > > Delete all these empty functions. > > > + > > +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) { > > Reverse this test. > > > + 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__); > > Delete all these debug statements which only print the name of the > function. Use ftrace for this instead. > > > + 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); > > This needs to indented another tab. > > switch (cmd) { > case SI4455_IOC_SEZC: > memcpy(&s->configuration, (void *)arg, sizeof(s->configuration)); > > Eep!!! > > Don't use memcpy() here. Use copy_from_user(). > > void __user *argp = arg; > > if (copy_from_user(&s->configuration, argp, > sizeof(s->configuration))) > return -EFAULT; > > > + 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; > > Preserve the error code: > > ret = PTR_ERR(s->shdn_gpio); > > > + 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; > > This is "Last if condition is reversed" anti-pattern. Always do error > handling, never success handling. > > > + > > + 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; > > This white space is whacky. > > > > + 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); > > +} > > Anyway, hopefully that's some ideas. > > regards, > dan carpenter > > Thank you for your suggestions. I made the canges suggested by you. I'll test the driver in my development environment, then I'll come back with a new patch soon. I set up a mail client on my linux dev environment, I hope my mails/patches/codes will be in proper quality in the future. Üdvözlettel / Best regards: József Horváth