9
0
Fork 0

param: Add dev_add_param_string

This function allows drivers to create a string parameter and
provides access to it via a pointer. Using regular dev_add_param
only allows access via dev_get_param().

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
Sascha Hauer 2014-07-16 16:35:52 +02:00
parent d9e1f9b09f
commit 32f4bd130c
2 changed files with 89 additions and 0 deletions

View File

@ -31,6 +31,11 @@ int dev_add_param(struct device_d *dev, const char *name,
const char *(*get)(struct device_d *, struct param_d *p),
unsigned long flags);
struct param_d *dev_add_param_string(struct device_d *dev, const char *name,
int (*set)(struct param_d *p, void *priv),
int (*get)(struct param_d *p, void *priv),
char **value, void *priv);
struct param_d *dev_add_param_int(struct device_d *dev, const char *name,
int (*set)(struct param_d *p, void *priv),
int (*get)(struct param_d *p, void *priv),
@ -95,6 +100,14 @@ static inline int dev_add_param(struct device_d *dev, char *name,
return 0;
}
static inline struct param_d *dev_add_param_string(struct device_d *dev, const char *name,
int (*set)(struct param_d *p, void *priv),
int (*get)(struct param_d *p, void *priv),
char **value, void *priv)
{
return NULL;
}
static inline struct param_d *dev_add_param_int(struct device_d *dev, const char *name,
int (*set)(struct param_d *p, void *priv),
int (*get)(struct param_d *p, void *priv),

View File

@ -201,6 +201,82 @@ int dev_add_param_fixed(struct device_d *dev, char *name, const char *value)
return 0;
}
struct param_string {
struct param_d param;
char **value;
int (*set)(struct param_d *p, void *priv);
int (*get)(struct param_d *p, void *priv);
};
static inline struct param_string *to_param_string(struct param_d *p)
{
return container_of(p, struct param_string, param);
}
static int param_string_set(struct device_d *dev, struct param_d *p, const char *val)
{
struct param_string *ps = to_param_string(p);
int ret;
char *value_save = *ps->value;
if (!val)
return -EINVAL;
*ps->value = xstrdup(val);
if (!ps->set)
return 0;
ret = ps->set(p, p->driver_priv);
if (ret) {
free(*ps->value);
*ps->value = value_save;
} else {
free(value_save);
}
return ret;
}
static const char *param_string_get(struct device_d *dev, struct param_d *p)
{
struct param_string *ps = to_param_string(p);
int ret;
if (ps->get) {
ret = ps->get(p, p->driver_priv);
if (ret)
return NULL;
}
return *ps->value;
}
struct param_d *dev_add_param_string(struct device_d *dev, const char *name,
int (*set)(struct param_d *p, void *priv),
int (*get)(struct param_d *p, void *priv),
char **value, void *priv)
{
struct param_string *ps;
struct param_d *p;
int ret;
ps = xzalloc(sizeof(*ps));
ps->value = value;
ps->set = set;
ps->get = get;
p = &ps->param;
p->driver_priv = priv;
ret = __dev_add_param(p, dev, name, param_string_set, param_string_get, 0);
if (ret) {
free(ps);
return ERR_PTR(ret);
}
return &ps->param;
}
struct param_int {
struct param_d param;
int *value;