Commit fbc1b323 authored by Quentin Schulz's avatar Quentin Schulz Committed by Dmitry Torokhov

Input: axp20x-pek - use driver_data of platform_device_id instead of extended attributes

To prepare an upcoming patch adding support for another PMIC that has
different startup and shutdown time, use driver_data of
platform_device_id instead of a fixed extended device attribute.

By doing so, we also remove a lot of nested structures that aren't
useful.

With this patch, a new PMIC can be easily supported by just filling
correctly its ax20x_info structure and adding a platform_device_id.

Moreover, since we get rid of extended attributes, rename
axp20x_store_ext_attr to axp20x_store_attr and axp20x_show_ext_attr to
axp20x_show_attr.
Signed-off-by: default avatarQuentin Schulz <quentin.schulz@free-electrons.com>
Acked-by: default avatarChen-Yu Tsai <wens@csie.org>
Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent 64954e34
...@@ -29,9 +29,17 @@ ...@@ -29,9 +29,17 @@
#define AXP20X_PEK_STARTUP_MASK (0xc0) #define AXP20X_PEK_STARTUP_MASK (0xc0)
#define AXP20X_PEK_SHUTDOWN_MASK (0x03) #define AXP20X_PEK_SHUTDOWN_MASK (0x03)
struct axp20x_info {
const struct axp20x_time *startup_time;
unsigned int startup_mask;
const struct axp20x_time *shutdown_time;
unsigned int shutdown_mask;
};
struct axp20x_pek { struct axp20x_pek {
struct axp20x_dev *axp20x; struct axp20x_dev *axp20x;
struct input_dev *input; struct input_dev *input;
struct axp20x_info *info;
int irq_dbr; int irq_dbr;
int irq_dbf; int irq_dbf;
}; };
...@@ -55,31 +63,18 @@ static const struct axp20x_time shutdown_time[] = { ...@@ -55,31 +63,18 @@ static const struct axp20x_time shutdown_time[] = {
{ .time = 10000, .idx = 3 }, { .time = 10000, .idx = 3 },
}; };
struct axp20x_pek_ext_attr { static const struct axp20x_info axp20x_info = {
const struct axp20x_time *p_time; .startup_time = startup_time,
unsigned int mask; .startup_mask = AXP20X_PEK_STARTUP_MASK,
}; .shutdown_time = shutdown_time,
.shutdown_mask = AXP20X_PEK_SHUTDOWN_MASK,
static struct axp20x_pek_ext_attr axp20x_pek_startup_ext_attr = {
.p_time = startup_time,
.mask = AXP20X_PEK_STARTUP_MASK,
};
static struct axp20x_pek_ext_attr axp20x_pek_shutdown_ext_attr = {
.p_time = shutdown_time,
.mask = AXP20X_PEK_SHUTDOWN_MASK,
}; };
static struct axp20x_pek_ext_attr *get_axp_ext_attr(struct device_attribute *attr) static ssize_t axp20x_show_attr(struct device *dev,
{ const struct axp20x_time *time,
return container_of(attr, struct dev_ext_attribute, attr)->var; unsigned int mask, char *buf)
}
static ssize_t axp20x_show_ext_attr(struct device *dev,
struct device_attribute *attr, char *buf)
{ {
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev); struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
struct axp20x_pek_ext_attr *axp20x_ea = get_axp_ext_attr(attr);
unsigned int val; unsigned int val;
int ret, i; int ret, i;
...@@ -87,22 +82,42 @@ static ssize_t axp20x_show_ext_attr(struct device *dev, ...@@ -87,22 +82,42 @@ static ssize_t axp20x_show_ext_attr(struct device *dev,
if (ret != 0) if (ret != 0)
return ret; return ret;
val &= axp20x_ea->mask; val &= mask;
val >>= ffs(axp20x_ea->mask) - 1; val >>= ffs(mask) - 1;
for (i = 0; i < 4; i++) for (i = 0; i < 4; i++)
if (val == axp20x_ea->p_time[i].idx) if (val == time[i].idx)
val = axp20x_ea->p_time[i].time; val = time[i].time;
return sprintf(buf, "%u\n", val); return sprintf(buf, "%u\n", val);
} }
static ssize_t axp20x_store_ext_attr(struct device *dev, static ssize_t axp20x_show_attr_startup(struct device *dev,
struct device_attribute *attr, struct device_attribute *attr,
const char *buf, size_t count) char *buf)
{
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
return axp20x_show_attr(dev, axp20x_pek->info->startup_time,
axp20x_pek->info->startup_mask, buf);
}
static ssize_t axp20x_show_attr_shutdown(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
return axp20x_show_attr(dev, axp20x_pek->info->shutdown_time,
axp20x_pek->info->shutdown_mask, buf);
}
static ssize_t axp20x_store_attr(struct device *dev,
const struct axp20x_time *time,
unsigned int mask, const char *buf,
size_t count)
{ {
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev); struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
struct axp20x_pek_ext_attr *axp20x_ea = get_axp_ext_attr(attr);
char val_str[20]; char val_str[20];
size_t len; size_t len;
int ret, i; int ret, i;
...@@ -123,39 +138,52 @@ static ssize_t axp20x_store_ext_attr(struct device *dev, ...@@ -123,39 +138,52 @@ static ssize_t axp20x_store_ext_attr(struct device *dev,
for (i = 3; i >= 0; i--) { for (i = 3; i >= 0; i--) {
unsigned int err; unsigned int err;
err = abs(axp20x_ea->p_time[i].time - val); err = abs(time[i].time - val);
if (err < best_err) { if (err < best_err) {
best_err = err; best_err = err;
idx = axp20x_ea->p_time[i].idx; idx = time[i].idx;
} }
if (!err) if (!err)
break; break;
} }
idx <<= ffs(axp20x_ea->mask) - 1; idx <<= ffs(mask) - 1;
ret = regmap_update_bits(axp20x_pek->axp20x->regmap, ret = regmap_update_bits(axp20x_pek->axp20x->regmap, AXP20X_PEK_KEY,
AXP20X_PEK_KEY, mask, idx);
axp20x_ea->mask, idx);
if (ret != 0) if (ret != 0)
return -EINVAL; return -EINVAL;
return count; return count;
} }
static struct dev_ext_attribute axp20x_dev_attr_startup = { static ssize_t axp20x_store_attr_startup(struct device *dev,
.attr = __ATTR(startup, 0644, axp20x_show_ext_attr, axp20x_store_ext_attr), struct device_attribute *attr,
.var = &axp20x_pek_startup_ext_attr, const char *buf, size_t count)
}; {
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
static struct dev_ext_attribute axp20x_dev_attr_shutdown = { return axp20x_store_attr(dev, axp20x_pek->info->startup_time,
.attr = __ATTR(shutdown, 0644, axp20x_show_ext_attr, axp20x_store_ext_attr), axp20x_pek->info->startup_mask, buf, count);
.var = &axp20x_pek_shutdown_ext_attr, }
};
static ssize_t axp20x_store_attr_shutdown(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
struct axp20x_pek *axp20x_pek = dev_get_drvdata(dev);
return axp20x_store_attr(dev, axp20x_pek->info->shutdown_time,
axp20x_pek->info->shutdown_mask, buf, count);
}
DEVICE_ATTR(startup, 0644, axp20x_show_attr_startup, axp20x_store_attr_startup);
DEVICE_ATTR(shutdown, 0644, axp20x_show_attr_shutdown,
axp20x_store_attr_shutdown);
static struct attribute *axp20x_attributes[] = { static struct attribute *axp20x_attributes[] = {
&axp20x_dev_attr_startup.attr.attr, &dev_attr_startup.attr,
&axp20x_dev_attr_shutdown.attr.attr, &dev_attr_shutdown.attr,
NULL, NULL,
}; };
...@@ -291,8 +319,14 @@ static bool axp20x_pek_should_register_input(struct axp20x_pek *axp20x_pek, ...@@ -291,8 +319,14 @@ static bool axp20x_pek_should_register_input(struct axp20x_pek *axp20x_pek,
static int axp20x_pek_probe(struct platform_device *pdev) static int axp20x_pek_probe(struct platform_device *pdev)
{ {
struct axp20x_pek *axp20x_pek; struct axp20x_pek *axp20x_pek;
const struct platform_device_id *match = platform_get_device_id(pdev);
int error; int error;
if (!match) {
dev_err(&pdev->dev, "Failed to get platform_device_id\n");
return -EINVAL;
}
axp20x_pek = devm_kzalloc(&pdev->dev, sizeof(struct axp20x_pek), axp20x_pek = devm_kzalloc(&pdev->dev, sizeof(struct axp20x_pek),
GFP_KERNEL); GFP_KERNEL);
if (!axp20x_pek) if (!axp20x_pek)
...@@ -306,6 +340,8 @@ static int axp20x_pek_probe(struct platform_device *pdev) ...@@ -306,6 +340,8 @@ static int axp20x_pek_probe(struct platform_device *pdev)
return error; return error;
} }
axp20x_pek->info = (struct axp20x_info *)match->driver_data;
error = devm_device_add_group(&pdev->dev, &axp20x_attribute_group); error = devm_device_add_group(&pdev->dev, &axp20x_attribute_group);
if (error) { if (error) {
dev_err(&pdev->dev, "Failed to create sysfs attributes: %d\n", dev_err(&pdev->dev, "Failed to create sysfs attributes: %d\n",
...@@ -342,8 +378,17 @@ static const struct dev_pm_ops axp20x_pek_pm_ops = { ...@@ -342,8 +378,17 @@ static const struct dev_pm_ops axp20x_pek_pm_ops = {
#endif #endif
}; };
static const struct platform_device_id axp_pek_id_match[] = {
{
.name = "axp20x-pek",
.driver_data = (kernel_ulong_t)&axp20x_info,
},
{ /* sentinel */ }
};
static struct platform_driver axp20x_pek_driver = { static struct platform_driver axp20x_pek_driver = {
.probe = axp20x_pek_probe, .probe = axp20x_pek_probe,
.id_table = axp_pek_id_match,
.driver = { .driver = {
.name = "axp20x-pek", .name = "axp20x-pek",
.pm = &axp20x_pek_pm_ops, .pm = &axp20x_pek_pm_ops,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment