Blame view

kernel/linux-rt-4.4.41/drivers/media/rc/sunxi-cir.c 8.93 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
  /*
   * Driver for Allwinner sunXi IR controller
   *
   * Copyright (C) 2014 Alexsey Shestacov <wingrime@linux-sunxi.org>
   * Copyright (C) 2014 Alexander Bersenev <bay@hackerdom.ru>
   *
   * Based on sun5i-ir.c:
   * Copyright (C) 2007-2012 Daniel Wang
   * Allwinner Technology Co., Ltd. <www.allwinnertech.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.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
   * GNU General Public License for more details.
   */
  
  #include <linux/clk.h>
  #include <linux/interrupt.h>
  #include <linux/module.h>
  #include <linux/of_platform.h>
  #include <linux/reset.h>
  #include <media/rc-core.h>
  
  #define SUNXI_IR_DEV "sunxi-ir"
  
  /* Registers */
  /* IR Control */
  #define SUNXI_IR_CTL_REG      0x00
  /* Global Enable */
  #define REG_CTL_GEN			BIT(0)
  /* RX block enable */
  #define REG_CTL_RXEN			BIT(1)
  /* CIR mode */
  #define REG_CTL_MD			(BIT(4) | BIT(5))
  
  /* Rx Config */
  #define SUNXI_IR_RXCTL_REG    0x10
  /* Pulse Polarity Invert flag */
  #define REG_RXCTL_RPPI			BIT(2)
  
  /* Rx Data */
  #define SUNXI_IR_RXFIFO_REG   0x20
  
  /* Rx Interrupt Enable */
  #define SUNXI_IR_RXINT_REG    0x2C
  /* Rx FIFO Overflow */
  #define REG_RXINT_ROI_EN		BIT(0)
  /* Rx Packet End */
  #define REG_RXINT_RPEI_EN		BIT(1)
  /* Rx FIFO Data Available */
  #define REG_RXINT_RAI_EN		BIT(4)
  
  /* Rx FIFO available byte level */
  #define REG_RXINT_RAL(val)    ((val) << 8)
  
  /* Rx Interrupt Status */
  #define SUNXI_IR_RXSTA_REG    0x30
  /* RX FIFO Get Available Counter */
  #define REG_RXSTA_GET_AC(val) (((val) >> 8) & (ir->fifo_size * 2 - 1))
  /* Clear all interrupt status value */
  #define REG_RXSTA_CLEARALL    0xff
  
  /* IR Sample Config */
  #define SUNXI_IR_CIR_REG      0x34
  /* CIR_REG register noise threshold */
  #define REG_CIR_NTHR(val)    (((val) << 2) & (GENMASK(7, 2)))
  /* CIR_REG register idle threshold */
  #define REG_CIR_ITHR(val)    (((val) << 8) & (GENMASK(15, 8)))
  
  /* Required frequency for IR0 or IR1 clock in CIR mode */
  #define SUNXI_IR_BASE_CLK     8000000
  /* Frequency after IR internal divider  */
  #define SUNXI_IR_CLK          (SUNXI_IR_BASE_CLK / 64)
  /* Sample period in ns */
  #define SUNXI_IR_SAMPLE       (1000000000ul / SUNXI_IR_CLK)
  /* Noise threshold in samples  */
  #define SUNXI_IR_RXNOISE      1
  /* Idle Threshold in samples */
  #define SUNXI_IR_RXIDLE       20
  /* Time after which device stops sending data in ms */
  #define SUNXI_IR_TIMEOUT      120
  
  struct sunxi_ir {
  	spinlock_t      ir_lock;
  	struct rc_dev   *rc;
  	void __iomem    *base;
  	int             irq;
  	int		fifo_size;
  	struct clk      *clk;
  	struct clk      *apb_clk;
  	struct reset_control *rst;
  	const char      *map_name;
  };
  
  static irqreturn_t sunxi_ir_irq(int irqno, void *dev_id)
  {
  	unsigned long status;
  	unsigned char dt;
  	unsigned int cnt, rc;
  	struct sunxi_ir *ir = dev_id;
  	DEFINE_IR_RAW_EVENT(rawir);
  
  	spin_lock(&ir->ir_lock);
  
  	status = readl(ir->base + SUNXI_IR_RXSTA_REG);
  
  	/* clean all pending statuses */
  	writel(status | REG_RXSTA_CLEARALL, ir->base + SUNXI_IR_RXSTA_REG);
  
  	if (status & (REG_RXINT_RAI_EN | REG_RXINT_RPEI_EN)) {
  		/* How many messages in fifo */
  		rc  = REG_RXSTA_GET_AC(status);
  		/* Sanity check */
  		rc = rc > ir->fifo_size ? ir->fifo_size : rc;
  		/* If we have data */
  		for (cnt = 0; cnt < rc; cnt++) {
  			/* for each bit in fifo */
  			dt = readb(ir->base + SUNXI_IR_RXFIFO_REG);
  			rawir.pulse = (dt & 0x80) != 0;
  			rawir.duration = ((dt & 0x7f) + 1) * SUNXI_IR_SAMPLE;
  			ir_raw_event_store_with_filter(ir->rc, &rawir);
  		}
  	}
  
  	if (status & REG_RXINT_ROI_EN) {
  		ir_raw_event_reset(ir->rc);
  	} else if (status & REG_RXINT_RPEI_EN) {
  		ir_raw_event_set_idle(ir->rc, true);
  		ir_raw_event_handle(ir->rc);
  	}
  
  	spin_unlock(&ir->ir_lock);
  
  	return IRQ_HANDLED;
  }
  
  static int sunxi_ir_probe(struct platform_device *pdev)
  {
  	int ret = 0;
  	unsigned long tmp = 0;
  
  	struct device *dev = &pdev->dev;
  	struct device_node *dn = dev->of_node;
  	struct resource *res;
  	struct sunxi_ir *ir;
  
  	ir = devm_kzalloc(dev, sizeof(struct sunxi_ir), GFP_KERNEL);
  	if (!ir)
  		return -ENOMEM;
  
  	spin_lock_init(&ir->ir_lock);
  
  	if (of_device_is_compatible(dn, "allwinner,sun5i-a13-ir"))
  		ir->fifo_size = 64;
  	else
  		ir->fifo_size = 16;
  
  	/* Clock */
  	ir->apb_clk = devm_clk_get(dev, "apb");
  	if (IS_ERR(ir->apb_clk)) {
  		dev_err(dev, "failed to get a apb clock.
  ");
  		return PTR_ERR(ir->apb_clk);
  	}
  	ir->clk = devm_clk_get(dev, "ir");
  	if (IS_ERR(ir->clk)) {
  		dev_err(dev, "failed to get a ir clock.
  ");
  		return PTR_ERR(ir->clk);
  	}
  
  	/* Reset (optional) */
  	ir->rst = devm_reset_control_get_optional(dev, NULL);
  	if (IS_ERR(ir->rst)) {
  		ret = PTR_ERR(ir->rst);
  		if (ret == -EPROBE_DEFER)
  			return ret;
  		ir->rst = NULL;
  	} else {
  		ret = reset_control_deassert(ir->rst);
  		if (ret)
  			return ret;
  	}
  
  	ret = clk_set_rate(ir->clk, SUNXI_IR_BASE_CLK);
  	if (ret) {
  		dev_err(dev, "set ir base clock failed!
  ");
  		goto exit_reset_assert;
  	}
  
  	if (clk_prepare_enable(ir->apb_clk)) {
  		dev_err(dev, "try to enable apb_ir_clk failed
  ");
  		ret = -EINVAL;
  		goto exit_reset_assert;
  	}
  
  	if (clk_prepare_enable(ir->clk)) {
  		dev_err(dev, "try to enable ir_clk failed
  ");
  		ret = -EINVAL;
  		goto exit_clkdisable_apb_clk;
  	}
  
  	/* IO */
  	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  	ir->base = devm_ioremap_resource(dev, res);
  	if (IS_ERR(ir->base)) {
  		dev_err(dev, "failed to map registers
  ");
  		ret = PTR_ERR(ir->base);
  		goto exit_clkdisable_clk;
  	}
  
  	ir->rc = rc_allocate_device();
  	if (!ir->rc) {
  		dev_err(dev, "failed to allocate device
  ");
  		ret = -ENOMEM;
  		goto exit_clkdisable_clk;
  	}
  
  	ir->rc->priv = ir;
  	ir->rc->input_name = SUNXI_IR_DEV;
  	ir->rc->input_phys = "sunxi-ir/input0";
  	ir->rc->input_id.bustype = BUS_HOST;
  	ir->rc->input_id.vendor = 0x0001;
  	ir->rc->input_id.product = 0x0001;
  	ir->rc->input_id.version = 0x0100;
  	ir->map_name = of_get_property(dn, "linux,rc-map-name", NULL);
  	ir->rc->map_name = ir->map_name ?: RC_MAP_EMPTY;
  	ir->rc->dev.parent = dev;
  	ir->rc->driver_type = RC_DRIVER_IR_RAW;
  	ir->rc->allowed_protocols = RC_BIT_ALL;
  	ir->rc->rx_resolution = SUNXI_IR_SAMPLE;
  	ir->rc->timeout = MS_TO_NS(SUNXI_IR_TIMEOUT);
  	ir->rc->driver_name = SUNXI_IR_DEV;
  
  	ret = rc_register_device(ir->rc);
  	if (ret) {
  		dev_err(dev, "failed to register rc device
  ");
  		goto exit_free_dev;
  	}
  
  	platform_set_drvdata(pdev, ir);
  
  	/* IRQ */
  	ir->irq = platform_get_irq(pdev, 0);
  	if (ir->irq < 0) {
  		dev_err(dev, "no irq resource
  ");
  		ret = ir->irq;
  		goto exit_free_dev;
  	}
  
  	ret = devm_request_irq(dev, ir->irq, sunxi_ir_irq, 0, SUNXI_IR_DEV, ir);
  	if (ret) {
  		dev_err(dev, "failed request irq
  ");
  		goto exit_free_dev;
  	}
  
  	/* Enable CIR Mode */
  	writel(REG_CTL_MD, ir->base+SUNXI_IR_CTL_REG);
  
  	/* Set noise threshold and idle threshold */
  	writel(REG_CIR_NTHR(SUNXI_IR_RXNOISE)|REG_CIR_ITHR(SUNXI_IR_RXIDLE),
  	       ir->base + SUNXI_IR_CIR_REG);
  
  	/* Invert Input Signal */
  	writel(REG_RXCTL_RPPI, ir->base + SUNXI_IR_RXCTL_REG);
  
  	/* Clear All Rx Interrupt Status */
  	writel(REG_RXSTA_CLEARALL, ir->base + SUNXI_IR_RXSTA_REG);
  
  	/*
  	 * Enable IRQ on overflow, packet end, FIFO available with trigger
  	 * level
  	 */
  	writel(REG_RXINT_ROI_EN | REG_RXINT_RPEI_EN |
  	       REG_RXINT_RAI_EN | REG_RXINT_RAL(ir->fifo_size / 2 - 1),
  	       ir->base + SUNXI_IR_RXINT_REG);
  
  	/* Enable IR Module */
  	tmp = readl(ir->base + SUNXI_IR_CTL_REG);
  	writel(tmp | REG_CTL_GEN | REG_CTL_RXEN, ir->base + SUNXI_IR_CTL_REG);
  
  	dev_info(dev, "initialized sunXi IR driver
  ");
  	return 0;
  
  exit_free_dev:
  	rc_free_device(ir->rc);
  exit_clkdisable_clk:
  	clk_disable_unprepare(ir->clk);
  exit_clkdisable_apb_clk:
  	clk_disable_unprepare(ir->apb_clk);
  exit_reset_assert:
  	if (ir->rst)
  		reset_control_assert(ir->rst);
  
  	return ret;
  }
  
  static int sunxi_ir_remove(struct platform_device *pdev)
  {
  	unsigned long flags;
  	struct sunxi_ir *ir = platform_get_drvdata(pdev);
  
  	clk_disable_unprepare(ir->clk);
  	clk_disable_unprepare(ir->apb_clk);
  	if (ir->rst)
  		reset_control_assert(ir->rst);
  
  	spin_lock_irqsave(&ir->ir_lock, flags);
  	/* disable IR IRQ */
  	writel(0, ir->base + SUNXI_IR_RXINT_REG);
  	/* clear All Rx Interrupt Status */
  	writel(REG_RXSTA_CLEARALL, ir->base + SUNXI_IR_RXSTA_REG);
  	/* disable IR */
  	writel(0, ir->base + SUNXI_IR_CTL_REG);
  	spin_unlock_irqrestore(&ir->ir_lock, flags);
  
  	rc_unregister_device(ir->rc);
  	return 0;
  }
  
  static const struct of_device_id sunxi_ir_match[] = {
  	{ .compatible = "allwinner,sun4i-a10-ir", },
  	{ .compatible = "allwinner,sun5i-a13-ir", },
  	{},
  };
  
  static struct platform_driver sunxi_ir_driver = {
  	.probe          = sunxi_ir_probe,
  	.remove         = sunxi_ir_remove,
  	.driver = {
  		.name = SUNXI_IR_DEV,
  		.of_match_table = sunxi_ir_match,
  	},
  };
  
  module_platform_driver(sunxi_ir_driver);
  
  MODULE_DESCRIPTION("Allwinner sunXi IR controller driver");
  MODULE_AUTHOR("Alexsey Shestacov <wingrime@linux-sunxi.org>");
  MODULE_LICENSE("GPL");