ice: remove u16 arithmetic in ice_gnss
Subsystems (2)
PATCH 1/3 ice: remove u16 arithmetic in ice_gnss
Change u16 to u32 where arithmetic occured.
--- drivers/net/ethernet/intel/ice/ice_gnss.c | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-)
drivers/net/ethernet/intel/ice/ice_gnss.c +3 -3
@@ -23,7 +23,7 @@ static void ice_gnss_read(struct kthread_work *work)struct ice_hw *hw;__be16 data_len_b;char *buf =NULL ; -u16 i, data_len; +u32 i, data_len;int err =0 ; pf = gnss->back;
@@ -65,7 +65,7 @@ static void ice_gnss_read(struct kthread_work *work)mdelay (10 ); } - data_len =min (data_len, (u16 )PAGE_SIZE ); + data_len =min_t (typeof (data_len), data_len,PAGE_SIZE ); data_len =tty_buffer_request_room (port, data_len);if (!data_len) { err = -ENOMEM ;
@@ -74,7 +74,7 @@ static void ice_gnss_read(struct kthread_work *work)/* Read received data */ for (i =0 ; i < data_len; i += bytes_read) { -u16 bytes_left = data_len - i; +u32 bytes_left = data_len - i; bytes_read =min_t (typeof (bytes_left), bytes_left,ICE_MAX_I2C_DATA_SIZE );
Signature · 1 line
2.34.1
PATCH 2/3 ice: add i2c write command
Add the possibility to write to connected i2c devices. FW may reject the write if the device is not on allowlist.
--- .../net/ethernet/intel/ice/ice_adminq_cmd.h | 7 +-- drivers/net/ethernet/intel/ice/ice_common.c | 45 ++++++++++++++++++- drivers/net/ethernet/intel/ice/ice_common.h | 4 ++ 3 files changed, 52 insertions(+), 4 deletions(-)
drivers/net/ethernet/intel/ice/ice_adminq_cmd.h +4 -3
@@ -1401,7 +1401,7 @@ struct ice_aqc_get_link_topo {u8 rsvd[9 ]; }; -/* Read I2C (direct, 0x06E2) */ +/* Read/Write I2C (direct, 0x06E2/0x06E3) */ struct ice_aqc_i2c {struct ice_aqc_link_topo_addr topo_addr;__le16 i2c_addr;
@@ -1411,7 +1411,7 @@ struct ice_aqc_i2c {u8 rsvd;__le16 i2c_bus_addr; -u8 rsvd2[4 ]; +u8 i2c_data[4 ];/* Used only by write command, reserved in read. */ };/* Read I2C Response (direct, 0x06E2) */
@@ -2130,7 +2130,7 @@ struct ice_aq_desc {struct ice_aqc_get_link_status get_link_status;struct ice_aqc_event_lan_overflow lan_overflow;struct ice_aqc_get_link_topo get_link_topo; -struct ice_aqc_i2c read_i2c; +struct ice_aqc_i2c read_write_i2c;struct ice_aqc_read_i2c_resp read_i2c_resp; } params; };
@@ -2247,6 +2247,7 @@ enum ice_adminq_opc { ice_aqc_opc_set_mac_lb =0x0620 , ice_aqc_opc_get_link_topo =0x06E0 , ice_aqc_opc_read_i2c =0x06E2 , + ice_aqc_opc_write_i2c =0x06E3 , ice_aqc_opc_set_port_id_led =0x06E9 , ice_aqc_opc_set_gpio =0x06EC , ice_aqc_opc_get_gpio = 0x06ED,
drivers/net/ethernet/intel/ice/ice_common.c +44 -1
57 lines not on this page · raw message
drivers/net/ethernet/intel/ice/ice_common.h +4 -0
@@ -214,5 +214,9 @@ int ice_aq_read_i2c(struct ice_hw *hw, struct ice_aqc_link_topo_addr topo_addr, u16 bus_addr, __le16 addr, u8 params, u8 *data, struct ice_sq_cd *cd); +int +ice_aq_write_i2c (struct ice_hw *hw,struct ice_aqc_link_topo_addr topo_addr, +u16 bus_addr,__le16 addr,u8 params,u8 *data, +struct ice_sq_cd *cd);bool ice_fw_supports_report_dflt_cfg (struct ice_hw *hw);#endif /* _ICE_COMMON_H_ */
Signature · 1 line
2.34.1
PATCH 2/3 ice: add i2c write command
Dear Karol,
Thank you for your patch.
Am 15.04.22 um 12:31 schrieb Karol Kolacinski:
Quoted 2 lines
Add the possibility to write to connected i2c devices. FW may reject the write if the device is not on allowlist.
Did you use a datasheet for implementing this. If so, please mention the name and revision.
Quoted 62 lines
Signed-off-by Karol Kolacinski <[email protected]>--- .../net/ethernet/intel/ice/ice_adminq_cmd.h | 7 +-- drivers/net/ethernet/intel/ice/ice_common.c | 45 ++++++++++++++++++- drivers/net/ethernet/intel/ice/ice_common.h | 4 ++ 3 files changed, 52 insertions(+), 4 deletions(-)drivers/net/ethernet/intel/ice/ice_adminq_cmd.h +4
-3@@ -1401,7 +1401,7 @@ struct ice_aqc_get_link_topo {u8 rsvd[9 ]; }; -/* Read I2C (direct, 0x06E2) */ +/* Read/Write I2C (direct, 0x06E2/0x06E3) */ struct ice_aqc_i2c {struct ice_aqc_link_topo_addr topo_addr;__le16 i2c_addr;@@ -1411,7 +1411,7 @@ struct ice_aqc_i2c {u8 rsvd;__le16 i2c_bus_addr; -u8 rsvd2[4 ]; +u8 i2c_data[4 ];/* Used only by write command, reserved in read. */ };/* Read I2C Response (direct, 0x06E2) */ @@ -2130,7 +2130,7 @@ struct ice_aq_desc {struct ice_aqc_get_link_status get_link_status;struct ice_aqc_event_lan_overflow lan_overflow;struct ice_aqc_get_link_topo get_link_topo; -struct ice_aqc_i2c read_i2c; +struct ice_aqc_i2c read_write_i2c;struct ice_aqc_read_i2c_resp read_i2c_resp; } params; };@@ -2247,6 +2247,7 @@ enum ice_adminq_opc { ice_aqc_opc_set_mac_lb =0x0620 , ice_aqc_opc_get_link_topo =0x06E0 , ice_aqc_opc_read_i2c =0x06E2 , + ice_aqc_opc_write_i2c =0x06E3 , ice_aqc_opc_set_port_id_led =0x06E9 , ice_aqc_opc_set_gpio =0x06EC , ice_aqc_opc_get_gpio = 0x06ED,drivers/net/ethernet/intel/ice/ice_common.c +1
-1@@ -4823,7 +4823,7 @@ ice_aq_read_i2c(struct ice_hw *hw, struct ice_aqc_link_topo_addr topo_addr,int status;ice_fill_dflt_direct_cmd_desc (&desc, ice_aqc_opc_read_i2c); - cmd = &desc.params.read_i2c; + cmd = &desc.params.read_write_i2c;if (!data)return -EINVAL ;@@ -4850,6 +4850,49 @@ ice_aq_read_i2c(struct ice_hw *hw, struct ice_aqc_link_topo_addr topo_addr,return status; }
drivers/net/ethernet/intel/ice/ice_common.c ice_aq_read_i2c(struct ice_hw *hw, struct ice_aqc_link_topo_addr topo_addr, · line 4861
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_common.c +9
-0+/** +* ice_aq_write_i2c +* @hw: pointer to the hw struct +* @topo_addr: topology address for a device to communicate with +* @bus_addr: 7-bit I2C bus address +* @addr: I2C memory address (I2C offset) with up to 16 bits +* @params: I2C parameters: bit [4] - I2C address type, bits [3:0] - data size to write (0-7 bytes) +* @data: pointer to data (0 to 4 bytes) to be written to the I2C device +* @cd: pointer to command details structure or NULL
Also document the return value?
drivers/net/ethernet/intel/ice/ice_common.c ice_aq_read_i2c(struct ice_hw *hw, struct ice_aqc_link_topo_addr topo_addr, · line 4872
Quoted 11 lines
drivers/net/ethernet/intel/ice/ice_common.c +11
-0+* +* Write I2C (0x06E3) +*/ +int +ice_aq_write_i2c (struct ice_hw *hw,struct ice_aqc_link_topo_addr topo_addr, +u16 bus_addr,__le16 addr,u8 params,u8 *data, +struct ice_sq_cd *cd) +{ +struct ice_aq_desc desc = {0 }; +struct ice_aqc_i2c *cmd; +u8 i, data_size;
The loop variable should be a native type.
Quoted 31 lines
drivers/net/ethernet/intel/ice/ice_common.c +23
-0+ +ice_fill_dflt_direct_cmd_desc (&desc, ice_aqc_opc_write_i2c); + cmd = &desc.params.read_write_i2c; + + data_size =FIELD_GET (ICE_AQC_I2C_DATA_SIZE_M , params); + +/* data_size limited to 4 */ +if (data_size >4 ) +return -EINVAL ; + + cmd->i2c_bus_addr =cpu_to_le16 (bus_addr); + cmd->topo_addr = topo_addr; + cmd->i2c_params = params; + cmd->i2c_addr = addr; + +for (i =0 ; i < data_size; i++) { + cmd->i2c_data[i] = *data; + data++; + } + +return ice_aq_send_cmd (hw, &desc,NULL ,0 , cd); +} +/** * ice_aq_set_driver_param - Set driver parameter to share via firmware * @hw: pointer to the HW struct drivers/net/ethernet/intel/ice/ice_common.h +0
-0
drivers/net/ethernet/intel/ice/ice_common.h int · line 222
Quoted 9 lines
drivers/net/ethernet/intel/ice/ice_common.h +4
-0@@ -214,5 +214,9 @@ int ice_aq_read_i2c(struct ice_hw *hw, struct ice_aqc_link_topo_addr topo_addr, u16 bus_addr, __le16 addr, u8 params, u8 *data, struct ice_sq_cd *cd); +int +ice_aq_write_i2c (struct ice_hw *hw,struct ice_aqc_link_topo_addr topo_addr, +u16 bus_addr,__le16 addr,u8 params,u8 *data, +struct ice_sq_cd *cd);bool ice_fw_supports_report_dflt_cfg (struct ice_hw *hw);#endif /* _ICE_COMMON_H_ */
Kind regards,
Paul
Kolacinski
PATCH 2/3 ice: add i2c write command
Dear Paul,
Thank you for your review.
Quoted 5 lines · Paul Menzel
Quoted 2 lines
Add the possibility to write to connected i2c devices. FW may reject the write if the device is not on allowlist.
Did you use a datasheet for implementing this. If so, please mention the name and revision.
Unfortunately, the original author did not leave the datasheet.
Quoted 11 lines
Quoted 9 lines
+/**
+ *ice_aq_write_i2c
+ * @hw: pointer to the hw struct
+ * @topo_addr: topology address for a device to communicate with
+ * @bus_addr: 7-bit I2C bus address
+ * @addr: I2C memory address (I2C offset) with up to 16 bits
+ * @params: I2C parameters: bit [4] - I2C address type, bits [3:0] - data size to write (0-7 bytes)
+ * @data: pointer to data (0 to 4 bytes) to be written to the I2C device
+ * @cd: pointer to command details structure or NULLAlso document the return value?
Done.
Quoted 5 lines
Quoted 5 lines
+ *
+ * Write I2C (0x06E3)
+ */(quoted diff) +2
-0+int +ice_aq_write_i2c(struct ice_hw *hw, struct ice_aqc_link_topo_addr topo_addr,
Quoted 8 lines
Quoted 6 lines
+????????????? u16
bus_addr,__le16addr, u8 params, u8 *data, +????????????? structice_sq_cd*cd)
+{
+???? structice_aq_descdesc = { 0 };
+???? structice_aqc_i2c*cmd;
+???? u8 i,data_size;The loop variable should be a native type.
Done.
Kind regards,
Karol
---------------------------------------------------------------------
Intel Technology Poland sp. z o.o.
ul. Slowackiego 173, 80-298 Gdansk
KRS 101882
NIP 957-07-52-316
PATCH 3/3 ice: add write functionality for GNSS TTY
In reply to Karol KolacinskiAdd the possibility to write raw bytes to the GNSS module through the first TTY device. This allow user to configure the module.
Create a second read-only TTY device.
--- drivers/net/ethernet/intel/ice/ice.h | 4 +- drivers/net/ethernet/intel/ice/ice_gnss.c | 230 +++++++++++++++++++--- drivers/net/ethernet/intel/ice/ice_gnss.h | 23 ++- 3 files changed, 231 insertions(+), 26 deletions(-)
drivers/net/ethernet/intel/ice/ice.h +2 -2
@@ -558,8 +558,8 @@ struct ice_pf {u32 msg_enable;struct ice_ptp ptp;struct tty_driver *ice_gnss_tty_driver; -struct tty_port gnss_tty_port; -struct gnss_serial *gnss_serial; +struct tty_port *gnss_tty_port[ICE_GNSS_TTY_MINOR_DEVICES ]; +struct gnss_serial *gnss_serial[ICE_GNSS_TTY_MINOR_DEVICES ];u16 num_rdma_msix;/* Total MSIX vectors for RDMA driver */ u16 rdma_base_vector;
drivers/net/ethernet/intel/ice/ice_gnss.c +208 -22
316 lines not on this page · raw message
drivers/net/ethernet/intel/ice/ice_gnss.h +21 -2
@@ -8,14 +8,31 @@#include <linux/tty_flip.h> #define ICE_E810T_GNSS_I2C_BUS 0x2 +#define ICE_GNSS_TIMER_DELAY_TIME (HZ / 10)/* 0.1 second per message */ +#define ICE_GNSS_TTY_MINOR_DEVICES 2 +#define ICE_GNSS_TTY_WRITE_BUF 250 +#define ICE_MAX_I2C_DATA_SIZE FIELD_MAX(ICE_AQC_I2C_DATA_SIZE_M) +#define ICE_MAX_I2C_WRITE_BYTES 4 + +/* ublox specific deifinitions */ #define ICE_GNSS_UBX_I2C_BUS_ADDR 0x42/* Data length register is big endian */ #define ICE_GNSS_UBX_DATA_LEN_H 0xFD#define ICE_GNSS_UBX_DATA_LEN_WIDTH 2#define ICE_GNSS_UBX_EMPTY_DATA 0xFF -#define ICE_GNSS_TIMER_DELAY_TIME (HZ / 10)/* 0.1 second per message */ -#define ICE_MAX_I2C_DATA_SIZE FIELD_MAX(ICE_AQC_I2C_DATA_SIZE_M) +/* For ublox writes are performed without address so the first byte to write is +* passed as I2C addr parameter. +*/ +#define ICE_GNSS_UBX_WRITE_BYTES (ICE_MAX_I2C_WRITE_BYTES + 1)#define ICE_MAX_UBX_READ_TRIES 255 +#define ICE_MAX_UBX_ACK_READ_TRIES 4095 + +struct gnss_write_buf { +struct list_head queue; +u32 size; +u8 *buf; +}; +/** * struct gnss_serial - data used to initialize GNSS TTY port
@@ -33,6 +50,8 @@ struct gnss_serial {struct mutex gnss_mutex;/* protects GNSS serial structure */ struct kthread_worker *kworker;struct kthread_delayed_work read_work; +struct kthread_work write_work; +struct list_head queue; };#if IS_ENABLED (CONFIG_TTY )
Signature · 1 line
2.34.1
PATCH 3/3 ice: add write functionality for GNSS TTY
Dear Karol,
Thank you for the patch.
Am 15.04.22 um 12:31 schrieb Karol Kolacinski:
Quoted 2 lines
Add the possibility to write raw bytes to the GNSS module through the first TTY device. This allow user to configure the module.
allow*s*
Quoted 2 lines
Create a second read-only TTY device.
Could you please give an example how to configure the module?
Quoted 31 lines
Signed-off-by Karol Kolacinski <[email protected]>--- drivers/net/ethernet/intel/ice/ice.h | 4 +- drivers/net/ethernet/intel/ice/ice_gnss.c | 230 +++++++++++++++++++--- drivers/net/ethernet/intel/ice/ice_gnss.h | 23 ++- 3 files changed, 231 insertions(+), 26 deletions(-)drivers/net/ethernet/intel/ice/ice.h +2
-2@@ -558,8 +558,8 @@ struct ice_pf {u32 msg_enable;struct ice_ptp ptp;struct tty_driver *ice_gnss_tty_driver; -struct tty_port gnss_tty_port; -struct gnss_serial *gnss_serial; +struct tty_port *gnss_tty_port[ICE_GNSS_TTY_MINOR_DEVICES ]; +struct gnss_serial *gnss_serial[ICE_GNSS_TTY_MINOR_DEVICES ];u16 num_rdma_msix;/* Total MSIX vectors for RDMA driver */ u16 rdma_base_vector;drivers/net/ethernet/intel/ice/ice_gnss.c +1
-0@@ -5,6 +5,99 @@#include "ice_lib.h" #include <linux/tty_driver.h> +/**
drivers/net/ethernet/intel/ice/ice_gnss.c line 18
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+* ice_gnss_do_write - Write data to internal GNSS +* @pf: board private structure +* @buf: command buffer +* @size: command buffer size +* +* Write UBX command data to the GNSS receiver +*/ +static void ice_gnss_do_write (struct ice_pf *pf,u8 *buf,u32 size) +{ +u32 i, num_writes, part_writes_num, last_write_bytes, offset =0 ;
Can native types be used at least for the loop variable?
Write out partial_writes_num?
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +8
-0+struct ice_aqc_link_topo_addr link_topo; +struct ice_hw *hw = &pf->hw; +int err =0 ; + +memset (&link_topo,0 ,sizeof (struct ice_aqc_link_topo_addr )); + link_topo.topo_params.index =ICE_E810T_GNSS_I2C_BUS ; + link_topo.topo_params.node_type_ctx |= + ICE_AQC_LINK_TOPO_NODE_CTX_OVERRIDE <<
drivers/net/ethernet/intel/ice/ice_gnss.c line 36
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+ICE_AQC_LINK_TOPO_NODE_CTX_S ; + +/* Write all bytes except the last partial write */ + last_write_bytes = size %ICE_GNSS_UBX_WRITE_BYTES ; +if (last_write_bytes ==0 ) + part_writes_num =0 ; +else if (last_write_bytes ==1 ) + part_writes_num =2 ; +else + part_writes_num =1 ;
I do not fully understand the formula. But I am ignorant, so please ignore, if it?s obvious.
Quoted 20 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +20
-0+ + num_writes = size /ICE_GNSS_UBX_WRITE_BYTES - part_writes_num; + +for (i =0 ; i < num_writes; i++) { + err =ice_aq_write_i2c (hw, link_topo,ICE_GNSS_UBX_I2C_BUS_ADDR , +cpu_to_le16 (buf[offset]), +ICE_MAX_I2C_WRITE_BYTES , + &buf[offset +1 ],NULL ); +if (err) + goto err; + + offset +=ICE_GNSS_UBX_WRITE_BYTES ; + } + +if (part_writes_num ==2 ) { +/* We cannot write a single byte to ublox. Do 2 last writes +* instead of 1. +*/ + err = ice_aq_write_i2c(hw, link_topo, ICE_GNSS_UBX_I2C_BUS_ADDR, + cpu_to_le16(buf[offset]),
drivers/net/ethernet/intel/ice/ice_gnss.c line 66
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+ICE_MAX_I2C_WRITE_BYTES -1 , + &buf[offset + 1], NULL); +if (err) + goto err; + + offset +=ICE_GNSS_UBX_WRITE_BYTES -1 ; + last_write_bytes =2 ; + } + +if (part_writes_num)
Please add a comment here, how you the logic works (that part_writes_num == 2 is also effected).
drivers/net/ethernet/intel/ice/ice_gnss.c line 71
Quoted 5 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +5
-0+ err =ice_aq_write_i2c (hw, link_topo,ICE_GNSS_UBX_I2C_BUS_ADDR , +cpu_to_le16 (buf[offset]), + last_write_bytes -1 , &buf[offset +1 ], +NULL ); +
I wonder if some kind of while could model the algorithm better.
drivers/net/ethernet/intel/ice/ice_gnss.c line 75
Quoted 4 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +4
-0+err: +if (err) +dev_err (ice_pf_to_dev (pf),"GNSS failed to write err=%d\n" , + err);
Please add the offset, and other values to the message.
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +8
-0+} + +/** +* ice_gnss_write_pending - Write all pending data to internal GNSS +* @work: GNSS write work structure +*/ +static void ice_gnss_write_pending (struct kthread_work *work) +{
drivers/net/ethernet/intel/ice/ice_gnss.c line 93
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+ struct gnss_serial *gnss = container_of(work, struct gnss_serial, + write_work); +struct ice_pf *pf = gnss->back; + +if (!list_empty (&gnss->queue)) { +struct gnss_write_buf *write_buf =NULL ; + + write_buf =list_first_entry (&gnss->queue, + struct gnss_write_buf, queue); +list_del (&write_buf->queue);
Why does the queue need to be deleted here, and not after the write below?
drivers/net/ethernet/intel/ice/ice_gnss.c line 95
Quoted 2 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +2
-0+ +ice_gnss_do_write (pf, write_buf->buf, write_buf->size);
Should ice_gnss_do_write return some success/failure code, or the number of writes?
Quoted 46 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +12
-4+kfree (write_buf->buf); +kfree (write_buf); + } +} +/** * ice_gnss_read - Read data from internal GNSS module * @work: GNSS read work structure @@ -103,8 +196,9 @@ static void ice_gnss_read(struct kthread_work *work)/** * ice_gnss_struct_init - Initialize GNSS structure for the TTY * @pf: Board private structure +* @index: TTY device index */ -static struct gnss_serial *ice_gnss_struct_init (struct ice_pf *pf) +static struct gnss_serial *ice_gnss_struct_init (struct ice_pf *pf,int index) {struct device *dev =ice_pf_to_dev (pf);struct kthread_worker *kworker;@@ -117,9 +211,11 @@ static struct gnss_serial *ice_gnss_struct_init(struct ice_pf *pf)mutex_init (&gnss->gnss_mutex); gnss->open_count =0 ; gnss->back = pf; - pf->gnss_serial = gnss; + pf->gnss_serial[index] = gnss;kthread_init_delayed_work (&gnss->read_work, ice_gnss_read); +INIT_LIST_HEAD (&gnss->queue); +kthread_init_work (&gnss->write_work, ice_gnss_write_pending);/* Allocate a kworker for handling work required for the GNSS TTY * writes. */ @@ -155,10 +251,10 @@ static int ice_gnss_tty_open(struct tty_struct *tty, struct file *filp) tty->driver_data =NULL ;/* Get the serial object associated with this tty pointer */ - gnss = pf->gnss_serial; + gnss = pf->gnss_serial[tty->index];if (!gnss) {/* Initialize GNSS struct on the first device open */ - gnss =ice_gnss_struct_init (pf); + gnss =ice_gnss_struct_init (pf, tty->index);if (!gnss)return -ENOMEM ; }
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 313
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-1@@ -211,25 +307,96 @@ static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) }/** -* ice_gnss_tty_write - Dummy TTY write function to avoid kernel panic +* ice_gnss_tty_write - Write GNSS data * @tty: pointer to the tty_struct * @buf: pointer to the user data * @cnt: the number of characters that was able to be sent to the hardware (or
s/was/were/
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 314
Quoted 1 line
drivers/net/ethernet/intel/ice/ice_gnss.c +0
-0* queued to be sent at a later time)
But you are passing cnt in, and not set it in the implementation below, aren?t you?
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 324
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +7
-0+* +* The write function call is called by the user when there is data to be sent +* to the hardware. First the tty core receives the call, and then it passes the +* data on to the tty driver?s write function. The tty core also tells the tty +* driver the size of the data being sent. +* If any errors happen during the write call, a negative error value should be +* returned instead of the number of characters that were written. */ static int ice_gnss_tty_write (struct tty_struct *tty,const unsigned char *buf,int cnt)
Should cnt be unsigned? Also, I?d use count.
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +8
-1{ -return 0 ; +struct gnss_write_buf *write_buf; +struct gnss_serial *gnss; +struct ice_pf *pf; +u8 *cmd_buf; + +/* We cannot write a single byte using our I2C implementation. */ +if (cnt <=1 || cnt >ICE_GNSS_TTY_WRITE_BUF ) +return -EINVAL ;
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 343
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+ + gnss = tty->driver_data; +if (!gnss) +return -EFAULT ; + + pf = (struct ice_pf *)tty->driver->driver_state; +if (!pf) +return -EFAULT ; + +/* Allow write only on TTY 0 */
Only allow to write on TTY 0
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 356
Quoted 13 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +13
-0+if (gnss != pf->gnss_serial[0 ]) +return -EIO ; + +mutex_lock (&gnss->gnss_mutex); + +if (!gnss->open_count) { +mutex_unlock (&gnss->gnss_mutex); +return -EINVAL ; + } + + cmd_buf =kzalloc (sizeof (*buf) * cnt,GFP_KERNEL ); +if (!cmd_buf) +return -ENOMEM ;
Does some unlocking need to happen here?
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 363
Quoted 7 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +7
-0+ +memcpy (cmd_buf, buf, cnt); + +/* Send the data out to a hardware port */ + write_buf =kzalloc (sizeof (*write_buf),GFP_KERNEL ); +if (!write_buf) +return -ENOMEM ;
Ditto.
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +8
-0+ + write_buf->buf = cmd_buf; + write_buf->size = cnt; +INIT_LIST_HEAD (&write_buf->queue); +list_add_tail (&write_buf->queue, &gnss->queue); +kthread_queue_work (gnss->kworker, &gnss->write_work); +mutex_unlock (&gnss->gnss_mutex); +return cnt;
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 380
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +5
-1}/** -* ice_gnss_tty_write_room - Dummy TTY write_room function to avoid kernel panic +* ice_gnss_tty_write_room - Returns the numbers of characters to be written. * @tty: pointer to the tty_struct +* +* This routine returns the numbers of characters the tty driver will accept +* for queuing to be written. This number is subject to change as output buffers +* get emptied, or if the output flow control is acted.
What do you mean by ?is acted??
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 387
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +4
-1*/ static unsigned int ice_gnss_tty_write_room (struct tty_struct *tty) { -return 0 ; +struct gnss_serial *gnss = tty->driver_data; +unsigned int room =0 ; + +/* Allow write only on TTY 0 */
Ditto.
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 389
Quoted 2 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +2
-0+if (!gnss || gnss != gnss->back->gnss_serial[0 ]) +return room;
Do you need room? return 0 here, and the macro in the end?
Quoted 14 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+ +mutex_lock (&gnss->gnss_mutex); + +if (!gnss->open_count) + goto exit; + + room =ICE_GNSS_TTY_WRITE_BUF ; +exit: +mutex_unlock (&gnss->gnss_mutex); +return room; }static const struct tty_operations tty_gps_ops = {
drivers/net/ethernet/intel/ice/ice_gnss.c static struct tty_driver *ice_gnss_create_tty_driver(struct ice_pf *pf) · line 420
Quoted 4 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-0@@ -250,10 +417,12 @@ static struct tty_driver *ice_gnss_create_tty_driver(struct ice_pf *pf)struct tty_driver *tty_driver;char *ttydrv_name;int err; +u32 i;
Use native types?
Quoted 50 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +18
-8- tty_driver =tty_alloc_driver (1 ,TTY_DRIVER_REAL_RAW ); + tty_driver =tty_alloc_driver (ICE_GNSS_TTY_MINOR_DEVICES , +TTY_DRIVER_REAL_RAW );if (IS_ERR (tty_driver)) { -dev_err (ice_pf_to_dev (pf),"Failed to allocate memory for GNSS TTY\n" ); +dev_err (dev,"Failed to allocate memory for GNSS TTY\n" );return NULL ; }@@ -283,23 +452,32 @@ static struct tty_driver *ice_gnss_create_tty_driver(struct ice_pf *pf) tty_driver->driver_state = pf;tty_set_operations (tty_driver, &tty_gps_ops); - pf->gnss_serial =NULL ; +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) { + pf->gnss_tty_port[i] =kzalloc (sizeof (*pf->gnss_tty_port[i]), +GFP_KERNEL ); + pf->gnss_serial[i] =NULL ; -tty_port_init (&pf->gnss_tty_port); -tty_port_link_device (&pf->gnss_tty_port, tty_driver,0 ); +tty_port_init (pf->gnss_tty_port[i]); +tty_port_link_device (pf->gnss_tty_port[i], tty_driver, i); + } err =tty_register_driver (tty_driver);if (err) { -dev_err (ice_pf_to_dev (pf),"Failed to register TTY driver err=%d\n" , - err); +dev_err (dev,"Failed to register TTY driver err=%d\n" , err); -tty_port_destroy (&pf->gnss_tty_port); +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) { +tty_port_destroy (pf->gnss_tty_port[i]); +kfree (pf->gnss_tty_port[i]); + }kfree (ttydrv_name);tty_driver_kref_put (pf->ice_gnss_tty_driver);return NULL ; } +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) +dev_info (dev,"%s%d registered\n" , ttydrv_name, i); +return tty_driver; }
drivers/net/ethernet/intel/ice/ice_gnss.c void ice_gnss_init(struct ice_pf *pf) · line 508
Quoted 4 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-0@@ -327,17 +505,25 @@ void ice_gnss_init(struct ice_pf *pf)*/ void ice_gnss_exit (struct ice_pf *pf) { +u32 i;
Ditto.
Quoted 49 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +13
-6+if (!test_bit (ICE_FLAG_GNSS , pf->flags) || !pf->ice_gnss_tty_driver)return ; -tty_port_destroy (&pf->gnss_tty_port); +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) { +if (pf->gnss_tty_port[i]) { +tty_port_destroy (pf->gnss_tty_port[i]); +kfree (pf->gnss_tty_port[i]); + } -if (pf->gnss_serial) { -struct gnss_serial *gnss = pf->gnss_serial; +if (pf->gnss_serial[i]) { +struct gnss_serial *gnss = pf->gnss_serial[i]; -kthread_cancel_delayed_work_sync (&gnss->read_work); -kfree (gnss); - pf->gnss_serial =NULL ; +kthread_cancel_work_sync (&gnss->write_work); +kthread_cancel_delayed_work_sync (&gnss->read_work); +kfree (gnss); + pf->gnss_serial[i] =NULL ; + } }tty_unregister_driver (pf->ice_gnss_tty_driver);drivers/net/ethernet/intel/ice/ice_gnss.h +7
-2@@ -8,14 +8,31 @@#include <linux/tty_flip.h> #define ICE_E810T_GNSS_I2C_BUS 0x2 +#define ICE_GNSS_TIMER_DELAY_TIME (HZ / 10)/* 0.1 second per message */ +#define ICE_GNSS_TTY_MINOR_DEVICES 2 +#define ICE_GNSS_TTY_WRITE_BUF 250 +#define ICE_MAX_I2C_DATA_SIZE FIELD_MAX(ICE_AQC_I2C_DATA_SIZE_M) +#define ICE_MAX_I2C_WRITE_BYTES 4 + +/* ublox specific deifinitions */ #define ICE_GNSS_UBX_I2C_BUS_ADDR 0x42/* Data length register is big endian */ #define ICE_GNSS_UBX_DATA_LEN_H 0xFD#define ICE_GNSS_UBX_DATA_LEN_WIDTH 2#define ICE_GNSS_UBX_EMPTY_DATA 0xFF -#define ICE_GNSS_TIMER_DELAY_TIME (HZ / 10)/* 0.1 second per message */ -#define ICE_MAX_I2C_DATA_SIZE FIELD_MAX(ICE_AQC_I2C_DATA_SIZE_M)
drivers/net/ethernet/intel/ice/ice_gnss.h line 32
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.h +9
-0+/* For ublox writes are performed without address so the first byte to write is +* passed as I2C addr parameter. +*/ +#define ICE_GNSS_UBX_WRITE_BYTES (ICE_MAX_I2C_WRITE_BYTES + 1)#define ICE_MAX_UBX_READ_TRIES 255 +#define ICE_MAX_UBX_ACK_READ_TRIES 4095 + +struct gnss_write_buf { +struct list_head queue; +u32 size;
Use native types.
Quoted 7 lines
drivers/net/ethernet/intel/ice/ice_gnss.h +3
-0+u8 *buf; +}; +/** * struct gnss_serial - data used to initialize GNSS TTY port
drivers/net/ethernet/intel/ice/ice_gnss.h struct gnss_serial { · line 57
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.h +2
-0@@ -33,6 +50,8 @@ struct gnss_serial {struct mutex gnss_mutex;/* protects GNSS serial structure */ struct kthread_worker *kworker;struct kthread_delayed_work read_work; +struct kthread_work write_work; +struct list_head queue; };#if IS_ENABLED (CONFIG_TTY )
Kind regards,
Paul
Kolacinski
PATCH 3/3 ice: add write functionality for GNSS TTY
Dear Paul,
Thank you for your review.
Quoted 4 lines · Paul Menzel
Quoted 2 lines
Add the possibility to write raw bytes to the GNSS module through the first TTY device. This allow user to configure the module.
allow*s*
Done.
Quoted 4 lines
Quoted 2 lines
Create a second read-only TTY device.
Could you please give an example how to configure the module?
The module is configured using the u-blox UBX protocol, I updated the commit message to reflect this.
Quoted 44 lines
Quoted 31 lines
Signed-off-by Karol Kolacinski <[email protected]>--- drivers/net/ethernet/intel/ice/ice.h | 4 +- drivers/net/ethernet/intel/ice/ice_gnss.c | 230 +++++++++++++++++++--- drivers/net/ethernet/intel/ice/ice_gnss.h | 23 ++- 3 files changed, 231 insertions(+), 26 deletions(-)drivers/net/ethernet/intel/ice/ice.h +2
-2@@ -558,8 +558,8 @@ struct ice_pf {u32 msg_enable;struct ice_ptp ptp;struct tty_driver *ice_gnss_tty_driver; -struct tty_port gnss_tty_port; -struct gnss_serial *gnss_serial; +struct tty_port *gnss_tty_port[ICE_GNSS_TTY_MINOR_DEVICES ]; +struct gnss_serial *gnss_serial[ICE_GNSS_TTY_MINOR_DEVICES ];u16 num_rdma_msix;/* Total MSIX vectors for RDMA driver */ u16 rdma_base_vector;drivers/net/ethernet/intel/ice/ice_gnss.c +1
-0@@ -5,6 +5,99 @@#include "ice_lib.h" #include <linux/tty_driver.h> +/** drivers/net/ethernet/intel/ice/ice_gnss.c line 18
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+* ice_gnss_do_write - Write data to internal GNSS +* @pf: board private structure +* @buf: command buffer +* @size: command buffer size +* +* Write UBX command data to the GNSS receiver +*/ +static void ice_gnss_do_write (struct ice_pf *pf,u8 *buf,u32 size) +{ +u32 i, num_writes, part_writes_num, last_write_bytes, offset =0 ;Can native types be used at least for the loop variable?
Quoted 1 line
Write out
partial_writes_num?
Done.
Quoted 13 lines
Quoted 13 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +13
-0+struct ice_aqc_link_topo_addr link_topo; +struct ice_hw *hw = &pf->hw; +int err =0 ; + +memset (&link_topo,0 ,sizeof (struct ice_aqc_link_topo_addr )); + link_topo.topo_params.index =ICE_E810T_GNSS_I2C_BUS ; + link_topo.topo_params.node_type_ctx |= +ICE_AQC_LINK_TOPO_NODE_CTX_OVERRIDE << +ICE_AQC_LINK_TOPO_NODE_CTX_S ; + +/* Write all bytes except the last partial write */ + last_write_bytes = size %ICE_GNSS_UBX_WRITE_BYTES ; +if (last_write_bytes ==0 )
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c line 36
Quoted 5 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +5
-0+ part_writes_num =0 ; + else if (last_write_bytes == 1) + part_writes_num =2 ; + else + part_writes_num =1 ;I do not fully understand the formula. But I am ignorant, so please ignore, if it?s obvious.
I changed the formula. Basically, I wanted to split the bytes between the last 2 writes if the last one would be only a byte.
Quoted 25 lines
Quoted 25 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +25
-0+ + num_writes = size /ICE_GNSS_UBX_WRITE_BYTES - part_writes_num; + +for (i =0 ; i < num_writes; i++) { + err =ice_aq_write_i2c (hw, link_topo,ICE_GNSS_UBX_I2C_BUS_ADDR , +cpu_to_le16 (buf[offset]), +ICE_MAX_I2C_WRITE_BYTES , + &buf[offset +1 ],NULL ); +if (err) + goto err; + + offset +=ICE_GNSS_UBX_WRITE_BYTES ; + } + +if (part_writes_num ==2 ) { +/* We cannot write a single byte to ublox. Do 2 last writes +* instead of 1. +*/ + err =ice_aq_write_i2c (hw, link_topo,ICE_GNSS_UBX_I2C_BUS_ADDR , +cpu_to_le16 (buf[offset]), +ICE_MAX_I2C_WRITE_BYTES -1 , + &buf[offset +1 ],NULL ); +if (err) + goto err; +
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c line 66
Quoted 5 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +5
-0+ offset +=ICE_GNSS_UBX_WRITE_BYTES -1 ; + last_write_bytes =2 ; + } + +if (part_writes_num)Please add a comment here, how you the logic works (that
part_writes_num == 2is also effected).
Done.
Quoted 7 lines
drivers/net/ethernet/intel/ice/ice_gnss.c line 71
Quoted 5 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +5
-0+ err =ice_aq_write_i2c (hw, link_topo,ICE_GNSS_UBX_I2C_BUS_ADDR , +cpu_to_le16 (buf[offset]), + last_write_bytes -1 , &buf[offset +1 ], +NULL ); +I wonder if some kind of while could model the algorithm better.
Done.
Quoted 6 lines
drivers/net/ethernet/intel/ice/ice_gnss.c line 75
Quoted 4 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +4
-0+err: +if (err) +dev_err (ice_pf_to_dev (pf),"GNSS failed to write err=%d\n" , + err);Please add the offset, and other values to the message.
Done.
Quoted 12 lines
Quoted 12 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +12
-0+} + +/** +* ice_gnss_write_pending - Write all pending data to internal GNSS +* @work: GNSS write work structure +*/ +static void ice_gnss_write_pending (struct kthread_work *work) +{ + struct gnss_serial *gnss = container_of(work, struct gnss_serial, + write_work); +struct ice_pf *pf = gnss->back; +
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c line 93
Quoted 6 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +6
-0+if (!list_empty (&gnss->queue)) { +struct gnss_write_buf *write_buf =NULL ; + + write_buf =list_first_entry (&gnss->queue, + struct gnss_write_buf, queue); +list_del (&write_buf->queue);Why does the queue need to be deleted here, and not after the write below?
Done.
Quoted 5 lines
drivers/net/ethernet/intel/ice/ice_gnss.c line 95
Quoted 2 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +2
-0+ +ice_gnss_do_write (pf, write_buf->buf, write_buf->size);Should
ice_gnss_do_writereturn some success/failure code, or the number of writes?
Done.
Quoted 48 lines
Quoted 48 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +12
-4+kfree (write_buf->buf); +kfree (write_buf); + } +} +/** * ice_gnss_read - Read data from internal GNSS module * @work: GNSS read work structure @@ -103,8 +196,9 @@ static void ice_gnss_read(struct kthread_work *work)/** * ice_gnss_struct_init - Initialize GNSS structure for the TTY * @pf: Board private structure +* @index: TTY device index */ -static struct gnss_serial *ice_gnss_struct_init (struct ice_pf *pf) +static struct gnss_serial *ice_gnss_struct_init (struct ice_pf *pf,int index) {struct device *dev =ice_pf_to_dev (pf);struct kthread_worker *kworker;@@ -117,9 +211,11 @@ static struct gnss_serial *ice_gnss_struct_init(struct ice_pf *pf)mutex_init (&gnss->gnss_mutex); gnss->open_count =0 ; gnss->back = pf; - pf->gnss_serial = gnss; + pf->gnss_serial[index] = gnss;kthread_init_delayed_work (&gnss->read_work, ice_gnss_read); +INIT_LIST_HEAD (&gnss->queue); +kthread_init_work (&gnss->write_work, ice_gnss_write_pending);/* Allocate a kworker for handling work required for the GNSS TTY * writes. */ @@ -155,10 +251,10 @@ static int ice_gnss_tty_open(struct tty_struct *tty, struct file *filp) tty->driver_data =NULL ;/* Get the serial object associated with this tty pointer */ - gnss = pf->gnss_serial; + gnss = pf->gnss_serial[tty->index];if (!gnss) {/* Initialize GNSS struct on the first device open */ - gnss =ice_gnss_struct_init (pf); + gnss =ice_gnss_struct_init (pf, tty->index);if (!gnss)return -ENOMEM ; }@@ -211,25 +307,96 @@ static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) }
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 313
Quoted 6 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-1/** -* ice_gnss_tty_write - Dummy TTY write function to avoid kernel panic +* ice_gnss_tty_write - Write GNSS data * @tty: pointer to the tty_struct * @buf: pointer to the user data * @cnt: the number of characters that was able to be sent to the hardware (or s/was/were/
Done.
Quoted 4 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 314
Quoted 1 line
drivers/net/ethernet/intel/ice/ice_gnss.c +0
-0* queued to be sent at a later time) But you are passing
cntin, and not set it in the implementation below, aren?t you?
Done.
Quoted 11 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 324
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +7
-0+* +* The write function call is called by the user when there is data to be sent +* to the hardware. First the tty core receives the call, and then it passes the +* data on to the tty driver?s write function. The tty core also tells the tty +* driver the size of the data being sent. +* If any errors happen during the write call, a negative error value should be +* returned instead of the number of characters that were written. */ static int ice_gnss_tty_write (struct tty_struct *tty,const unsigned char *buf,int cnt)
Quoted 1 line
Should
cntbe unsigned? Also, I?d usecount.
Changed to 'count'. I cannot use unsigned here as it's defined by the kernel interface.
Quoted 14 lines
Quoted 14 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +12
-1{ -return 0 ; +struct gnss_write_buf *write_buf; +struct gnss_serial *gnss; +struct ice_pf *pf; +u8 *cmd_buf; + +/* We cannot write a single byte using our I2C implementation. */ +if (cnt <=1 || cnt >ICE_GNSS_TTY_WRITE_BUF ) +return -EINVAL ; + + gnss = tty->driver_data; +if (!gnss) +return -EFAULT ;
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 343
Quoted 6 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +6
-0+ + pf = (struct ice_pf *)tty->driver->driver_state; +if (!pf) +return -EFAULT ; + +/* Allow write only on TTY 0 */ Only allow to write on TTY 0
Done.
Quoted 7 lines
Quoted 7 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +7
-0+if (gnss != pf->gnss_serial[0 ]) +return -EIO ; + +mutex_lock (&gnss->gnss_mutex); + +if (!gnss->open_count) { +mutex_unlock (&gnss->gnss_mutex);
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 356
Quoted 6 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +6
-0+return -EINVAL ; + } + + cmd_buf =kzalloc (sizeof (*buf) * cnt,GFP_KERNEL ); +if (!cmd_buf) +return -ENOMEM ;Does some unlocking need to happen here?
Done.
Quoted 9 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 363
Quoted 7 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +7
-0+ +memcpy (cmd_buf, buf, cnt); + +/* Send the data out to a hardware port */ + write_buf =kzalloc (sizeof (*write_buf),GFP_KERNEL ); +if (!write_buf) +return -ENOMEM ;Ditto.
Done.
Quoted 19 lines
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +8
-0+ + write_buf->buf = cmd_buf; + write_buf->size = cnt; +INIT_LIST_HEAD (&write_buf->queue); +list_add_tail (&write_buf->queue, &gnss->queue); +kthread_queue_work (gnss->kworker, &gnss->write_work); +mutex_unlock (&gnss->gnss_mutex); +return cnt;drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 380
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +5
-1}/** -* ice_gnss_tty_write_room - Dummy TTY write_room function to avoid kernel panic +* ice_gnss_tty_write_room - Returns the numbers of characters to be written. * @tty: pointer to the tty_struct +* +* This routine returns the numbers of characters the tty driver will accept +* for queuing to be written. This number is subject to change as output buffers +* get emptied, or if the output flow control is acted.
Quoted 1 line
What do you mean by ?is acted??
Rephrased the description.
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 387
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +4
-1*/ static unsigned int ice_gnss_tty_write_room (struct tty_struct *tty) { -return 0 ; +struct gnss_serial *gnss = tty->driver_data; +unsigned int room =0 ; + +/* Allow write only on TTY 0 */ Ditto.
Done.
Quoted 4 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_tty_close(struct tty_struct *tty, struct file *filp) · line 389
Quoted 2 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +2
-0+if (!gnss || gnss != gnss->back->gnss_serial[0 ]) +return room;Do you need
room?return 0here, and the macro in the end?
Done.
Quoted 12 lines
Quoted 12 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +10
-0+ +mutex_lock (&gnss->gnss_mutex); + +if (!gnss->open_count) + goto exit; + + room =ICE_GNSS_TTY_WRITE_BUF ; +exit: +mutex_unlock (&gnss->gnss_mutex); +return room; }
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static struct tty_driver *ice_gnss_create_tty_driver(struct ice_pf *pf) · line 420
Quoted 6 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-0static const struct tty_operations tty_gps_ops = {@@ -250,10 +417,12 @@ static struct tty_driver *ice_gnss_create_tty_driver(struct ice_pf *pf)struct tty_driver *tty_driver;char *ttydrv_name;int err; +u32 i;Use native types?
Done.
Quoted 49 lines
Quoted 49 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +18
-8- tty_driver =tty_alloc_driver (1 ,TTY_DRIVER_REAL_RAW ); + tty_driver =tty_alloc_driver (ICE_GNSS_TTY_MINOR_DEVICES , +TTY_DRIVER_REAL_RAW );if (IS_ERR (tty_driver)) { -dev_err (ice_pf_to_dev (pf),"Failed to allocate memory for GNSS TTY\n" ); +dev_err (dev,"Failed to allocate memory for GNSS TTY\n" );return NULL ; }@@ -283,23 +452,32 @@ static struct tty_driver *ice_gnss_create_tty_driver(struct ice_pf *pf) tty_driver->driver_state = pf;tty_set_operations (tty_driver, &tty_gps_ops); - pf->gnss_serial =NULL ; +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) { + pf->gnss_tty_port[i] =kzalloc (sizeof (*pf->gnss_tty_port[i]), +GFP_KERNEL ); + pf->gnss_serial[i] =NULL ; -tty_port_init (&pf->gnss_tty_port); -tty_port_link_device (&pf->gnss_tty_port, tty_driver,0 ); +tty_port_init (pf->gnss_tty_port[i]); +tty_port_link_device (pf->gnss_tty_port[i], tty_driver, i); + } err =tty_register_driver (tty_driver);if (err) { -dev_err (ice_pf_to_dev (pf),"Failed to register TTY driver err=%d\n" , - err); +dev_err (dev,"Failed to register TTY driver err=%d\n" , err); -tty_port_destroy (&pf->gnss_tty_port); +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) { +tty_port_destroy (pf->gnss_tty_port[i]); +kfree (pf->gnss_tty_port[i]); + }kfree (ttydrv_name);tty_driver_kref_put (pf->ice_gnss_tty_driver);return NULL ; } +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) +dev_info (dev,"%s%d registered\n" , ttydrv_name, i); +return tty_driver; }
Quoted 7 lines
drivers/net/ethernet/intel/ice/ice_gnss.c void ice_gnss_init(struct ice_pf *pf) · line 508
Quoted 5 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-0@@ -327,17 +505,25 @@ void ice_gnss_init(struct ice_pf *pf)*/ void ice_gnss_exit (struct ice_pf *pf) { +u32 i;Ditto.
Done.
Quoted 53 lines
Quoted 53 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +13
-6+if (!test_bit (ICE_FLAG_GNSS , pf->flags) || !pf->ice_gnss_tty_driver)return ; -tty_port_destroy (&pf->gnss_tty_port); +for (i =0 ; i <ICE_GNSS_TTY_MINOR_DEVICES ; i++) { +if (pf->gnss_tty_port[i]) { +tty_port_destroy (pf->gnss_tty_port[i]); +kfree (pf->gnss_tty_port[i]); + } -if (pf->gnss_serial) { -struct gnss_serial *gnss = pf->gnss_serial; +if (pf->gnss_serial[i]) { +struct gnss_serial *gnss = pf->gnss_serial[i]; -kthread_cancel_delayed_work_sync (&gnss->read_work); -kfree (gnss); - pf->gnss_serial =NULL ; +kthread_cancel_work_sync (&gnss->write_work); +kthread_cancel_delayed_work_sync (&gnss->read_work); +kfree (gnss); + pf->gnss_serial[i] =NULL ; + } }tty_unregister_driver (pf->ice_gnss_tty_driver);drivers/net/ethernet/intel/ice/ice_gnss.h +11
-2@@ -8,14 +8,31 @@#include <linux/tty_flip.h> #define ICE_E810T_GNSS_I2C_BUS 0x2 +#define ICE_GNSS_TIMER_DELAY_TIME (HZ / 10)/* 0.1 second per message */ +#define ICE_GNSS_TTY_MINOR_DEVICES 2 +#define ICE_GNSS_TTY_WRITE_BUF 250 +#define ICE_MAX_I2C_DATA_SIZE FIELD_MAX(ICE_AQC_I2C_DATA_SIZE_M) +#define ICE_MAX_I2C_WRITE_BYTES 4 + +/* ublox specific deifinitions */ #define ICE_GNSS_UBX_I2C_BUS_ADDR 0x42/* Data length register is big endian */ #define ICE_GNSS_UBX_DATA_LEN_H 0xFD#define ICE_GNSS_UBX_DATA_LEN_WIDTH 2#define ICE_GNSS_UBX_EMPTY_DATA 0xFF -#define ICE_GNSS_TIMER_DELAY_TIME (HZ / 10)/* 0.1 second per message */ -#define ICE_MAX_I2C_DATA_SIZE FIELD_MAX(ICE_AQC_I2C_DATA_SIZE_M) +/* For ublox writes are performed without address so the first byte to write is +* passed as I2C addr parameter. +*/ +#define ICE_GNSS_UBX_WRITE_BYTES (ICE_MAX_I2C_WRITE_BYTES + 1)
Quoted 8 lines
drivers/net/ethernet/intel/ice/ice_gnss.h line 32
Quoted 6 lines
drivers/net/ethernet/intel/ice/ice_gnss.h +5
-0#define ICE_MAX_UBX_READ_TRIES 255 +#define ICE_MAX_UBX_ACK_READ_TRIES 4095 + +struct gnss_write_buf { +struct list_head queue; +u32 size;Use native types.
Done.
Kind regards,
Karol
---------------------------------------------------------------------
Intel Technology Poland sp. z o.o.
ul. Slowackiego 173, 80-298 Gdansk
KRS 101882
NIP 957-07-52-316
PATCH 1/3 ice: remove u16 arithmetic in ice_gnss
In reply to Karol KolacinskiDear Karol,
Am 15.04.22 um 12:31 schrieb Karol Kolacinski:
Quoted 1 line
Change u16 to u32 where arithmetic occured.
occur*r*e*s*
Why does 16-bit width not work?
Kind regards,
Paul
Quoted 10 lines
Signed-off-by Karol Kolacinski <[email protected]>--- drivers/net/ethernet/intel/ice/ice_gnss.c | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-)drivers/net/ethernet/intel/ice/ice_gnss.c +0
-0
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_read(struct kthread_work *work) · line 26
Quoted 5 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-1@@ -23,7 +23,7 @@ static void ice_gnss_read(struct kthread_work *work)struct ice_hw *hw;__be16 data_len_b;char *buf =NULL ; -u16 i, data_len; +u32 i, data_len;
Why does the length need to be specified at all, and no native types can be used?
Kind regards,
Paul
Quoted 21 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +2
-2int err =0 ; pf = gnss->back;@@ -65,7 +65,7 @@ static void ice_gnss_read(struct kthread_work *work)mdelay (10 ); } - data_len =min (data_len, (u16 )PAGE_SIZE ); + data_len =min_t (typeof (data_len), data_len,PAGE_SIZE ); data_len =tty_buffer_request_room (port, data_len);if (!data_len) { err = -ENOMEM ;@@ -74,7 +74,7 @@ static void ice_gnss_read(struct kthread_work *work)/* Read received data */ for (i =0 ; i < data_len; i += bytes_read) { -u16 bytes_left = data_len - i; +u32 bytes_left = data_len - i; bytes_read =min_t (typeof (bytes_left), bytes_left,ICE_MAX_I2C_DATA_SIZE );
Kolacinski
PATCH 1/3 ice: remove u16 arithmetic in ice_gnss
Dear Paul,
Thank you for your review.
Quoted 5 lines · Paul Menzel
Quoted 1 line
Change u16 to u32 where arithmetic occured.
occur*r*e*s*
Why does 16-bit width not work?
In the previous GNSS patch review, David Laight wrote that I should not do arithmetic on anything smaller than 'int'.
Quoted 6 lines
Quoted 6 lines
Signed-off-by Karol Kolacinski <[email protected]>---
??drivers/net/ethernet/intel/ice/ice_gnss.c| 6 +++--- ?? 1 file changed, 3 insertions(+), 3 deletions(-)
Quoted 13 lines
drivers/net/ethernet/intel/ice/ice_gnss.c static void ice_gnss_read(struct kthread_work *work) · line 26
Quoted 10 lines
drivers/net/ethernet/intel/ice/ice_gnss.c +1
-1@@ -23,7 +23,7 @@ static void ice_gnss_read(struct kthread_work *work) ??????? struct ice_hw *hw; ??????? __be16 data_len_b; ??????? char *buf = NULL; -???? u16 i, data_len; +???? u32 i, data_len;Why does the length need to be specified at all, and no native types can be used?
I changed it to use native type. Length of the buffer is read from the device and then used in a read loop.
Kind regards,
Karol
---------------------------------------------------------------------
Intel Technology Poland sp. z o.o.
ul. Slowackiego 173, 80-298 Gdansk
KRS 101882
NIP 957-07-52-316