604 lines
14 KiB
C
604 lines
14 KiB
C
|
// SPDX-License-Identifier: GPL-2.0+
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2018 Google LLC
|
||
|
|
* Copyright (c) 2021 Aspeed Technology Inc.
|
||
|
|
*/
|
||
|
|
#include <linux/device.h>
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/of_device.h>
|
||
|
|
#include <linux/of_platform.h>
|
||
|
|
#include <linux/mfd/syscon.h>
|
||
|
|
#include <linux/regmap.h>
|
||
|
|
#include <linux/platform_device.h>
|
||
|
|
|
||
|
|
/* register offsets */
|
||
|
|
#define HICR9 0x98
|
||
|
|
#define HICRA 0x9c
|
||
|
|
|
||
|
|
/* attributes options */
|
||
|
|
#define UART_ROUTING_IO1 "io1"
|
||
|
|
#define UART_ROUTING_IO2 "io2"
|
||
|
|
#define UART_ROUTING_IO3 "io3"
|
||
|
|
#define UART_ROUTING_IO4 "io4"
|
||
|
|
#define UART_ROUTING_IO5 "io5"
|
||
|
|
#define UART_ROUTING_IO6 "io6"
|
||
|
|
#define UART_ROUTING_IO10 "io10"
|
||
|
|
#define UART_ROUTING_UART1 "uart1"
|
||
|
|
#define UART_ROUTING_UART2 "uart2"
|
||
|
|
#define UART_ROUTING_UART3 "uart3"
|
||
|
|
#define UART_ROUTING_UART4 "uart4"
|
||
|
|
#define UART_ROUTING_UART5 "uart5"
|
||
|
|
#define UART_ROUTING_UART6 "uart6"
|
||
|
|
#define UART_ROUTING_UART10 "uart10"
|
||
|
|
#define UART_ROUTING_RES "reserved"
|
||
|
|
|
||
|
|
struct aspeed_uart_routing {
|
||
|
|
struct regmap *map;
|
||
|
|
struct attribute_group const *attr_grp;
|
||
|
|
};
|
||
|
|
|
||
|
|
struct aspeed_uart_routing_selector {
|
||
|
|
struct device_attribute dev_attr;
|
||
|
|
uint8_t reg;
|
||
|
|
uint8_t mask;
|
||
|
|
uint8_t shift;
|
||
|
|
const char *const options[];
|
||
|
|
};
|
||
|
|
|
||
|
|
#define to_routing_selector(_dev_attr) \
|
||
|
|
container_of(_dev_attr, struct aspeed_uart_routing_selector, dev_attr)
|
||
|
|
|
||
|
|
static ssize_t aspeed_uart_routing_show(struct device *dev,
|
||
|
|
struct device_attribute *attr,
|
||
|
|
char *buf);
|
||
|
|
|
||
|
|
static ssize_t aspeed_uart_routing_store(struct device *dev,
|
||
|
|
struct device_attribute *attr,
|
||
|
|
const char *buf, size_t count);
|
||
|
|
|
||
|
|
#define ROUTING_ATTR(_name) { \
|
||
|
|
.attr = {.name = _name, \
|
||
|
|
.mode = VERIFY_OCTAL_PERMISSIONS(0644) }, \
|
||
|
|
.show = aspeed_uart_routing_show, \
|
||
|
|
.store = aspeed_uart_routing_store, \
|
||
|
|
}
|
||
|
|
|
||
|
|
/* routing selector for AST25xx */
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_io6_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO6),
|
||
|
|
.reg = HICR9,
|
||
|
|
.shift = 8,
|
||
|
|
.mask = 0xf,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART5,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO5,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_uart5_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART5),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 28,
|
||
|
|
.mask = 0xf,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO5,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_uart4_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART4),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 25,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_uart3_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART3),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 22,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_uart2_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART2),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 19,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_uart1_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART1),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 16,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_io5_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO5),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 12,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART5,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_io4_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO4),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 9,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART5,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_io3_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO3),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 6,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART5,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_io2_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO2),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 3,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART5,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2500_io1_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO1),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 0,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART5,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO6,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct attribute *ast2500_uart_routing_attrs[] = {
|
||
|
|
&ast2500_io6_sel.dev_attr.attr,
|
||
|
|
&ast2500_uart5_sel.dev_attr.attr,
|
||
|
|
&ast2500_uart4_sel.dev_attr.attr,
|
||
|
|
&ast2500_uart3_sel.dev_attr.attr,
|
||
|
|
&ast2500_uart2_sel.dev_attr.attr,
|
||
|
|
&ast2500_uart1_sel.dev_attr.attr,
|
||
|
|
&ast2500_io5_sel.dev_attr.attr,
|
||
|
|
&ast2500_io4_sel.dev_attr.attr,
|
||
|
|
&ast2500_io3_sel.dev_attr.attr,
|
||
|
|
&ast2500_io2_sel.dev_attr.attr,
|
||
|
|
&ast2500_io1_sel.dev_attr.attr,
|
||
|
|
NULL,
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct attribute_group ast2500_uart_routing_attr_group = {
|
||
|
|
.attrs = ast2500_uart_routing_attrs,
|
||
|
|
};
|
||
|
|
|
||
|
|
/* routing selector for AST26xx */
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_uart10_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART10),
|
||
|
|
.reg = HICR9,
|
||
|
|
.shift = 12,
|
||
|
|
.mask = 0xf,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_RES,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_io10_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO10),
|
||
|
|
.reg = HICR9,
|
||
|
|
.shift = 8,
|
||
|
|
.mask = 0xf,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_RES,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_RES,
|
||
|
|
UART_ROUTING_UART10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_uart4_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART4),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 25,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_uart3_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART3),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 22,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_uart2_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART2),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 19,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_uart1_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_UART1),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 16,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_io4_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO4),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 9,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART10,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_io3_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO3),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 6,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART10,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_IO1,
|
||
|
|
UART_ROUTING_IO2,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_io2_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO2),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 3,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART10,
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct aspeed_uart_routing_selector ast2600_io1_sel = {
|
||
|
|
.dev_attr = ROUTING_ATTR(UART_ROUTING_IO1),
|
||
|
|
.reg = HICRA,
|
||
|
|
.shift = 0,
|
||
|
|
.mask = 0x7,
|
||
|
|
.options = {
|
||
|
|
UART_ROUTING_UART1,
|
||
|
|
UART_ROUTING_UART2,
|
||
|
|
UART_ROUTING_UART3,
|
||
|
|
UART_ROUTING_UART4,
|
||
|
|
UART_ROUTING_UART10,
|
||
|
|
UART_ROUTING_IO3,
|
||
|
|
UART_ROUTING_IO4,
|
||
|
|
UART_ROUTING_IO10,
|
||
|
|
NULL,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct attribute *ast2600_uart_routing_attrs[] = {
|
||
|
|
&ast2600_uart10_sel.dev_attr.attr,
|
||
|
|
&ast2600_io10_sel.dev_attr.attr,
|
||
|
|
&ast2600_uart4_sel.dev_attr.attr,
|
||
|
|
&ast2600_uart3_sel.dev_attr.attr,
|
||
|
|
&ast2600_uart2_sel.dev_attr.attr,
|
||
|
|
&ast2600_uart1_sel.dev_attr.attr,
|
||
|
|
&ast2600_io4_sel.dev_attr.attr,
|
||
|
|
&ast2600_io3_sel.dev_attr.attr,
|
||
|
|
&ast2600_io2_sel.dev_attr.attr,
|
||
|
|
&ast2600_io1_sel.dev_attr.attr,
|
||
|
|
NULL,
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct attribute_group ast2600_uart_routing_attr_group = {
|
||
|
|
.attrs = ast2600_uart_routing_attrs,
|
||
|
|
};
|
||
|
|
|
||
|
|
static ssize_t aspeed_uart_routing_show(struct device *dev,
|
||
|
|
struct device_attribute *attr,
|
||
|
|
char *buf)
|
||
|
|
{
|
||
|
|
struct aspeed_uart_routing *uart_routing = dev_get_drvdata(dev);
|
||
|
|
struct aspeed_uart_routing_selector *sel = to_routing_selector(attr);
|
||
|
|
int val, pos, len;
|
||
|
|
|
||
|
|
regmap_read(uart_routing->map, sel->reg, &val);
|
||
|
|
val = (val >> sel->shift) & sel->mask;
|
||
|
|
|
||
|
|
len = 0;
|
||
|
|
for (pos = 0; sel->options[pos] != NULL; ++pos) {
|
||
|
|
if (pos == val)
|
||
|
|
len += sysfs_emit_at(buf, len, "[%s] ", sel->options[pos]);
|
||
|
|
else
|
||
|
|
len += sysfs_emit_at(buf, len, "%s ", sel->options[pos]);
|
||
|
|
}
|
||
|
|
|
||
|
|
if (val >= pos)
|
||
|
|
len += sysfs_emit_at(buf, len, "[unknown(%d)]", val);
|
||
|
|
|
||
|
|
len += sysfs_emit_at(buf, len, "\n");
|
||
|
|
|
||
|
|
return len;
|
||
|
|
}
|
||
|
|
|
||
|
|
static ssize_t aspeed_uart_routing_store(struct device *dev,
|
||
|
|
struct device_attribute *attr,
|
||
|
|
const char *buf, size_t count)
|
||
|
|
{
|
||
|
|
struct aspeed_uart_routing *uart_routing = dev_get_drvdata(dev);
|
||
|
|
struct aspeed_uart_routing_selector *sel = to_routing_selector(attr);
|
||
|
|
int val;
|
||
|
|
|
||
|
|
val = __sysfs_match_string(sel->options, -1, buf);
|
||
|
|
if (val < 0) {
|
||
|
|
dev_err(dev, "invalid value \"%s\"\n", buf);
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
regmap_update_bits(uart_routing->map, sel->reg,
|
||
|
|
(sel->mask << sel->shift),
|
||
|
|
(val & sel->mask) << sel->shift);
|
||
|
|
|
||
|
|
return count;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int aspeed_uart_routing_probe(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
int rc;
|
||
|
|
struct device *dev = &pdev->dev;
|
||
|
|
struct aspeed_uart_routing *uart_routing;
|
||
|
|
|
||
|
|
uart_routing = devm_kzalloc(&pdev->dev, sizeof(*uart_routing), GFP_KERNEL);
|
||
|
|
if (!uart_routing)
|
||
|
|
return -ENOMEM;
|
||
|
|
|
||
|
|
uart_routing->map = syscon_node_to_regmap(dev->parent->of_node);
|
||
|
|
if (IS_ERR(uart_routing->map)) {
|
||
|
|
dev_err(dev, "cannot get regmap\n");
|
||
|
|
return PTR_ERR(uart_routing->map);
|
||
|
|
}
|
||
|
|
|
||
|
|
uart_routing->attr_grp = of_device_get_match_data(dev);
|
||
|
|
|
||
|
|
rc = sysfs_create_group(&dev->kobj, uart_routing->attr_grp);
|
||
|
|
if (rc < 0)
|
||
|
|
return rc;
|
||
|
|
|
||
|
|
dev_set_drvdata(dev, uart_routing);
|
||
|
|
|
||
|
|
dev_info(dev, "module loaded\n");
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int aspeed_uart_routing_remove(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
struct device *dev = &pdev->dev;
|
||
|
|
struct aspeed_uart_routing *uart_routing = platform_get_drvdata(pdev);
|
||
|
|
|
||
|
|
sysfs_remove_group(&dev->kobj, uart_routing->attr_grp);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct of_device_id aspeed_uart_routing_table[] = {
|
||
|
|
{ .compatible = "aspeed,ast2400-uart-routing",
|
||
|
|
.data = &ast2500_uart_routing_attr_group },
|
||
|
|
{ .compatible = "aspeed,ast2500-uart-routing",
|
||
|
|
.data = &ast2500_uart_routing_attr_group },
|
||
|
|
{ .compatible = "aspeed,ast2600-uart-routing",
|
||
|
|
.data = &ast2600_uart_routing_attr_group },
|
||
|
|
{ },
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct platform_driver aspeed_uart_routing_driver = {
|
||
|
|
.driver = {
|
||
|
|
.name = "aspeed-uart-routing",
|
||
|
|
.of_match_table = aspeed_uart_routing_table,
|
||
|
|
},
|
||
|
|
.probe = aspeed_uart_routing_probe,
|
||
|
|
.remove = aspeed_uart_routing_remove,
|
||
|
|
};
|
||
|
|
|
||
|
|
module_platform_driver(aspeed_uart_routing_driver);
|
||
|
|
|
||
|
|
MODULE_AUTHOR("Oskar Senft <osk@google.com>");
|
||
|
|
MODULE_AUTHOR("Chia-Wei Wang <chiawei_wang@aspeedtech.com>");
|
||
|
|
MODULE_LICENSE("GPL v2");
|
||
|
|
MODULE_DESCRIPTION("Driver to configure Aspeed UART routing");
|