mic: vop: Fix use-after-free on remove
[linux/fpc-iii.git] / drivers / media / rc / meson-ir.c
blob9914c83fecb983d9be4cfe75efdd72d87ab943c7
1 /*
2 * Driver for Amlogic Meson IR remote receiver
4 * Copyright (C) 2014 Beniamino Galvani <b.galvani@gmail.com>
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * version 2 as published by the Free Software Foundation.
10 * You should have received a copy of the GNU General Public License
11 * along with this program. If not, see <http://www.gnu.org/licenses/>.
14 #include <linux/device.h>
15 #include <linux/err.h>
16 #include <linux/interrupt.h>
17 #include <linux/io.h>
18 #include <linux/module.h>
19 #include <linux/of_platform.h>
20 #include <linux/platform_device.h>
21 #include <linux/spinlock.h>
22 #include <linux/bitfield.h>
24 #include <media/rc-core.h>
26 #define DRIVER_NAME "meson-ir"
28 /* valid on all Meson platforms */
29 #define IR_DEC_LDR_ACTIVE 0x00
30 #define IR_DEC_LDR_IDLE 0x04
31 #define IR_DEC_LDR_REPEAT 0x08
32 #define IR_DEC_BIT_0 0x0c
33 #define IR_DEC_REG0 0x10
34 #define IR_DEC_FRAME 0x14
35 #define IR_DEC_STATUS 0x18
36 #define IR_DEC_REG1 0x1c
37 /* only available on Meson 8b and newer */
38 #define IR_DEC_REG2 0x20
40 #define REG0_RATE_MASK GENMASK(11, 0)
42 #define DECODE_MODE_NEC 0x0
43 #define DECODE_MODE_RAW 0x2
45 /* Meson 6b uses REG1 to configure the mode */
46 #define REG1_MODE_MASK GENMASK(8, 7)
47 #define REG1_MODE_SHIFT 7
49 /* Meson 8b / GXBB use REG2 to configure the mode */
50 #define REG2_MODE_MASK GENMASK(3, 0)
51 #define REG2_MODE_SHIFT 0
53 #define REG1_TIME_IV_MASK GENMASK(28, 16)
55 #define REG1_IRQSEL_MASK GENMASK(3, 2)
56 #define REG1_IRQSEL_NEC_MODE 0
57 #define REG1_IRQSEL_RISE_FALL 1
58 #define REG1_IRQSEL_FALL 2
59 #define REG1_IRQSEL_RISE 3
61 #define REG1_RESET BIT(0)
62 #define REG1_ENABLE BIT(15)
64 #define STATUS_IR_DEC_IN BIT(8)
66 #define MESON_TRATE 10 /* us */
68 struct meson_ir {
69 void __iomem *reg;
70 struct rc_dev *rc;
71 spinlock_t lock;
74 static void meson_ir_set_mask(struct meson_ir *ir, unsigned int reg,
75 u32 mask, u32 value)
77 u32 data;
79 data = readl(ir->reg + reg);
80 data &= ~mask;
81 data |= (value & mask);
82 writel(data, ir->reg + reg);
85 static irqreturn_t meson_ir_irq(int irqno, void *dev_id)
87 struct meson_ir *ir = dev_id;
88 u32 duration, status;
89 struct ir_raw_event rawir = {};
91 spin_lock(&ir->lock);
93 duration = readl_relaxed(ir->reg + IR_DEC_REG1);
94 duration = FIELD_GET(REG1_TIME_IV_MASK, duration);
95 rawir.duration = US_TO_NS(duration * MESON_TRATE);
97 status = readl_relaxed(ir->reg + IR_DEC_STATUS);
98 rawir.pulse = !!(status & STATUS_IR_DEC_IN);
100 ir_raw_event_store_with_timeout(ir->rc, &rawir);
102 spin_unlock(&ir->lock);
104 return IRQ_HANDLED;
107 static int meson_ir_probe(struct platform_device *pdev)
109 struct device *dev = &pdev->dev;
110 struct device_node *node = dev->of_node;
111 struct resource *res;
112 const char *map_name;
113 struct meson_ir *ir;
114 int irq, ret;
116 ir = devm_kzalloc(dev, sizeof(struct meson_ir), GFP_KERNEL);
117 if (!ir)
118 return -ENOMEM;
120 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
121 ir->reg = devm_ioremap_resource(dev, res);
122 if (IS_ERR(ir->reg)) {
123 dev_err(dev, "failed to map registers\n");
124 return PTR_ERR(ir->reg);
127 irq = platform_get_irq(pdev, 0);
128 if (irq < 0) {
129 dev_err(dev, "no irq resource\n");
130 return irq;
133 ir->rc = devm_rc_allocate_device(dev, RC_DRIVER_IR_RAW);
134 if (!ir->rc) {
135 dev_err(dev, "failed to allocate rc device\n");
136 return -ENOMEM;
139 ir->rc->priv = ir;
140 ir->rc->device_name = DRIVER_NAME;
141 ir->rc->input_phys = DRIVER_NAME "/input0";
142 ir->rc->input_id.bustype = BUS_HOST;
143 map_name = of_get_property(node, "linux,rc-map-name", NULL);
144 ir->rc->map_name = map_name ? map_name : RC_MAP_EMPTY;
145 ir->rc->allowed_protocols = RC_PROTO_BIT_ALL_IR_DECODER;
146 ir->rc->rx_resolution = US_TO_NS(MESON_TRATE);
147 ir->rc->min_timeout = 1;
148 ir->rc->timeout = IR_DEFAULT_TIMEOUT;
149 ir->rc->max_timeout = 10 * IR_DEFAULT_TIMEOUT;
150 ir->rc->driver_name = DRIVER_NAME;
152 spin_lock_init(&ir->lock);
153 platform_set_drvdata(pdev, ir);
155 ret = devm_rc_register_device(dev, ir->rc);
156 if (ret) {
157 dev_err(dev, "failed to register rc device\n");
158 return ret;
161 ret = devm_request_irq(dev, irq, meson_ir_irq, 0, NULL, ir);
162 if (ret) {
163 dev_err(dev, "failed to request irq\n");
164 return ret;
167 /* Reset the decoder */
168 meson_ir_set_mask(ir, IR_DEC_REG1, REG1_RESET, REG1_RESET);
169 meson_ir_set_mask(ir, IR_DEC_REG1, REG1_RESET, 0);
171 /* Set general operation mode (= raw/software decoding) */
172 if (of_device_is_compatible(node, "amlogic,meson6-ir"))
173 meson_ir_set_mask(ir, IR_DEC_REG1, REG1_MODE_MASK,
174 FIELD_PREP(REG1_MODE_MASK, DECODE_MODE_RAW));
175 else
176 meson_ir_set_mask(ir, IR_DEC_REG2, REG2_MODE_MASK,
177 FIELD_PREP(REG2_MODE_MASK, DECODE_MODE_RAW));
179 /* Set rate */
180 meson_ir_set_mask(ir, IR_DEC_REG0, REG0_RATE_MASK, MESON_TRATE - 1);
181 /* IRQ on rising and falling edges */
182 meson_ir_set_mask(ir, IR_DEC_REG1, REG1_IRQSEL_MASK,
183 FIELD_PREP(REG1_IRQSEL_MASK, REG1_IRQSEL_RISE_FALL));
184 /* Enable the decoder */
185 meson_ir_set_mask(ir, IR_DEC_REG1, REG1_ENABLE, REG1_ENABLE);
187 dev_info(dev, "receiver initialized\n");
189 return 0;
192 static int meson_ir_remove(struct platform_device *pdev)
194 struct meson_ir *ir = platform_get_drvdata(pdev);
195 unsigned long flags;
197 /* Disable the decoder */
198 spin_lock_irqsave(&ir->lock, flags);
199 meson_ir_set_mask(ir, IR_DEC_REG1, REG1_ENABLE, 0);
200 spin_unlock_irqrestore(&ir->lock, flags);
202 return 0;
205 static void meson_ir_shutdown(struct platform_device *pdev)
207 struct device *dev = &pdev->dev;
208 struct device_node *node = dev->of_node;
209 struct meson_ir *ir = platform_get_drvdata(pdev);
210 unsigned long flags;
212 spin_lock_irqsave(&ir->lock, flags);
215 * Set operation mode to NEC/hardware decoding to give
216 * bootloader a chance to power the system back on
218 if (of_device_is_compatible(node, "amlogic,meson6-ir"))
219 meson_ir_set_mask(ir, IR_DEC_REG1, REG1_MODE_MASK,
220 DECODE_MODE_NEC << REG1_MODE_SHIFT);
221 else
222 meson_ir_set_mask(ir, IR_DEC_REG2, REG2_MODE_MASK,
223 DECODE_MODE_NEC << REG2_MODE_SHIFT);
225 /* Set rate to default value */
226 meson_ir_set_mask(ir, IR_DEC_REG0, REG0_RATE_MASK, 0x13);
228 spin_unlock_irqrestore(&ir->lock, flags);
231 static const struct of_device_id meson_ir_match[] = {
232 { .compatible = "amlogic,meson6-ir" },
233 { .compatible = "amlogic,meson8b-ir" },
234 { .compatible = "amlogic,meson-gxbb-ir" },
235 { },
237 MODULE_DEVICE_TABLE(of, meson_ir_match);
239 static struct platform_driver meson_ir_driver = {
240 .probe = meson_ir_probe,
241 .remove = meson_ir_remove,
242 .shutdown = meson_ir_shutdown,
243 .driver = {
244 .name = DRIVER_NAME,
245 .of_match_table = meson_ir_match,
249 module_platform_driver(meson_ir_driver);
251 MODULE_DESCRIPTION("Amlogic Meson IR remote receiver driver");
252 MODULE_AUTHOR("Beniamino Galvani <b.galvani@gmail.com>");
253 MODULE_LICENSE("GPL v2");