On 08/31/2013 01:32 PM, edubezval@xxxxxxxxx wrote: > On Fri, Aug 30, 2013 at 7:28 AM, Dinesh Ram <dinram@xxxxxxxxx> wrote: >> Checks have been introduced at several places in the code to test if an interrupt is set or not. >> For devices which do not use the interrupt, to get a valid response, within a specified timeout, >> the device is polled instead. >> >> Signed-off-by: Dinesh Ram <dinram@xxxxxxxxx> >> --- >> drivers/media/radio/si4713/si4713.c | 110 ++++++++++++++++++++---------------- >> drivers/media/radio/si4713/si4713.h | 1 + >> 2 files changed, 63 insertions(+), 48 deletions(-) >> >> diff --git a/drivers/media/radio/si4713/si4713.c b/drivers/media/radio/si4713/si4713.c >> index ac727e3..55c4d27 100644 >> --- a/drivers/media/radio/si4713/si4713.c >> +++ b/drivers/media/radio/si4713/si4713.c >> @@ -27,7 +27,6 @@ >> #include <linux/i2c.h> >> #include <linux/slab.h> >> #include <linux/gpio.h> >> -#include <linux/regulator/consumer.h> >> #include <linux/module.h> >> #include <media/v4l2-device.h> >> #include <media/v4l2-ioctl.h> >> @@ -213,6 +212,7 @@ static int si4713_send_command(struct si4713_device *sdev, const u8 command, >> u8 response[], const int respn, const int usecs) >> { >> struct i2c_client *client = v4l2_get_subdevdata(&sdev->sd); >> + unsigned long until_jiffies; >> u8 data1[MAX_ARGS + 1]; >> int err; >> >> @@ -228,30 +228,39 @@ static int si4713_send_command(struct si4713_device *sdev, const u8 command, >> if (err != argn + 1) { >> v4l2_err(&sdev->sd, "Error while sending command 0x%02x\n", >> command); >> - return (err > 0) ? -EIO : err; >> + return err < 0 ? err : -EIO; >> } >> >> + until_jiffies = jiffies + usecs_to_jiffies(usecs) + 1; >> + >> /* Wait response from interrupt */ >> - if (!wait_for_completion_timeout(&sdev->work, >> + if (client->irq) { >> + if (!wait_for_completion_timeout(&sdev->work, >> usecs_to_jiffies(usecs) + 1)) >> - v4l2_warn(&sdev->sd, >> + v4l2_warn(&sdev->sd, >> "(%s) Device took too much time to answer.\n", >> __func__); >> - >> - /* Then get the response */ >> - err = i2c_master_recv(client, response, respn); >> - if (err != respn) { >> - v4l2_err(&sdev->sd, >> - "Error while reading response for command 0x%02x\n", >> - command); >> - return (err > 0) ? -EIO : err; >> } >> >> - DBG_BUFFER(&sdev->sd, "Response", response, respn); >> - if (check_command_failed(response[0])) >> - return -EBUSY; >> + do { >> + err = i2c_master_recv(client, response, respn); >> + if (err != respn) { >> + v4l2_err(&sdev->sd, >> + "Error %d while reading response for command 0x%02x\n", >> + err, command); >> + return err < 0 ? err : -EIO; >> + } >> >> - return 0; >> + DBG_BUFFER(&sdev->sd, "Response", response, respn); >> + if (!check_command_failed(response[0])) >> + return 0; >> + >> + if (client->irq) >> + return -EBUSY; >> + msleep(1); >> + } while (jiffies <= until_jiffies); >> + >> + return -EBUSY; >> } >> >> /* >> @@ -344,14 +353,15 @@ static int si4713_write_property(struct si4713_device *sdev, u16 prop, u16 val) >> */ >> static int si4713_powerup(struct si4713_device *sdev) >> { >> + struct i2c_client *client = v4l2_get_subdevdata(&sdev->sd); >> int err; >> u8 resp[SI4713_PWUP_NRESP]; >> /* >> * .First byte = Enabled interrupts and boot function >> * .Second byte = Input operation mode >> */ >> - const u8 args[SI4713_PWUP_NARGS] = { >> - SI4713_PWUP_CTSIEN | SI4713_PWUP_GPO2OEN | SI4713_PWUP_FUNC_TX, >> + u8 args[SI4713_PWUP_NARGS] = { >> + SI4713_PWUP_GPO2OEN | SI4713_PWUP_FUNC_TX, >> SI4713_PWUP_OPMOD_ANALOG, >> }; >> >> @@ -369,18 +379,22 @@ static int si4713_powerup(struct si4713_device *sdev) >> gpio_set_value(sdev->gpio_reset, 1); >> } >> >> + if (client->irq) >> + args[0] |= SI4713_PWUP_CTSIEN; >> + >> err = si4713_send_command(sdev, SI4713_CMD_POWER_UP, >> args, ARRAY_SIZE(args), >> resp, ARRAY_SIZE(resp), >> TIMEOUT_POWER_UP); >> - >> + >> if (!err) { >> v4l2_dbg(1, debug, &sdev->sd, "Powerup response: 0x%02x\n", >> resp[0]); >> v4l2_dbg(1, debug, &sdev->sd, "Device in power up mode\n"); >> sdev->power_state = POWER_ON; >> >> - err = si4713_write_property(sdev, SI4713_GPO_IEN, >> + if (client->irq) >> + err = si4713_write_property(sdev, SI4713_GPO_IEN, >> SI4713_STC_INT | SI4713_CTS); >> } else { >> if (gpio_is_valid(sdev->gpio_reset)) >> @@ -447,7 +461,7 @@ static int si4713_checkrev(struct si4713_device *sdev) >> if (rval < 0) >> return rval; >> >> - if (resp[1] == SI4713_PRODUCT_NUMBER) { >> + if (resp[1] == SI4713_PRODUCT_NUMBER) { >> v4l2_info(&sdev->sd, "chip found @ 0x%02x (%s)\n", >> client->addr << 1, client->adapter->name); >> } else { >> @@ -465,33 +479,34 @@ static int si4713_checkrev(struct si4713_device *sdev) >> */ >> static int si4713_wait_stc(struct si4713_device *sdev, const int usecs) >> { >> - int err; >> + struct i2c_client *client = v4l2_get_subdevdata(&sdev->sd); >> u8 resp[SI4713_GET_STATUS_NRESP]; >> - >> - /* Wait response from STC interrupt */ >> - if (!wait_for_completion_timeout(&sdev->work, >> - usecs_to_jiffies(usecs) + 1)) >> - v4l2_warn(&sdev->sd, >> - "%s: device took too much time to answer (%d usec).\n", >> - __func__, usecs); >> - >> - /* Clear status bits */ >> - err = si4713_send_command(sdev, SI4713_CMD_GET_INT_STATUS, >> - NULL, 0, >> - resp, ARRAY_SIZE(resp), >> - DEFAULT_TIMEOUT); >> - >> - if (err < 0) >> - goto exit; >> - >> - v4l2_dbg(1, debug, &sdev->sd, >> - "%s: status bits: 0x%02x\n", __func__, resp[0]); >> - >> - if (!(resp[0] & SI4713_STC_INT)) >> - err = -EIO; >> - >> -exit: >> - return err; >> + unsigned long start_jiffies = jiffies; >> + int err; >> + >> + if (client->irq && >> + !wait_for_completion_timeout(&sdev->work, usecs_to_jiffies(usecs) + 1)) >> + v4l2_warn(&sdev->sd, >> + "(%s) Device took too much time to answer.\n", __func__); >> + >> + for (;;) { >> + /* Clear status bits */ >> + err = si4713_send_command(sdev, SI4713_CMD_GET_INT_STATUS, >> + NULL, 0, >> + resp, ARRAY_SIZE(resp), >> + DEFAULT_TIMEOUT); >> + >> + if (err >= 0) { >> + v4l2_dbg(1, debug, &sdev->sd, >> + "%s: status bits: 0x%02x\n", __func__, resp[0]); >> + >> + if (resp[0] & SI4713_STC_INT) >> + return 0; >> + } >> + if (jiffies_to_usecs(jiffies - start_jiffies) > usecs) >> + return -EIO; >> + msleep(3); >> + } >> } >> >> /* >> @@ -1024,7 +1039,6 @@ static int si4713_initialize(struct si4713_device *sdev) >> if (rval < 0) >> return rval; >> >> - >> sdev->frequency = DEFAULT_FREQUENCY; >> sdev->stereo = 1; >> sdev->tune_rnl = DEFAULT_TUNE_RNL; >> diff --git a/drivers/media/radio/si4713/si4713.h b/drivers/media/radio/si4713/si4713.h >> index c274e1f..dc0ce66 100644 >> --- a/drivers/media/radio/si4713/si4713.h >> +++ b/drivers/media/radio/si4713/si4713.h >> @@ -15,6 +15,7 @@ >> #ifndef SI4713_I2C_H >> #define SI4713_I2C_H >> >> +#include <linux/regulator/consumer.h> > > Forgot to ask, why do you need to have regulator/consumer.h in this > header to add polling mode to this driver. The header include was moved from the C-source to the header since the header needs it. This header will also be included by the USB driver and it is silly if the USB driver would have to include consumer.h when the si4713.h should do it. If you want it can be split off to a separate patch. Regards, Hans -- To unsubscribe from this list: send the line "unsubscribe linux-media" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html