xref: /openbmc/linux/drivers/media/rc/mtk-cir.c (revision c900529f3d9161bfde5cca0754f83b4d3c3e0220)
1c942fddfSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
26691e7b9SSean Wang /*
36691e7b9SSean Wang  * Driver for Mediatek IR Receiver Controller
46691e7b9SSean Wang  *
56691e7b9SSean Wang  * Copyright (C) 2017 Sean Wang <sean.wang@mediatek.com>
66691e7b9SSean Wang  */
76691e7b9SSean Wang 
86691e7b9SSean Wang #include <linux/clk.h>
96691e7b9SSean Wang #include <linux/interrupt.h>
106691e7b9SSean Wang #include <linux/module.h>
11*7c7e33b7SRob Herring #include <linux/of.h>
12*7c7e33b7SRob Herring #include <linux/platform_device.h>
136691e7b9SSean Wang #include <linux/reset.h>
146691e7b9SSean Wang #include <media/rc-core.h>
156691e7b9SSean Wang 
166691e7b9SSean Wang #define MTK_IR_DEV KBUILD_MODNAME
176691e7b9SSean Wang 
186691e7b9SSean Wang /* Register to enable PWM and IR */
196691e7b9SSean Wang #define MTK_CONFIG_HIGH_REG       0x0c
2050c3c1baSSean Wang 
2150c3c1baSSean Wang /* Bit to enable IR pulse width detection */
226691e7b9SSean Wang #define MTK_PWM_EN		  BIT(13)
2350c3c1baSSean Wang 
2450c3c1baSSean Wang /*
2550c3c1baSSean Wang  * Register to setting ok count whose unit based on hardware sampling period
2650c3c1baSSean Wang  * indicating IR receiving completion and then making IRQ fires
2750c3c1baSSean Wang  */
281ad09bbfSSean Young #define MTK_OK_COUNT_MASK	  (GENMASK(22, 16))
291ad09bbfSSean Young #define MTK_OK_COUNT(x)		  ((x) << 16)
3050c3c1baSSean Wang 
3150c3c1baSSean Wang /* Bit to enable IR hardware function */
326691e7b9SSean Wang #define MTK_IR_EN		  BIT(0)
336691e7b9SSean Wang 
346691e7b9SSean Wang /* Bit to restart IR receiving */
356691e7b9SSean Wang #define MTK_IRCLR		  BIT(0)
366691e7b9SSean Wang 
3750c3c1baSSean Wang /* Fields containing pulse width data */
386691e7b9SSean Wang #define MTK_WIDTH_MASK		  (GENMASK(7, 0))
396691e7b9SSean Wang 
405dd4b89dSSean Young /* IR threshold */
415dd4b89dSSean Young #define MTK_IRTHD		 0x14
425dd4b89dSSean Young #define MTK_DG_CNT_MASK		 (GENMASK(12, 8))
435dd4b89dSSean Young #define MTK_DG_CNT(x)		 ((x) << 8)
445dd4b89dSSean Young 
456691e7b9SSean Wang /* Bit to enable interrupt */
466691e7b9SSean Wang #define MTK_IRINT_EN		  BIT(0)
476691e7b9SSean Wang 
486691e7b9SSean Wang /* Bit to clear interrupt status */
496691e7b9SSean Wang #define MTK_IRINT_CLR		  BIT(0)
506691e7b9SSean Wang 
516691e7b9SSean Wang /* Maximum count of samples */
526691e7b9SSean Wang #define MTK_MAX_SAMPLES		  0xff
536691e7b9SSean Wang /* Indicate the end of IR message */
546691e7b9SSean Wang #define MTK_IR_END(v, p)	  ((v) == MTK_MAX_SAMPLES && (p) == 0)
556691e7b9SSean Wang /* Number of registers to record the pulse width */
566691e7b9SSean Wang #define MTK_CHKDATA_SZ		  17
57528222d8SSean Young /* Sample period in us */
58528222d8SSean Young #define MTK_IR_SAMPLE		  46
5950c3c1baSSean Wang 
6050c3c1baSSean Wang enum mtk_fields {
6150c3c1baSSean Wang 	/* Register to setting software sampling period */
6250c3c1baSSean Wang 	MTK_CHK_PERIOD,
6350c3c1baSSean Wang 	/* Register to setting hardware sampling period */
6450c3c1baSSean Wang 	MTK_HW_PERIOD,
6550c3c1baSSean Wang };
6650c3c1baSSean Wang 
6750c3c1baSSean Wang enum mtk_regs {
6850c3c1baSSean Wang 	/* Register to clear state of state machine */
6950c3c1baSSean Wang 	MTK_IRCLR_REG,
7050c3c1baSSean Wang 	/* Register containing pulse width data */
7150c3c1baSSean Wang 	MTK_CHKDATA_REG,
7250c3c1baSSean Wang 	/* Register to enable IR interrupt */
7350c3c1baSSean Wang 	MTK_IRINT_EN_REG,
7450c3c1baSSean Wang 	/* Register to ack IR interrupt */
7550c3c1baSSean Wang 	MTK_IRINT_CLR_REG
7650c3c1baSSean Wang };
7750c3c1baSSean Wang 
7850c3c1baSSean Wang static const u32 mt7623_regs[] = {
7950c3c1baSSean Wang 	[MTK_IRCLR_REG] =	0x20,
8050c3c1baSSean Wang 	[MTK_CHKDATA_REG] =	0x88,
8150c3c1baSSean Wang 	[MTK_IRINT_EN_REG] =	0xcc,
8250c3c1baSSean Wang 	[MTK_IRINT_CLR_REG] =	0xd0,
8350c3c1baSSean Wang };
8450c3c1baSSean Wang 
8558389982SSean Wang static const u32 mt7622_regs[] = {
8658389982SSean Wang 	[MTK_IRCLR_REG] =	0x18,
8758389982SSean Wang 	[MTK_CHKDATA_REG] =	0x30,
8858389982SSean Wang 	[MTK_IRINT_EN_REG] =	0x1c,
8958389982SSean Wang 	[MTK_IRINT_CLR_REG] =	0x20,
9058389982SSean Wang };
9158389982SSean Wang 
9250c3c1baSSean Wang struct mtk_field_type {
9350c3c1baSSean Wang 	u32 reg;
9450c3c1baSSean Wang 	u8 offset;
9550c3c1baSSean Wang 	u32 mask;
9650c3c1baSSean Wang };
9750c3c1baSSean Wang 
9850c3c1baSSean Wang /*
9950c3c1baSSean Wang  * struct mtk_ir_data -	This is the structure holding all differences among
10050c3c1baSSean Wang 			various hardwares
10150c3c1baSSean Wang  * @regs:		The pointer to the array holding registers offset
10250c3c1baSSean Wang  * @fields:		The pointer to the array holding fields location
10350c3c1baSSean Wang  * @div:		The internal divisor for the based reference clock
10450c3c1baSSean Wang  * @ok_count:		The count indicating the completion of IR data
10550c3c1baSSean Wang  *			receiving when count is reached
10650c3c1baSSean Wang  * @hw_period:		The value indicating the hardware sampling period
10750c3c1baSSean Wang  */
10850c3c1baSSean Wang struct mtk_ir_data {
10950c3c1baSSean Wang 	const u32 *regs;
11050c3c1baSSean Wang 	const struct mtk_field_type *fields;
11150c3c1baSSean Wang 	u8 div;
11250c3c1baSSean Wang 	u8 ok_count;
11350c3c1baSSean Wang 	u32 hw_period;
11450c3c1baSSean Wang };
11550c3c1baSSean Wang 
11650c3c1baSSean Wang static const struct mtk_field_type mt7623_fields[] = {
11750c3c1baSSean Wang 	[MTK_CHK_PERIOD] = {0x10, 8, GENMASK(20, 8)},
11850c3c1baSSean Wang 	[MTK_HW_PERIOD] = {0x10, 0, GENMASK(7, 0)},
11950c3c1baSSean Wang };
1206691e7b9SSean Wang 
12158389982SSean Wang static const struct mtk_field_type mt7622_fields[] = {
12258389982SSean Wang 	[MTK_CHK_PERIOD] = {0x24, 0, GENMASK(24, 0)},
12358389982SSean Wang 	[MTK_HW_PERIOD] = {0x10, 0, GENMASK(24, 0)},
12458389982SSean Wang };
12558389982SSean Wang 
1266691e7b9SSean Wang /*
1276691e7b9SSean Wang  * struct mtk_ir -	This is the main datasructure for holding the state
1286691e7b9SSean Wang  *			of the driver
1296691e7b9SSean Wang  * @dev:		The device pointer
1306691e7b9SSean Wang  * @rc:			The rc instrance
1316691e7b9SSean Wang  * @base:		The mapped register i/o base
13250c3c1baSSean Wang  * @irq:		The IRQ that we are using
13350c3c1baSSean Wang  * @clk:		The clock that IR internal is using
13450c3c1baSSean Wang  * @bus:		The clock that software decoder is using
13550c3c1baSSean Wang  * @data:		Holding specific data for vaious platform
1366691e7b9SSean Wang  */
1376691e7b9SSean Wang struct mtk_ir {
1386691e7b9SSean Wang 	struct device	*dev;
1396691e7b9SSean Wang 	struct rc_dev	*rc;
1406691e7b9SSean Wang 	void __iomem	*base;
1416691e7b9SSean Wang 	int		irq;
1426691e7b9SSean Wang 	struct clk	*clk;
14350c3c1baSSean Wang 	struct clk	*bus;
14450c3c1baSSean Wang 	const struct mtk_ir_data *data;
1456691e7b9SSean Wang };
1466691e7b9SSean Wang 
mtk_chkdata_reg(struct mtk_ir * ir,u32 i)14750c3c1baSSean Wang static inline u32 mtk_chkdata_reg(struct mtk_ir *ir, u32 i)
14850c3c1baSSean Wang {
14950c3c1baSSean Wang 	return ir->data->regs[MTK_CHKDATA_REG] + 4 * i;
15050c3c1baSSean Wang }
15150c3c1baSSean Wang 
mtk_chk_period(struct mtk_ir * ir)15250c3c1baSSean Wang static inline u32 mtk_chk_period(struct mtk_ir *ir)
15350c3c1baSSean Wang {
15450c3c1baSSean Wang 	u32 val;
15550c3c1baSSean Wang 
15650c3c1baSSean Wang 	/*
15750c3c1baSSean Wang 	 * Period for software decoder used in the
15850c3c1baSSean Wang 	 * unit of raw software sampling
15950c3c1baSSean Wang 	 */
160d904eb0bSSean Young 	val = DIV_ROUND_CLOSEST(clk_get_rate(ir->bus),
161d904eb0bSSean Young 				USEC_PER_SEC * ir->data->div / MTK_IR_SAMPLE);
16250c3c1baSSean Wang 
16350c3c1baSSean Wang 	dev_dbg(ir->dev, "@pwm clk  = \t%lu\n",
16450c3c1baSSean Wang 		clk_get_rate(ir->bus) / ir->data->div);
16550c3c1baSSean Wang 	dev_dbg(ir->dev, "@chkperiod = %08x\n", val);
16650c3c1baSSean Wang 
16750c3c1baSSean Wang 	return val;
16850c3c1baSSean Wang }
16950c3c1baSSean Wang 
mtk_w32_mask(struct mtk_ir * ir,u32 val,u32 mask,unsigned int reg)1706691e7b9SSean Wang static void mtk_w32_mask(struct mtk_ir *ir, u32 val, u32 mask, unsigned int reg)
1716691e7b9SSean Wang {
1726691e7b9SSean Wang 	u32 tmp;
1736691e7b9SSean Wang 
1746691e7b9SSean Wang 	tmp = __raw_readl(ir->base + reg);
1756691e7b9SSean Wang 	tmp = (tmp & ~mask) | val;
1766691e7b9SSean Wang 	__raw_writel(tmp, ir->base + reg);
1776691e7b9SSean Wang }
1786691e7b9SSean Wang 
mtk_w32(struct mtk_ir * ir,u32 val,unsigned int reg)1796691e7b9SSean Wang static void mtk_w32(struct mtk_ir *ir, u32 val, unsigned int reg)
1806691e7b9SSean Wang {
1816691e7b9SSean Wang 	__raw_writel(val, ir->base + reg);
1826691e7b9SSean Wang }
1836691e7b9SSean Wang 
mtk_r32(struct mtk_ir * ir,unsigned int reg)1846691e7b9SSean Wang static u32 mtk_r32(struct mtk_ir *ir, unsigned int reg)
1856691e7b9SSean Wang {
1866691e7b9SSean Wang 	return __raw_readl(ir->base + reg);
1876691e7b9SSean Wang }
1886691e7b9SSean Wang 
mtk_irq_disable(struct mtk_ir * ir,u32 mask)1896691e7b9SSean Wang static inline void mtk_irq_disable(struct mtk_ir *ir, u32 mask)
1906691e7b9SSean Wang {
1916691e7b9SSean Wang 	u32 val;
1926691e7b9SSean Wang 
19350c3c1baSSean Wang 	val = mtk_r32(ir, ir->data->regs[MTK_IRINT_EN_REG]);
19450c3c1baSSean Wang 	mtk_w32(ir, val & ~mask, ir->data->regs[MTK_IRINT_EN_REG]);
1956691e7b9SSean Wang }
1966691e7b9SSean Wang 
mtk_irq_enable(struct mtk_ir * ir,u32 mask)1976691e7b9SSean Wang static inline void mtk_irq_enable(struct mtk_ir *ir, u32 mask)
1986691e7b9SSean Wang {
1996691e7b9SSean Wang 	u32 val;
2006691e7b9SSean Wang 
20150c3c1baSSean Wang 	val = mtk_r32(ir, ir->data->regs[MTK_IRINT_EN_REG]);
20250c3c1baSSean Wang 	mtk_w32(ir, val | mask, ir->data->regs[MTK_IRINT_EN_REG]);
2036691e7b9SSean Wang }
2046691e7b9SSean Wang 
mtk_ir_irq(int irqno,void * dev_id)2056691e7b9SSean Wang static irqreturn_t mtk_ir_irq(int irqno, void *dev_id)
2066691e7b9SSean Wang {
207183e19f5SSean Young 	struct ir_raw_event rawir = {};
2087dc5fc6dSSean Young 	struct mtk_ir *ir = dev_id;
2097dc5fc6dSSean Young 	u32 i, j, val;
2107dc5fc6dSSean Young 	u8 wid;
2116691e7b9SSean Wang 
2126691e7b9SSean Wang 	/*
2136a554bb5SSean Young 	 * Each pulse and space is encoded as a single byte, each byte
2146a554bb5SSean Young 	 * alternating between pulse and space. If a pulse or space is longer
2156a554bb5SSean Young 	 * than can be encoded in a single byte, it is encoded as the maximum
2166a554bb5SSean Young 	 * value 0xff.
2176a554bb5SSean Young 	 *
2186a554bb5SSean Young 	 * If a space is longer than ok_count (about 23ms), the value is
2196a554bb5SSean Young 	 * encoded as zero, and all following bytes are zero. Any IR that
2206a554bb5SSean Young 	 * follows will be presented in the next interrupt.
2216a554bb5SSean Young 	 *
2226a554bb5SSean Young 	 * If there are more than 68 (=MTK_CHKDATA_SZ * 4) pulses and spaces,
2236a554bb5SSean Young 	 * then the only the first 68 will be presented; the rest is lost.
2246691e7b9SSean Wang 	 */
2256691e7b9SSean Wang 
2266691e7b9SSean Wang 	/* Handle all pulse and space IR controller captures */
2276691e7b9SSean Wang 	for (i = 0 ; i < MTK_CHKDATA_SZ ; i++) {
22850c3c1baSSean Wang 		val = mtk_r32(ir, mtk_chkdata_reg(ir, i));
2296691e7b9SSean Wang 		dev_dbg(ir->dev, "@reg%d=0x%08x\n", i, val);
2306691e7b9SSean Wang 
2316691e7b9SSean Wang 		for (j = 0 ; j < 4 ; j++) {
2327dc5fc6dSSean Young 			wid = val & MTK_WIDTH_MASK;
2337dc5fc6dSSean Young 			val >>= 8;
2346691e7b9SSean Wang 			rawir.pulse = !rawir.pulse;
2356691e7b9SSean Wang 			rawir.duration = wid * (MTK_IR_SAMPLE + 1);
2366691e7b9SSean Wang 			ir_raw_event_store_with_filter(ir->rc, &rawir);
2376691e7b9SSean Wang 		}
2386691e7b9SSean Wang 	}
2396691e7b9SSean Wang 
2406691e7b9SSean Wang 	/*
2416691e7b9SSean Wang 	 * The maximum number of edges the IR controller can
2426691e7b9SSean Wang 	 * hold is MTK_CHKDATA_SZ * 4. So if received IR messages
2436691e7b9SSean Wang 	 * is over the limit, the last incomplete IR message would
2446691e7b9SSean Wang 	 * be appended trailing space and still would be sent into
2456691e7b9SSean Wang 	 * ir-rc-raw to decode. That helps it is possible that it
2466691e7b9SSean Wang 	 * has enough information to decode a scancode even if the
2476691e7b9SSean Wang 	 * trailing end of the message is missing.
2486691e7b9SSean Wang 	 */
2496691e7b9SSean Wang 	if (!MTK_IR_END(wid, rawir.pulse)) {
2506691e7b9SSean Wang 		rawir.pulse = false;
2516691e7b9SSean Wang 		rawir.duration = MTK_MAX_SAMPLES * (MTK_IR_SAMPLE + 1);
2526691e7b9SSean Wang 		ir_raw_event_store_with_filter(ir->rc, &rawir);
2536691e7b9SSean Wang 	}
2546691e7b9SSean Wang 
2556691e7b9SSean Wang 	ir_raw_event_handle(ir->rc);
2566691e7b9SSean Wang 
2576691e7b9SSean Wang 	/*
2586691e7b9SSean Wang 	 * Restart controller for the next receive that would
2596691e7b9SSean Wang 	 * clear up all CHKDATA registers
2606691e7b9SSean Wang 	 */
26150c3c1baSSean Wang 	mtk_w32_mask(ir, 0x1, MTK_IRCLR, ir->data->regs[MTK_IRCLR_REG]);
2626691e7b9SSean Wang 
2636691e7b9SSean Wang 	/* Clear interrupt status */
26450c3c1baSSean Wang 	mtk_w32_mask(ir, 0x1, MTK_IRINT_CLR,
26550c3c1baSSean Wang 		     ir->data->regs[MTK_IRINT_CLR_REG]);
2666691e7b9SSean Wang 
2676691e7b9SSean Wang 	return IRQ_HANDLED;
2686691e7b9SSean Wang }
2696691e7b9SSean Wang 
27050c3c1baSSean Wang static const struct mtk_ir_data mt7623_data = {
27150c3c1baSSean Wang 	.regs = mt7623_regs,
27250c3c1baSSean Wang 	.fields = mt7623_fields,
2731ad09bbfSSean Young 	.ok_count = 3,
27450c3c1baSSean Wang 	.hw_period = 0xff,
27550c3c1baSSean Wang 	.div	= 4,
27650c3c1baSSean Wang };
27750c3c1baSSean Wang 
27858389982SSean Wang static const struct mtk_ir_data mt7622_data = {
27958389982SSean Wang 	.regs = mt7622_regs,
28058389982SSean Wang 	.fields = mt7622_fields,
2811ad09bbfSSean Young 	.ok_count = 3,
28258389982SSean Wang 	.hw_period = 0xffff,
28358389982SSean Wang 	.div	= 32,
28458389982SSean Wang };
28558389982SSean Wang 
28650c3c1baSSean Wang static const struct of_device_id mtk_ir_match[] = {
28750c3c1baSSean Wang 	{ .compatible = "mediatek,mt7623-cir", .data = &mt7623_data},
28858389982SSean Wang 	{ .compatible = "mediatek,mt7622-cir", .data = &mt7622_data},
28950c3c1baSSean Wang 	{},
29050c3c1baSSean Wang };
29150c3c1baSSean Wang MODULE_DEVICE_TABLE(of, mtk_ir_match);
29250c3c1baSSean Wang 
mtk_ir_probe(struct platform_device * pdev)2936691e7b9SSean Wang static int mtk_ir_probe(struct platform_device *pdev)
2946691e7b9SSean Wang {
2956691e7b9SSean Wang 	struct device *dev = &pdev->dev;
2966691e7b9SSean Wang 	struct device_node *dn = dev->of_node;
2976691e7b9SSean Wang 	struct mtk_ir *ir;
2986691e7b9SSean Wang 	u32 val;
2996691e7b9SSean Wang 	int ret = 0;
3006691e7b9SSean Wang 	const char *map_name;
3016691e7b9SSean Wang 
3026691e7b9SSean Wang 	ir = devm_kzalloc(dev, sizeof(struct mtk_ir), GFP_KERNEL);
3036691e7b9SSean Wang 	if (!ir)
3046691e7b9SSean Wang 		return -ENOMEM;
3056691e7b9SSean Wang 
3066691e7b9SSean Wang 	ir->dev = dev;
3075d0af51fSRyder Lee 	ir->data = of_device_get_match_data(dev);
3086691e7b9SSean Wang 
3096691e7b9SSean Wang 	ir->clk = devm_clk_get(dev, "clk");
3106691e7b9SSean Wang 	if (IS_ERR(ir->clk)) {
3116691e7b9SSean Wang 		dev_err(dev, "failed to get a ir clock.\n");
3126691e7b9SSean Wang 		return PTR_ERR(ir->clk);
3136691e7b9SSean Wang 	}
3146691e7b9SSean Wang 
31550c3c1baSSean Wang 	ir->bus = devm_clk_get(dev, "bus");
31650c3c1baSSean Wang 	if (IS_ERR(ir->bus)) {
31750c3c1baSSean Wang 		/*
31850c3c1baSSean Wang 		 * For compatibility with older device trees try unnamed
31950c3c1baSSean Wang 		 * ir->bus uses the same clock as ir->clock.
32050c3c1baSSean Wang 		 */
32150c3c1baSSean Wang 		ir->bus = ir->clk;
32250c3c1baSSean Wang 	}
32350c3c1baSSean Wang 
324dfa974f5SCai Huoqing 	ir->base = devm_platform_ioremap_resource(pdev, 0);
3259e2e4382SDing Xiang 	if (IS_ERR(ir->base))
3266691e7b9SSean Wang 		return PTR_ERR(ir->base);
3276691e7b9SSean Wang 
3286691e7b9SSean Wang 	ir->rc = devm_rc_allocate_device(dev, RC_DRIVER_IR_RAW);
3296691e7b9SSean Wang 	if (!ir->rc) {
3306691e7b9SSean Wang 		dev_err(dev, "failed to allocate device\n");
3316691e7b9SSean Wang 		return -ENOMEM;
3326691e7b9SSean Wang 	}
3336691e7b9SSean Wang 
3346691e7b9SSean Wang 	ir->rc->priv = ir;
335518f4b26SSean Young 	ir->rc->device_name = MTK_IR_DEV;
3366691e7b9SSean Wang 	ir->rc->input_phys = MTK_IR_DEV "/input0";
3376691e7b9SSean Wang 	ir->rc->input_id.bustype = BUS_HOST;
3386691e7b9SSean Wang 	ir->rc->input_id.vendor = 0x0001;
3396691e7b9SSean Wang 	ir->rc->input_id.product = 0x0001;
3406691e7b9SSean Wang 	ir->rc->input_id.version = 0x0001;
3416691e7b9SSean Wang 	map_name = of_get_property(dn, "linux,rc-map-name", NULL);
3426691e7b9SSean Wang 	ir->rc->map_name = map_name ?: RC_MAP_EMPTY;
3436691e7b9SSean Wang 	ir->rc->dev.parent = dev;
3446691e7b9SSean Wang 	ir->rc->driver_name = MTK_IR_DEV;
345eab86520SSean Young 	ir->rc->allowed_protocols = RC_PROTO_BIT_ALL_IR_DECODER;
3466691e7b9SSean Wang 	ir->rc->rx_resolution = MTK_IR_SAMPLE;
3476691e7b9SSean Wang 	ir->rc->timeout = MTK_MAX_SAMPLES * (MTK_IR_SAMPLE + 1);
3486691e7b9SSean Wang 
3496691e7b9SSean Wang 	ret = devm_rc_register_device(dev, ir->rc);
3506691e7b9SSean Wang 	if (ret) {
3516691e7b9SSean Wang 		dev_err(dev, "failed to register rc device\n");
3526691e7b9SSean Wang 		return ret;
3536691e7b9SSean Wang 	}
3546691e7b9SSean Wang 
3556691e7b9SSean Wang 	platform_set_drvdata(pdev, ir);
3566691e7b9SSean Wang 
3576691e7b9SSean Wang 	ir->irq = platform_get_irq(pdev, 0);
35897299a30SStephen Boyd 	if (ir->irq < 0)
3596691e7b9SSean Wang 		return -ENODEV;
3606691e7b9SSean Wang 
3616691e7b9SSean Wang 	if (clk_prepare_enable(ir->clk)) {
3626691e7b9SSean Wang 		dev_err(dev, "try to enable ir_clk failed\n");
36350c3c1baSSean Wang 		return -EINVAL;
36450c3c1baSSean Wang 	}
36550c3c1baSSean Wang 
36650c3c1baSSean Wang 	if (clk_prepare_enable(ir->bus)) {
36750c3c1baSSean Wang 		dev_err(dev, "try to enable ir_clk failed\n");
3686691e7b9SSean Wang 		ret = -EINVAL;
3696691e7b9SSean Wang 		goto exit_clkdisable_clk;
3706691e7b9SSean Wang 	}
3716691e7b9SSean Wang 
37250c3c1baSSean Wang 	/*
37350c3c1baSSean Wang 	 * Enable interrupt after proper hardware
37450c3c1baSSean Wang 	 * setup and IRQ handler registration
37550c3c1baSSean Wang 	 */
3766691e7b9SSean Wang 	mtk_irq_disable(ir, MTK_IRINT_EN);
3776691e7b9SSean Wang 
3786691e7b9SSean Wang 	ret = devm_request_irq(dev, ir->irq, mtk_ir_irq, 0, MTK_IR_DEV, ir);
3796691e7b9SSean Wang 	if (ret) {
3806691e7b9SSean Wang 		dev_err(dev, "failed request irq\n");
38150c3c1baSSean Wang 		goto exit_clkdisable_bus;
3826691e7b9SSean Wang 	}
3836691e7b9SSean Wang 
38450c3c1baSSean Wang 	/*
38550c3c1baSSean Wang 	 * Setup software sample period as the reference of software decoder
38650c3c1baSSean Wang 	 */
38750c3c1baSSean Wang 	val = (mtk_chk_period(ir) << ir->data->fields[MTK_CHK_PERIOD].offset) &
38850c3c1baSSean Wang 	       ir->data->fields[MTK_CHK_PERIOD].mask;
38950c3c1baSSean Wang 	mtk_w32_mask(ir, val, ir->data->fields[MTK_CHK_PERIOD].mask,
39050c3c1baSSean Wang 		     ir->data->fields[MTK_CHK_PERIOD].reg);
39150c3c1baSSean Wang 
39250c3c1baSSean Wang 	/*
39350c3c1baSSean Wang 	 * Setup hardware sampling period used to setup the proper timeout for
39450c3c1baSSean Wang 	 * indicating end of IR receiving completion
39550c3c1baSSean Wang 	 */
39650c3c1baSSean Wang 	val = (ir->data->hw_period << ir->data->fields[MTK_HW_PERIOD].offset) &
39750c3c1baSSean Wang 	       ir->data->fields[MTK_HW_PERIOD].mask;
39850c3c1baSSean Wang 	mtk_w32_mask(ir, val, ir->data->fields[MTK_HW_PERIOD].mask,
39950c3c1baSSean Wang 		     ir->data->fields[MTK_HW_PERIOD].reg);
40050c3c1baSSean Wang 
4015dd4b89dSSean Young 	/* Set de-glitch counter */
4025dd4b89dSSean Young 	mtk_w32_mask(ir, MTK_DG_CNT(1), MTK_DG_CNT_MASK, MTK_IRTHD);
4035dd4b89dSSean Young 
4046691e7b9SSean Wang 	/* Enable IR and PWM */
4051ad09bbfSSean Young 	val = mtk_r32(ir, MTK_CONFIG_HIGH_REG) & ~MTK_OK_COUNT_MASK;
40650c3c1baSSean Wang 	val |= MTK_OK_COUNT(ir->data->ok_count) |  MTK_PWM_EN | MTK_IR_EN;
4076691e7b9SSean Wang 	mtk_w32(ir, val, MTK_CONFIG_HIGH_REG);
4086691e7b9SSean Wang 
4096691e7b9SSean Wang 	mtk_irq_enable(ir, MTK_IRINT_EN);
4106691e7b9SSean Wang 
41150c3c1baSSean Wang 	dev_info(dev, "Initialized MT7623 IR driver, sample period = %dus\n",
412d904eb0bSSean Young 		 MTK_IR_SAMPLE);
4136691e7b9SSean Wang 
4146691e7b9SSean Wang 	return 0;
4156691e7b9SSean Wang 
41650c3c1baSSean Wang exit_clkdisable_bus:
41750c3c1baSSean Wang 	clk_disable_unprepare(ir->bus);
4186691e7b9SSean Wang exit_clkdisable_clk:
4196691e7b9SSean Wang 	clk_disable_unprepare(ir->clk);
4206691e7b9SSean Wang 
4216691e7b9SSean Wang 	return ret;
4226691e7b9SSean Wang }
4236691e7b9SSean Wang 
mtk_ir_remove(struct platform_device * pdev)424d6db10b1SUwe Kleine-König static void mtk_ir_remove(struct platform_device *pdev)
4256691e7b9SSean Wang {
4266691e7b9SSean Wang 	struct mtk_ir *ir = platform_get_drvdata(pdev);
4276691e7b9SSean Wang 
4286691e7b9SSean Wang 	/*
4296691e7b9SSean Wang 	 * Avoid contention between remove handler and
4306691e7b9SSean Wang 	 * IRQ handler so that disabling IR interrupt and
4316691e7b9SSean Wang 	 * waiting for pending IRQ handler to complete
4326691e7b9SSean Wang 	 */
4336691e7b9SSean Wang 	mtk_irq_disable(ir, MTK_IRINT_EN);
4346691e7b9SSean Wang 	synchronize_irq(ir->irq);
4356691e7b9SSean Wang 
43650c3c1baSSean Wang 	clk_disable_unprepare(ir->bus);
4376691e7b9SSean Wang 	clk_disable_unprepare(ir->clk);
4386691e7b9SSean Wang }
4396691e7b9SSean Wang 
4406691e7b9SSean Wang static struct platform_driver mtk_ir_driver = {
4416691e7b9SSean Wang 	.probe          = mtk_ir_probe,
442d6db10b1SUwe Kleine-König 	.remove_new     = mtk_ir_remove,
4436691e7b9SSean Wang 	.driver = {
4446691e7b9SSean Wang 		.name = MTK_IR_DEV,
4456691e7b9SSean Wang 		.of_match_table = mtk_ir_match,
4466691e7b9SSean Wang 	},
4476691e7b9SSean Wang };
4486691e7b9SSean Wang 
4496691e7b9SSean Wang module_platform_driver(mtk_ir_driver);
4506691e7b9SSean Wang 
4516691e7b9SSean Wang MODULE_DESCRIPTION("Mediatek IR Receiver Controller Driver");
4526691e7b9SSean Wang MODULE_AUTHOR("Sean Wang <sean.wang@mediatek.com>");
4536691e7b9SSean Wang MODULE_LICENSE("GPL");
454