• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Copyright (C) 2015 Mans Rullgard <mans@mansr.com>
4  */
5 
6 #include <linux/input.h>
7 #include <linux/module.h>
8 #include <linux/platform_device.h>
9 #include <linux/interrupt.h>
10 #include <linux/io.h>
11 #include <linux/clk.h>
12 #include <linux/of.h>
13 #include <media/rc-core.h>
14 
15 #define DRIVER_NAME "tango-ir"
16 
17 #define IR_NEC_CTRL	0x00
18 #define IR_NEC_DATA	0x04
19 #define IR_CTRL		0x08
20 #define IR_RC5_CLK_DIV	0x0c
21 #define IR_RC5_DATA	0x10
22 #define IR_INT		0x14
23 
24 #define NEC_TIME_BASE	560
25 #define RC5_TIME_BASE	1778
26 
27 #define RC6_CTRL	0x00
28 #define RC6_CLKDIV	0x04
29 #define RC6_DATA0	0x08
30 #define RC6_DATA1	0x0c
31 #define RC6_DATA2	0x10
32 #define RC6_DATA3	0x14
33 #define RC6_DATA4	0x18
34 
35 #define RC6_CARRIER	36000
36 #define RC6_TIME_BASE	16
37 
38 #define NEC_CAP(n)	((n) << 24)
39 #define GPIO_SEL(n)	((n) << 16)
40 #define DISABLE_NEC	(BIT(4) | BIT(8))
41 #define ENABLE_RC5	(BIT(0) | BIT(9))
42 #define ENABLE_RC6	(BIT(0) | BIT(7))
43 #define ACK_IR_INT	(BIT(0) | BIT(1))
44 #define ACK_RC6_INT	(BIT(31))
45 
46 #define NEC_ANY (RC_PROTO_BIT_NEC | RC_PROTO_BIT_NECX | RC_PROTO_BIT_NEC32)
47 
48 struct tango_ir {
49 	void __iomem *rc5_base;
50 	void __iomem *rc6_base;
51 	struct rc_dev *rc;
52 	struct clk *clk;
53 };
54 
tango_ir_handle_nec(struct tango_ir * ir)55 static void tango_ir_handle_nec(struct tango_ir *ir)
56 {
57 	u32 v, code;
58 	enum rc_proto proto;
59 
60 	v = readl_relaxed(ir->rc5_base + IR_NEC_DATA);
61 	if (!v) {
62 		rc_repeat(ir->rc);
63 		return;
64 	}
65 
66 	code = ir_nec_bytes_to_scancode(v, v >> 8, v >> 16, v >> 24, &proto);
67 	rc_keydown(ir->rc, proto, code, 0);
68 }
69 
tango_ir_handle_rc5(struct tango_ir * ir)70 static void tango_ir_handle_rc5(struct tango_ir *ir)
71 {
72 	u32 data, field, toggle, addr, cmd, code;
73 
74 	data = readl_relaxed(ir->rc5_base + IR_RC5_DATA);
75 	if (data & BIT(31))
76 		return;
77 
78 	field = data >> 12 & 1;
79 	toggle = data >> 11 & 1;
80 	addr = data >> 6 & 0x1f;
81 	cmd = (data & 0x3f) | (field ^ 1) << 6;
82 
83 	code = RC_SCANCODE_RC5(addr, cmd);
84 	rc_keydown(ir->rc, RC_PROTO_RC5, code, toggle);
85 }
86 
tango_ir_handle_rc6(struct tango_ir * ir)87 static void tango_ir_handle_rc6(struct tango_ir *ir)
88 {
89 	u32 data0, data1, toggle, mode, addr, cmd, code;
90 
91 	data0 = readl_relaxed(ir->rc6_base + RC6_DATA0);
92 	data1 = readl_relaxed(ir->rc6_base + RC6_DATA1);
93 
94 	mode = data0 >> 1 & 7;
95 	if (mode != 0)
96 		return;
97 
98 	toggle = data0 & 1;
99 	addr = data0 >> 16;
100 	cmd = data1;
101 
102 	code = RC_SCANCODE_RC6_0(addr, cmd);
103 	rc_keydown(ir->rc, RC_PROTO_RC6_0, code, toggle);
104 }
105 
tango_ir_irq(int irq,void * dev_id)106 static irqreturn_t tango_ir_irq(int irq, void *dev_id)
107 {
108 	struct tango_ir *ir = dev_id;
109 	unsigned int rc5_stat;
110 	unsigned int rc6_stat;
111 
112 	rc5_stat = readl_relaxed(ir->rc5_base + IR_INT);
113 	writel_relaxed(rc5_stat, ir->rc5_base + IR_INT);
114 
115 	rc6_stat = readl_relaxed(ir->rc6_base + RC6_CTRL);
116 	writel_relaxed(rc6_stat, ir->rc6_base + RC6_CTRL);
117 
118 	if (!(rc5_stat & 3) && !(rc6_stat & BIT(31)))
119 		return IRQ_NONE;
120 
121 	if (rc5_stat & BIT(0))
122 		tango_ir_handle_rc5(ir);
123 
124 	if (rc5_stat & BIT(1))
125 		tango_ir_handle_nec(ir);
126 
127 	if (rc6_stat & BIT(31))
128 		tango_ir_handle_rc6(ir);
129 
130 	return IRQ_HANDLED;
131 }
132 
tango_change_protocol(struct rc_dev * dev,u64 * rc_type)133 static int tango_change_protocol(struct rc_dev *dev, u64 *rc_type)
134 {
135 	struct tango_ir *ir = dev->priv;
136 	u32 rc5_ctrl = DISABLE_NEC;
137 	u32 rc6_ctrl = 0;
138 
139 	if (*rc_type & NEC_ANY)
140 		rc5_ctrl = 0;
141 
142 	if (*rc_type & RC_PROTO_BIT_RC5)
143 		rc5_ctrl |= ENABLE_RC5;
144 
145 	if (*rc_type & RC_PROTO_BIT_RC6_0)
146 		rc6_ctrl = ENABLE_RC6;
147 
148 	writel_relaxed(rc5_ctrl, ir->rc5_base + IR_CTRL);
149 	writel_relaxed(rc6_ctrl, ir->rc6_base + RC6_CTRL);
150 
151 	return 0;
152 }
153 
tango_ir_probe(struct platform_device * pdev)154 static int tango_ir_probe(struct platform_device *pdev)
155 {
156 	const char *map_name = RC_MAP_TANGO;
157 	struct device *dev = &pdev->dev;
158 	struct rc_dev *rc;
159 	struct tango_ir *ir;
160 	struct resource *rc5_res;
161 	struct resource *rc6_res;
162 	u64 clkrate, clkdiv;
163 	int irq, err;
164 	u32 val;
165 
166 	rc5_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
167 	if (!rc5_res)
168 		return -EINVAL;
169 
170 	rc6_res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
171 	if (!rc6_res)
172 		return -EINVAL;
173 
174 	irq = platform_get_irq(pdev, 0);
175 	if (irq <= 0)
176 		return -EINVAL;
177 
178 	ir = devm_kzalloc(dev, sizeof(*ir), GFP_KERNEL);
179 	if (!ir)
180 		return -ENOMEM;
181 
182 	ir->rc5_base = devm_ioremap_resource(dev, rc5_res);
183 	if (IS_ERR(ir->rc5_base))
184 		return PTR_ERR(ir->rc5_base);
185 
186 	ir->rc6_base = devm_ioremap_resource(dev, rc6_res);
187 	if (IS_ERR(ir->rc6_base))
188 		return PTR_ERR(ir->rc6_base);
189 
190 	ir->clk = devm_clk_get(dev, NULL);
191 	if (IS_ERR(ir->clk))
192 		return PTR_ERR(ir->clk);
193 
194 	rc = devm_rc_allocate_device(dev, RC_DRIVER_SCANCODE);
195 	if (!rc)
196 		return -ENOMEM;
197 
198 	of_property_read_string(dev->of_node, "linux,rc-map-name", &map_name);
199 
200 	rc->device_name = DRIVER_NAME;
201 	rc->driver_name = DRIVER_NAME;
202 	rc->input_phys = DRIVER_NAME "/input0";
203 	rc->map_name = map_name;
204 	rc->allowed_protocols = NEC_ANY | RC_PROTO_BIT_RC5 | RC_PROTO_BIT_RC6_0;
205 	rc->change_protocol = tango_change_protocol;
206 	rc->priv = ir;
207 	ir->rc = rc;
208 
209 	err = clk_prepare_enable(ir->clk);
210 	if (err)
211 		return err;
212 
213 	clkrate = clk_get_rate(ir->clk);
214 
215 	clkdiv = clkrate * NEC_TIME_BASE;
216 	do_div(clkdiv, 1000000);
217 
218 	val = NEC_CAP(31) | GPIO_SEL(12) | clkdiv;
219 	writel_relaxed(val, ir->rc5_base + IR_NEC_CTRL);
220 
221 	clkdiv = clkrate * RC5_TIME_BASE;
222 	do_div(clkdiv, 1000000);
223 
224 	writel_relaxed(DISABLE_NEC, ir->rc5_base + IR_CTRL);
225 	writel_relaxed(clkdiv, ir->rc5_base + IR_RC5_CLK_DIV);
226 	writel_relaxed(ACK_IR_INT, ir->rc5_base + IR_INT);
227 
228 	clkdiv = clkrate * RC6_TIME_BASE;
229 	do_div(clkdiv, RC6_CARRIER);
230 
231 	writel_relaxed(ACK_RC6_INT, ir->rc6_base + RC6_CTRL);
232 	writel_relaxed((clkdiv >> 2) << 18 | clkdiv, ir->rc6_base + RC6_CLKDIV);
233 
234 	err = devm_request_irq(dev, irq, tango_ir_irq, IRQF_SHARED,
235 			       dev_name(dev), ir);
236 	if (err)
237 		goto err_clk;
238 
239 	err = devm_rc_register_device(dev, rc);
240 	if (err)
241 		goto err_clk;
242 
243 	platform_set_drvdata(pdev, ir);
244 	return 0;
245 
246 err_clk:
247 	clk_disable_unprepare(ir->clk);
248 	return err;
249 }
250 
tango_ir_remove(struct platform_device * pdev)251 static int tango_ir_remove(struct platform_device *pdev)
252 {
253 	struct tango_ir *ir = platform_get_drvdata(pdev);
254 
255 	clk_disable_unprepare(ir->clk);
256 	return 0;
257 }
258 
259 static const struct of_device_id tango_ir_dt_ids[] = {
260 	{ .compatible = "sigma,smp8642-ir" },
261 	{ }
262 };
263 MODULE_DEVICE_TABLE(of, tango_ir_dt_ids);
264 
265 static struct platform_driver tango_ir_driver = {
266 	.probe	= tango_ir_probe,
267 	.remove	= tango_ir_remove,
268 	.driver	= {
269 		.name		= DRIVER_NAME,
270 		.of_match_table	= tango_ir_dt_ids,
271 	},
272 };
273 module_platform_driver(tango_ir_driver);
274 
275 MODULE_DESCRIPTION("SMP86xx IR decoder driver");
276 MODULE_AUTHOR("Mans Rullgard <mans@mansr.com>");
277 MODULE_LICENSE("GPL");
278