xref: /OK3568_Linux_fs/kernel/drivers/char/ipmi/kcs_bmc_aspeed.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (c) 2015-2018, Intel Corporation.
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #define pr_fmt(fmt) "aspeed-kcs-bmc: " fmt
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include <linux/atomic.h>
9*4882a593Smuzhiyun #include <linux/errno.h>
10*4882a593Smuzhiyun #include <linux/interrupt.h>
11*4882a593Smuzhiyun #include <linux/io.h>
12*4882a593Smuzhiyun #include <linux/mfd/syscon.h>
13*4882a593Smuzhiyun #include <linux/module.h>
14*4882a593Smuzhiyun #include <linux/of.h>
15*4882a593Smuzhiyun #include <linux/of_address.h>
16*4882a593Smuzhiyun #include <linux/platform_device.h>
17*4882a593Smuzhiyun #include <linux/poll.h>
18*4882a593Smuzhiyun #include <linux/regmap.h>
19*4882a593Smuzhiyun #include <linux/sched.h>
20*4882a593Smuzhiyun #include <linux/slab.h>
21*4882a593Smuzhiyun #include <linux/timer.h>
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun #include "kcs_bmc.h"
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #define DEVICE_NAME     "ast-kcs-bmc"
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun #define KCS_CHANNEL_MAX     4
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun /* mapped to lpc-bmc@0 IO space */
31*4882a593Smuzhiyun #define LPC_HICR0            0x000
32*4882a593Smuzhiyun #define     LPC_HICR0_LPC3E          BIT(7)
33*4882a593Smuzhiyun #define     LPC_HICR0_LPC2E          BIT(6)
34*4882a593Smuzhiyun #define     LPC_HICR0_LPC1E          BIT(5)
35*4882a593Smuzhiyun #define LPC_HICR2            0x008
36*4882a593Smuzhiyun #define     LPC_HICR2_IBFIF3         BIT(3)
37*4882a593Smuzhiyun #define     LPC_HICR2_IBFIF2         BIT(2)
38*4882a593Smuzhiyun #define     LPC_HICR2_IBFIF1         BIT(1)
39*4882a593Smuzhiyun #define LPC_HICR4            0x010
40*4882a593Smuzhiyun #define     LPC_HICR4_LADR12AS       BIT(7)
41*4882a593Smuzhiyun #define     LPC_HICR4_KCSENBL        BIT(2)
42*4882a593Smuzhiyun #define LPC_LADR3H           0x014
43*4882a593Smuzhiyun #define LPC_LADR3L           0x018
44*4882a593Smuzhiyun #define LPC_LADR12H          0x01C
45*4882a593Smuzhiyun #define LPC_LADR12L          0x020
46*4882a593Smuzhiyun #define LPC_IDR1             0x024
47*4882a593Smuzhiyun #define LPC_IDR2             0x028
48*4882a593Smuzhiyun #define LPC_IDR3             0x02C
49*4882a593Smuzhiyun #define LPC_ODR1             0x030
50*4882a593Smuzhiyun #define LPC_ODR2             0x034
51*4882a593Smuzhiyun #define LPC_ODR3             0x038
52*4882a593Smuzhiyun #define LPC_STR1             0x03C
53*4882a593Smuzhiyun #define LPC_STR2             0x040
54*4882a593Smuzhiyun #define LPC_STR3             0x044
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun /* mapped to lpc-host@80 IO space */
57*4882a593Smuzhiyun #define LPC_HICRB            0x080
58*4882a593Smuzhiyun #define     LPC_HICRB_IBFIF4         BIT(1)
59*4882a593Smuzhiyun #define     LPC_HICRB_LPC4E          BIT(0)
60*4882a593Smuzhiyun #define LPC_LADR4            0x090
61*4882a593Smuzhiyun #define LPC_IDR4             0x094
62*4882a593Smuzhiyun #define LPC_ODR4             0x098
63*4882a593Smuzhiyun #define LPC_STR4             0x09C
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun struct aspeed_kcs_bmc {
66*4882a593Smuzhiyun 	struct regmap *map;
67*4882a593Smuzhiyun };
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun 
aspeed_kcs_inb(struct kcs_bmc * kcs_bmc,u32 reg)70*4882a593Smuzhiyun static u8 aspeed_kcs_inb(struct kcs_bmc *kcs_bmc, u32 reg)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun 	struct aspeed_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc);
73*4882a593Smuzhiyun 	u32 val = 0;
74*4882a593Smuzhiyun 	int rc;
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun 	rc = regmap_read(priv->map, reg, &val);
77*4882a593Smuzhiyun 	WARN(rc != 0, "regmap_read() failed: %d\n", rc);
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun 	return rc == 0 ? (u8) val : 0;
80*4882a593Smuzhiyun }
81*4882a593Smuzhiyun 
aspeed_kcs_outb(struct kcs_bmc * kcs_bmc,u32 reg,u8 data)82*4882a593Smuzhiyun static void aspeed_kcs_outb(struct kcs_bmc *kcs_bmc, u32 reg, u8 data)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun 	struct aspeed_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc);
85*4882a593Smuzhiyun 	int rc;
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun 	rc = regmap_write(priv->map, reg, data);
88*4882a593Smuzhiyun 	WARN(rc != 0, "regmap_write() failed: %d\n", rc);
89*4882a593Smuzhiyun }
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun /*
93*4882a593Smuzhiyun  * AST_usrGuide_KCS.pdf
94*4882a593Smuzhiyun  * 2. Background:
95*4882a593Smuzhiyun  *   we note D for Data, and C for Cmd/Status, default rules are
96*4882a593Smuzhiyun  *     A. KCS1 / KCS2 ( D / C:X / X+4 )
97*4882a593Smuzhiyun  *        D / C : CA0h / CA4h
98*4882a593Smuzhiyun  *        D / C : CA8h / CACh
99*4882a593Smuzhiyun  *     B. KCS3 ( D / C:XX2h / XX3h )
100*4882a593Smuzhiyun  *        D / C : CA2h / CA3h
101*4882a593Smuzhiyun  *        D / C : CB2h / CB3h
102*4882a593Smuzhiyun  *     C. KCS4
103*4882a593Smuzhiyun  *        D / C : CA4h / CA5h
104*4882a593Smuzhiyun  */
aspeed_kcs_set_address(struct kcs_bmc * kcs_bmc,u16 addr)105*4882a593Smuzhiyun static void aspeed_kcs_set_address(struct kcs_bmc *kcs_bmc, u16 addr)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun 	struct aspeed_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc);
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 	switch (kcs_bmc->channel) {
110*4882a593Smuzhiyun 	case 1:
111*4882a593Smuzhiyun 		regmap_update_bits(priv->map, LPC_HICR4,
112*4882a593Smuzhiyun 				LPC_HICR4_LADR12AS, 0);
113*4882a593Smuzhiyun 		regmap_write(priv->map, LPC_LADR12H, addr >> 8);
114*4882a593Smuzhiyun 		regmap_write(priv->map, LPC_LADR12L, addr & 0xFF);
115*4882a593Smuzhiyun 		break;
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun 	case 2:
118*4882a593Smuzhiyun 		regmap_update_bits(priv->map, LPC_HICR4,
119*4882a593Smuzhiyun 				LPC_HICR4_LADR12AS, LPC_HICR4_LADR12AS);
120*4882a593Smuzhiyun 		regmap_write(priv->map, LPC_LADR12H, addr >> 8);
121*4882a593Smuzhiyun 		regmap_write(priv->map, LPC_LADR12L, addr & 0xFF);
122*4882a593Smuzhiyun 		break;
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 	case 3:
125*4882a593Smuzhiyun 		regmap_write(priv->map, LPC_LADR3H, addr >> 8);
126*4882a593Smuzhiyun 		regmap_write(priv->map, LPC_LADR3L, addr & 0xFF);
127*4882a593Smuzhiyun 		break;
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun 	case 4:
130*4882a593Smuzhiyun 		regmap_write(priv->map, LPC_LADR4, ((addr + 1) << 16) |
131*4882a593Smuzhiyun 			addr);
132*4882a593Smuzhiyun 		break;
133*4882a593Smuzhiyun 
134*4882a593Smuzhiyun 	default:
135*4882a593Smuzhiyun 		break;
136*4882a593Smuzhiyun 	}
137*4882a593Smuzhiyun }
138*4882a593Smuzhiyun 
aspeed_kcs_enable_channel(struct kcs_bmc * kcs_bmc,bool enable)139*4882a593Smuzhiyun static void aspeed_kcs_enable_channel(struct kcs_bmc *kcs_bmc, bool enable)
140*4882a593Smuzhiyun {
141*4882a593Smuzhiyun 	struct aspeed_kcs_bmc *priv = kcs_bmc_priv(kcs_bmc);
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 	switch (kcs_bmc->channel) {
144*4882a593Smuzhiyun 	case 1:
145*4882a593Smuzhiyun 		if (enable) {
146*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR2,
147*4882a593Smuzhiyun 					LPC_HICR2_IBFIF1, LPC_HICR2_IBFIF1);
148*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR0,
149*4882a593Smuzhiyun 					LPC_HICR0_LPC1E, LPC_HICR0_LPC1E);
150*4882a593Smuzhiyun 		} else {
151*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR0,
152*4882a593Smuzhiyun 					LPC_HICR0_LPC1E, 0);
153*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR2,
154*4882a593Smuzhiyun 					LPC_HICR2_IBFIF1, 0);
155*4882a593Smuzhiyun 		}
156*4882a593Smuzhiyun 		break;
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun 	case 2:
159*4882a593Smuzhiyun 		if (enable) {
160*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR2,
161*4882a593Smuzhiyun 					LPC_HICR2_IBFIF2, LPC_HICR2_IBFIF2);
162*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR0,
163*4882a593Smuzhiyun 					LPC_HICR0_LPC2E, LPC_HICR0_LPC2E);
164*4882a593Smuzhiyun 		} else {
165*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR0,
166*4882a593Smuzhiyun 					LPC_HICR0_LPC2E, 0);
167*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR2,
168*4882a593Smuzhiyun 					LPC_HICR2_IBFIF2, 0);
169*4882a593Smuzhiyun 		}
170*4882a593Smuzhiyun 		break;
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	case 3:
173*4882a593Smuzhiyun 		if (enable) {
174*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR2,
175*4882a593Smuzhiyun 					LPC_HICR2_IBFIF3, LPC_HICR2_IBFIF3);
176*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR0,
177*4882a593Smuzhiyun 					LPC_HICR0_LPC3E, LPC_HICR0_LPC3E);
178*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR4,
179*4882a593Smuzhiyun 					LPC_HICR4_KCSENBL, LPC_HICR4_KCSENBL);
180*4882a593Smuzhiyun 		} else {
181*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR0,
182*4882a593Smuzhiyun 					LPC_HICR0_LPC3E, 0);
183*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR4,
184*4882a593Smuzhiyun 					LPC_HICR4_KCSENBL, 0);
185*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICR2,
186*4882a593Smuzhiyun 					LPC_HICR2_IBFIF3, 0);
187*4882a593Smuzhiyun 		}
188*4882a593Smuzhiyun 		break;
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun 	case 4:
191*4882a593Smuzhiyun 		if (enable)
192*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICRB,
193*4882a593Smuzhiyun 					LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E,
194*4882a593Smuzhiyun 					LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E);
195*4882a593Smuzhiyun 		else
196*4882a593Smuzhiyun 			regmap_update_bits(priv->map, LPC_HICRB,
197*4882a593Smuzhiyun 					LPC_HICRB_IBFIF4 | LPC_HICRB_LPC4E,
198*4882a593Smuzhiyun 					0);
199*4882a593Smuzhiyun 		break;
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun 	default:
202*4882a593Smuzhiyun 		break;
203*4882a593Smuzhiyun 	}
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun 
aspeed_kcs_irq(int irq,void * arg)206*4882a593Smuzhiyun static irqreturn_t aspeed_kcs_irq(int irq, void *arg)
207*4882a593Smuzhiyun {
208*4882a593Smuzhiyun 	struct kcs_bmc *kcs_bmc = arg;
209*4882a593Smuzhiyun 
210*4882a593Smuzhiyun 	if (!kcs_bmc_handle_event(kcs_bmc))
211*4882a593Smuzhiyun 		return IRQ_HANDLED;
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 	return IRQ_NONE;
214*4882a593Smuzhiyun }
215*4882a593Smuzhiyun 
aspeed_kcs_config_irq(struct kcs_bmc * kcs_bmc,struct platform_device * pdev)216*4882a593Smuzhiyun static int aspeed_kcs_config_irq(struct kcs_bmc *kcs_bmc,
217*4882a593Smuzhiyun 			struct platform_device *pdev)
218*4882a593Smuzhiyun {
219*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
220*4882a593Smuzhiyun 	int irq;
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	irq = platform_get_irq(pdev, 0);
223*4882a593Smuzhiyun 	if (irq < 0)
224*4882a593Smuzhiyun 		return irq;
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	return devm_request_irq(dev, irq, aspeed_kcs_irq, IRQF_SHARED,
227*4882a593Smuzhiyun 				dev_name(dev), kcs_bmc);
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun static const struct kcs_ioreg ast_kcs_bmc_ioregs[KCS_CHANNEL_MAX] = {
231*4882a593Smuzhiyun 	{ .idr = LPC_IDR1, .odr = LPC_ODR1, .str = LPC_STR1 },
232*4882a593Smuzhiyun 	{ .idr = LPC_IDR2, .odr = LPC_ODR2, .str = LPC_STR2 },
233*4882a593Smuzhiyun 	{ .idr = LPC_IDR3, .odr = LPC_ODR3, .str = LPC_STR3 },
234*4882a593Smuzhiyun 	{ .idr = LPC_IDR4, .odr = LPC_ODR4, .str = LPC_STR4 },
235*4882a593Smuzhiyun };
236*4882a593Smuzhiyun 
aspeed_kcs_probe_of_v1(struct platform_device * pdev)237*4882a593Smuzhiyun static struct kcs_bmc *aspeed_kcs_probe_of_v1(struct platform_device *pdev)
238*4882a593Smuzhiyun {
239*4882a593Smuzhiyun 	struct aspeed_kcs_bmc *priv;
240*4882a593Smuzhiyun 	struct device_node *np;
241*4882a593Smuzhiyun 	struct kcs_bmc *kcs;
242*4882a593Smuzhiyun 	u32 channel;
243*4882a593Smuzhiyun 	u32 slave;
244*4882a593Smuzhiyun 	int rc;
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun 	np = pdev->dev.of_node;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	rc = of_property_read_u32(np, "kcs_chan", &channel);
249*4882a593Smuzhiyun 	if ((rc != 0) || (channel == 0 || channel > KCS_CHANNEL_MAX)) {
250*4882a593Smuzhiyun 		dev_err(&pdev->dev, "no valid 'kcs_chan' configured\n");
251*4882a593Smuzhiyun 		return ERR_PTR(-EINVAL);
252*4882a593Smuzhiyun 	}
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	kcs = kcs_bmc_alloc(&pdev->dev, sizeof(struct aspeed_kcs_bmc), channel);
255*4882a593Smuzhiyun 	if (!kcs)
256*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 	priv = kcs_bmc_priv(kcs);
259*4882a593Smuzhiyun 	priv->map = syscon_node_to_regmap(pdev->dev.parent->of_node);
260*4882a593Smuzhiyun 	if (IS_ERR(priv->map)) {
261*4882a593Smuzhiyun 		dev_err(&pdev->dev, "Couldn't get regmap\n");
262*4882a593Smuzhiyun 		return ERR_PTR(-ENODEV);
263*4882a593Smuzhiyun 	}
264*4882a593Smuzhiyun 
265*4882a593Smuzhiyun 	rc = of_property_read_u32(np, "kcs_addr", &slave);
266*4882a593Smuzhiyun 	if (rc) {
267*4882a593Smuzhiyun 		dev_err(&pdev->dev, "no valid 'kcs_addr' configured\n");
268*4882a593Smuzhiyun 		return ERR_PTR(-EINVAL);
269*4882a593Smuzhiyun 	}
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	kcs->ioreg = ast_kcs_bmc_ioregs[channel - 1];
272*4882a593Smuzhiyun 	aspeed_kcs_set_address(kcs, slave);
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun 	return kcs;
275*4882a593Smuzhiyun }
276*4882a593Smuzhiyun 
aspeed_kcs_calculate_channel(const struct kcs_ioreg * regs)277*4882a593Smuzhiyun static int aspeed_kcs_calculate_channel(const struct kcs_ioreg *regs)
278*4882a593Smuzhiyun {
279*4882a593Smuzhiyun 	int i;
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(ast_kcs_bmc_ioregs); i++) {
282*4882a593Smuzhiyun 		if (!memcmp(&ast_kcs_bmc_ioregs[i], regs, sizeof(*regs)))
283*4882a593Smuzhiyun 			return i + 1;
284*4882a593Smuzhiyun 	}
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	return -EINVAL;
287*4882a593Smuzhiyun }
288*4882a593Smuzhiyun 
aspeed_kcs_probe_of_v2(struct platform_device * pdev)289*4882a593Smuzhiyun static struct kcs_bmc *aspeed_kcs_probe_of_v2(struct platform_device *pdev)
290*4882a593Smuzhiyun {
291*4882a593Smuzhiyun 	struct aspeed_kcs_bmc *priv;
292*4882a593Smuzhiyun 	struct device_node *np;
293*4882a593Smuzhiyun 	struct kcs_ioreg ioreg;
294*4882a593Smuzhiyun 	struct kcs_bmc *kcs;
295*4882a593Smuzhiyun 	const __be32 *reg;
296*4882a593Smuzhiyun 	int channel;
297*4882a593Smuzhiyun 	u32 slave;
298*4882a593Smuzhiyun 	int rc;
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	np = pdev->dev.of_node;
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	/* Don't translate addresses, we want offsets for the regmaps */
303*4882a593Smuzhiyun 	reg = of_get_address(np, 0, NULL, NULL);
304*4882a593Smuzhiyun 	if (!reg)
305*4882a593Smuzhiyun 		return ERR_PTR(-EINVAL);
306*4882a593Smuzhiyun 	ioreg.idr = be32_to_cpup(reg);
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	reg = of_get_address(np, 1, NULL, NULL);
309*4882a593Smuzhiyun 	if (!reg)
310*4882a593Smuzhiyun 		return ERR_PTR(-EINVAL);
311*4882a593Smuzhiyun 	ioreg.odr = be32_to_cpup(reg);
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	reg = of_get_address(np, 2, NULL, NULL);
314*4882a593Smuzhiyun 	if (!reg)
315*4882a593Smuzhiyun 		return ERR_PTR(-EINVAL);
316*4882a593Smuzhiyun 	ioreg.str = be32_to_cpup(reg);
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	channel = aspeed_kcs_calculate_channel(&ioreg);
319*4882a593Smuzhiyun 	if (channel < 0)
320*4882a593Smuzhiyun 		return ERR_PTR(channel);
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	kcs = kcs_bmc_alloc(&pdev->dev, sizeof(struct aspeed_kcs_bmc), channel);
323*4882a593Smuzhiyun 	if (!kcs)
324*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun 	kcs->ioreg = ioreg;
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	priv = kcs_bmc_priv(kcs);
329*4882a593Smuzhiyun 	priv->map = syscon_node_to_regmap(pdev->dev.parent->of_node);
330*4882a593Smuzhiyun 	if (IS_ERR(priv->map)) {
331*4882a593Smuzhiyun 		dev_err(&pdev->dev, "Couldn't get regmap\n");
332*4882a593Smuzhiyun 		return ERR_PTR(-ENODEV);
333*4882a593Smuzhiyun 	}
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun 	rc = of_property_read_u32(np, "aspeed,lpc-io-reg", &slave);
336*4882a593Smuzhiyun 	if (rc)
337*4882a593Smuzhiyun 		return ERR_PTR(rc);
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	aspeed_kcs_set_address(kcs, slave);
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	return kcs;
342*4882a593Smuzhiyun }
343*4882a593Smuzhiyun 
aspeed_kcs_probe(struct platform_device * pdev)344*4882a593Smuzhiyun static int aspeed_kcs_probe(struct platform_device *pdev)
345*4882a593Smuzhiyun {
346*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
347*4882a593Smuzhiyun 	struct kcs_bmc *kcs_bmc;
348*4882a593Smuzhiyun 	struct device_node *np;
349*4882a593Smuzhiyun 	int rc;
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 	np = pdev->dev.of_node;
352*4882a593Smuzhiyun 	if (of_device_is_compatible(np, "aspeed,ast2400-kcs-bmc") ||
353*4882a593Smuzhiyun 			of_device_is_compatible(np, "aspeed,ast2500-kcs-bmc"))
354*4882a593Smuzhiyun 		kcs_bmc = aspeed_kcs_probe_of_v1(pdev);
355*4882a593Smuzhiyun 	else if (of_device_is_compatible(np, "aspeed,ast2400-kcs-bmc-v2") ||
356*4882a593Smuzhiyun 			of_device_is_compatible(np, "aspeed,ast2500-kcs-bmc-v2"))
357*4882a593Smuzhiyun 		kcs_bmc = aspeed_kcs_probe_of_v2(pdev);
358*4882a593Smuzhiyun 	else
359*4882a593Smuzhiyun 		return -EINVAL;
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	if (IS_ERR(kcs_bmc))
362*4882a593Smuzhiyun 		return PTR_ERR(kcs_bmc);
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun 	kcs_bmc->io_inputb = aspeed_kcs_inb;
365*4882a593Smuzhiyun 	kcs_bmc->io_outputb = aspeed_kcs_outb;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	rc = aspeed_kcs_config_irq(kcs_bmc, pdev);
368*4882a593Smuzhiyun 	if (rc)
369*4882a593Smuzhiyun 		return rc;
370*4882a593Smuzhiyun 
371*4882a593Smuzhiyun 	dev_set_drvdata(dev, kcs_bmc);
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun 	aspeed_kcs_enable_channel(kcs_bmc, true);
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	rc = misc_register(&kcs_bmc->miscdev);
376*4882a593Smuzhiyun 	if (rc) {
377*4882a593Smuzhiyun 		dev_err(dev, "Unable to register device\n");
378*4882a593Smuzhiyun 		return rc;
379*4882a593Smuzhiyun 	}
380*4882a593Smuzhiyun 
381*4882a593Smuzhiyun 	dev_dbg(&pdev->dev,
382*4882a593Smuzhiyun 		"Probed KCS device %d (IDR=0x%x, ODR=0x%x, STR=0x%x)\n",
383*4882a593Smuzhiyun 		kcs_bmc->channel, kcs_bmc->ioreg.idr, kcs_bmc->ioreg.odr,
384*4882a593Smuzhiyun 		kcs_bmc->ioreg.str);
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	return 0;
387*4882a593Smuzhiyun }
388*4882a593Smuzhiyun 
aspeed_kcs_remove(struct platform_device * pdev)389*4882a593Smuzhiyun static int aspeed_kcs_remove(struct platform_device *pdev)
390*4882a593Smuzhiyun {
391*4882a593Smuzhiyun 	struct kcs_bmc *kcs_bmc = dev_get_drvdata(&pdev->dev);
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 	misc_deregister(&kcs_bmc->miscdev);
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun 	return 0;
396*4882a593Smuzhiyun }
397*4882a593Smuzhiyun 
398*4882a593Smuzhiyun static const struct of_device_id ast_kcs_bmc_match[] = {
399*4882a593Smuzhiyun 	{ .compatible = "aspeed,ast2400-kcs-bmc" },
400*4882a593Smuzhiyun 	{ .compatible = "aspeed,ast2500-kcs-bmc" },
401*4882a593Smuzhiyun 	{ .compatible = "aspeed,ast2400-kcs-bmc-v2" },
402*4882a593Smuzhiyun 	{ .compatible = "aspeed,ast2500-kcs-bmc-v2" },
403*4882a593Smuzhiyun 	{ }
404*4882a593Smuzhiyun };
405*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, ast_kcs_bmc_match);
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun static struct platform_driver ast_kcs_bmc_driver = {
408*4882a593Smuzhiyun 	.driver = {
409*4882a593Smuzhiyun 		.name           = DEVICE_NAME,
410*4882a593Smuzhiyun 		.of_match_table = ast_kcs_bmc_match,
411*4882a593Smuzhiyun 	},
412*4882a593Smuzhiyun 	.probe  = aspeed_kcs_probe,
413*4882a593Smuzhiyun 	.remove = aspeed_kcs_remove,
414*4882a593Smuzhiyun };
415*4882a593Smuzhiyun module_platform_driver(ast_kcs_bmc_driver);
416*4882a593Smuzhiyun 
417*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
418*4882a593Smuzhiyun MODULE_AUTHOR("Haiyue Wang <haiyue.wang@linux.intel.com>");
419*4882a593Smuzhiyun MODULE_DESCRIPTION("Aspeed device interface to the KCS BMC device");
420