Message ID | 20141211214308.3753.25865.stgit@notabene.brown (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
On 11 December 2014 at 22:43, NeilBrown <neilb@suse.de> wrote: > Using the common code removes some code duplication, and > makes it easier to switch to using mmc_of_parse() which > will remove more duplication. > > As hsmmc has a slightly different interrupt service routine > for card-detect, enhance slot-gpio to allow an alternate > routine to be provided. > > Signed-off-by: NeilBrown <neilb@suse.de> > --- > drivers/mmc/core/slot-gpio.c | 24 ++++++++++++++- > drivers/mmc/host/omap_hsmmc.c | 67 +++++++++-------------------------------- > include/linux/mmc/slot-gpio.h | 2 + > 3 files changed, 39 insertions(+), 54 deletions(-) I like the looks of this patch, still I want the mmc core parts to be separated into it's own patch. Can you please split this up. Kind regards Uffe > > diff --git a/drivers/mmc/core/slot-gpio.c b/drivers/mmc/core/slot-gpio.c > index 69bbf2adb329..f56323f5a996 100644 > --- a/drivers/mmc/core/slot-gpio.c > +++ b/drivers/mmc/core/slot-gpio.c > @@ -23,6 +23,7 @@ struct mmc_gpio { > struct gpio_desc *cd_gpio; > bool override_ro_active_level; > bool override_cd_active_level; > + irqreturn_t (*cd_gpio_isr)(int irq, void *dev_id); > char *ro_label; > char cd_label[0]; > }; > @@ -156,8 +157,10 @@ void mmc_gpiod_request_cd_irq(struct mmc_host *host) > irq = -EINVAL; > > if (irq >= 0) { > + if (ctx->cd_gpio_isr == NULL) > + ctx->cd_gpio_isr = mmc_gpio_cd_irqt; > ret = devm_request_threaded_irq(&host->class_dev, irq, > - NULL, mmc_gpio_cd_irqt, > + NULL, ctx->cd_gpio_isr, > IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, > ctx->cd_label, host); > if (ret < 0) > @@ -171,6 +174,25 @@ void mmc_gpiod_request_cd_irq(struct mmc_host *host) > } > EXPORT_SYMBOL(mmc_gpiod_request_cd_irq); > > +/* Register an alternate interrupt service routine for > + * the card-detect GPIO. > + */ > +int mmc_gpio_request_cd_isr(struct mmc_host *host, > + irqreturn_t (*isr)(int irq, void *dev_id)) > +{ > + struct mmc_gpio *ctx; > + int ret; > + > + ret = mmc_gpio_alloc(host); > + if (ret < 0) > + return ret; > + ctx = host->slot.handler_priv; > + if (ctx->cd_gpio_isr) > + return -EBUSY; > + ctx->cd_gpio_isr = isr; > + return 0; > +} > + > /** > * mmc_gpio_request_cd - request a gpio for card-detection > * @host: mmc host > diff --git a/drivers/mmc/host/omap_hsmmc.c b/drivers/mmc/host/omap_hsmmc.c > index 537cba8f1de1..32514b648e3c 100644 > --- a/drivers/mmc/host/omap_hsmmc.c > +++ b/drivers/mmc/host/omap_hsmmc.c > @@ -36,6 +36,7 @@ > #include <linux/mmc/host.h> > #include <linux/mmc/core.h> > #include <linux/mmc/mmc.h> > +#include <linux/mmc/slot-gpio.h> > #include <linux/io.h> > #include <linux/irq.h> > #include <linux/gpio.h> > @@ -251,28 +252,22 @@ static void omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host); > static int omap_hsmmc_card_detect(struct device *dev) > { > struct omap_hsmmc_host *host = dev_get_drvdata(dev); > - struct omap_hsmmc_platform_data *mmc = host->pdata; > > - /* NOTE: assumes card detect signal is active-low */ > - return !gpio_get_value_cansleep(mmc->switch_pin); > + return mmc_gpio_get_cd(host->mmc); > } > > static int omap_hsmmc_get_wp(struct device *dev) > { > struct omap_hsmmc_host *host = dev_get_drvdata(dev); > - struct omap_hsmmc_platform_data *mmc = host->pdata; > > - /* NOTE: assumes write protect signal is active-high */ > - return gpio_get_value_cansleep(mmc->gpio_wp); > + return mmc_gpio_get_ro(host->mmc); > } > > static int omap_hsmmc_get_cover_state(struct device *dev) > { > struct omap_hsmmc_host *host = dev_get_drvdata(dev); > - struct omap_hsmmc_platform_data *mmc = host->pdata; > > - /* NOTE: assumes card detect signal is active-low */ > - return !gpio_get_value_cansleep(mmc->switch_pin); > + return mmc_gpio_get_cd(host->mmc); > } > > #ifdef CONFIG_REGULATOR > @@ -439,7 +434,10 @@ static inline int omap_hsmmc_have_reg(void) > > #endif > > -static int omap_hsmmc_gpio_init(struct omap_hsmmc_host *host, > +static irqreturn_t omap_hsmmc_detect(int irq, void *dev_id); > + > +static int omap_hsmmc_gpio_init(struct mmc_host *mmc, > + struct omap_hsmmc_host *host, > struct omap_hsmmc_platform_data *pdata) > { > int ret; > @@ -452,46 +450,26 @@ static int omap_hsmmc_gpio_init(struct omap_hsmmc_host *host, > host->card_detect = omap_hsmmc_card_detect; > host->card_detect_irq = > gpio_to_irq(pdata->switch_pin); > - ret = gpio_request(pdata->switch_pin, "mmc_cd"); > + ret = mmc_gpio_request_cd_isr(mmc, omap_hsmmc_detect); > if (ret) > return ret; > - ret = gpio_direction_input(pdata->switch_pin); > + ret = mmc_gpio_request_cd(mmc, pdata->switch_pin, 0); > if (ret) > - goto err_free_sp; > + return ret; > } else { > pdata->switch_pin = -EINVAL; > } > > if (gpio_is_valid(pdata->gpio_wp)) { > host->get_ro = omap_hsmmc_get_wp; > - ret = gpio_request(pdata->gpio_wp, "mmc_wp"); > - if (ret) > - goto err_free_cd; > - ret = gpio_direction_input(pdata->gpio_wp); > + ret = mmc_gpio_request_ro(mmc, pdata->gpio_wp); > if (ret) > - goto err_free_wp; > + return ret; > } else { > pdata->gpio_wp = -EINVAL; > } > > return 0; > - > -err_free_wp: > - gpio_free(pdata->gpio_wp); > -err_free_cd: > - if (gpio_is_valid(pdata->switch_pin)) > -err_free_sp: > - gpio_free(pdata->switch_pin); > - return ret; > -} > - > -static void omap_hsmmc_gpio_free(struct omap_hsmmc_host *host, > - struct omap_hsmmc_platform_data *pdata) > -{ > - if (gpio_is_valid(pdata->gpio_wp)) > - gpio_free(pdata->gpio_wp); > - if (gpio_is_valid(pdata->switch_pin)) > - gpio_free(pdata->switch_pin); > } > > /* > @@ -2066,7 +2044,7 @@ static int omap_hsmmc_probe(struct platform_device *pdev) > host->next_data.cookie = 1; > host->pbias_enabled = 0; > > - ret = omap_hsmmc_gpio_init(host, pdata); > + ret = omap_hsmmc_gpio_init(mmc, host, pdata); > if (ret) > goto err_gpio; > > @@ -2197,20 +2175,6 @@ static int omap_hsmmc_probe(struct platform_device *pdev) > > mmc->ocr_avail = mmc_pdata(host)->ocr_mask; > > - /* Request IRQ for card detect */ > - if (host->card_detect_irq) { > - ret = devm_request_threaded_irq(&pdev->dev, > - host->card_detect_irq, > - NULL, omap_hsmmc_detect, > - IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, > - mmc_hostname(mmc), host); > - if (ret) { > - dev_err(mmc_dev(host->mmc), > - "Unable to grab MMC CD IRQ\n"); > - goto err_irq_cd; > - } > - } > - > omap_hsmmc_disable_irq(host); > > /* > @@ -2249,7 +2213,6 @@ static int omap_hsmmc_probe(struct platform_device *pdev) > > err_slot_name: > mmc_remove_host(mmc); > -err_irq_cd: > if (host->use_reg) > omap_hsmmc_reg_put(host); > err_irq: > @@ -2262,7 +2225,6 @@ err_irq: > if (host->dbclk) > clk_disable_unprepare(host->dbclk); > err1: > - omap_hsmmc_gpio_free(host, pdata); > err_gpio: > mmc_free_host(mmc); > err: > @@ -2288,7 +2250,6 @@ static int omap_hsmmc_remove(struct platform_device *pdev) > if (host->dbclk) > clk_disable_unprepare(host->dbclk); > > - omap_hsmmc_gpio_free(host, host->pdata); > mmc_free_host(host->mmc); > > return 0; > diff --git a/include/linux/mmc/slot-gpio.h b/include/linux/mmc/slot-gpio.h > index e56fa24c9322..9e55db60deb0 100644 > --- a/include/linux/mmc/slot-gpio.h > +++ b/include/linux/mmc/slot-gpio.h > @@ -28,6 +28,8 @@ int mmc_gpiod_request_cd(struct mmc_host *host, const char *con_id, > int mmc_gpiod_request_ro(struct mmc_host *host, const char *con_id, > unsigned int idx, bool override_active_level, > unsigned int debounce, bool *gpio_invert); > +int mmc_gpio_request_cd_isr(struct mmc_host *host, > + irqreturn_t (*isr)(int irq, void *dev_id)); > void mmc_gpiod_free_cd(struct mmc_host *host); > void mmc_gpiod_request_cd_irq(struct mmc_host *host); > > > -- To unsubscribe from this list: send the line "unsubscribe linux-omap" in the body of a message to majordomo@vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html
diff --git a/drivers/mmc/core/slot-gpio.c b/drivers/mmc/core/slot-gpio.c index 69bbf2adb329..f56323f5a996 100644 --- a/drivers/mmc/core/slot-gpio.c +++ b/drivers/mmc/core/slot-gpio.c @@ -23,6 +23,7 @@ struct mmc_gpio { struct gpio_desc *cd_gpio; bool override_ro_active_level; bool override_cd_active_level; + irqreturn_t (*cd_gpio_isr)(int irq, void *dev_id); char *ro_label; char cd_label[0]; }; @@ -156,8 +157,10 @@ void mmc_gpiod_request_cd_irq(struct mmc_host *host) irq = -EINVAL; if (irq >= 0) { + if (ctx->cd_gpio_isr == NULL) + ctx->cd_gpio_isr = mmc_gpio_cd_irqt; ret = devm_request_threaded_irq(&host->class_dev, irq, - NULL, mmc_gpio_cd_irqt, + NULL, ctx->cd_gpio_isr, IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, ctx->cd_label, host); if (ret < 0) @@ -171,6 +174,25 @@ void mmc_gpiod_request_cd_irq(struct mmc_host *host) } EXPORT_SYMBOL(mmc_gpiod_request_cd_irq); +/* Register an alternate interrupt service routine for + * the card-detect GPIO. + */ +int mmc_gpio_request_cd_isr(struct mmc_host *host, + irqreturn_t (*isr)(int irq, void *dev_id)) +{ + struct mmc_gpio *ctx; + int ret; + + ret = mmc_gpio_alloc(host); + if (ret < 0) + return ret; + ctx = host->slot.handler_priv; + if (ctx->cd_gpio_isr) + return -EBUSY; + ctx->cd_gpio_isr = isr; + return 0; +} + /** * mmc_gpio_request_cd - request a gpio for card-detection * @host: mmc host diff --git a/drivers/mmc/host/omap_hsmmc.c b/drivers/mmc/host/omap_hsmmc.c index 537cba8f1de1..32514b648e3c 100644 --- a/drivers/mmc/host/omap_hsmmc.c +++ b/drivers/mmc/host/omap_hsmmc.c @@ -36,6 +36,7 @@ #include <linux/mmc/host.h> #include <linux/mmc/core.h> #include <linux/mmc/mmc.h> +#include <linux/mmc/slot-gpio.h> #include <linux/io.h> #include <linux/irq.h> #include <linux/gpio.h> @@ -251,28 +252,22 @@ static void omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host); static int omap_hsmmc_card_detect(struct device *dev) { struct omap_hsmmc_host *host = dev_get_drvdata(dev); - struct omap_hsmmc_platform_data *mmc = host->pdata; - /* NOTE: assumes card detect signal is active-low */ - return !gpio_get_value_cansleep(mmc->switch_pin); + return mmc_gpio_get_cd(host->mmc); } static int omap_hsmmc_get_wp(struct device *dev) { struct omap_hsmmc_host *host = dev_get_drvdata(dev); - struct omap_hsmmc_platform_data *mmc = host->pdata; - /* NOTE: assumes write protect signal is active-high */ - return gpio_get_value_cansleep(mmc->gpio_wp); + return mmc_gpio_get_ro(host->mmc); } static int omap_hsmmc_get_cover_state(struct device *dev) { struct omap_hsmmc_host *host = dev_get_drvdata(dev); - struct omap_hsmmc_platform_data *mmc = host->pdata; - /* NOTE: assumes card detect signal is active-low */ - return !gpio_get_value_cansleep(mmc->switch_pin); + return mmc_gpio_get_cd(host->mmc); } #ifdef CONFIG_REGULATOR @@ -439,7 +434,10 @@ static inline int omap_hsmmc_have_reg(void) #endif -static int omap_hsmmc_gpio_init(struct omap_hsmmc_host *host, +static irqreturn_t omap_hsmmc_detect(int irq, void *dev_id); + +static int omap_hsmmc_gpio_init(struct mmc_host *mmc, + struct omap_hsmmc_host *host, struct omap_hsmmc_platform_data *pdata) { int ret; @@ -452,46 +450,26 @@ static int omap_hsmmc_gpio_init(struct omap_hsmmc_host *host, host->card_detect = omap_hsmmc_card_detect; host->card_detect_irq = gpio_to_irq(pdata->switch_pin); - ret = gpio_request(pdata->switch_pin, "mmc_cd"); + ret = mmc_gpio_request_cd_isr(mmc, omap_hsmmc_detect); if (ret) return ret; - ret = gpio_direction_input(pdata->switch_pin); + ret = mmc_gpio_request_cd(mmc, pdata->switch_pin, 0); if (ret) - goto err_free_sp; + return ret; } else { pdata->switch_pin = -EINVAL; } if (gpio_is_valid(pdata->gpio_wp)) { host->get_ro = omap_hsmmc_get_wp; - ret = gpio_request(pdata->gpio_wp, "mmc_wp"); - if (ret) - goto err_free_cd; - ret = gpio_direction_input(pdata->gpio_wp); + ret = mmc_gpio_request_ro(mmc, pdata->gpio_wp); if (ret) - goto err_free_wp; + return ret; } else { pdata->gpio_wp = -EINVAL; } return 0; - -err_free_wp: - gpio_free(pdata->gpio_wp); -err_free_cd: - if (gpio_is_valid(pdata->switch_pin)) -err_free_sp: - gpio_free(pdata->switch_pin); - return ret; -} - -static void omap_hsmmc_gpio_free(struct omap_hsmmc_host *host, - struct omap_hsmmc_platform_data *pdata) -{ - if (gpio_is_valid(pdata->gpio_wp)) - gpio_free(pdata->gpio_wp); - if (gpio_is_valid(pdata->switch_pin)) - gpio_free(pdata->switch_pin); } /* @@ -2066,7 +2044,7 @@ static int omap_hsmmc_probe(struct platform_device *pdev) host->next_data.cookie = 1; host->pbias_enabled = 0; - ret = omap_hsmmc_gpio_init(host, pdata); + ret = omap_hsmmc_gpio_init(mmc, host, pdata); if (ret) goto err_gpio; @@ -2197,20 +2175,6 @@ static int omap_hsmmc_probe(struct platform_device *pdev) mmc->ocr_avail = mmc_pdata(host)->ocr_mask; - /* Request IRQ for card detect */ - if (host->card_detect_irq) { - ret = devm_request_threaded_irq(&pdev->dev, - host->card_detect_irq, - NULL, omap_hsmmc_detect, - IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, - mmc_hostname(mmc), host); - if (ret) { - dev_err(mmc_dev(host->mmc), - "Unable to grab MMC CD IRQ\n"); - goto err_irq_cd; - } - } - omap_hsmmc_disable_irq(host); /* @@ -2249,7 +2213,6 @@ static int omap_hsmmc_probe(struct platform_device *pdev) err_slot_name: mmc_remove_host(mmc); -err_irq_cd: if (host->use_reg) omap_hsmmc_reg_put(host); err_irq: @@ -2262,7 +2225,6 @@ err_irq: if (host->dbclk) clk_disable_unprepare(host->dbclk); err1: - omap_hsmmc_gpio_free(host, pdata); err_gpio: mmc_free_host(mmc); err: @@ -2288,7 +2250,6 @@ static int omap_hsmmc_remove(struct platform_device *pdev) if (host->dbclk) clk_disable_unprepare(host->dbclk); - omap_hsmmc_gpio_free(host, host->pdata); mmc_free_host(host->mmc); return 0; diff --git a/include/linux/mmc/slot-gpio.h b/include/linux/mmc/slot-gpio.h index e56fa24c9322..9e55db60deb0 100644 --- a/include/linux/mmc/slot-gpio.h +++ b/include/linux/mmc/slot-gpio.h @@ -28,6 +28,8 @@ int mmc_gpiod_request_cd(struct mmc_host *host, const char *con_id, int mmc_gpiod_request_ro(struct mmc_host *host, const char *con_id, unsigned int idx, bool override_active_level, unsigned int debounce, bool *gpio_invert); +int mmc_gpio_request_cd_isr(struct mmc_host *host, + irqreturn_t (*isr)(int irq, void *dev_id)); void mmc_gpiod_free_cd(struct mmc_host *host); void mmc_gpiod_request_cd_irq(struct mmc_host *host);
Using the common code removes some code duplication, and makes it easier to switch to using mmc_of_parse() which will remove more duplication. As hsmmc has a slightly different interrupt service routine for card-detect, enhance slot-gpio to allow an alternate routine to be provided. Signed-off-by: NeilBrown <neilb@suse.de> --- drivers/mmc/core/slot-gpio.c | 24 ++++++++++++++- drivers/mmc/host/omap_hsmmc.c | 67 +++++++++-------------------------------- include/linux/mmc/slot-gpio.h | 2 + 3 files changed, 39 insertions(+), 54 deletions(-) -- To unsubscribe from this list: send the line "unsubscribe linux-omap" in the body of a message to majordomo@vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html