Loading Documentation/devicetree/bindings/platform/msm/qpnp-vibrator.txt 0 → 100644 +40 −0 Original line number Diff line number Diff line QPNP Vibrator QPNP (Qualcomm technologies Inc Plug N Play) vibrator is a peripheral on Qualcomm technologies Inc PMICs. The PMIC is connected to Host processor via SPMI bus. Required Properties: - status: default status is set to "disabled. Must be "okay" - compatible: must be "qcom,qpnp-vibrator" - label: name which describes the device - reg: address of device Optional Properties: - qcom,vib-timeout-ms: timeout of vibrator, in ms. Default 15000 ms - qcom,vib-vtg-level-mV: voltage level, in mV. Default 3100 mV - qcom,mode: mode in which vibrator is operating. It can be one of "manual", "dtest1", "dtest2" and "dtest3" - qcom,active-low: boolean to specify if the dtestx is operated in active low or high Required Properties for "dtestx" mode: - qcom,pwm-channel: pwm channel number - qcom,period-us: period for pwm in micro secs - qcom,duty-us: duty cycle for pwm in micro secs Example: qcom,vib@c000 { status = "okay"; compatible = "qcom,qpnp-vibrator"; reg = <0xc000 0x100>; label = "vibrator"; qcom,vib-timeout-ms = <15000>; qcom,vib-vtg-level-mV = <3100>; qcom,mode = "dtest3"; qcom,pwm-channel = <5>; qcom,period-us = <1000>; qcom,duty-us = <750>; qcom,active-low; }; drivers/platform/msm/Kconfig +10 −0 Original line number Diff line number Diff line Loading @@ -128,6 +128,16 @@ config SPS_SUPPORT_NDP_BAM help No-Data-Path BAM is used to improve BAM performance. config QPNP_VIBRATOR tristate "Vibrator support for QPNP PMIC" depends on OF_SPMI help This option enables device driver support for the vibrator on the Qualcomm technologies Inc's QPNP PMICs. The vibrator is connected on the VIB_DRV_N line and can be controlled manually or by the DTEST lines.It uses the android timed-output framework. config IPA tristate "IPA support" depends on SPS && NET Loading drivers/platform/msm/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -19,6 +19,7 @@ obj-$(CONFIG_SEEMP_CORE) += seemp_core/ obj-$(CONFIG_QPNP_HAPTIC) += qpnp-haptic.o obj-$(CONFIG_GPIO_USB_DETECT) += gpio-usbdetect.o obj-$(CONFIG_USB_BAM) += usb_bam.o obj-$(CONFIG_QPNP_VIBRATOR) += qpnp-vibrator.o obj-$(CONFIG_MSM_AVTIMER) += avtimer.o obj-$(CONFIG_MSM_11AD) += msm_11ad/ obj-$(CONFIG_MSM_MHI_DEV) += mhi_dev/ drivers/platform/msm/qpnp-vibrator.c 0 → 100644 +420 −0 Original line number Diff line number Diff line /* Copyright (c) 2013-2015, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include <linux/module.h> #include <linux/init.h> #include <linux/kernel.h> #include <linux/errno.h> #include <linux/slab.h> #include <linux/hrtimer.h> #include <linux/of_device.h> #include <linux/spmi.h> #include <linux/qpnp/pwm.h> #include <linux/err.h> #include "../../staging/android/timed_output.h" #define QPNP_VIB_VTG_CTL(base) (base + 0x41) #define QPNP_VIB_EN_CTL(base) (base + 0x46) #define QPNP_VIB_MAX_LEVEL 31 #define QPNP_VIB_MIN_LEVEL 12 #define QPNP_VIB_DEFAULT_TIMEOUT 15000 #define QPNP_VIB_DEFAULT_VTG_LVL 3100 #define QPNP_VIB_EN BIT(7) #define QPNP_VIB_VTG_SET_MASK 0x1F #define QPNP_VIB_LOGIC_SHIFT 4 enum qpnp_vib_mode { QPNP_VIB_MANUAL, QPNP_VIB_DTEST1, QPNP_VIB_DTEST2, QPNP_VIB_DTEST3, }; struct qpnp_pwm_info { struct pwm_device *pwm_dev; u32 pwm_channel; u32 duty_us; u32 period_us; }; struct qpnp_vib { struct spmi_device *spmi; struct hrtimer vib_timer; struct timed_output_dev timed_dev; struct work_struct work; struct qpnp_pwm_info pwm_info; enum qpnp_vib_mode mode; u8 reg_vtg_ctl; u8 reg_en_ctl; u8 active_low; u16 base; int state; int vtg_level; int timeout; struct mutex lock; }; static int qpnp_vib_read_u8(struct qpnp_vib *vib, u8 *data, u16 reg) { int rc; rc = spmi_ext_register_readl(vib->spmi->ctrl, vib->spmi->sid, reg, data, 1); if (rc < 0) dev_err(&vib->spmi->dev, "Error reading address: %X - ret %X\n", reg, rc); return rc; } static int qpnp_vib_write_u8(struct qpnp_vib *vib, u8 *data, u16 reg) { int rc; rc = spmi_ext_register_writel(vib->spmi->ctrl, vib->spmi->sid, reg, data, 1); if (rc < 0) dev_err(&vib->spmi->dev, "Error writing address: %X - ret %X\n", reg, rc); return rc; } static int qpnp_vibrator_config(struct qpnp_vib *vib) { u8 reg = 0; int rc; /* Configure the VTG CTL regiser */ rc = qpnp_vib_read_u8(vib, ®, QPNP_VIB_VTG_CTL(vib->base)); if (rc < 0) return rc; reg &= ~QPNP_VIB_VTG_SET_MASK; reg |= (vib->vtg_level & QPNP_VIB_VTG_SET_MASK); rc = qpnp_vib_write_u8(vib, ®, QPNP_VIB_VTG_CTL(vib->base)); if (rc) return rc; vib->reg_vtg_ctl = reg; /* Configure the VIB ENABLE regiser */ rc = qpnp_vib_read_u8(vib, ®, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; reg |= (!!vib->active_low) << QPNP_VIB_LOGIC_SHIFT; if (vib->mode != QPNP_VIB_MANUAL) { vib->pwm_info.pwm_dev = pwm_request(vib->pwm_info.pwm_channel, "qpnp-vib"); if (IS_ERR_OR_NULL(vib->pwm_info.pwm_dev)) { dev_err(&vib->spmi->dev, "vib pwm request failed\n"); return -ENODEV; } rc = pwm_config(vib->pwm_info.pwm_dev, vib->pwm_info.duty_us, vib->pwm_info.period_us); if (rc < 0) { dev_err(&vib->spmi->dev, "vib pwm config failed\n"); pwm_free(vib->pwm_info.pwm_dev); return -ENODEV; } reg |= BIT(vib->mode - 1); } rc = qpnp_vib_write_u8(vib, ®, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; vib->reg_en_ctl = reg; return rc; } static int qpnp_vib_set(struct qpnp_vib *vib, int on) { int rc; u8 val; if (on) { if (vib->mode != QPNP_VIB_MANUAL) { pwm_enable(vib->pwm_info.pwm_dev); } else { val = vib->reg_en_ctl; val |= QPNP_VIB_EN; rc = qpnp_vib_write_u8(vib, &val, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; vib->reg_en_ctl = val; } } else { if (vib->mode != QPNP_VIB_MANUAL) { pwm_disable(vib->pwm_info.pwm_dev); } else { val = vib->reg_en_ctl; val &= ~QPNP_VIB_EN; rc = qpnp_vib_write_u8(vib, &val, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; vib->reg_en_ctl = val; } } return 0; } static void qpnp_vib_enable(struct timed_output_dev *dev, int value) { struct qpnp_vib *vib = container_of(dev, struct qpnp_vib, timed_dev); mutex_lock(&vib->lock); hrtimer_cancel(&vib->vib_timer); if (value == 0) { vib->state = 0; } else { value = (value > vib->timeout ? vib->timeout : value); vib->state = 1; hrtimer_start(&vib->vib_timer, ktime_set(value / 1000, (value % 1000) * 1000000), HRTIMER_MODE_REL); } mutex_unlock(&vib->lock); schedule_work(&vib->work); } static void qpnp_vib_update(struct work_struct *work) { struct qpnp_vib *vib = container_of(work, struct qpnp_vib, work); qpnp_vib_set(vib, vib->state); } static int qpnp_vib_get_time(struct timed_output_dev *dev) { struct qpnp_vib *vib = container_of(dev, struct qpnp_vib, timed_dev); if (hrtimer_active(&vib->vib_timer)) { ktime_t r = hrtimer_get_remaining(&vib->vib_timer); return (int)ktime_to_us(r); } else return 0; } static enum hrtimer_restart qpnp_vib_timer_func(struct hrtimer *timer) { struct qpnp_vib *vib = container_of(timer, struct qpnp_vib, vib_timer); vib->state = 0; schedule_work(&vib->work); return HRTIMER_NORESTART; } #ifdef CONFIG_PM static int qpnp_vibrator_suspend(struct device *dev) { struct qpnp_vib *vib = dev_get_drvdata(dev); hrtimer_cancel(&vib->vib_timer); cancel_work_sync(&vib->work); /* turn-off vibrator */ qpnp_vib_set(vib, 0); return 0; } #endif static SIMPLE_DEV_PM_OPS(qpnp_vibrator_pm_ops, qpnp_vibrator_suspend, NULL); static int qpnp_vib_parse_dt(struct qpnp_vib *vib) { struct spmi_device *spmi = vib->spmi; int rc; const char *mode; u32 temp_val; vib->timeout = QPNP_VIB_DEFAULT_TIMEOUT; rc = of_property_read_u32(spmi->dev.of_node, "qcom,vib-timeout-ms", &temp_val); if (!rc) { vib->timeout = temp_val; } else if (rc != -EINVAL) { dev_err(&spmi->dev, "Unable to read vib timeout\n"); return rc; } vib->vtg_level = QPNP_VIB_DEFAULT_VTG_LVL; rc = of_property_read_u32(spmi->dev.of_node, "qcom,vib-vtg-level-mV", &temp_val); if (!rc) { vib->vtg_level = temp_val; } else if (rc != -EINVAL) { dev_err(&spmi->dev, "Unable to read vtg level\n"); return rc; } vib->vtg_level /= 100; if (vib->vtg_level < QPNP_VIB_MIN_LEVEL) vib->vtg_level = QPNP_VIB_MIN_LEVEL; else if (vib->vtg_level > QPNP_VIB_MAX_LEVEL) vib->vtg_level = QPNP_VIB_MAX_LEVEL; vib->mode = QPNP_VIB_MANUAL; rc = of_property_read_string(spmi->dev.of_node, "qcom,mode", &mode); if (!rc) { if (strcmp(mode, "manual") == 0) { vib->mode = QPNP_VIB_MANUAL; } else if (strcmp(mode, "dtest1") == 0) { vib->mode = QPNP_VIB_DTEST1; } else if (strcmp(mode, "dtest2") == 0) { vib->mode = QPNP_VIB_DTEST2; } else if (strcmp(mode, "dtest3") == 0) { vib->mode = QPNP_VIB_DTEST3; } else { dev_err(&spmi->dev, "Invalid mode\n"); return -EINVAL; } } else if (rc != -EINVAL) { dev_err(&spmi->dev, "Unable to read mode\n"); return rc; } if (vib->mode != QPNP_VIB_MANUAL) { rc = of_property_read_u32(spmi->dev.of_node, "qcom,pwm-channel", &temp_val); if (!rc) vib->pwm_info.pwm_channel = temp_val; else return rc; rc = of_property_read_u32(spmi->dev.of_node, "qcom,period-us", &temp_val); if (!rc) vib->pwm_info.period_us = temp_val; else return rc; rc = of_property_read_u32(spmi->dev.of_node, "qcom,duty-us", &temp_val); if (!rc) vib->pwm_info.duty_us = temp_val; else return rc; } vib->active_low = of_property_read_bool(spmi->dev.of_node, "qcom,active-low"); return 0; } static int qpnp_vibrator_probe(struct spmi_device *spmi) { struct qpnp_vib *vib; struct resource *vib_resource; int rc; vib = devm_kzalloc(&spmi->dev, sizeof(*vib), GFP_KERNEL); if (!vib) return -ENOMEM; vib->spmi = spmi; vib_resource = spmi_get_resource(spmi, 0, IORESOURCE_MEM, 0); if (!vib_resource) { dev_err(&spmi->dev, "Unable to get vibrator base address\n"); return -EINVAL; } vib->base = vib_resource->start; rc = qpnp_vib_parse_dt(vib); if (rc) { dev_err(&spmi->dev, "DT parsing failed\n"); return rc; } rc = qpnp_vibrator_config(vib); if (rc) { dev_err(&spmi->dev, "vib config failed\n"); return rc; } mutex_init(&vib->lock); INIT_WORK(&vib->work, qpnp_vib_update); hrtimer_init(&vib->vib_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); vib->vib_timer.function = qpnp_vib_timer_func; vib->timed_dev.name = "vibrator"; vib->timed_dev.get_time = qpnp_vib_get_time; vib->timed_dev.enable = qpnp_vib_enable; dev_set_drvdata(&spmi->dev, vib); rc = timed_output_dev_register(&vib->timed_dev); if (rc < 0) return rc; return rc; } static int qpnp_vibrator_remove(struct spmi_device *spmi) { struct qpnp_vib *vib = dev_get_drvdata(&spmi->dev); cancel_work_sync(&vib->work); hrtimer_cancel(&vib->vib_timer); timed_output_dev_unregister(&vib->timed_dev); mutex_destroy(&vib->lock); return 0; } static struct of_device_id spmi_match_table[] = { { .compatible = "qcom,qpnp-vibrator", }, {} }; static struct spmi_driver qpnp_vibrator_driver = { .driver = { .name = "qcom,qpnp-vibrator", .of_match_table = spmi_match_table, .pm = &qpnp_vibrator_pm_ops, }, .probe = qpnp_vibrator_probe, .remove = __devexit_p(qpnp_vibrator_remove), }; static int __init qpnp_vibrator_init(void) { return spmi_driver_register(&qpnp_vibrator_driver); } module_init(qpnp_vibrator_init); static void __exit qpnp_vibrator_exit(void) { return spmi_driver_unregister(&qpnp_vibrator_driver); } module_exit(qpnp_vibrator_exit); MODULE_DESCRIPTION("qpnp vibrator driver"); MODULE_LICENSE("GPL v2"); Loading
Documentation/devicetree/bindings/platform/msm/qpnp-vibrator.txt 0 → 100644 +40 −0 Original line number Diff line number Diff line QPNP Vibrator QPNP (Qualcomm technologies Inc Plug N Play) vibrator is a peripheral on Qualcomm technologies Inc PMICs. The PMIC is connected to Host processor via SPMI bus. Required Properties: - status: default status is set to "disabled. Must be "okay" - compatible: must be "qcom,qpnp-vibrator" - label: name which describes the device - reg: address of device Optional Properties: - qcom,vib-timeout-ms: timeout of vibrator, in ms. Default 15000 ms - qcom,vib-vtg-level-mV: voltage level, in mV. Default 3100 mV - qcom,mode: mode in which vibrator is operating. It can be one of "manual", "dtest1", "dtest2" and "dtest3" - qcom,active-low: boolean to specify if the dtestx is operated in active low or high Required Properties for "dtestx" mode: - qcom,pwm-channel: pwm channel number - qcom,period-us: period for pwm in micro secs - qcom,duty-us: duty cycle for pwm in micro secs Example: qcom,vib@c000 { status = "okay"; compatible = "qcom,qpnp-vibrator"; reg = <0xc000 0x100>; label = "vibrator"; qcom,vib-timeout-ms = <15000>; qcom,vib-vtg-level-mV = <3100>; qcom,mode = "dtest3"; qcom,pwm-channel = <5>; qcom,period-us = <1000>; qcom,duty-us = <750>; qcom,active-low; };
drivers/platform/msm/Kconfig +10 −0 Original line number Diff line number Diff line Loading @@ -128,6 +128,16 @@ config SPS_SUPPORT_NDP_BAM help No-Data-Path BAM is used to improve BAM performance. config QPNP_VIBRATOR tristate "Vibrator support for QPNP PMIC" depends on OF_SPMI help This option enables device driver support for the vibrator on the Qualcomm technologies Inc's QPNP PMICs. The vibrator is connected on the VIB_DRV_N line and can be controlled manually or by the DTEST lines.It uses the android timed-output framework. config IPA tristate "IPA support" depends on SPS && NET Loading
drivers/platform/msm/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -19,6 +19,7 @@ obj-$(CONFIG_SEEMP_CORE) += seemp_core/ obj-$(CONFIG_QPNP_HAPTIC) += qpnp-haptic.o obj-$(CONFIG_GPIO_USB_DETECT) += gpio-usbdetect.o obj-$(CONFIG_USB_BAM) += usb_bam.o obj-$(CONFIG_QPNP_VIBRATOR) += qpnp-vibrator.o obj-$(CONFIG_MSM_AVTIMER) += avtimer.o obj-$(CONFIG_MSM_11AD) += msm_11ad/ obj-$(CONFIG_MSM_MHI_DEV) += mhi_dev/
drivers/platform/msm/qpnp-vibrator.c 0 → 100644 +420 −0 Original line number Diff line number Diff line /* Copyright (c) 2013-2015, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include <linux/module.h> #include <linux/init.h> #include <linux/kernel.h> #include <linux/errno.h> #include <linux/slab.h> #include <linux/hrtimer.h> #include <linux/of_device.h> #include <linux/spmi.h> #include <linux/qpnp/pwm.h> #include <linux/err.h> #include "../../staging/android/timed_output.h" #define QPNP_VIB_VTG_CTL(base) (base + 0x41) #define QPNP_VIB_EN_CTL(base) (base + 0x46) #define QPNP_VIB_MAX_LEVEL 31 #define QPNP_VIB_MIN_LEVEL 12 #define QPNP_VIB_DEFAULT_TIMEOUT 15000 #define QPNP_VIB_DEFAULT_VTG_LVL 3100 #define QPNP_VIB_EN BIT(7) #define QPNP_VIB_VTG_SET_MASK 0x1F #define QPNP_VIB_LOGIC_SHIFT 4 enum qpnp_vib_mode { QPNP_VIB_MANUAL, QPNP_VIB_DTEST1, QPNP_VIB_DTEST2, QPNP_VIB_DTEST3, }; struct qpnp_pwm_info { struct pwm_device *pwm_dev; u32 pwm_channel; u32 duty_us; u32 period_us; }; struct qpnp_vib { struct spmi_device *spmi; struct hrtimer vib_timer; struct timed_output_dev timed_dev; struct work_struct work; struct qpnp_pwm_info pwm_info; enum qpnp_vib_mode mode; u8 reg_vtg_ctl; u8 reg_en_ctl; u8 active_low; u16 base; int state; int vtg_level; int timeout; struct mutex lock; }; static int qpnp_vib_read_u8(struct qpnp_vib *vib, u8 *data, u16 reg) { int rc; rc = spmi_ext_register_readl(vib->spmi->ctrl, vib->spmi->sid, reg, data, 1); if (rc < 0) dev_err(&vib->spmi->dev, "Error reading address: %X - ret %X\n", reg, rc); return rc; } static int qpnp_vib_write_u8(struct qpnp_vib *vib, u8 *data, u16 reg) { int rc; rc = spmi_ext_register_writel(vib->spmi->ctrl, vib->spmi->sid, reg, data, 1); if (rc < 0) dev_err(&vib->spmi->dev, "Error writing address: %X - ret %X\n", reg, rc); return rc; } static int qpnp_vibrator_config(struct qpnp_vib *vib) { u8 reg = 0; int rc; /* Configure the VTG CTL regiser */ rc = qpnp_vib_read_u8(vib, ®, QPNP_VIB_VTG_CTL(vib->base)); if (rc < 0) return rc; reg &= ~QPNP_VIB_VTG_SET_MASK; reg |= (vib->vtg_level & QPNP_VIB_VTG_SET_MASK); rc = qpnp_vib_write_u8(vib, ®, QPNP_VIB_VTG_CTL(vib->base)); if (rc) return rc; vib->reg_vtg_ctl = reg; /* Configure the VIB ENABLE regiser */ rc = qpnp_vib_read_u8(vib, ®, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; reg |= (!!vib->active_low) << QPNP_VIB_LOGIC_SHIFT; if (vib->mode != QPNP_VIB_MANUAL) { vib->pwm_info.pwm_dev = pwm_request(vib->pwm_info.pwm_channel, "qpnp-vib"); if (IS_ERR_OR_NULL(vib->pwm_info.pwm_dev)) { dev_err(&vib->spmi->dev, "vib pwm request failed\n"); return -ENODEV; } rc = pwm_config(vib->pwm_info.pwm_dev, vib->pwm_info.duty_us, vib->pwm_info.period_us); if (rc < 0) { dev_err(&vib->spmi->dev, "vib pwm config failed\n"); pwm_free(vib->pwm_info.pwm_dev); return -ENODEV; } reg |= BIT(vib->mode - 1); } rc = qpnp_vib_write_u8(vib, ®, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; vib->reg_en_ctl = reg; return rc; } static int qpnp_vib_set(struct qpnp_vib *vib, int on) { int rc; u8 val; if (on) { if (vib->mode != QPNP_VIB_MANUAL) { pwm_enable(vib->pwm_info.pwm_dev); } else { val = vib->reg_en_ctl; val |= QPNP_VIB_EN; rc = qpnp_vib_write_u8(vib, &val, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; vib->reg_en_ctl = val; } } else { if (vib->mode != QPNP_VIB_MANUAL) { pwm_disable(vib->pwm_info.pwm_dev); } else { val = vib->reg_en_ctl; val &= ~QPNP_VIB_EN; rc = qpnp_vib_write_u8(vib, &val, QPNP_VIB_EN_CTL(vib->base)); if (rc < 0) return rc; vib->reg_en_ctl = val; } } return 0; } static void qpnp_vib_enable(struct timed_output_dev *dev, int value) { struct qpnp_vib *vib = container_of(dev, struct qpnp_vib, timed_dev); mutex_lock(&vib->lock); hrtimer_cancel(&vib->vib_timer); if (value == 0) { vib->state = 0; } else { value = (value > vib->timeout ? vib->timeout : value); vib->state = 1; hrtimer_start(&vib->vib_timer, ktime_set(value / 1000, (value % 1000) * 1000000), HRTIMER_MODE_REL); } mutex_unlock(&vib->lock); schedule_work(&vib->work); } static void qpnp_vib_update(struct work_struct *work) { struct qpnp_vib *vib = container_of(work, struct qpnp_vib, work); qpnp_vib_set(vib, vib->state); } static int qpnp_vib_get_time(struct timed_output_dev *dev) { struct qpnp_vib *vib = container_of(dev, struct qpnp_vib, timed_dev); if (hrtimer_active(&vib->vib_timer)) { ktime_t r = hrtimer_get_remaining(&vib->vib_timer); return (int)ktime_to_us(r); } else return 0; } static enum hrtimer_restart qpnp_vib_timer_func(struct hrtimer *timer) { struct qpnp_vib *vib = container_of(timer, struct qpnp_vib, vib_timer); vib->state = 0; schedule_work(&vib->work); return HRTIMER_NORESTART; } #ifdef CONFIG_PM static int qpnp_vibrator_suspend(struct device *dev) { struct qpnp_vib *vib = dev_get_drvdata(dev); hrtimer_cancel(&vib->vib_timer); cancel_work_sync(&vib->work); /* turn-off vibrator */ qpnp_vib_set(vib, 0); return 0; } #endif static SIMPLE_DEV_PM_OPS(qpnp_vibrator_pm_ops, qpnp_vibrator_suspend, NULL); static int qpnp_vib_parse_dt(struct qpnp_vib *vib) { struct spmi_device *spmi = vib->spmi; int rc; const char *mode; u32 temp_val; vib->timeout = QPNP_VIB_DEFAULT_TIMEOUT; rc = of_property_read_u32(spmi->dev.of_node, "qcom,vib-timeout-ms", &temp_val); if (!rc) { vib->timeout = temp_val; } else if (rc != -EINVAL) { dev_err(&spmi->dev, "Unable to read vib timeout\n"); return rc; } vib->vtg_level = QPNP_VIB_DEFAULT_VTG_LVL; rc = of_property_read_u32(spmi->dev.of_node, "qcom,vib-vtg-level-mV", &temp_val); if (!rc) { vib->vtg_level = temp_val; } else if (rc != -EINVAL) { dev_err(&spmi->dev, "Unable to read vtg level\n"); return rc; } vib->vtg_level /= 100; if (vib->vtg_level < QPNP_VIB_MIN_LEVEL) vib->vtg_level = QPNP_VIB_MIN_LEVEL; else if (vib->vtg_level > QPNP_VIB_MAX_LEVEL) vib->vtg_level = QPNP_VIB_MAX_LEVEL; vib->mode = QPNP_VIB_MANUAL; rc = of_property_read_string(spmi->dev.of_node, "qcom,mode", &mode); if (!rc) { if (strcmp(mode, "manual") == 0) { vib->mode = QPNP_VIB_MANUAL; } else if (strcmp(mode, "dtest1") == 0) { vib->mode = QPNP_VIB_DTEST1; } else if (strcmp(mode, "dtest2") == 0) { vib->mode = QPNP_VIB_DTEST2; } else if (strcmp(mode, "dtest3") == 0) { vib->mode = QPNP_VIB_DTEST3; } else { dev_err(&spmi->dev, "Invalid mode\n"); return -EINVAL; } } else if (rc != -EINVAL) { dev_err(&spmi->dev, "Unable to read mode\n"); return rc; } if (vib->mode != QPNP_VIB_MANUAL) { rc = of_property_read_u32(spmi->dev.of_node, "qcom,pwm-channel", &temp_val); if (!rc) vib->pwm_info.pwm_channel = temp_val; else return rc; rc = of_property_read_u32(spmi->dev.of_node, "qcom,period-us", &temp_val); if (!rc) vib->pwm_info.period_us = temp_val; else return rc; rc = of_property_read_u32(spmi->dev.of_node, "qcom,duty-us", &temp_val); if (!rc) vib->pwm_info.duty_us = temp_val; else return rc; } vib->active_low = of_property_read_bool(spmi->dev.of_node, "qcom,active-low"); return 0; } static int qpnp_vibrator_probe(struct spmi_device *spmi) { struct qpnp_vib *vib; struct resource *vib_resource; int rc; vib = devm_kzalloc(&spmi->dev, sizeof(*vib), GFP_KERNEL); if (!vib) return -ENOMEM; vib->spmi = spmi; vib_resource = spmi_get_resource(spmi, 0, IORESOURCE_MEM, 0); if (!vib_resource) { dev_err(&spmi->dev, "Unable to get vibrator base address\n"); return -EINVAL; } vib->base = vib_resource->start; rc = qpnp_vib_parse_dt(vib); if (rc) { dev_err(&spmi->dev, "DT parsing failed\n"); return rc; } rc = qpnp_vibrator_config(vib); if (rc) { dev_err(&spmi->dev, "vib config failed\n"); return rc; } mutex_init(&vib->lock); INIT_WORK(&vib->work, qpnp_vib_update); hrtimer_init(&vib->vib_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); vib->vib_timer.function = qpnp_vib_timer_func; vib->timed_dev.name = "vibrator"; vib->timed_dev.get_time = qpnp_vib_get_time; vib->timed_dev.enable = qpnp_vib_enable; dev_set_drvdata(&spmi->dev, vib); rc = timed_output_dev_register(&vib->timed_dev); if (rc < 0) return rc; return rc; } static int qpnp_vibrator_remove(struct spmi_device *spmi) { struct qpnp_vib *vib = dev_get_drvdata(&spmi->dev); cancel_work_sync(&vib->work); hrtimer_cancel(&vib->vib_timer); timed_output_dev_unregister(&vib->timed_dev); mutex_destroy(&vib->lock); return 0; } static struct of_device_id spmi_match_table[] = { { .compatible = "qcom,qpnp-vibrator", }, {} }; static struct spmi_driver qpnp_vibrator_driver = { .driver = { .name = "qcom,qpnp-vibrator", .of_match_table = spmi_match_table, .pm = &qpnp_vibrator_pm_ops, }, .probe = qpnp_vibrator_probe, .remove = __devexit_p(qpnp_vibrator_remove), }; static int __init qpnp_vibrator_init(void) { return spmi_driver_register(&qpnp_vibrator_driver); } module_init(qpnp_vibrator_init); static void __exit qpnp_vibrator_exit(void) { return spmi_driver_unregister(&qpnp_vibrator_driver); } module_exit(qpnp_vibrator_exit); MODULE_DESCRIPTION("qpnp vibrator driver"); MODULE_LICENSE("GPL v2");
