116 lines
2.7 KiB
C
116 lines
2.7 KiB
C
/*
|
|
* Marvell MVEBU pinctrl core driver
|
|
*
|
|
* Sebastian Hesselbarth <sebastian.hesselbarth@gmail.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <malloc.h>
|
|
#include <of.h>
|
|
#include <pinctrl.h>
|
|
|
|
#include "common.h"
|
|
|
|
struct mvebu_pinctrl {
|
|
struct mvebu_pinctrl_soc_info *soc;
|
|
struct pinctrl_device pinctrl;
|
|
};
|
|
|
|
static struct mvebu_mpp_mode *mvebu_pinctrl_find_mode_by_name(
|
|
struct mvebu_pinctrl *pctl, const char *name)
|
|
{
|
|
unsigned n;
|
|
for (n = 0; n < pctl->soc->nmodes; n++) {
|
|
if (strcmp(name, pctl->soc->modes[n].name) == 0)
|
|
return &pctl->soc->modes[n];
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static struct mvebu_mpp_ctrl_setting *mvebu_pinctrl_find_setting_by_name(
|
|
struct mvebu_pinctrl *pctl, struct mvebu_mpp_mode *mode,
|
|
const char *name)
|
|
{
|
|
struct mvebu_mpp_ctrl_setting *setting = mode->settings;
|
|
|
|
while (setting->name) {
|
|
if (strcmp(name, setting->name) == 0) {
|
|
if (!pctl->soc->variant ||
|
|
(pctl->soc->variant & setting->variant))
|
|
return setting;
|
|
}
|
|
setting++;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static int mvebu_pinctrl_set_state(struct pinctrl_device *pdev,
|
|
struct device_node *np)
|
|
{
|
|
struct mvebu_pinctrl *pctl =
|
|
container_of(pdev, struct mvebu_pinctrl, pinctrl);
|
|
struct property *prop;
|
|
const char *function;
|
|
const char *group;
|
|
int ret;
|
|
|
|
ret = of_property_read_string(np, "marvell,function", &function);
|
|
if (ret) {
|
|
dev_err(pdev->dev, "missing marvell,function in node %s\n",
|
|
np->full_name);
|
|
return -EINVAL;
|
|
}
|
|
|
|
of_property_for_each_string(np, "marvell,pins", prop, group) {
|
|
struct mvebu_mpp_mode *mode =
|
|
mvebu_pinctrl_find_mode_by_name(pctl, group);
|
|
struct mvebu_mpp_ctrl_setting *set;
|
|
|
|
if (!mode) {
|
|
dev_err(pdev->dev, "unknown pin group %s", group);
|
|
continue;
|
|
}
|
|
|
|
set = mvebu_pinctrl_find_setting_by_name(pctl, mode, function);
|
|
if (!set) {
|
|
dev_err(pdev->dev, "unsupported function %s on pin %s",
|
|
function, group);
|
|
continue;
|
|
}
|
|
|
|
dev_dbg(pdev->dev, "np = %s, mode = %s, setting = %s (%s)\n",
|
|
np->name, mode->name, set->name, set->subname);
|
|
|
|
mode->mpp_set(mode->pid, set->val);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct pinctrl_ops mvebu_pinctrl_ops = {
|
|
.set_state = mvebu_pinctrl_set_state,
|
|
};
|
|
|
|
int mvebu_pinctrl_probe(struct device_d *dev,
|
|
struct mvebu_pinctrl_soc_info *soc)
|
|
{
|
|
struct mvebu_pinctrl *pctl;
|
|
int ret;
|
|
|
|
pctl = xzalloc(sizeof(*pctl));
|
|
pctl->soc = soc;
|
|
pctl->pinctrl.dev = dev;
|
|
pctl->pinctrl.ops = &mvebu_pinctrl_ops;
|
|
|
|
ret = pinctrl_register(&pctl->pinctrl);
|
|
if (ret)
|
|
free(pctl);
|
|
|
|
return ret;
|
|
}
|