xref: /openbmc/linux/drivers/media/rc/ir-imon-decoder.c (revision 4f2c0a4acffbec01079c28f839422e64ddeff004)
1447dcc0cSSean Young // SPDX-License-Identifier: GPL-2.0+
2447dcc0cSSean Young // ir-imon-decoder.c - handle iMon protocol
3447dcc0cSSean Young //
4447dcc0cSSean Young // Copyright (C) 2018 by Sean Young <sean@mess.org>
5447dcc0cSSean Young 
6447dcc0cSSean Young #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
7447dcc0cSSean Young 
8447dcc0cSSean Young #include <linux/module.h>
9447dcc0cSSean Young #include "rc-core-priv.h"
10447dcc0cSSean Young 
11528222d8SSean Young #define IMON_UNIT		416 /* us */
12447dcc0cSSean Young #define IMON_BITS		30
13447dcc0cSSean Young #define IMON_CHKBITS		(BIT(30) | BIT(25) | BIT(24) | BIT(22) | \
14447dcc0cSSean Young 				 BIT(21) | BIT(20) | BIT(19) | BIT(18) | \
15447dcc0cSSean Young 				 BIT(17) | BIT(16) | BIT(14) | BIT(13) | \
16447dcc0cSSean Young 				 BIT(12) | BIT(11) | BIT(10) | BIT(9))
17447dcc0cSSean Young 
18447dcc0cSSean Young /*
19447dcc0cSSean Young  * This protocol has 30 bits. The format is one IMON_UNIT header pulse,
20447dcc0cSSean Young  * followed by 30 bits. Each bit is one IMON_UNIT check field, and then
21447dcc0cSSean Young  * one IMON_UNIT field with the actual bit (1=space, 0=pulse).
22447dcc0cSSean Young  * The check field is always space for some bits, for others it is pulse if
23447dcc0cSSean Young  * both the preceding and current bit are zero, else space. IMON_CHKBITS
24447dcc0cSSean Young  * defines which bits are of type check.
25447dcc0cSSean Young  *
26447dcc0cSSean Young  * There is no way to distinguish an incomplete message from one where
27447dcc0cSSean Young  * the lower bits are all set, iow. the last pulse is for the lowest
28447dcc0cSSean Young  * bit which is 0.
29447dcc0cSSean Young  */
30447dcc0cSSean Young enum imon_state {
31447dcc0cSSean Young 	STATE_INACTIVE,
32447dcc0cSSean Young 	STATE_BIT_CHK,
33447dcc0cSSean Young 	STATE_BIT_START,
34f9d94a10SSean Young 	STATE_FINISHED,
35f9d94a10SSean Young 	STATE_ERROR,
36447dcc0cSSean Young };
37447dcc0cSSean Young 
ir_imon_decode_scancode(struct rc_dev * dev)38f9d94a10SSean Young static void ir_imon_decode_scancode(struct rc_dev *dev)
39f9d94a10SSean Young {
40f9d94a10SSean Young 	struct imon_dec *imon = &dev->raw->imon;
41f9d94a10SSean Young 
42f9d94a10SSean Young 	/* Keyboard/Mouse toggle */
43f9d94a10SSean Young 	if (imon->bits == 0x299115b7)
44f9d94a10SSean Young 		imon->stick_keyboard = !imon->stick_keyboard;
45f9d94a10SSean Young 
46f9d94a10SSean Young 	if ((imon->bits & 0xfc0000ff) == 0x680000b7) {
47f9d94a10SSean Young 		int rel_x, rel_y;
48f9d94a10SSean Young 		u8 buf;
49f9d94a10SSean Young 
50f9d94a10SSean Young 		buf = imon->bits >> 16;
51f9d94a10SSean Young 		rel_x = (buf & 0x08) | (buf & 0x10) >> 2 |
52f9d94a10SSean Young 			(buf & 0x20) >> 4 | (buf & 0x40) >> 6;
53f9d94a10SSean Young 		if (imon->bits & 0x02000000)
54f9d94a10SSean Young 			rel_x |= ~0x0f;
55f9d94a10SSean Young 		buf = imon->bits >> 8;
56f9d94a10SSean Young 		rel_y = (buf & 0x08) | (buf & 0x10) >> 2 |
57f9d94a10SSean Young 			(buf & 0x20) >> 4 | (buf & 0x40) >> 6;
58f9d94a10SSean Young 		if (imon->bits & 0x01000000)
59f9d94a10SSean Young 			rel_y |= ~0x0f;
60f9d94a10SSean Young 
61f9d94a10SSean Young 		if (rel_x && rel_y && imon->stick_keyboard) {
62f9d94a10SSean Young 			if (abs(rel_y) > abs(rel_x))
63f9d94a10SSean Young 				imon->bits = rel_y > 0 ?
64f9d94a10SSean Young 					0x289515b7 : /* KEY_DOWN */
65f9d94a10SSean Young 					0x2aa515b7;  /* KEY_UP */
66f9d94a10SSean Young 			else
67f9d94a10SSean Young 				imon->bits = rel_x > 0 ?
68f9d94a10SSean Young 					0x2ba515b7 : /* KEY_RIGHT */
69f9d94a10SSean Young 					0x29a515b7;  /* KEY_LEFT */
70f9d94a10SSean Young 		}
71f9d94a10SSean Young 
72f9d94a10SSean Young 		if (!imon->stick_keyboard) {
730ac5a603SSean Young 			input_report_rel(dev->input_dev, REL_X, rel_x);
740ac5a603SSean Young 			input_report_rel(dev->input_dev, REL_Y, rel_y);
75f9d94a10SSean Young 
760ac5a603SSean Young 			input_report_key(dev->input_dev, BTN_LEFT,
77f9d94a10SSean Young 					 (imon->bits & 0x00010000) != 0);
780ac5a603SSean Young 			input_report_key(dev->input_dev, BTN_RIGHT,
79f9d94a10SSean Young 					 (imon->bits & 0x00040000) != 0);
80f9d94a10SSean Young 		}
81f9d94a10SSean Young 	}
82f9d94a10SSean Young 
83f9d94a10SSean Young 	rc_keydown(dev, RC_PROTO_IMON, imon->bits, 0);
84f9d94a10SSean Young }
85f9d94a10SSean Young 
86447dcc0cSSean Young /**
87447dcc0cSSean Young  * ir_imon_decode() - Decode one iMON pulse or space
88447dcc0cSSean Young  * @dev:	the struct rc_dev descriptor of the device
89447dcc0cSSean Young  * @ev:		the struct ir_raw_event descriptor of the pulse/space
90447dcc0cSSean Young  *
91447dcc0cSSean Young  * This function returns -EINVAL if the pulse violates the state machine
92447dcc0cSSean Young  */
ir_imon_decode(struct rc_dev * dev,struct ir_raw_event ev)93447dcc0cSSean Young static int ir_imon_decode(struct rc_dev *dev, struct ir_raw_event ev)
94447dcc0cSSean Young {
95447dcc0cSSean Young 	struct imon_dec *data = &dev->raw->imon;
96447dcc0cSSean Young 
97447dcc0cSSean Young 	if (!is_timing_event(ev)) {
98*950170d6SSean Young 		if (ev.overflow)
99447dcc0cSSean Young 			data->state = STATE_INACTIVE;
100447dcc0cSSean Young 		return 0;
101447dcc0cSSean Young 	}
102447dcc0cSSean Young 
103447dcc0cSSean Young 	dev_dbg(&dev->dev,
104447dcc0cSSean Young 		"iMON decode started at state %d bitno %d (%uus %s)\n",
105528222d8SSean Young 		data->state, data->count, ev.duration, TO_STR(ev.pulse));
106447dcc0cSSean Young 
107f9d94a10SSean Young 	/*
108f9d94a10SSean Young 	 * Since iMON protocol is a series of bits, if at any point
109f9d94a10SSean Young 	 * we encounter an error, make sure that any remaining bits
110f9d94a10SSean Young 	 * aren't parsed as a scancode made up of less bits.
111f9d94a10SSean Young 	 *
112f9d94a10SSean Young 	 * Note that if the stick is held, then the remote repeats
113f9d94a10SSean Young 	 * the scancode with about 12ms between them. So, make sure
114f9d94a10SSean Young 	 * we have at least 10ms of space after an error. That way,
115f9d94a10SSean Young 	 * we're at a new scancode.
116f9d94a10SSean Young 	 */
117f9d94a10SSean Young 	if (data->state == STATE_ERROR) {
118528222d8SSean Young 		if (!ev.pulse && ev.duration > MS_TO_US(10))
119f9d94a10SSean Young 			data->state = STATE_INACTIVE;
120f9d94a10SSean Young 		return 0;
121f9d94a10SSean Young 	}
122f9d94a10SSean Young 
123447dcc0cSSean Young 	for (;;) {
124447dcc0cSSean Young 		if (!geq_margin(ev.duration, IMON_UNIT, IMON_UNIT / 2))
125447dcc0cSSean Young 			return 0;
126447dcc0cSSean Young 
127447dcc0cSSean Young 		decrease_duration(&ev, IMON_UNIT);
128447dcc0cSSean Young 
129447dcc0cSSean Young 		switch (data->state) {
130447dcc0cSSean Young 		case STATE_INACTIVE:
131447dcc0cSSean Young 			if (ev.pulse) {
132447dcc0cSSean Young 				data->state = STATE_BIT_CHK;
133447dcc0cSSean Young 				data->bits = 0;
134447dcc0cSSean Young 				data->count = IMON_BITS;
135447dcc0cSSean Young 			}
136447dcc0cSSean Young 			break;
137447dcc0cSSean Young 		case STATE_BIT_CHK:
138447dcc0cSSean Young 			if (IMON_CHKBITS & BIT(data->count))
139447dcc0cSSean Young 				data->last_chk = ev.pulse;
140447dcc0cSSean Young 			else if (ev.pulse)
141447dcc0cSSean Young 				goto err_out;
142447dcc0cSSean Young 			data->state = STATE_BIT_START;
143447dcc0cSSean Young 			break;
144447dcc0cSSean Young 		case STATE_BIT_START:
145447dcc0cSSean Young 			data->bits <<= 1;
146447dcc0cSSean Young 			if (!ev.pulse)
147447dcc0cSSean Young 				data->bits |= 1;
148447dcc0cSSean Young 
149447dcc0cSSean Young 			if (IMON_CHKBITS & BIT(data->count)) {
150447dcc0cSSean Young 				if (data->last_chk != !(data->bits & 3))
151447dcc0cSSean Young 					goto err_out;
152447dcc0cSSean Young 			}
153447dcc0cSSean Young 
154447dcc0cSSean Young 			if (!data->count--)
155447dcc0cSSean Young 				data->state = STATE_FINISHED;
156447dcc0cSSean Young 			else
157447dcc0cSSean Young 				data->state = STATE_BIT_CHK;
158447dcc0cSSean Young 			break;
159447dcc0cSSean Young 		case STATE_FINISHED:
160447dcc0cSSean Young 			if (ev.pulse)
161447dcc0cSSean Young 				goto err_out;
162f9d94a10SSean Young 			ir_imon_decode_scancode(dev);
163447dcc0cSSean Young 			data->state = STATE_INACTIVE;
164447dcc0cSSean Young 			break;
165447dcc0cSSean Young 		}
166447dcc0cSSean Young 	}
167447dcc0cSSean Young 
168447dcc0cSSean Young err_out:
169447dcc0cSSean Young 	dev_dbg(&dev->dev,
170447dcc0cSSean Young 		"iMON decode failed at state %d bitno %d (%uus %s)\n",
171528222d8SSean Young 		data->state, data->count, ev.duration, TO_STR(ev.pulse));
172447dcc0cSSean Young 
173f9d94a10SSean Young 	data->state = STATE_ERROR;
174447dcc0cSSean Young 
175447dcc0cSSean Young 	return -EINVAL;
176447dcc0cSSean Young }
177447dcc0cSSean Young 
178447dcc0cSSean Young /**
179447dcc0cSSean Young  * ir_imon_encode() - Encode a scancode as a stream of raw events
180447dcc0cSSean Young  *
181447dcc0cSSean Young  * @protocol:	protocol to encode
182447dcc0cSSean Young  * @scancode:	scancode to encode
183447dcc0cSSean Young  * @events:	array of raw ir events to write into
184447dcc0cSSean Young  * @max:	maximum size of @events
185447dcc0cSSean Young  *
186447dcc0cSSean Young  * Returns:	The number of events written.
187447dcc0cSSean Young  *		-ENOBUFS if there isn't enough space in the array to fit the
188447dcc0cSSean Young  *		encoding. In this case all @max events will have been written.
189447dcc0cSSean Young  */
ir_imon_encode(enum rc_proto protocol,u32 scancode,struct ir_raw_event * events,unsigned int max)190447dcc0cSSean Young static int ir_imon_encode(enum rc_proto protocol, u32 scancode,
191447dcc0cSSean Young 			  struct ir_raw_event *events, unsigned int max)
192447dcc0cSSean Young {
193447dcc0cSSean Young 	struct ir_raw_event *e = events;
194447dcc0cSSean Young 	int i, pulse;
195447dcc0cSSean Young 
196447dcc0cSSean Young 	if (!max--)
197447dcc0cSSean Young 		return -ENOBUFS;
198447dcc0cSSean Young 	init_ir_raw_event_duration(e, 1, IMON_UNIT);
199447dcc0cSSean Young 
200447dcc0cSSean Young 	for (i = IMON_BITS; i >= 0; i--) {
201447dcc0cSSean Young 		if (BIT(i) & IMON_CHKBITS)
202447dcc0cSSean Young 			pulse = !(scancode & (BIT(i) | BIT(i + 1)));
203447dcc0cSSean Young 		else
204447dcc0cSSean Young 			pulse = 0;
205447dcc0cSSean Young 
206447dcc0cSSean Young 		if (pulse == e->pulse) {
207447dcc0cSSean Young 			e->duration += IMON_UNIT;
208447dcc0cSSean Young 		} else {
209447dcc0cSSean Young 			if (!max--)
210447dcc0cSSean Young 				return -ENOBUFS;
211447dcc0cSSean Young 			init_ir_raw_event_duration(++e, pulse, IMON_UNIT);
212447dcc0cSSean Young 		}
213447dcc0cSSean Young 
214447dcc0cSSean Young 		pulse = !(scancode & BIT(i));
215447dcc0cSSean Young 
216447dcc0cSSean Young 		if (pulse == e->pulse) {
217447dcc0cSSean Young 			e->duration += IMON_UNIT;
218447dcc0cSSean Young 		} else {
219447dcc0cSSean Young 			if (!max--)
220447dcc0cSSean Young 				return -ENOBUFS;
221447dcc0cSSean Young 			init_ir_raw_event_duration(++e, pulse, IMON_UNIT);
222447dcc0cSSean Young 		}
223447dcc0cSSean Young 	}
224447dcc0cSSean Young 
225447dcc0cSSean Young 	if (e->pulse)
226447dcc0cSSean Young 		e++;
227447dcc0cSSean Young 
228447dcc0cSSean Young 	return e - events;
229447dcc0cSSean Young }
230447dcc0cSSean Young 
ir_imon_register(struct rc_dev * dev)231f9d94a10SSean Young static int ir_imon_register(struct rc_dev *dev)
232f9d94a10SSean Young {
233f9d94a10SSean Young 	struct imon_dec *imon = &dev->raw->imon;
234f9d94a10SSean Young 
235f9d94a10SSean Young 	imon->stick_keyboard = false;
236f9d94a10SSean Young 
237f9d94a10SSean Young 	return 0;
238f9d94a10SSean Young }
239f9d94a10SSean Young 
240447dcc0cSSean Young static struct ir_raw_handler imon_handler = {
241447dcc0cSSean Young 	.protocols	= RC_PROTO_BIT_IMON,
242447dcc0cSSean Young 	.decode		= ir_imon_decode,
243447dcc0cSSean Young 	.encode		= ir_imon_encode,
244447dcc0cSSean Young 	.carrier	= 38000,
245f9d94a10SSean Young 	.raw_register	= ir_imon_register,
246a86d6df8SSean Young 	.min_timeout	= IMON_UNIT * IMON_BITS * 2,
247447dcc0cSSean Young };
248447dcc0cSSean Young 
ir_imon_decode_init(void)249447dcc0cSSean Young static int __init ir_imon_decode_init(void)
250447dcc0cSSean Young {
251447dcc0cSSean Young 	ir_raw_handler_register(&imon_handler);
252447dcc0cSSean Young 
253447dcc0cSSean Young 	pr_info("IR iMON protocol handler initialized\n");
254447dcc0cSSean Young 	return 0;
255447dcc0cSSean Young }
256447dcc0cSSean Young 
ir_imon_decode_exit(void)257447dcc0cSSean Young static void __exit ir_imon_decode_exit(void)
258447dcc0cSSean Young {
259447dcc0cSSean Young 	ir_raw_handler_unregister(&imon_handler);
260447dcc0cSSean Young }
261447dcc0cSSean Young 
262447dcc0cSSean Young module_init(ir_imon_decode_init);
263447dcc0cSSean Young module_exit(ir_imon_decode_exit);
264447dcc0cSSean Young 
265447dcc0cSSean Young MODULE_LICENSE("GPL");
266447dcc0cSSean Young MODULE_AUTHOR("Sean Young <sean@mess.org>");
267447dcc0cSSean Young MODULE_DESCRIPTION("iMON IR protocol decoder");
268