pwm: Use dev_add_param_int for pwm parameters
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de> Cc: Robert Jarzmik <robert.jarzmik@free.fr>
This commit is contained in:
parent
c57fa97ee7
commit
3a9f068ccb
|
@ -18,6 +18,7 @@
|
||||||
#include <malloc.h>
|
#include <malloc.h>
|
||||||
#include <pwm.h>
|
#include <pwm.h>
|
||||||
#include <linux/list.h>
|
#include <linux/list.h>
|
||||||
|
#include <linux/err.h>
|
||||||
|
|
||||||
struct pwm_device {
|
struct pwm_device {
|
||||||
struct pwm_chip *chip;
|
struct pwm_chip *chip;
|
||||||
|
@ -26,22 +27,14 @@ struct pwm_device {
|
||||||
#define FLAG_ENABLED 1
|
#define FLAG_ENABLED 1
|
||||||
struct list_head node;
|
struct list_head node;
|
||||||
struct device_d *dev;
|
struct device_d *dev;
|
||||||
|
|
||||||
|
unsigned int duty_ns;
|
||||||
|
unsigned int period_ns;
|
||||||
|
unsigned int p_enable;
|
||||||
};
|
};
|
||||||
|
|
||||||
static LIST_HEAD(pwm_list);
|
static LIST_HEAD(pwm_list);
|
||||||
|
|
||||||
static struct pwm_device *dev_to_pwm(struct device_d *dev)
|
|
||||||
{
|
|
||||||
struct pwm_device *pwm;
|
|
||||||
|
|
||||||
list_for_each_entry(pwm, &pwm_list, node) {
|
|
||||||
if (pwm->dev == dev)
|
|
||||||
return pwm;
|
|
||||||
}
|
|
||||||
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct pwm_device *_find_pwm(const char *devname)
|
static struct pwm_device *_find_pwm(const char *devname)
|
||||||
{
|
{
|
||||||
struct pwm_device *pwm;
|
struct pwm_device *pwm;
|
||||||
|
@ -54,61 +47,25 @@ static struct pwm_device *_find_pwm(const char *devname)
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int set_period_ns(struct device_d *dev, struct param_d *p,
|
static int set_duty_period_ns(struct param_d *p, void *priv)
|
||||||
const char *val)
|
|
||||||
{
|
{
|
||||||
struct pwm_device *pwm = dev_to_pwm(dev);
|
struct pwm_device *pwm = priv;
|
||||||
int period_ns;
|
|
||||||
|
|
||||||
if (!val)
|
pwm_config(pwm, pwm->chip->duty_ns, pwm->chip->period_ns);
|
||||||
return dev_param_set_generic(dev, p, NULL);
|
|
||||||
|
|
||||||
period_ns = simple_strtoul(val, NULL, 0);
|
return 0;
|
||||||
pwm_config(pwm, pwm->chip->duty_ns, period_ns);
|
|
||||||
return dev_param_set_generic(dev, p, val);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int set_duty_ns(struct device_d *dev, struct param_d *p, const char *val)
|
static int set_enable(struct param_d *p, void *priv)
|
||||||
{
|
{
|
||||||
struct pwm_device *pwm = dev_to_pwm(dev);
|
struct pwm_device *pwm = priv;
|
||||||
int duty_ns;
|
|
||||||
|
|
||||||
if (!val)
|
if (pwm->p_enable)
|
||||||
return dev_param_set_generic(dev, p, NULL);
|
|
||||||
|
|
||||||
duty_ns = simple_strtoul(val, NULL, 0);
|
|
||||||
pwm_config(pwm, duty_ns, pwm->chip->period_ns);
|
|
||||||
return dev_param_set_generic(dev, p, val);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int set_enable(struct device_d *dev, struct param_d *p, const char *val)
|
|
||||||
{
|
|
||||||
struct pwm_device *pwm = dev_to_pwm(dev);
|
|
||||||
int enable;
|
|
||||||
|
|
||||||
if (!val)
|
|
||||||
return dev_param_set_generic(dev, p, NULL);
|
|
||||||
|
|
||||||
enable = !!simple_strtoul(val, NULL, 0);
|
|
||||||
if (enable)
|
|
||||||
pwm_enable(pwm);
|
pwm_enable(pwm);
|
||||||
else
|
else
|
||||||
pwm_disable(pwm);
|
pwm_disable(pwm);
|
||||||
return dev_param_set_generic(dev, p, enable ? "1" : "0");
|
|
||||||
}
|
|
||||||
|
|
||||||
static int pwm_register_vars(struct device_d *dev)
|
return 0;
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
ret = dev_add_param(dev, "duty_ns", set_duty_ns, NULL, 0);
|
|
||||||
if (!ret)
|
|
||||||
ret = dev_add_param(dev, "period_ns", set_period_ns, NULL, 0);
|
|
||||||
if (!ret)
|
|
||||||
ret = dev_add_param(dev, "enable", set_enable, NULL, 0);
|
|
||||||
if (!ret)
|
|
||||||
ret = dev_set_param(dev, "enable", 0);
|
|
||||||
return ret;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -121,7 +78,7 @@ static int pwm_register_vars(struct device_d *dev)
|
||||||
int pwmchip_add(struct pwm_chip *chip, struct device_d *dev)
|
int pwmchip_add(struct pwm_chip *chip, struct device_d *dev)
|
||||||
{
|
{
|
||||||
struct pwm_device *pwm;
|
struct pwm_device *pwm;
|
||||||
int ret = 0;
|
struct param_d *p;
|
||||||
|
|
||||||
if (_find_pwm(chip->devname))
|
if (_find_pwm(chip->devname))
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
|
@ -131,9 +88,23 @@ int pwmchip_add(struct pwm_chip *chip, struct device_d *dev)
|
||||||
pwm->dev = dev;
|
pwm->dev = dev;
|
||||||
|
|
||||||
list_add_tail(&pwm->node, &pwm_list);
|
list_add_tail(&pwm->node, &pwm_list);
|
||||||
pwm_register_vars(dev);
|
|
||||||
|
|
||||||
return ret;
|
p = dev_add_param_int(dev, "duty_ns", set_duty_period_ns,
|
||||||
|
NULL, &pwm->chip->duty_ns, "%u", pwm);
|
||||||
|
if (IS_ERR(p))
|
||||||
|
return PTR_ERR(p);
|
||||||
|
|
||||||
|
p = dev_add_param_int(dev, "period_ns", set_duty_period_ns,
|
||||||
|
NULL, &pwm->chip->period_ns, "%u", pwm);
|
||||||
|
if (IS_ERR(p))
|
||||||
|
return PTR_ERR(p);
|
||||||
|
|
||||||
|
p = dev_add_param_bool(dev, "enable", set_enable,
|
||||||
|
NULL, &pwm->p_enable, pwm);
|
||||||
|
if (IS_ERR(p))
|
||||||
|
return PTR_ERR(p);
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(pwmchip_add);
|
EXPORT_SYMBOL_GPL(pwmchip_add);
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue