cregit-Linux how code gets into the kernel

Release 4.11 drivers/input/misc/pm8xxx-vibrator.c

/* Copyright (c) 2010-2011, Code Aurora Forum. 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/kernel.h>
#include <linux/errno.h>
#include <linux/platform_device.h>
#include <linux/input.h>
#include <linux/slab.h>
#include <linux/regmap.h>


#define VIB_DRV			0x4A


#define VIB_DRV_SEL_MASK	0xf8

#define VIB_DRV_SEL_SHIFT	0x03

#define VIB_DRV_EN_MANUAL_MASK	0xfc


#define VIB_MAX_LEVEL_mV	(3100)

#define VIB_MIN_LEVEL_mV	(1200)

#define VIB_MAX_LEVELS		(VIB_MAX_LEVEL_mV - VIB_MIN_LEVEL_mV)


#define MAX_FF_SPEED		0xff

/**
 * struct pm8xxx_vib - structure to hold vibrator data
 * @vib_input_dev: input device supporting force feedback
 * @work: work structure to set the vibration parameters
 * @regmap: regmap for register read/write
 * @speed: speed of vibration set from userland
 * @active: state of vibrator
 * @level: level of vibration to set in the chip
 * @reg_vib_drv: VIB_DRV register value
 */

struct pm8xxx_vib {
	
struct input_dev *vib_input_dev;
	
struct work_struct work;
	
struct regmap *regmap;
	
int speed;
	
int level;
	
bool active;
	
u8  reg_vib_drv;
};

/**
 * pm8xxx_vib_set - handler to start/stop vibration
 * @vib: pointer to vibrator structure
 * @on: state to set
 */

static int pm8xxx_vib_set(struct pm8xxx_vib *vib, bool on) { int rc; unsigned int val = vib->reg_vib_drv; if (on) val |= ((vib->level << VIB_DRV_SEL_SHIFT) & VIB_DRV_SEL_MASK); else val &= ~VIB_DRV_SEL_MASK; rc = regmap_write(vib->regmap, VIB_DRV, val); if (rc < 0) return rc; vib->reg_vib_drv = val; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Amy Maloche7391.25%150.00%
Stephen Boyd78.75%150.00%
Total80100.00%2100.00%

/** * pm8xxx_work_handler - worker to set vibration level * @work: pointer to work_struct */
static void pm8xxx_work_handler(struct work_struct *work) { struct pm8xxx_vib *vib = container_of(work, struct pm8xxx_vib, work); int rc; unsigned int val; rc = regmap_read(vib->regmap, VIB_DRV, &val); if (rc < 0) return; /* * pmic vibrator supports voltage ranges from 1.2 to 3.1V, so * scale the level to fit into these ranges. */ if (vib->speed) { vib->active = true; vib->level = ((VIB_MAX_LEVELS * vib->speed) / MAX_FF_SPEED) + VIB_MIN_LEVEL_mV; vib->level /= 100; } else { vib->active = false; vib->level = VIB_MIN_LEVEL_mV / 100; } pm8xxx_vib_set(vib, vib->active); }

Contributors

PersonTokensPropCommitsCommitProp
Amy Maloche11294.12%150.00%
Stephen Boyd75.88%150.00%
Total119100.00%2100.00%

/** * pm8xxx_vib_close - callback of input close callback * @dev: input device pointer * * Turns off the vibrator. */
static void pm8xxx_vib_close(struct input_dev *dev) { struct pm8xxx_vib *vib = input_get_drvdata(dev); cancel_work_sync(&vib->work); if (vib->active) pm8xxx_vib_set(vib, false); }

Contributors

PersonTokensPropCommitsCommitProp
Amy Maloche42100.00%1100.00%
Total42100.00%1100.00%

/** * pm8xxx_vib_play_effect - function to handle vib effects. * @dev: input device pointer * @data: data of effect * @effect: effect to play * * Currently this driver supports only rumble effects. */
static int pm8xxx_vib_play_effect(struct input_dev *dev, void *data, struct ff_effect *effect) { struct pm8xxx_vib *vib = input_get_drvdata(dev); vib->speed = effect->u.rumble.strong_magnitude >> 8; if (!vib->speed) vib->speed = effect->u.rumble.weak_magnitude >> 9; schedule_work(&vib->work); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Amy Maloche76100.00%1100.00%
Total76100.00%1100.00%


static int pm8xxx_vib_probe(struct platform_device *pdev) { struct pm8xxx_vib *vib; struct input_dev *input_dev; int error; unsigned int val; vib = devm_kzalloc(&pdev->dev, sizeof(*vib), GFP_KERNEL); if (!vib) return -ENOMEM; vib->regmap = dev_get_regmap(pdev->dev.parent, NULL); if (!vib->regmap) return -ENODEV; input_dev = devm_input_allocate_device(&pdev->dev); if (!input_dev) return -ENOMEM; INIT_WORK(&vib->work, pm8xxx_work_handler); vib->vib_input_dev = input_dev; /* operate in manual mode */ error = regmap_read(vib->regmap, VIB_DRV, &val); if (error < 0) return error; val &= ~VIB_DRV_EN_MANUAL_MASK; error = regmap_write(vib->regmap, VIB_DRV, val); if (error < 0) return error; vib->reg_vib_drv = val; input_dev->name = "pm8xxx_vib_ffmemless"; input_dev->id.version = 1; input_dev->close = pm8xxx_vib_close; input_set_drvdata(input_dev, vib); input_set_capability(vib->vib_input_dev, EV_FF, FF_RUMBLE); error = input_ff_create_memless(input_dev, NULL, pm8xxx_vib_play_effect); if (error) { dev_err(&pdev->dev, "couldn't register vibrator as FF device\n"); return error; } error = input_register_device(input_dev); if (error) { dev_err(&pdev->dev, "couldn't register input device\n"); return error; } platform_set_drvdata(pdev, vib); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Amy Maloche20875.09%133.33%
Stephen Boyd6924.91%266.67%
Total277100.00%3100.00%


static int __maybe_unused pm8xxx_vib_suspend(struct device *dev) { struct pm8xxx_vib *vib = dev_get_drvdata(dev); /* Turn off the vibrator */ pm8xxx_vib_set(vib, false); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Amy Maloche3296.97%150.00%
Jingoo Han13.03%150.00%
Total33100.00%2100.00%

static SIMPLE_DEV_PM_OPS(pm8xxx_vib_pm_ops, pm8xxx_vib_suspend, NULL); static const struct of_device_id pm8xxx_vib_id_table[] = { { .compatible = "qcom,pm8058-vib" }, { .compatible = "qcom,pm8921-vib" }, { } }; MODULE_DEVICE_TABLE(of, pm8xxx_vib_id_table); static struct platform_driver pm8xxx_vib_driver = { .probe = pm8xxx_vib_probe, .driver = { .name = "pm8xxx-vib", .pm = &pm8xxx_vib_pm_ops, .of_match_table = pm8xxx_vib_id_table, }, }; module_platform_driver(pm8xxx_vib_driver); MODULE_ALIAS("platform:pm8xxx_vib"); MODULE_DESCRIPTION("PMIC8xxx vibrator driver based on ff-memless framework"); MODULE_LICENSE("GPL v2"); MODULE_AUTHOR("Amy Maloche <amaloche@codeaurora.org>");

Overall Contributors

PersonTokensPropCommitsCommitProp
Amy Maloche69184.58%116.67%
Stephen Boyd12415.18%350.00%
Jingoo Han10.12%116.67%
JJ Ding10.12%116.67%
Total817100.00%6100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.