input: misc: ixp4-beeper: use gpiolib strictly
Request and free the GPIO line used for the beeper properly. Then use the gpiolib API to flip the output of the GPIO pin instead of relying on hacks to poke the register bits. Cc: Imre Kaloz <kaloz@openwrt.org> Cc: Alexandre Courbot <acourbot@nvidia.com> Acked-by: Dmitry Torokhov <dmitry.torokhov@gmail.com> Acked-by: Arnd Bergmann <arnd@arndb.de> Acked-by: Krzysztof Halasa <khc@pm.waw.pl> Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
Родитель
e9c9fc2315
Коммит
b22973d0ec
|
@ -76,11 +76,13 @@ static int ixp4xx_spkr_event(struct input_dev *dev, unsigned int type, unsigned
|
|||
|
||||
static irqreturn_t ixp4xx_spkr_interrupt(int irq, void *dev_id)
|
||||
{
|
||||
unsigned int pin = (unsigned int) dev_id;
|
||||
|
||||
/* clear interrupt */
|
||||
*IXP4XX_OSST = IXP4XX_OSST_TIMER_2_PEND;
|
||||
|
||||
/* flip the beeper output */
|
||||
*IXP4XX_GPIO_GPOUTR ^= (1 << (unsigned int) dev_id);
|
||||
gpio_set_value(pin, !gpio_get_value(pin));
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
@ -108,11 +110,15 @@ static int ixp4xx_spkr_probe(struct platform_device *dev)
|
|||
input_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE);
|
||||
input_dev->event = ixp4xx_spkr_event;
|
||||
|
||||
err = gpio_request(dev->id, "ixp4-beeper");
|
||||
if (err)
|
||||
goto err_free_device;
|
||||
|
||||
err = request_irq(IRQ_IXP4XX_TIMER2, &ixp4xx_spkr_interrupt,
|
||||
IRQF_NO_SUSPEND, "ixp4xx-beeper",
|
||||
(void *) dev->id);
|
||||
if (err)
|
||||
goto err_free_device;
|
||||
goto err_free_gpio;
|
||||
|
||||
err = input_register_device(input_dev);
|
||||
if (err)
|
||||
|
@ -124,6 +130,8 @@ static int ixp4xx_spkr_probe(struct platform_device *dev)
|
|||
|
||||
err_free_irq:
|
||||
free_irq(IRQ_IXP4XX_TIMER2, (void *)dev->id);
|
||||
err_free_gpio:
|
||||
gpio_free(dev->id);
|
||||
err_free_device:
|
||||
input_free_device(input_dev);
|
||||
|
||||
|
@ -142,6 +150,7 @@ static int ixp4xx_spkr_remove(struct platform_device *dev)
|
|||
ixp4xx_spkr_control(pin, 0);
|
||||
|
||||
free_irq(IRQ_IXP4XX_TIMER2, (void *)dev->id);
|
||||
gpio_free(dev->id);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
Загрузка…
Ссылка в новой задаче