1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright 2017 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
4  */
5 
6 #include <linux/delay.h>
7 #include <linux/slab.h>
8 #include <linux/sched/types.h>
9 
10 #include <media/cec-pin.h>
11 #include "cec-pin-priv.h"
12 
13 struct cec_error_inj_cmd {
14 	unsigned int mode_offset;
15 	int arg_idx;
16 	const char *cmd;
17 };
18 
19 static const struct cec_error_inj_cmd cec_error_inj_cmds[] = {
20 	{ CEC_ERROR_INJ_RX_NACK_OFFSET, -1, "rx-nack" },
21 	{ CEC_ERROR_INJ_RX_LOW_DRIVE_OFFSET,
22 	  CEC_ERROR_INJ_RX_LOW_DRIVE_ARG_IDX, "rx-low-drive" },
23 	{ CEC_ERROR_INJ_RX_ADD_BYTE_OFFSET, -1, "rx-add-byte" },
24 	{ CEC_ERROR_INJ_RX_REMOVE_BYTE_OFFSET, -1, "rx-remove-byte" },
25 	{ CEC_ERROR_INJ_RX_ARB_LOST_OFFSET,
26 	  CEC_ERROR_INJ_RX_ARB_LOST_ARG_IDX, "rx-arb-lost" },
27 
28 	{ CEC_ERROR_INJ_TX_NO_EOM_OFFSET, -1, "tx-no-eom" },
29 	{ CEC_ERROR_INJ_TX_EARLY_EOM_OFFSET, -1, "tx-early-eom" },
30 	{ CEC_ERROR_INJ_TX_ADD_BYTES_OFFSET,
31 	  CEC_ERROR_INJ_TX_ADD_BYTES_ARG_IDX, "tx-add-bytes" },
32 	{ CEC_ERROR_INJ_TX_REMOVE_BYTE_OFFSET, -1, "tx-remove-byte" },
33 	{ CEC_ERROR_INJ_TX_SHORT_BIT_OFFSET,
34 	  CEC_ERROR_INJ_TX_SHORT_BIT_ARG_IDX, "tx-short-bit" },
35 	{ CEC_ERROR_INJ_TX_LONG_BIT_OFFSET,
36 	  CEC_ERROR_INJ_TX_LONG_BIT_ARG_IDX, "tx-long-bit" },
37 	{ CEC_ERROR_INJ_TX_CUSTOM_BIT_OFFSET,
38 	  CEC_ERROR_INJ_TX_CUSTOM_BIT_ARG_IDX, "tx-custom-bit" },
39 	{ CEC_ERROR_INJ_TX_SHORT_START_OFFSET, -1, "tx-short-start" },
40 	{ CEC_ERROR_INJ_TX_LONG_START_OFFSET, -1, "tx-long-start" },
41 	{ CEC_ERROR_INJ_TX_CUSTOM_START_OFFSET, -1, "tx-custom-start" },
42 	{ CEC_ERROR_INJ_TX_LAST_BIT_OFFSET,
43 	  CEC_ERROR_INJ_TX_LAST_BIT_ARG_IDX, "tx-last-bit" },
44 	{ CEC_ERROR_INJ_TX_LOW_DRIVE_OFFSET,
45 	  CEC_ERROR_INJ_TX_LOW_DRIVE_ARG_IDX, "tx-low-drive" },
46 	{ 0, -1, NULL }
47 };
48 
49 u16 cec_pin_rx_error_inj(struct cec_pin *pin)
50 {
51 	u16 cmd = CEC_ERROR_INJ_OP_ANY;
52 
53 	/* Only when 18 bits have been received do we have a valid cmd */
54 	if (!(pin->error_inj[cmd] & CEC_ERROR_INJ_RX_MASK) &&
55 	    pin->rx_bit >= 18)
56 		cmd = pin->rx_msg.msg[1];
57 	return (pin->error_inj[cmd] & CEC_ERROR_INJ_RX_MASK) ? cmd :
58 		CEC_ERROR_INJ_OP_ANY;
59 }
60 
61 u16 cec_pin_tx_error_inj(struct cec_pin *pin)
62 {
63 	u16 cmd = CEC_ERROR_INJ_OP_ANY;
64 
65 	if (!(pin->error_inj[cmd] & CEC_ERROR_INJ_TX_MASK) &&
66 	    pin->tx_msg.len > 1)
67 		cmd = pin->tx_msg.msg[1];
68 	return (pin->error_inj[cmd] & CEC_ERROR_INJ_TX_MASK) ? cmd :
69 		CEC_ERROR_INJ_OP_ANY;
70 }
71 
72 bool cec_pin_error_inj_parse_line(struct cec_adapter *adap, char *line)
73 {
74 	static const char *delims = " \t\r";
75 	struct cec_pin *pin = adap->pin;
76 	unsigned int i;
77 	bool has_pos = false;
78 	char *p = line;
79 	char *token;
80 	char *comma;
81 	u64 *error;
82 	u8 *args;
83 	bool has_op;
84 	u8 op;
85 	u8 mode;
86 	u8 pos;
87 
88 	p = skip_spaces(p);
89 	token = strsep(&p, delims);
90 	if (!strcmp(token, "clear")) {
91 		memset(pin->error_inj, 0, sizeof(pin->error_inj));
92 		pin->rx_toggle = pin->tx_toggle = false;
93 		pin->tx_ignore_nack_until_eom = false;
94 		pin->tx_custom_pulse = false;
95 		pin->tx_custom_low_usecs = CEC_TIM_CUSTOM_DEFAULT;
96 		pin->tx_custom_high_usecs = CEC_TIM_CUSTOM_DEFAULT;
97 		return true;
98 	}
99 	if (!strcmp(token, "rx-clear")) {
100 		for (i = 0; i <= CEC_ERROR_INJ_OP_ANY; i++)
101 			pin->error_inj[i] &= ~CEC_ERROR_INJ_RX_MASK;
102 		pin->rx_toggle = false;
103 		return true;
104 	}
105 	if (!strcmp(token, "tx-clear")) {
106 		for (i = 0; i <= CEC_ERROR_INJ_OP_ANY; i++)
107 			pin->error_inj[i] &= ~CEC_ERROR_INJ_TX_MASK;
108 		pin->tx_toggle = false;
109 		pin->tx_ignore_nack_until_eom = false;
110 		pin->tx_custom_pulse = false;
111 		pin->tx_custom_low_usecs = CEC_TIM_CUSTOM_DEFAULT;
112 		pin->tx_custom_high_usecs = CEC_TIM_CUSTOM_DEFAULT;
113 		return true;
114 	}
115 	if (!strcmp(token, "tx-ignore-nack-until-eom")) {
116 		pin->tx_ignore_nack_until_eom = true;
117 		return true;
118 	}
119 	if (!strcmp(token, "tx-custom-pulse")) {
120 		pin->tx_custom_pulse = true;
121 		cec_pin_start_timer(pin);
122 		return true;
123 	}
124 	if (!p)
125 		return false;
126 
127 	p = skip_spaces(p);
128 	if (!strcmp(token, "tx-custom-low-usecs")) {
129 		u32 usecs;
130 
131 		if (kstrtou32(p, 0, &usecs) || usecs > 10000000)
132 			return false;
133 		pin->tx_custom_low_usecs = usecs;
134 		return true;
135 	}
136 	if (!strcmp(token, "tx-custom-high-usecs")) {
137 		u32 usecs;
138 
139 		if (kstrtou32(p, 0, &usecs) || usecs > 10000000)
140 			return false;
141 		pin->tx_custom_high_usecs = usecs;
142 		return true;
143 	}
144 
145 	comma = strchr(token, ',');
146 	if (comma)
147 		*comma++ = '\0';
148 	if (!strcmp(token, "any")) {
149 		has_op = false;
150 		error = pin->error_inj + CEC_ERROR_INJ_OP_ANY;
151 		args = pin->error_inj_args[CEC_ERROR_INJ_OP_ANY];
152 	} else if (!kstrtou8(token, 0, &op)) {
153 		has_op = true;
154 		error = pin->error_inj + op;
155 		args = pin->error_inj_args[op];
156 	} else {
157 		return false;
158 	}
159 
160 	mode = CEC_ERROR_INJ_MODE_ONCE;
161 	if (comma) {
162 		if (!strcmp(comma, "off"))
163 			mode = CEC_ERROR_INJ_MODE_OFF;
164 		else if (!strcmp(comma, "once"))
165 			mode = CEC_ERROR_INJ_MODE_ONCE;
166 		else if (!strcmp(comma, "always"))
167 			mode = CEC_ERROR_INJ_MODE_ALWAYS;
168 		else if (!strcmp(comma, "toggle"))
169 			mode = CEC_ERROR_INJ_MODE_TOGGLE;
170 		else
171 			return false;
172 	}
173 
174 	token = strsep(&p, delims);
175 	if (p) {
176 		p = skip_spaces(p);
177 		has_pos = !kstrtou8(p, 0, &pos);
178 	}
179 
180 	if (!strcmp(token, "clear")) {
181 		*error = 0;
182 		return true;
183 	}
184 	if (!strcmp(token, "rx-clear")) {
185 		*error &= ~CEC_ERROR_INJ_RX_MASK;
186 		return true;
187 	}
188 	if (!strcmp(token, "tx-clear")) {
189 		*error &= ~CEC_ERROR_INJ_TX_MASK;
190 		return true;
191 	}
192 
193 	for (i = 0; cec_error_inj_cmds[i].cmd; i++) {
194 		const char *cmd = cec_error_inj_cmds[i].cmd;
195 		unsigned int mode_offset;
196 		u64 mode_mask;
197 		int arg_idx;
198 		bool is_bit_pos = true;
199 
200 		if (strcmp(token, cmd))
201 			continue;
202 
203 		mode_offset = cec_error_inj_cmds[i].mode_offset;
204 		mode_mask = CEC_ERROR_INJ_MODE_MASK << mode_offset;
205 		arg_idx = cec_error_inj_cmds[i].arg_idx;
206 
207 		if (mode_offset == CEC_ERROR_INJ_RX_ARB_LOST_OFFSET) {
208 			if (has_op)
209 				return false;
210 			if (!has_pos)
211 				pos = 0x0f;
212 			is_bit_pos = false;
213 		} else if (mode_offset == CEC_ERROR_INJ_TX_ADD_BYTES_OFFSET) {
214 			if (!has_pos || !pos)
215 				return false;
216 			is_bit_pos = false;
217 		}
218 
219 		if (arg_idx >= 0 && is_bit_pos) {
220 			if (!has_pos || pos >= 160)
221 				return false;
222 			if (has_op && pos < 10 + 8)
223 				return false;
224 			/* Invalid bit position may not be the Ack bit */
225 			if ((mode_offset == CEC_ERROR_INJ_TX_SHORT_BIT_OFFSET ||
226 			     mode_offset == CEC_ERROR_INJ_TX_LONG_BIT_OFFSET ||
227 			     mode_offset == CEC_ERROR_INJ_TX_CUSTOM_BIT_OFFSET) &&
228 			    (pos % 10) == 9)
229 				return false;
230 		}
231 		*error &= ~mode_mask;
232 		*error |= (u64)mode << mode_offset;
233 		if (arg_idx >= 0)
234 			args[arg_idx] = pos;
235 		return true;
236 	}
237 	return false;
238 }
239 
240 static void cec_pin_show_cmd(struct seq_file *sf, u32 cmd, u8 mode)
241 {
242 	if (cmd == CEC_ERROR_INJ_OP_ANY)
243 		seq_puts(sf, "any,");
244 	else
245 		seq_printf(sf, "0x%02x,", cmd);
246 	switch (mode) {
247 	case CEC_ERROR_INJ_MODE_ONCE:
248 		seq_puts(sf, "once ");
249 		break;
250 	case CEC_ERROR_INJ_MODE_ALWAYS:
251 		seq_puts(sf, "always ");
252 		break;
253 	case CEC_ERROR_INJ_MODE_TOGGLE:
254 		seq_puts(sf, "toggle ");
255 		break;
256 	default:
257 		seq_puts(sf, "off ");
258 		break;
259 	}
260 }
261 
262 int cec_pin_error_inj_show(struct cec_adapter *adap, struct seq_file *sf)
263 {
264 	struct cec_pin *pin = adap->pin;
265 	unsigned int i, j;
266 
267 	seq_puts(sf, "# Clear error injections:\n");
268 	seq_puts(sf, "#   clear          clear all rx and tx error injections\n");
269 	seq_puts(sf, "#   rx-clear       clear all rx error injections\n");
270 	seq_puts(sf, "#   tx-clear       clear all tx error injections\n");
271 	seq_puts(sf, "#   <op> clear     clear all rx and tx error injections for <op>\n");
272 	seq_puts(sf, "#   <op> rx-clear  clear all rx error injections for <op>\n");
273 	seq_puts(sf, "#   <op> tx-clear  clear all tx error injections for <op>\n");
274 	seq_puts(sf, "#\n");
275 	seq_puts(sf, "# RX error injection:\n");
276 	seq_puts(sf, "#   <op>[,<mode>] rx-nack              NACK the message instead of sending an ACK\n");
277 	seq_puts(sf, "#   <op>[,<mode>] rx-low-drive <bit>   force a low-drive condition at this bit position\n");
278 	seq_puts(sf, "#   <op>[,<mode>] rx-add-byte          add a spurious byte to the received CEC message\n");
279 	seq_puts(sf, "#   <op>[,<mode>] rx-remove-byte       remove the last byte from the received CEC message\n");
280 	seq_puts(sf, "#   <op>[,<mode>] rx-arb-lost <poll>   generate a POLL message to trigger an arbitration lost\n");
281 	seq_puts(sf, "#\n");
282 	seq_puts(sf, "# TX error injection settings:\n");
283 	seq_puts(sf, "#   tx-ignore-nack-until-eom           ignore early NACKs until EOM\n");
284 	seq_puts(sf, "#   tx-custom-low-usecs <usecs>        define the 'low' time for the custom pulse\n");
285 	seq_puts(sf, "#   tx-custom-high-usecs <usecs>       define the 'high' time for the custom pulse\n");
286 	seq_puts(sf, "#   tx-custom-pulse                    transmit the custom pulse once the bus is idle\n");
287 	seq_puts(sf, "#\n");
288 	seq_puts(sf, "# TX error injection:\n");
289 	seq_puts(sf, "#   <op>[,<mode>] tx-no-eom            don't set the EOM bit\n");
290 	seq_puts(sf, "#   <op>[,<mode>] tx-early-eom         set the EOM bit one byte too soon\n");
291 	seq_puts(sf, "#   <op>[,<mode>] tx-add-bytes <num>   append <num> (1-255) spurious bytes to the message\n");
292 	seq_puts(sf, "#   <op>[,<mode>] tx-remove-byte       drop the last byte from the message\n");
293 	seq_puts(sf, "#   <op>[,<mode>] tx-short-bit <bit>   make this bit shorter than allowed\n");
294 	seq_puts(sf, "#   <op>[,<mode>] tx-long-bit <bit>    make this bit longer than allowed\n");
295 	seq_puts(sf, "#   <op>[,<mode>] tx-custom-bit <bit>  send the custom pulse instead of this bit\n");
296 	seq_puts(sf, "#   <op>[,<mode>] tx-short-start       send a start pulse that's too short\n");
297 	seq_puts(sf, "#   <op>[,<mode>] tx-long-start        send a start pulse that's too long\n");
298 	seq_puts(sf, "#   <op>[,<mode>] tx-custom-start      send the custom pulse instead of the start pulse\n");
299 	seq_puts(sf, "#   <op>[,<mode>] tx-last-bit <bit>    stop sending after this bit\n");
300 	seq_puts(sf, "#   <op>[,<mode>] tx-low-drive <bit>   force a low-drive condition at this bit position\n");
301 	seq_puts(sf, "#\n");
302 	seq_puts(sf, "# <op>       CEC message opcode (0-255) or 'any'\n");
303 	seq_puts(sf, "# <mode>     'once' (default), 'always', 'toggle' or 'off'\n");
304 	seq_puts(sf, "# <bit>      CEC message bit (0-159)\n");
305 	seq_puts(sf, "#            10 bits per 'byte': bits 0-7: data, bit 8: EOM, bit 9: ACK\n");
306 	seq_puts(sf, "# <poll>     CEC poll message used to test arbitration lost (0x00-0xff, default 0x0f)\n");
307 	seq_puts(sf, "# <usecs>    microseconds (0-10000000, default 1000)\n");
308 
309 	seq_puts(sf, "\nclear\n");
310 
311 	for (i = 0; i < ARRAY_SIZE(pin->error_inj); i++) {
312 		u64 e = pin->error_inj[i];
313 
314 		for (j = 0; cec_error_inj_cmds[j].cmd; j++) {
315 			const char *cmd = cec_error_inj_cmds[j].cmd;
316 			unsigned int mode;
317 			unsigned int mode_offset;
318 			int arg_idx;
319 
320 			mode_offset = cec_error_inj_cmds[j].mode_offset;
321 			arg_idx = cec_error_inj_cmds[j].arg_idx;
322 			mode = (e >> mode_offset) & CEC_ERROR_INJ_MODE_MASK;
323 			if (!mode)
324 				continue;
325 			cec_pin_show_cmd(sf, i, mode);
326 			seq_puts(sf, cmd);
327 			if (arg_idx >= 0)
328 				seq_printf(sf, " %u",
329 					   pin->error_inj_args[i][arg_idx]);
330 			seq_puts(sf, "\n");
331 		}
332 	}
333 
334 	if (pin->tx_ignore_nack_until_eom)
335 		seq_puts(sf, "tx-ignore-nack-until-eom\n");
336 	if (pin->tx_custom_pulse)
337 		seq_puts(sf, "tx-custom-pulse\n");
338 	if (pin->tx_custom_low_usecs != CEC_TIM_CUSTOM_DEFAULT)
339 		seq_printf(sf, "tx-custom-low-usecs %u\n",
340 			   pin->tx_custom_low_usecs);
341 	if (pin->tx_custom_high_usecs != CEC_TIM_CUSTOM_DEFAULT)
342 		seq_printf(sf, "tx-custom-high-usecs %u\n",
343 			   pin->tx_custom_high_usecs);
344 	return 0;
345 }
346