fsi: Disable link when slave init fails
Subsystems (2)
Eddie James
maintainerv2 cover fsi: Disable link when slave init fails
This series modifies the link_enable function to accept a boolean parameter to indicate whether to enable or disable the link. Then, it disables the link when initialization of the slave fails or if there is no slave on the link.
Changes since v1:
- Drop the change to remove the read-back after link enable
- Rework the layout of the boolean handling.
- Add some detail to commit messages.
Eddie James (2):
fsi: master: Add boolean parameter to link_enable function
fsi: core: Disable link when slave init fails
drivers/fsi/fsi-core.c | 15 +++++++++++++-- drivers/fsi/fsi-master-aspeed.c | 7 ++++++- drivers/fsi/fsi-master-ast-cf.c | 5 +++-- drivers/fsi/fsi-master-gpio.c | 5 +++-- drivers/fsi/fsi-master-hub.c | 7 ++++++- drivers/fsi/fsi-master.h | 3 ++- 6 files changed, 33 insertions(+), 9 deletions(-)
Signature · 1 line
2.24.0
Eddie James
maintainerPATCH v2 1/2 fsi: master: Add boolean parameter to link_enable function
Add the ability to disable a link with a boolean parameter to the link_enable function. This is necessary so that the master can disable links that it isn't using; for example, links to slaves that fail initialization.
--- drivers/fsi/fsi-core.c | 2 +- drivers/fsi/fsi-master-aspeed.c | 7 ++++++- drivers/fsi/fsi-master-ast-cf.c | 5 +++-- drivers/fsi/fsi-master-gpio.c | 5 +++-- drivers/fsi/fsi-master-hub.c | 7 ++++++- drivers/fsi/fsi-master.h | 3 ++- 6 files changed, 21 insertions(+), 8 deletions(-)
drivers/fsi/fsi-core.c +1 -1
@@ -1157,7 +1157,7 @@ static int fsi_master_write(struct fsi_master *master, int link,static int fsi_master_link_enable (struct fsi_master *master,int link) {if (master->link_enable) -return master->link_enable (master, link); +return master->link_enable (master, link, true);return 0 ; }
drivers/fsi/fsi-master-aspeed.c +6 -1
@@ -307,7 +307,8 @@ static int aspeed_master_write(struct fsi_master *master, int link,return 0 ; } -static int aspeed_master_link_enable (struct fsi_master *master,int link) +static int aspeed_master_link_enable (struct fsi_master *master,int link, +bool enable) {struct fsi_master_aspeed *aspeed =to_fsi_master_aspeed (master);int idx, bit, ret;
@@ -318,6 +319,10 @@ static int aspeed_master_link_enable(struct fsi_master *master, int link) reg =cpu_to_be32 (0x80000000 >> bit); +if (!enable) +return opb_writel (aspeed, ctrl_base +FSI_MCENP0 + (4 * idx), + reg); + ret =opb_writel (aspeed, ctrl_base +FSI_MSENP0 + (4 * idx), reg);if (ret)return ret;
drivers/fsi/fsi-master-ast-cf.c +3 -2
@@ -1039,7 +1039,8 @@ static void fsi_master_acf_setup_external(struct fsi_master_acf *master)gpiod_direction_input (master->gpio_data); } -static int fsi_master_acf_link_enable (struct fsi_master *_master,int link) +static int fsi_master_acf_link_enable (struct fsi_master *_master,int link, +bool enable) {struct fsi_master_acf *master =to_fsi_master_acf (_master);int rc = -EBUSY ;
@@ -1049,7 +1050,7 @@ static int fsi_master_acf_link_enable(struct fsi_master *_master, int link)mutex_lock (&master->lock);if (!master->external_mode) { -gpiod_set_value (master->gpio_enable,1 ); +gpiod_set_value (master->gpio_enable, enable ?1 :0 ); rc =0 ; }mutex_unlock (&master->lock);
drivers/fsi/fsi-master-gpio.c +3 -2
@@ -678,7 +678,8 @@ static void fsi_master_gpio_init_external(struct fsi_master_gpio *master)gpiod_direction_input (master->gpio_data); } -static int fsi_master_gpio_link_enable (struct fsi_master *_master,int link) +static int fsi_master_gpio_link_enable (struct fsi_master *_master,int link, +bool enable) {struct fsi_master_gpio *master =to_fsi_master_gpio (_master);int rc = -EBUSY ;
@@ -688,7 +689,7 @@ static int fsi_master_gpio_link_enable(struct fsi_master *_master, int link)mutex_lock (&master->cmd_lock);if (!master->external_mode) { -gpiod_set_value (master->gpio_enable,1 ); +gpiod_set_value (master->gpio_enable, enable ?1 :0 ); rc =0 ; }mutex_unlock (&master->cmd_lock);
drivers/fsi/fsi-master-hub.c +6 -1
@@ -77,7 +77,8 @@ static int hub_master_break(struct fsi_master *master, int link)return hub_master_write (master, link,0 , addr, &cmd,sizeof (cmd)); } -static int hub_master_link_enable (struct fsi_master *master,int link) +static int hub_master_link_enable (struct fsi_master *master,int link, +bool enable) {struct fsi_master_hub *hub =to_fsi_master_hub (master);int idx, bit;
@@ -89,6 +90,10 @@ static int hub_master_link_enable(struct fsi_master *master, int link) reg =cpu_to_be32 (0x80000000 >> bit); +if (!enable) +return fsi_device_write (hub->upstream,FSI_MCENP0 + (4 * idx), + ®,4 ); + rc =fsi_device_write (hub->upstream,FSI_MSENP0 + (4 * idx), ®,4 );mdelay (FSI_LINK_ENABLE_SETUP_TIME );
drivers/fsi/fsi-master.h +2 -1
@@ -130,7 +130,8 @@ struct fsi_master { uint32_t addr, const void *val, size_t size);int (*term)(struct fsi_master *,int link,uint8_t id);int (*send_break)(struct fsi_master *,int link); -int (*link_enable)(struct fsi_master *,int link); +int (*link_enable)(struct fsi_master *,int link, +bool enable);int (*link_config)(struct fsi_master *,int link,u8 t_send_delay,u8 t_echo_delay); };
Signature · 1 line
2.24.0
Eddie James
maintainerPATCH v2 2/2 fsi: core: Disable link when slave init fails
In reply to Eddie JamesIn the case that links don't have slaves or fail to be accessed, the master should disable the link during the scan since it won't be using the slave.
--- drivers/fsi/fsi-core.c | 13 ++++++++++++- 1 file changed, 12 insertions(+), 1 deletion(-)
drivers/fsi/fsi-core.c +12 -1
@@ -1154,6 +1154,14 @@ static int fsi_master_write(struct fsi_master *master, int link,return rc; } +static int fsi_master_link_disable (struct fsi_master *master,int link) +{ +if (master->link_enable) +return master->link_enable (master, link, false); + +return 0 ; +} +static int fsi_master_link_enable (struct fsi_master *master,int link) {if (master->link_enable)
@@ -1192,12 +1200,15 @@ static int fsi_master_scan(struct fsi_master *master) } rc =fsi_master_break (master, link);if (rc) { +fsi_master_link_disable (master, link);dev_dbg (&master->dev,"break to link %d failed: %d\n" , link, rc);continue ; } -fsi_slave_init (master, link,0 ); + rc =fsi_slave_init (master, link,0 ); +if (rc) +fsi_master_link_disable (master, link); }return 0 ;
Signature · 1 line
2.24.0