^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * Copyright (C) 2011 Philippe Rétornaz
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Based on twl4030-pwrbutton driver by:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Peter De Schrijver <peter.de-schrijver@nokia.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Felipe Balbi <felipe.balbi@nokia.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * This file is subject to the terms and conditions of the GNU General
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Public License. See the file "COPYING" in the main directory of this
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * archive for more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * This program is distributed in the hope that it will be useful,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * but WITHOUT ANY WARRANTY; without even the implied warranty of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) * GNU General Public License for more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) * You should have received a copy of the GNU General Public License
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) * along with this program; if not, write to the Free Software
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) * Foundation, Inc., 51 Franklin Street, Suite 500, Boston, MA 02110-1335 USA
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/mfd/mc13783.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include <linux/sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct mc13783_pwrb {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) struct input_dev *pwr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) struct mc13xxx *mc13783;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define MC13783_PWRB_B1_POL_INVERT (1 << 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define MC13783_PWRB_B2_POL_INVERT (1 << 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define MC13783_PWRB_B3_POL_INVERT (1 << 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) unsigned short keymap[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define MC13783_REG_INTERRUPT_SENSE_1 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define MC13783_IRQSENSE1_ONOFD1S (1 << 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define MC13783_IRQSENSE1_ONOFD2S (1 << 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define MC13783_IRQSENSE1_ONOFD3S (1 << 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define MC13783_REG_POWER_CONTROL_2 15
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define MC13783_POWER_CONTROL_2_ON1BDBNC 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define MC13783_POWER_CONTROL_2_ON2BDBNC 6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) #define MC13783_POWER_CONTROL_2_ON3BDBNC 8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define MC13783_POWER_CONTROL_2_ON1BRSTEN (1 << 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define MC13783_POWER_CONTROL_2_ON2BRSTEN (1 << 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) #define MC13783_POWER_CONTROL_2_ON3BRSTEN (1 << 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) static irqreturn_t button_irq(int irq, void *_priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct mc13783_pwrb *priv = _priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) int val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) mc13xxx_irq_ack(priv->mc13783, irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) mc13xxx_reg_read(priv->mc13783, MC13783_REG_INTERRUPT_SENSE_1, &val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) switch (irq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) case MC13783_IRQ_ONOFD1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) val = val & MC13783_IRQSENSE1_ONOFD1S ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) if (priv->flags & MC13783_PWRB_B1_POL_INVERT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) val ^= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) input_report_key(priv->pwr, priv->keymap[0], val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) case MC13783_IRQ_ONOFD2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) val = val & MC13783_IRQSENSE1_ONOFD2S ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) if (priv->flags & MC13783_PWRB_B2_POL_INVERT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) val ^= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) input_report_key(priv->pwr, priv->keymap[1], val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) case MC13783_IRQ_ONOFD3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) val = val & MC13783_IRQSENSE1_ONOFD3S ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) if (priv->flags & MC13783_PWRB_B3_POL_INVERT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) val ^= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) input_report_key(priv->pwr, priv->keymap[2], val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) input_sync(priv->pwr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) static int mc13783_pwrbutton_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) const struct mc13xxx_buttons_platform_data *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) struct mc13xxx *mc13783 = dev_get_drvdata(pdev->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) struct input_dev *pwr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) struct mc13783_pwrb *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) int reg = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) pdata = dev_get_platdata(&pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) if (!pdata) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) dev_err(&pdev->dev, "missing platform data\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) pwr = input_allocate_device();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) if (!pwr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) dev_dbg(&pdev->dev, "Can't allocate power button\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) priv = kzalloc(sizeof(*priv), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) if (!priv) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) dev_dbg(&pdev->dev, "Can't allocate power button\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) goto free_input_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) reg |= (pdata->b1on_flags & 0x3) << MC13783_POWER_CONTROL_2_ON1BDBNC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) reg |= (pdata->b2on_flags & 0x3) << MC13783_POWER_CONTROL_2_ON2BDBNC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) reg |= (pdata->b3on_flags & 0x3) << MC13783_POWER_CONTROL_2_ON3BDBNC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) priv->pwr = pwr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) priv->mc13783 = mc13783;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) mc13xxx_lock(mc13783);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) if (pdata->b1on_flags & MC13783_BUTTON_ENABLE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) priv->keymap[0] = pdata->b1on_key;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) if (pdata->b1on_key != KEY_RESERVED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) __set_bit(pdata->b1on_key, pwr->keybit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) if (pdata->b1on_flags & MC13783_BUTTON_POL_INVERT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) priv->flags |= MC13783_PWRB_B1_POL_INVERT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) if (pdata->b1on_flags & MC13783_BUTTON_RESET_EN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) reg |= MC13783_POWER_CONTROL_2_ON1BRSTEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) err = mc13xxx_irq_request(mc13783, MC13783_IRQ_ONOFD1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) button_irq, "b1on", priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) dev_dbg(&pdev->dev, "Can't request irq\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) goto free_priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) if (pdata->b2on_flags & MC13783_BUTTON_ENABLE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) priv->keymap[1] = pdata->b2on_key;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) if (pdata->b2on_key != KEY_RESERVED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) __set_bit(pdata->b2on_key, pwr->keybit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) if (pdata->b2on_flags & MC13783_BUTTON_POL_INVERT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) priv->flags |= MC13783_PWRB_B2_POL_INVERT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) if (pdata->b2on_flags & MC13783_BUTTON_RESET_EN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) reg |= MC13783_POWER_CONTROL_2_ON2BRSTEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) err = mc13xxx_irq_request(mc13783, MC13783_IRQ_ONOFD2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) button_irq, "b2on", priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) dev_dbg(&pdev->dev, "Can't request irq\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) goto free_irq_b1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) if (pdata->b3on_flags & MC13783_BUTTON_ENABLE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) priv->keymap[2] = pdata->b3on_key;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) if (pdata->b3on_key != KEY_RESERVED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) __set_bit(pdata->b3on_key, pwr->keybit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) if (pdata->b3on_flags & MC13783_BUTTON_POL_INVERT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) priv->flags |= MC13783_PWRB_B3_POL_INVERT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) if (pdata->b3on_flags & MC13783_BUTTON_RESET_EN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) reg |= MC13783_POWER_CONTROL_2_ON3BRSTEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) err = mc13xxx_irq_request(mc13783, MC13783_IRQ_ONOFD3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) button_irq, "b3on", priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) dev_dbg(&pdev->dev, "Can't request irq: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) goto free_irq_b2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) mc13xxx_reg_rmw(mc13783, MC13783_REG_POWER_CONTROL_2, 0x3FE, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) mc13xxx_unlock(mc13783);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) pwr->name = "mc13783_pwrbutton";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) pwr->phys = "mc13783_pwrbutton/input0";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) pwr->dev.parent = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) pwr->keycode = priv->keymap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) pwr->keycodemax = ARRAY_SIZE(priv->keymap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) pwr->keycodesize = sizeof(priv->keymap[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) __set_bit(EV_KEY, pwr->evbit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) err = input_register_device(pwr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) dev_dbg(&pdev->dev, "Can't register power button: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) goto free_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) platform_set_drvdata(pdev, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) free_irq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) mc13xxx_lock(mc13783);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) if (pdata->b3on_flags & MC13783_BUTTON_ENABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) mc13xxx_irq_free(mc13783, MC13783_IRQ_ONOFD3, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) free_irq_b2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) if (pdata->b2on_flags & MC13783_BUTTON_ENABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) mc13xxx_irq_free(mc13783, MC13783_IRQ_ONOFD2, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) free_irq_b1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) if (pdata->b1on_flags & MC13783_BUTTON_ENABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) mc13xxx_irq_free(mc13783, MC13783_IRQ_ONOFD1, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) free_priv:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) mc13xxx_unlock(mc13783);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) kfree(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) free_input_dev:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) input_free_device(pwr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) static int mc13783_pwrbutton_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) struct mc13783_pwrb *priv = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) const struct mc13xxx_buttons_platform_data *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) pdata = dev_get_platdata(&pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) mc13xxx_lock(priv->mc13783);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) if (pdata->b3on_flags & MC13783_BUTTON_ENABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) mc13xxx_irq_free(priv->mc13783, MC13783_IRQ_ONOFD3, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) if (pdata->b2on_flags & MC13783_BUTTON_ENABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) mc13xxx_irq_free(priv->mc13783, MC13783_IRQ_ONOFD2, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) if (pdata->b1on_flags & MC13783_BUTTON_ENABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) mc13xxx_irq_free(priv->mc13783, MC13783_IRQ_ONOFD1, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) mc13xxx_unlock(priv->mc13783);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) input_unregister_device(priv->pwr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) kfree(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) static struct platform_driver mc13783_pwrbutton_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) .probe = mc13783_pwrbutton_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) .remove = mc13783_pwrbutton_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) .name = "mc13783-pwrbutton",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) module_platform_driver(mc13783_pwrbutton_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) MODULE_ALIAS("platform:mc13783-pwrbutton");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) MODULE_DESCRIPTION("MC13783 Power Button");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) MODULE_AUTHOR("Philippe Retornaz");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags