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