@@ -459,6 +459,16 @@ config INPUT_REGULATOR_HAPTIC
To compile this driver as a module, choose M here: the
module will be called regulator-haptic.
+config INPUT_REGULATOR_VIBRATOR
+ tristate "Regulator vibrator support"
+ depends on REGULATOR
+ help
+ This option enables device driver support vibrator by a regulator.
+ Say Y here if you want to enable this.
+
+ To compile this driver as a module, choose M here: the module will
+ be called regulator-vibrator.
+
config INPUT_RETU_PWRBUTTON
tristate "Retu Power button Driver"
depends on MFD_RETU
@@ -65,6 +65,7 @@ obj-$(CONFIG_INPUT_PWM_VIBRA) += pwm-vibra.o
obj-$(CONFIG_INPUT_RAVE_SP_PWRBUTTON) += rave-sp-pwrbutton.o
obj-$(CONFIG_INPUT_RB532_BUTTON) += rb532_button.o
obj-$(CONFIG_INPUT_REGULATOR_HAPTIC) += regulator-haptic.o
+obj-$(CONFIG_INPUT_REGULATOR_VIBRATOR) += regulator-vibrator.o
obj-$(CONFIG_INPUT_RETU_PWRBUTTON) += retu-pwrbutton.o
obj-$(CONFIG_INPUT_AXP20X_PEK) += axp20x-pek.o
obj-$(CONFIG_INPUT_GPIO_ROTARY_ENCODER) += rotary_encoder.o
new file mode 100644
@@ -0,0 +1,422 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2019 MediaTek Inc.
+ *
+ */
+
+#include <linux/device.h>
+#include <linux/hrtimer.h>
+#include <linux/init.h>
+#include <linux/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/of_platform.h>
+#include <linux/platform_device.h>
+#include <linux/regulator/consumer.h>
+#include <linux/spinlock.h>
+#include <linux/timer.h>
+#include <linux/workqueue.h>
+
+#define VIB_DEVICE "regulator_vibrator"
+
+#define DEFAULT_MIN_LIMIT 15
+
+struct reg_vibr_config {
+ unsigned int min_limit;
+ unsigned int max_limit;
+ unsigned int min_volt;
+ unsigned int max_volt;
+ struct regulator *reg;
+};
+
+struct reg_vibr {
+ struct input_dev *vibr_input_dev;
+ struct workqueue_struct *vibr_queue;
+ struct work_struct vibr_work;
+ struct hrtimer vibr_timer;
+ spinlock_t vibr_lock; /* hrtimer lock */
+ unsigned int vibr_dur;
+ bool vibr_active;
+ bool vibr_state;
+ bool reg_status;
+ bool vibr_shutdown;
+ struct reg_vibr_config vibr_conf;
+ struct notifier_block oc_handle;
+};
+
+static int mt_vibra_parse_dt(struct device *dev,
+ struct reg_vibr_config *vibr_conf)
+{
+ int ret;
+
+ if (device_property_read_u32(dev, "min-limit",
+ &vibr_conf->min_limit))
+ vibr_conf->min_limit = DEFAULT_MIN_LIMIT;
+ vibr_conf->min_limit = max_t(unsigned int,
+ vibr_conf->min_limit, DEFAULT_MIN_LIMIT);
+
+ if (device_property_read_u32(dev, "max-limit",
+ &vibr_conf->max_limit))
+ vibr_conf->max_limit = 0;
+
+ if (!vibr_conf->max_limit &&
+ vibr_conf->max_limit < vibr_conf->min_limit) {
+ dev_err(dev, "error load dts: get error limitation(min > max)\n");
+ return -EINVAL;
+ }
+
+ vibr_conf->reg = devm_regulator_get(dev, "vib");
+ if (IS_ERR(vibr_conf->reg)) {
+ dev_err(dev, "error load dts: get regulator return %d\n",
+ PTR_ERR(vibr_conf->reg));
+ vibr_conf->reg = NULL;
+ return PTR_ERR(vibr_conf->reg);
+ }
+
+ if (device_property_read_u32(dev, "max-volt",
+ &vibr_conf->max_volt)) {
+ dev_err(dev, "error load dts: get max-volt failed\n");
+ return -EINVAL;
+ }
+
+ if (device_property_read_u32(dev, "min-volt",
+ &vibr_conf->min_volt)) {
+ dev_err(dev, "error load dts: get min-volt failed!\n");
+ return -EINVAL;
+ }
+
+ if (vibr_conf->min_volt > vibr_conf->max_volt) {
+ dev_err(dev, "error load dts: get error voltage(min > max)\n");
+ return -EINVAL;
+ }
+
+ dev_info(dev, "vibr_conf = %u, %u, %u-%u\n",
+ vibr_conf->min_limit, vibr_conf->max_limit,
+ vibr_conf->min_volt, vibr_conf->max_volt);
+
+ return ret;
+}
+
+static int vibr_power_set(struct reg_vibr *vibr)
+{
+ int ret;
+
+ ret = regulator_set_voltage(vibr->vibr_conf.reg,
+ vibr->vibr_conf.min_volt,
+ vibr->vibr_conf.max_volt);
+ if (ret < 0)
+ dev_err(&vibr->vibr_input_dev->dev,
+ "set voltage fail, ret = %d\n", ret);
+
+ return ret;
+}
+
+static void vibr_enable(struct reg_vibr *vibr)
+{
+ if (!vibr->reg_status) {
+ if (regulator_enable(vibr->vibr_conf.reg))
+ dev_err(&vibr->vibr_input_dev->dev, "set vibr_reg enable failed!\n");
+ else
+ vibr->reg_status = 1;
+ } else {
+ dev_info(&vibr->vibr_input_dev->dev, "vibr_reg already enabled.\n");
+ }
+}
+
+static void vibr_disable(struct reg_vibr *vibr)
+{
+ if (vibr->reg_status) {
+ if (regulator_disable(vibr->vibr_conf.reg))
+ dev_err(&vibr->vibr_input_dev->dev, "set vibr_reg disable failed!\n");
+ else
+ vibr->reg_status = 0;
+ } else {
+ dev_info(&vibr->vibr_input_dev->dev, "vibr_reg already disabled.\n");
+ }
+}
+
+static void update_vibrator(struct work_struct *work)
+{
+ struct reg_vibr *vibr = container_of(work, struct reg_vibr, vibr_work);
+
+ if (!vibr->vibr_state)
+ vibr_disable(vibr);
+ else
+ vibr_enable(vibr);
+}
+
+static void vibrator_enable(struct reg_vibr *vibr,
+ unsigned int dur, unsigned int activate)
+{
+ unsigned long flags;
+
+ spin_lock_irqsave(&vibr->vibr_lock, flags);
+ hrtimer_cancel(&vibr->vibr_timer);
+
+ if (!activate || vibr->vibr_shutdown || !dur) {
+ vibr->vibr_state = 0;
+ } else {
+ dur = max(vibr->vibr_conf.min_limit, dur);
+ if (vibr->vibr_conf.max_limit)
+ dur = min(dur, vibr->vibr_conf.max_limit);
+ vibr->vibr_state = 1;
+ hrtimer_start(&vibr->vibr_timer,
+ ktime_set(dur / 1000, (dur % 1000) * 1000000),
+ HRTIMER_MODE_REL);
+ }
+ spin_unlock_irqrestore(&vibr->vibr_lock, flags);
+ queue_work(vibr->vibr_queue, &vibr->vibr_work);
+}
+
+static enum hrtimer_restart vibrator_timer_func(struct hrtimer *timer)
+{
+ struct reg_vibr *vibr = container_of(timer,
+ struct reg_vibr, vibr_timer);
+
+ vibr->vibr_state = 0;
+ queue_work(vibr->vibr_queue, &vibr->vibr_work);
+ return HRTIMER_NORESTART;
+}
+
+static const struct of_device_id vibr_of_ids[] = {
+ { .compatible = "regulator-vibrator", },
+ { /* sentienel */ }
+};
+
+static ssize_t activate_show(struct device *dev,
+ struct device_attribute *attr,
+ char *buf)
+{
+ struct reg_vibr *vibr = dev_get_drvdata(dev->parent);
+
+ return sprintf(buf, "%d\n", vibr->vibr_active);
+}
+
+static ssize_t activate_store(struct device *dev,
+ struct device_attribute *attr, const char *buf, size_t size)
+{
+ unsigned int activate, duration;
+ ssize_t ret;
+ struct reg_vibr *vibr = dev_get_drvdata(dev->parent);
+
+ ret = kstrtouint(buf, 10, &activate);
+ if (ret) {
+ dev_err(dev, "set activate fail\n");
+ return ret;
+ }
+ duration = vibr->vibr_dur;
+ dev_info(dev, "set activate duration = %u, %u\n",
+ activate, duration);
+ vibrator_enable(vibr, duration, activate);
+
+ ret = size;
+ return ret;
+}
+
+static ssize_t state_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct reg_vibr *vibr = dev_get_drvdata(dev->parent);
+
+ return sprintf(buf, "%d\n", vibr->vibr_state);
+}
+
+static ssize_t state_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t size)
+{
+ unsigned int state;
+ ssize_t ret;
+ struct reg_vibr *vibr = dev_get_drvdata(dev->parent);
+
+ ret = kstrtouint(buf, 10, &state);
+ if (ret) {
+ dev_err(dev, "set state fail\n");
+ return ret;
+ }
+
+ vibr->vibr_state = state;
+ ret = size;
+ return ret;
+}
+
+static ssize_t duration_show(struct device *dev,
+ struct device_attribute *attr,
+ char *buf)
+{
+ struct reg_vibr *vibr = dev_get_drvdata(dev->parent);
+
+ return sprintf(buf, "%u\n", vibr->vibr_dur);
+}
+
+static ssize_t duration_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t size)
+{
+ unsigned int duration;
+ ssize_t ret;
+ struct reg_vibr *vibr;
+
+ ret = kstrtouint(buf, 10, &duration);
+ if (ret) {
+ dev_err(dev, "set duration fail!\n");
+ return ret;
+ }
+ vibr = dev_get_drvdata(dev->parent);
+ vibr->vibr_dur = duration;
+
+ dev_dbg(dev, "set activate duration = %u\n",
+ duration);
+
+ ret = size;
+ return ret;
+}
+
+static DEVICE_ATTR_RW(activate);
+static DEVICE_ATTR_RW(state);
+static DEVICE_ATTR_RW(duration);
+
+static struct attribute *sysfs_attrs[] = {
+ &dev_attr_activate.attr,
+ &dev_attr_state.attr,
+ &dev_attr_duration.attr,
+ NULL,
+};
+
+static struct attribute_group vibr_group = {
+ .attrs = sysfs_attrs,
+};
+
+static int regulator_oc_event(struct notifier_block *nb,
+ unsigned long event, void *data)
+{
+ struct reg_vibr *vibr = container_of(nb, struct reg_vibr, oc_handle);
+
+ switch (event) {
+ case REGULATOR_EVENT_OVER_CURRENT:
+ case REGULATOR_EVENT_FAIL:
+ vibr_disable(vibr);
+ break;
+
+ default:
+ break;
+ }
+
+ return NOTIFY_OK;
+}
+
+static int vib_probe(struct platform_device *pdev)
+{
+ int ret;
+ struct reg_vibr *m_vibr;
+
+ m_vibr = devm_kzalloc(&pdev->dev, sizeof(struct reg_vibr), GFP_KERNEL);
+ if (!m_vibr)
+ return -ENOMEM;
+
+ m_vibr->vibr_input_dev = devm_input_allocate_device(&pdev->dev);
+ if (!m_vibr->vibr_input_dev) {
+ dev_err(&pdev->dev, "failed to allocate input dev\n");
+ return -ENOMEM;
+ }
+
+ m_vibr->vibr_input_dev->name = VIB_DEVICE;
+ m_vibr->vibr_input_dev->id.bustype = BUS_HOST;
+ m_vibr->vibr_input_dev->dev.parent = &pdev->dev;
+
+ m_vibr->vibr_queue = create_singlethread_workqueue(VIB_DEVICE);
+ if (!m_vibr->vibr_queue) {
+ dev_err(&pdev->dev, "unable to create workqueue\n");
+ return -ENOMEM;
+ }
+
+ ret = mt_vibra_parse_dt(&pdev->dev, &m_vibr->vibr_conf);
+ if (ret) {
+ dev_err(&pdev->dev, "failed to parse devicetree(%d)\n", ret);
+ return ret;
+ }
+
+ INIT_WORK(&m_vibr->vibr_work, update_vibrator);
+ spin_lock_init(&m_vibr->vibr_lock);
+ m_vibr->vibr_shutdown = 0;
+ if (regulator_is_enabled(m_vibr->vibr_conf.reg))
+ m_vibr->reg_status = 1;
+ else
+ m_vibr->reg_status = 0;
+
+ hrtimer_init(&m_vibr->vibr_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+ m_vibr->vibr_timer.function = vibrator_timer_func;
+
+ ret = input_register_device(m_vibr->vibr_input_dev);
+ if (ret < 0) {
+ dev_dbg(&pdev->dev, "couldn't register input device\n");
+ return ret;
+ }
+
+ /* register oc notification for this regulator */
+ m_vibr->oc_handle.notifier_call = regulator_oc_event;
+ ret = devm_regulator_register_notifier(m_vibr->vibr_conf.reg,
+ &m_vibr->oc_handle);
+ if (ret)
+ dev_info(&pdev->dev, "regulator notifier request failed\n");
+
+ ret = sysfs_create_group(&pdev->dev.kobj, &vibr_group);
+ if (ret)
+ dev_warn(&pdev->dev, "cannot allocate sysfs group for %s\n",
+ VIB_DEVICE);
+
+ platform_set_drvdata(pdev, m_vibr);
+ ret = vibr_power_set(m_vibr);
+ if (ret < 0) {
+ dev_info(&pdev->dev, "set voltage for regulator fail\n");
+ return ret;
+ }
+
+ return 0;
+}
+
+static int vib_remove(struct platform_device *pdev)
+{
+ struct reg_vibr *vibr = platform_get_drvdata(pdev);
+
+ cancel_work_sync(&vibr->vibr_work);
+ hrtimer_cancel(&vibr->vibr_timer);
+
+ sysfs_remove_group(&pdev->dev.kobj, &vibr_group);
+
+ input_unregister_device(vibr->vibr_input_dev);
+
+ return 0;
+}
+
+static void vib_shutdown(struct platform_device *pdev)
+{
+ unsigned long flags;
+ struct reg_vibr *vibr = platform_get_drvdata(pdev);
+
+ spin_lock_irqsave(&vibr->vibr_lock, flags);
+ vibr->vibr_shutdown = 1;
+
+ if (vibr->vibr_state) {
+ vibr->vibr_state = 0;
+ spin_unlock_irqrestore(&vibr->vibr_lock, flags);
+ vibr_disable(vibr);
+ } else {
+ spin_unlock_irqrestore(&vibr->vibr_lock, flags);
+ }
+}
+
+static struct platform_driver vibrator_driver = {
+ .probe = vib_probe,
+ .remove = vib_remove,
+ .shutdown = vib_shutdown,
+ .driver = {
+ .name = VIB_DEVICE,
+ .of_match_table = vibr_of_ids,
+ },
+};
+module_platform_driver(vibrator_driver);
+
+MODULE_AUTHOR("Mediatek Corporation");
+MODULE_DESCRIPTION("Regulator Vibrator Driver (VIB)");
+MODULE_LICENSE("GPL");