xref: /linux/drivers/platform/chrome/cros_ec_typec.c (revision d48d8380d92ba2db4fcf81c566093276dbbb4ebc)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright 2020 Google LLC
4  *
5  * This driver provides the ability to view and manage Type C ports through the
6  * Chrome OS EC.
7  */
8 
9 #include <linux/acpi.h>
10 #include <linux/module.h>
11 #include <linux/of.h>
12 #include <linux/platform_data/cros_ec_commands.h>
13 #include <linux/platform_data/cros_usbpd_notify.h>
14 #include <linux/platform_device.h>
15 #include <linux/usb/pd_vdo.h>
16 #include <linux/usb/typec_dp.h>
17 #include <linux/usb/typec_tbt.h>
18 
19 #include "cros_ec_typec.h"
20 #include "cros_typec_vdm.h"
21 #include "cros_typec_altmode.h"
22 
23 #define DRV_NAME "cros-ec-typec"
24 
25 #define DP_PORT_VDO	(DP_CAP_DFP_D | DP_CAP_RECEPTACLE | \
26 			 DP_CONF_SET_PIN_ASSIGN(BIT(DP_PIN_ASSIGN_C) | \
27 						BIT(DP_PIN_ASSIGN_D) | \
28 						BIT(DP_PIN_ASSIGN_E)))
29 
cros_typec_role_switch_quirk(struct fwnode_handle * fwnode)30 static void cros_typec_role_switch_quirk(struct fwnode_handle *fwnode)
31 {
32 #ifdef CONFIG_ACPI
33 	struct fwnode_handle *switch_fwnode;
34 
35 	/* Supply the USB role switch with the correct pld_crc if it's missing. */
36 	switch_fwnode = fwnode_find_reference(fwnode, "usb-role-switch", 0);
37 	if (!IS_ERR_OR_NULL(switch_fwnode)) {
38 		struct acpi_device *adev = to_acpi_device_node(switch_fwnode);
39 
40 		if (adev && !adev->pld_crc)
41 			adev->pld_crc = to_acpi_device_node(fwnode)->pld_crc;
42 		fwnode_handle_put(switch_fwnode);
43 	}
44 #endif
45 }
46 
cros_typec_enter_usb_mode(struct typec_port * tc_port,enum usb_mode mode)47 static int cros_typec_enter_usb_mode(struct typec_port *tc_port, enum usb_mode mode)
48 {
49 	struct cros_typec_port *port = typec_get_drvdata(tc_port);
50 	struct ec_params_typec_control req = {
51 		.port = port->port_num,
52 		.command = (mode == USB_MODE_USB4) ?
53 			TYPEC_CONTROL_COMMAND_ENTER_MODE : TYPEC_CONTROL_COMMAND_EXIT_MODES,
54 		.mode_to_enter = CROS_EC_ALTMODE_USB4
55 	};
56 
57 	return cros_ec_cmd(port->typec_data->ec, 0, EC_CMD_TYPEC_CONTROL,
58 			  &req, sizeof(req), NULL, 0);
59 }
60 
61 static const struct typec_operations cros_typec_usb_mode_ops = {
62 	.enter_usb_mode = cros_typec_enter_usb_mode
63 };
64 
cros_typec_parse_port_props(struct typec_capability * cap,struct fwnode_handle * fwnode,struct device * dev)65 static int cros_typec_parse_port_props(struct typec_capability *cap,
66 				       struct fwnode_handle *fwnode,
67 				       struct device *dev)
68 {
69 	const char *buf;
70 	int ret;
71 
72 	memset(cap, 0, sizeof(*cap));
73 	ret = fwnode_property_read_string(fwnode, "power-role", &buf);
74 	if (ret) {
75 		dev_err(dev, "power-role not found: %d\n", ret);
76 		return ret;
77 	}
78 
79 	ret = typec_find_port_power_role(buf);
80 	if (ret < 0)
81 		return ret;
82 	cap->type = ret;
83 
84 	ret = fwnode_property_read_string(fwnode, "data-role", &buf);
85 	if (ret) {
86 		dev_err(dev, "data-role not found: %d\n", ret);
87 		return ret;
88 	}
89 
90 	ret = typec_find_port_data_role(buf);
91 	if (ret < 0)
92 		return ret;
93 	cap->data = ret;
94 
95 	/* Try-power-role is optional. */
96 	ret = fwnode_property_read_string(fwnode, "try-power-role", &buf);
97 	if (ret) {
98 		dev_warn(dev, "try-power-role not found: %d\n", ret);
99 		cap->prefer_role = TYPEC_NO_PREFERRED_ROLE;
100 	} else {
101 		ret = typec_find_power_role(buf);
102 		if (ret < 0)
103 			return ret;
104 		cap->prefer_role = ret;
105 	}
106 
107 	if (fwnode_property_present(fwnode, "usb2-port"))
108 		cap->usb_capability |= USB_CAPABILITY_USB2;
109 	if (fwnode_property_present(fwnode, "usb3-port"))
110 		cap->usb_capability |= USB_CAPABILITY_USB3;
111 	if (fwnode_property_present(fwnode, "usb4-port"))
112 		cap->usb_capability |= USB_CAPABILITY_USB4;
113 
114 	cros_typec_role_switch_quirk(fwnode);
115 
116 	cap->fwnode = fwnode;
117 
118 	return 0;
119 }
120 
cros_typec_get_switch_handles(struct cros_typec_port * port,struct fwnode_handle * fwnode,struct device * dev)121 static int cros_typec_get_switch_handles(struct cros_typec_port *port,
122 					 struct fwnode_handle *fwnode,
123 					 struct device *dev)
124 {
125 	int ret = 0;
126 
127 	port->mux = fwnode_typec_mux_get(fwnode);
128 	if (IS_ERR(port->mux)) {
129 		ret = PTR_ERR(port->mux);
130 		dev_err_probe(dev, ret, "Mux handle not found\n");
131 		goto mux_err;
132 	}
133 
134 	port->retimer = fwnode_typec_retimer_get(fwnode);
135 	if (IS_ERR(port->retimer)) {
136 		ret = PTR_ERR(port->retimer);
137 		dev_err_probe(dev, ret, "Retimer handle not found\n");
138 		goto retimer_sw_err;
139 	}
140 
141 	port->ori_sw = fwnode_typec_switch_get(fwnode);
142 	if (IS_ERR(port->ori_sw)) {
143 		ret = PTR_ERR(port->ori_sw);
144 		dev_err_probe(dev, ret, "Orientation switch handle not found\n");
145 		goto ori_sw_err;
146 	}
147 
148 	port->role_sw = fwnode_usb_role_switch_get(fwnode);
149 	if (IS_ERR(port->role_sw)) {
150 		ret = PTR_ERR(port->role_sw);
151 		dev_err_probe(dev, ret, "USB role switch handle not found\n");
152 		goto role_sw_err;
153 	}
154 
155 	return 0;
156 
157 role_sw_err:
158 	typec_switch_put(port->ori_sw);
159 	port->ori_sw = NULL;
160 ori_sw_err:
161 	typec_retimer_put(port->retimer);
162 	port->retimer = NULL;
163 retimer_sw_err:
164 	typec_mux_put(port->mux);
165 	port->mux = NULL;
166 mux_err:
167 	return ret;
168 }
169 
cros_typec_add_partner(struct cros_typec_data * typec,int port_num,bool pd_en)170 static int cros_typec_add_partner(struct cros_typec_data *typec, int port_num,
171 				  bool pd_en)
172 {
173 	struct cros_typec_port *port = typec->ports[port_num];
174 	struct typec_partner_desc p_desc = {
175 		.usb_pd = pd_en,
176 	};
177 	int ret = 0;
178 
179 	/*
180 	 * Fill an initial PD identity, which will then be updated with info
181 	 * from the EC.
182 	 */
183 	p_desc.identity = &port->p_identity;
184 
185 	port->partner = typec_register_partner(port->port, &p_desc);
186 	if (IS_ERR(port->partner)) {
187 		ret = PTR_ERR(port->partner);
188 		port->partner = NULL;
189 	}
190 
191 	return ret;
192 }
193 
cros_typec_unregister_altmodes(struct cros_typec_data * typec,int port_num,bool is_partner)194 static void cros_typec_unregister_altmodes(struct cros_typec_data *typec, int port_num,
195 					   bool is_partner)
196 {
197 	struct cros_typec_port *port = typec->ports[port_num];
198 	struct cros_typec_altmode_node *node, *tmp;
199 	struct list_head *head;
200 
201 	head = is_partner ? &port->partner_mode_list : &port->plug_mode_list;
202 	list_for_each_entry_safe(node, tmp, head, list) {
203 		list_del(&node->list);
204 		typec_unregister_altmode(node->amode);
205 		devm_kfree(typec->dev, node);
206 	}
207 }
208 
209 /*
210  * Map the Type-C Mux state to retimer state and call the retimer set function. We need this
211  * because we re-use the Type-C mux state for retimers.
212  */
cros_typec_retimer_set(struct typec_retimer * retimer,struct typec_mux_state state)213 static int cros_typec_retimer_set(struct typec_retimer *retimer, struct typec_mux_state state)
214 {
215 	struct typec_retimer_state rstate = {
216 		.alt = state.alt,
217 		.mode = state.mode,
218 		.data = state.data,
219 	};
220 
221 	return typec_retimer_set(retimer, &rstate);
222 }
223 
cros_typec_usb_disconnect_state(struct cros_typec_port * port)224 static int cros_typec_usb_disconnect_state(struct cros_typec_port *port)
225 {
226 	port->state.alt = NULL;
227 	port->state.mode = TYPEC_STATE_USB;
228 	port->state.data = NULL;
229 
230 	usb_role_switch_set_role(port->role_sw, USB_ROLE_NONE);
231 	typec_switch_set(port->ori_sw, TYPEC_ORIENTATION_NONE);
232 	cros_typec_retimer_set(port->retimer, port->state);
233 
234 	return typec_mux_set(port->mux, &port->state);
235 }
236 
cros_typec_remove_partner(struct cros_typec_data * typec,int port_num)237 static void cros_typec_remove_partner(struct cros_typec_data *typec,
238 				      int port_num)
239 {
240 	struct cros_typec_port *port = typec->ports[port_num];
241 
242 	if (!port->partner)
243 		return;
244 
245 	cros_typec_unregister_altmodes(typec, port_num, true);
246 
247 	typec_partner_set_usb_power_delivery(port->partner, NULL);
248 	usb_power_delivery_unregister_capabilities(port->partner_sink_caps);
249 	port->partner_sink_caps = NULL;
250 	usb_power_delivery_unregister_capabilities(port->partner_src_caps);
251 	port->partner_src_caps = NULL;
252 	usb_power_delivery_unregister(port->partner_pd);
253 	port->partner_pd = NULL;
254 
255 	cros_typec_usb_disconnect_state(port);
256 	port->mux_flags = USB_PD_MUX_NONE;
257 
258 	typec_unregister_partner(port->partner);
259 	port->partner = NULL;
260 	memset(&port->p_identity, 0, sizeof(port->p_identity));
261 	port->sop_disc_done = false;
262 }
263 
cros_typec_remove_cable(struct cros_typec_data * typec,int port_num)264 static void cros_typec_remove_cable(struct cros_typec_data *typec,
265 				    int port_num)
266 {
267 	struct cros_typec_port *port = typec->ports[port_num];
268 
269 	if (!port->cable)
270 		return;
271 
272 	cros_typec_unregister_altmodes(typec, port_num, false);
273 
274 	typec_unregister_plug(port->plug);
275 	port->plug = NULL;
276 	typec_unregister_cable(port->cable);
277 	port->cable = NULL;
278 	memset(&port->c_identity, 0, sizeof(port->c_identity));
279 	port->sop_prime_disc_done = false;
280 }
281 
cros_typec_unregister_port_altmodes(struct cros_typec_port * port)282 static void cros_typec_unregister_port_altmodes(struct cros_typec_port *port)
283 {
284 	int i;
285 
286 	for (i = 0; i < CROS_EC_ALTMODE_MAX; i++)
287 		typec_unregister_altmode(port->port_altmode[i]);
288 }
289 
cros_unregister_ports(struct cros_typec_data * typec)290 static void cros_unregister_ports(struct cros_typec_data *typec)
291 {
292 	int i;
293 
294 	for (i = 0; i < typec->num_ports; i++) {
295 		if (!typec->ports[i])
296 			continue;
297 
298 		cros_typec_remove_partner(typec, i);
299 		cros_typec_remove_cable(typec, i);
300 
301 		usb_role_switch_put(typec->ports[i]->role_sw);
302 		typec_switch_put(typec->ports[i]->ori_sw);
303 		typec_mux_put(typec->ports[i]->mux);
304 		cros_typec_unregister_port_altmodes(typec->ports[i]);
305 		typec_unregister_port(typec->ports[i]->port);
306 	}
307 }
308 
309 /*
310  * Register port alt modes with known values till we start retrieving
311  * port capabilities from the EC.
312  */
cros_typec_register_port_altmodes(struct cros_typec_data * typec,int port_num)313 static int cros_typec_register_port_altmodes(struct cros_typec_data *typec,
314 					      int port_num)
315 {
316 	struct cros_typec_port *port = typec->ports[port_num];
317 	struct typec_altmode_desc desc;
318 	struct typec_altmode *amode;
319 
320 	/* All PD capable CrOS devices are assumed to support DP altmode. */
321 	memset(&desc, 0, sizeof(desc));
322 	desc.svid = USB_TYPEC_DP_SID;
323 	desc.mode = USB_TYPEC_DP_MODE;
324 	desc.vdo = DP_PORT_VDO;
325 	amode = cros_typec_register_displayport(port, &desc,
326 						typec->ap_driven_altmode);
327 	if (IS_ERR(amode))
328 		return PTR_ERR(amode);
329 	port->port_altmode[CROS_EC_ALTMODE_DP] = amode;
330 
331 	/*
332 	 * Register TBT compatibility alt mode. The EC will not enter the mode
333 	 * if it doesn't support it and it will not enter automatically by
334 	 * design so we can use the |ap_driven_altmode| feature to check if we
335 	 * should register it.
336 	 */
337 	if (typec->ap_driven_altmode) {
338 		memset(&desc, 0, sizeof(desc));
339 		desc.svid = USB_TYPEC_TBT_SID;
340 		desc.mode = TBT_MODE;
341 		desc.inactive = true;
342 		amode = cros_typec_register_thunderbolt(port, &desc);
343 		if (IS_ERR(amode))
344 			return PTR_ERR(amode);
345 		port->port_altmode[CROS_EC_ALTMODE_TBT] = amode;
346 	}
347 
348 	port->state.alt = NULL;
349 	port->state.mode = TYPEC_STATE_USB;
350 	port->state.data = NULL;
351 
352 	return 0;
353 }
354 
cros_typec_init_ports(struct cros_typec_data * typec)355 static int cros_typec_init_ports(struct cros_typec_data *typec)
356 {
357 	struct device *dev = typec->dev;
358 	struct typec_capability *cap;
359 	struct fwnode_handle *fwnode;
360 	struct cros_typec_port *cros_port;
361 	const char *port_prop;
362 	int ret;
363 	int nports;
364 	u32 port_num = 0;
365 
366 	nports = device_get_child_node_count(dev);
367 	if (nports == 0) {
368 		dev_err(dev, "No port entries found.\n");
369 		return -ENODEV;
370 	}
371 
372 	if (nports > typec->num_ports) {
373 		dev_err(dev, "More ports listed than can be supported.\n");
374 		return -EINVAL;
375 	}
376 
377 	/* DT uses "reg" to specify port number. */
378 	port_prop = dev->of_node ? "reg" : "port-number";
379 	device_for_each_child_node(dev, fwnode) {
380 		if (fwnode_property_read_u32(fwnode, port_prop, &port_num)) {
381 			ret = -EINVAL;
382 			dev_err(dev, "No port-number for port, aborting.\n");
383 			goto unregister_ports;
384 		}
385 
386 		if (port_num >= typec->num_ports) {
387 			dev_err(dev, "Invalid port number.\n");
388 			ret = -EINVAL;
389 			goto unregister_ports;
390 		}
391 
392 		dev_dbg(dev, "Registering port %d\n", port_num);
393 
394 		cros_port = devm_kzalloc(dev, sizeof(*cros_port), GFP_KERNEL);
395 		if (!cros_port) {
396 			ret = -ENOMEM;
397 			goto unregister_ports;
398 		}
399 
400 		cros_port->port_num = port_num;
401 		cros_port->typec_data = typec;
402 		typec->ports[port_num] = cros_port;
403 		cap = &cros_port->caps;
404 
405 		ret = cros_typec_parse_port_props(cap, fwnode, dev);
406 		if (ret < 0)
407 			goto unregister_ports;
408 
409 		cap->driver_data = cros_port;
410 		cap->ops = &cros_typec_usb_mode_ops;
411 
412 		cros_port->port = typec_register_port(dev, cap);
413 		if (IS_ERR(cros_port->port)) {
414 			ret = PTR_ERR(cros_port->port);
415 			dev_err_probe(dev, ret, "Failed to register port %d\n", port_num);
416 			goto unregister_ports;
417 		}
418 
419 		ret = cros_typec_get_switch_handles(cros_port, fwnode, dev);
420 		if (ret) {
421 			dev_dbg(dev, "No switch control for port %d, err: %d\n", port_num, ret);
422 			if (ret == -EPROBE_DEFER)
423 				goto unregister_ports;
424 		}
425 
426 		ret = cros_typec_register_port_altmodes(typec, port_num);
427 		if (ret) {
428 			dev_err(dev, "Failed to register port altmodes\n");
429 			goto unregister_ports;
430 		}
431 
432 		cros_port->disc_data = devm_kzalloc(dev, EC_PROTO2_MAX_RESPONSE_SIZE, GFP_KERNEL);
433 		if (!cros_port->disc_data) {
434 			ret = -ENOMEM;
435 			goto unregister_ports;
436 		}
437 
438 		INIT_LIST_HEAD(&cros_port->partner_mode_list);
439 		INIT_LIST_HEAD(&cros_port->plug_mode_list);
440 	}
441 
442 	return 0;
443 
444 unregister_ports:
445 	fwnode_handle_put(fwnode);
446 	cros_unregister_ports(typec);
447 	return ret;
448 }
449 
cros_typec_usb_safe_state(struct cros_typec_port * port)450 static int cros_typec_usb_safe_state(struct cros_typec_port *port)
451 {
452 	int ret;
453 	port->state.mode = TYPEC_STATE_SAFE;
454 
455 	ret = cros_typec_retimer_set(port->retimer, port->state);
456 	if (!ret)
457 		ret = typec_mux_set(port->mux, &port->state);
458 
459 	return ret;
460 }
461 
462 /**
463  * cros_typec_get_cable_vdo() - Get Cable VDO of the connected cable
464  * @port: Type-C port data
465  * @svid: Standard or Vendor ID to match
466  *
467  * Returns the Cable VDO if match is found and returns 0 if match is not found.
468  */
cros_typec_get_cable_vdo(struct cros_typec_port * port,u16 svid)469 static int cros_typec_get_cable_vdo(struct cros_typec_port *port, u16 svid)
470 {
471 	struct list_head *head = &port->plug_mode_list;
472 	struct cros_typec_altmode_node *node;
473 	u32 ret = 0;
474 
475 	list_for_each_entry(node, head, list) {
476 		if (node->amode->svid == svid)
477 			return node->amode->vdo;
478 	}
479 
480 	return ret;
481 }
482 
483 /*
484  * Spoof the VDOs that were likely communicated by the partner for TBT alt
485  * mode.
486  */
cros_typec_enable_tbt(struct cros_typec_data * typec,int port_num,struct ec_response_usb_pd_control_v2 * pd_ctrl)487 static int cros_typec_enable_tbt(struct cros_typec_data *typec,
488 				 int port_num,
489 				 struct ec_response_usb_pd_control_v2 *pd_ctrl)
490 {
491 	struct cros_typec_port *port = typec->ports[port_num];
492 	struct typec_thunderbolt_data data;
493 	int ret;
494 
495 	if (typec->pd_ctrl_ver < 2) {
496 		dev_err(typec->dev,
497 			"PD_CTRL version too old: %d\n", typec->pd_ctrl_ver);
498 		return -ENOTSUPP;
499 	}
500 
501 	/* Device Discover Mode VDO */
502 	data.device_mode = TBT_MODE;
503 
504 	if (pd_ctrl->control_flags & USB_PD_CTRL_TBT_LEGACY_ADAPTER)
505 		data.device_mode = TBT_SET_ADAPTER(TBT_ADAPTER_TBT3);
506 
507 	/* Cable Discover Mode VDO */
508 	data.cable_mode = TBT_MODE;
509 
510 	data.cable_mode |= cros_typec_get_cable_vdo(port, USB_TYPEC_TBT_SID);
511 
512 	data.cable_mode |= TBT_SET_CABLE_SPEED(pd_ctrl->cable_speed);
513 
514 	if (pd_ctrl->control_flags & USB_PD_CTRL_OPTICAL_CABLE)
515 		data.cable_mode |= TBT_CABLE_OPTICAL;
516 
517 	if (pd_ctrl->control_flags & USB_PD_CTRL_ACTIVE_LINK_UNIDIR)
518 		data.cable_mode |= TBT_CABLE_LINK_TRAINING;
519 
520 	data.cable_mode |= TBT_SET_CABLE_ROUNDED(pd_ctrl->cable_gen);
521 
522 	/* Enter Mode VDO */
523 	data.enter_vdo = TBT_SET_CABLE_SPEED(pd_ctrl->cable_speed);
524 
525 	if (pd_ctrl->control_flags & USB_PD_CTRL_ACTIVE_CABLE)
526 		data.enter_vdo |= TBT_ENTER_MODE_ACTIVE_CABLE;
527 
528 	if (!port->state.alt) {
529 		port->state.alt = port->port_altmode[CROS_EC_ALTMODE_TBT];
530 		ret = cros_typec_usb_safe_state(port);
531 		if (ret)
532 			return ret;
533 	}
534 
535 	port->state.data = &data;
536 	port->state.mode = TYPEC_TBT_MODE;
537 
538 	return typec_mux_set(port->mux, &port->state);
539 }
540 
541 /* Spoof the VDOs that were likely communicated by the partner. */
cros_typec_enable_dp(struct cros_typec_data * typec,int port_num,struct ec_response_usb_pd_control_v2 * pd_ctrl)542 static int cros_typec_enable_dp(struct cros_typec_data *typec,
543 				int port_num,
544 				struct ec_response_usb_pd_control_v2 *pd_ctrl)
545 {
546 	struct cros_typec_port *port = typec->ports[port_num];
547 	struct typec_displayport_data dp_data;
548 	u32 cable_tbt_vdo;
549 	u32 cable_dp_vdo;
550 	int ret;
551 
552 	if (typec->pd_ctrl_ver < 2) {
553 		dev_err(typec->dev,
554 			"PD_CTRL version too old: %d\n", typec->pd_ctrl_ver);
555 		return -ENOTSUPP;
556 	}
557 
558 	if (!pd_ctrl->dp_mode) {
559 		dev_err(typec->dev, "No valid DP mode provided.\n");
560 		return -EINVAL;
561 	}
562 
563 	/* Status VDO. */
564 	dp_data.status = DP_STATUS_ENABLED;
565 	if (port->mux_flags & USB_PD_MUX_HPD_IRQ)
566 		dp_data.status |= DP_STATUS_IRQ_HPD;
567 	if (port->mux_flags & USB_PD_MUX_HPD_LVL)
568 		dp_data.status |= DP_STATUS_HPD_STATE;
569 
570 	/* Configuration VDO. */
571 	dp_data.conf = DP_CONF_SET_PIN_ASSIGN(pd_ctrl->dp_mode);
572 	if (!port->state.alt) {
573 		port->state.alt = port->port_altmode[CROS_EC_ALTMODE_DP];
574 		ret = cros_typec_usb_safe_state(port);
575 		if (ret)
576 			return ret;
577 	}
578 
579 	port->state.data = &dp_data;
580 	port->state.mode = TYPEC_MODAL_STATE(ffs(pd_ctrl->dp_mode));
581 
582 	/* Get cable VDO for cables with DPSID to check DPAM2.1 is supported */
583 	cable_dp_vdo = cros_typec_get_cable_vdo(port, USB_TYPEC_DP_SID);
584 
585 	/**
586 	 * Get cable VDO for thunderbolt cables and cables with DPSID but does not
587 	 * support DPAM2.1.
588 	 */
589 	cable_tbt_vdo = cros_typec_get_cable_vdo(port, USB_TYPEC_TBT_SID);
590 
591 	if (cable_dp_vdo & DP_CAP_DPAM_VERSION) {
592 		dp_data.conf |= cable_dp_vdo;
593 	} else if (cable_tbt_vdo) {
594 		dp_data.conf |=  TBT_CABLE_SPEED(cable_tbt_vdo) << DP_CONF_SIGNALLING_SHIFT;
595 
596 		/* Cable Type */
597 		if (cable_tbt_vdo & TBT_CABLE_OPTICAL)
598 			dp_data.conf |= DP_CONF_CABLE_TYPE_OPTICAL << DP_CONF_CABLE_TYPE_SHIFT;
599 		else if (cable_tbt_vdo & TBT_CABLE_RETIMER)
600 			dp_data.conf |= DP_CONF_CABLE_TYPE_RE_TIMER << DP_CONF_CABLE_TYPE_SHIFT;
601 		else if (cable_tbt_vdo & TBT_CABLE_ACTIVE_PASSIVE)
602 			dp_data.conf |= DP_CONF_CABLE_TYPE_RE_DRIVER << DP_CONF_CABLE_TYPE_SHIFT;
603 	} else if (PD_IDH_PTYPE(port->c_identity.id_header) == IDH_PTYPE_PCABLE) {
604 		dp_data.conf |= VDO_TYPEC_CABLE_SPEED(port->c_identity.vdo[0]) <<
605 				DP_CONF_SIGNALLING_SHIFT;
606 	}
607 
608 	ret = cros_typec_retimer_set(port->retimer, port->state);
609 	if (!ret)
610 		ret = typec_mux_set(port->mux, &port->state);
611 
612 	if (!ret)
613 		ret = cros_typec_displayport_status_update(port->state.alt,
614 							   port->state.data);
615 
616 	return ret;
617 }
618 
cros_typec_enable_usb4(struct cros_typec_data * typec,int port_num,struct ec_response_usb_pd_control_v2 * pd_ctrl)619 static int cros_typec_enable_usb4(struct cros_typec_data *typec,
620 				  int port_num,
621 				  struct ec_response_usb_pd_control_v2 *pd_ctrl)
622 {
623 	struct cros_typec_port *port = typec->ports[port_num];
624 	struct enter_usb_data data;
625 
626 	data.eudo = EUDO_USB_MODE_USB4 << EUDO_USB_MODE_SHIFT;
627 
628 	/* Cable Speed */
629 	data.eudo |= pd_ctrl->cable_speed << EUDO_CABLE_SPEED_SHIFT;
630 
631 	/* Cable Type */
632 	if (pd_ctrl->control_flags & USB_PD_CTRL_OPTICAL_CABLE)
633 		data.eudo |= EUDO_CABLE_TYPE_OPTICAL << EUDO_CABLE_TYPE_SHIFT;
634 	else if (cros_typec_get_cable_vdo(port, USB_TYPEC_TBT_SID) & TBT_CABLE_RETIMER)
635 		data.eudo |= EUDO_CABLE_TYPE_RE_TIMER << EUDO_CABLE_TYPE_SHIFT;
636 	else if (pd_ctrl->control_flags & USB_PD_CTRL_ACTIVE_CABLE)
637 		data.eudo |= EUDO_CABLE_TYPE_RE_DRIVER << EUDO_CABLE_TYPE_SHIFT;
638 
639 	data.active_link_training = !!(pd_ctrl->control_flags &
640 				       USB_PD_CTRL_ACTIVE_LINK_UNIDIR);
641 
642 	port->state.alt = NULL;
643 	port->state.data = &data;
644 	port->state.mode = TYPEC_MODE_USB4;
645 
646 	return typec_mux_set(port->mux, &port->state);
647 }
648 
cros_typec_configure_mux(struct cros_typec_data * typec,int port_num,struct ec_response_usb_pd_control_v2 * pd_ctrl)649 static int cros_typec_configure_mux(struct cros_typec_data *typec, int port_num,
650 				struct ec_response_usb_pd_control_v2 *pd_ctrl)
651 {
652 	struct cros_typec_port *port = typec->ports[port_num];
653 	struct ec_response_usb_pd_mux_info resp;
654 	struct ec_params_usb_pd_mux_info req = {
655 		.port = port_num,
656 	};
657 	struct ec_params_usb_pd_mux_ack mux_ack;
658 	enum typec_orientation orientation;
659 	struct cros_typec_altmode_node *node;
660 	int ret;
661 
662 	ret = cros_ec_cmd(typec->ec, 0, EC_CMD_USB_PD_MUX_INFO,
663 			  &req, sizeof(req), &resp, sizeof(resp));
664 	if (ret < 0) {
665 		dev_warn(typec->dev, "Failed to get mux info for port: %d, err = %d\n",
666 			 port_num, ret);
667 		return ret;
668 	}
669 
670 	/* No change needs to be made, let's exit early. */
671 	if (port->mux_flags == resp.flags && port->role == pd_ctrl->role)
672 		return 0;
673 
674 	port->mux_flags = resp.flags;
675 	port->role = pd_ctrl->role;
676 
677 	if (port->mux_flags == USB_PD_MUX_NONE) {
678 		ret = cros_typec_usb_disconnect_state(port);
679 		goto mux_ack;
680 	}
681 
682 	if (port->mux_flags & USB_PD_MUX_POLARITY_INVERTED)
683 		orientation = TYPEC_ORIENTATION_REVERSE;
684 	else
685 		orientation = TYPEC_ORIENTATION_NORMAL;
686 
687 	ret = typec_switch_set(port->ori_sw, orientation);
688 	if (ret)
689 		return ret;
690 
691 	ret = usb_role_switch_set_role(typec->ports[port_num]->role_sw,
692 					pd_ctrl->role & PD_CTRL_RESP_ROLE_DATA
693 					? USB_ROLE_HOST : USB_ROLE_DEVICE);
694 	if (ret)
695 		return ret;
696 
697 	if (port->mux_flags & USB_PD_MUX_USB4_ENABLED) {
698 		ret = cros_typec_enable_usb4(typec, port_num, pd_ctrl);
699 	} else if (port->mux_flags & USB_PD_MUX_TBT_COMPAT_ENABLED) {
700 		ret = cros_typec_enable_tbt(typec, port_num, pd_ctrl);
701 	} else if (port->mux_flags & USB_PD_MUX_DP_ENABLED) {
702 		ret = cros_typec_enable_dp(typec, port_num, pd_ctrl);
703 	} else if (port->mux_flags & USB_PD_MUX_SAFE_MODE) {
704 		ret = cros_typec_usb_safe_state(port);
705 	} else if (port->mux_flags & USB_PD_MUX_USB_ENABLED) {
706 		port->state.alt = NULL;
707 		port->state.mode = TYPEC_STATE_USB;
708 
709 		ret = cros_typec_retimer_set(port->retimer, port->state);
710 		if (!ret)
711 			ret = typec_mux_set(port->mux, &port->state);
712 	} else {
713 		dev_dbg(typec->dev,
714 			"Unrecognized mode requested, mux flags: %x\n",
715 			port->mux_flags);
716 	}
717 
718 	/* Iterate all partner alt-modes and set the active alternate mode. */
719 	list_for_each_entry(node, &port->partner_mode_list, list) {
720 		typec_altmode_update_active(
721 			node->amode,
722 			port->state.alt &&
723 				node->amode->svid == port->state.alt->svid);
724 	}
725 
726 mux_ack:
727 	if (!typec->needs_mux_ack)
728 		return ret;
729 
730 	/* Sending Acknowledgment to EC */
731 	mux_ack.port = port_num;
732 
733 	if (cros_ec_cmd(typec->ec, 0, EC_CMD_USB_PD_MUX_ACK, &mux_ack,
734 			sizeof(mux_ack), NULL, 0) < 0)
735 		dev_warn(typec->dev,
736 			 "Failed to send Mux ACK to EC for port: %d\n",
737 			 port_num);
738 
739 	return ret;
740 }
741 
cros_typec_set_port_params_v0(struct cros_typec_data * typec,int port_num,struct ec_response_usb_pd_control * resp)742 static void cros_typec_set_port_params_v0(struct cros_typec_data *typec,
743 		int port_num, struct ec_response_usb_pd_control *resp)
744 {
745 	struct typec_port *port = typec->ports[port_num]->port;
746 	enum typec_orientation polarity;
747 
748 	if (!resp->enabled)
749 		polarity = TYPEC_ORIENTATION_NONE;
750 	else if (!resp->polarity)
751 		polarity = TYPEC_ORIENTATION_NORMAL;
752 	else
753 		polarity = TYPEC_ORIENTATION_REVERSE;
754 
755 	typec_set_pwr_role(port, resp->role ? TYPEC_SOURCE : TYPEC_SINK);
756 	typec_set_orientation(port, polarity);
757 }
758 
cros_typec_set_port_params_v1(struct cros_typec_data * typec,int port_num,struct ec_response_usb_pd_control_v1 * resp)759 static void cros_typec_set_port_params_v1(struct cros_typec_data *typec,
760 		int port_num, struct ec_response_usb_pd_control_v1 *resp)
761 {
762 	struct typec_port *port = typec->ports[port_num]->port;
763 	enum typec_orientation polarity;
764 	bool pd_en;
765 	int ret;
766 
767 	if (!(resp->enabled & PD_CTRL_RESP_ENABLED_CONNECTED))
768 		polarity = TYPEC_ORIENTATION_NONE;
769 	else if (!resp->polarity)
770 		polarity = TYPEC_ORIENTATION_NORMAL;
771 	else
772 		polarity = TYPEC_ORIENTATION_REVERSE;
773 	typec_set_orientation(port, polarity);
774 	typec_set_data_role(port, resp->role & PD_CTRL_RESP_ROLE_DATA ?
775 			TYPEC_HOST : TYPEC_DEVICE);
776 	typec_set_pwr_role(port, resp->role & PD_CTRL_RESP_ROLE_POWER ?
777 			TYPEC_SOURCE : TYPEC_SINK);
778 	typec_set_vconn_role(port, resp->role & PD_CTRL_RESP_ROLE_VCONN ?
779 			TYPEC_SOURCE : TYPEC_SINK);
780 
781 	/* Register/remove partners when a connect/disconnect occurs. */
782 	if (resp->enabled & PD_CTRL_RESP_ENABLED_CONNECTED) {
783 		if (typec->ports[port_num]->partner)
784 			return;
785 
786 		pd_en = resp->enabled & PD_CTRL_RESP_ENABLED_PD_CAPABLE;
787 		ret = cros_typec_add_partner(typec, port_num, pd_en);
788 		if (ret)
789 			dev_warn(typec->dev,
790 				 "Failed to register partner on port: %d\n",
791 				 port_num);
792 	} else {
793 		cros_typec_remove_partner(typec, port_num);
794 		cros_typec_remove_cable(typec, port_num);
795 	}
796 }
797 
798 /*
799  * Helper function to register partner/plug altmodes.
800  */
cros_typec_register_altmodes(struct cros_typec_data * typec,int port_num,bool is_partner)801 static int cros_typec_register_altmodes(struct cros_typec_data *typec, int port_num,
802 					bool is_partner)
803 {
804 	struct cros_typec_port *port = typec->ports[port_num];
805 	struct ec_response_typec_discovery *sop_disc = port->disc_data;
806 	struct cros_typec_altmode_node *node;
807 	struct typec_altmode_desc desc;
808 	struct typec_altmode *amode;
809 	int num_altmodes = 0;
810 	int ret = 0;
811 	int i, j;
812 
813 	for (i = 0; i < sop_disc->svid_count; i++) {
814 		for (j = 0; j < sop_disc->svids[i].mode_count; j++) {
815 			memset(&desc, 0, sizeof(desc));
816 			desc.svid = sop_disc->svids[i].svid;
817 			desc.mode = j + 1;
818 			desc.vdo = sop_disc->svids[i].mode_vdo[j];
819 
820 			if (is_partner)
821 				amode = typec_partner_register_altmode(port->partner, &desc);
822 			else
823 				amode = typec_plug_register_altmode(port->plug, &desc);
824 
825 			if (IS_ERR(amode)) {
826 				ret = PTR_ERR(amode);
827 				goto err_cleanup;
828 			}
829 
830 			/* If no memory is available we should unregister and exit. */
831 			node = devm_kzalloc(typec->dev, sizeof(*node), GFP_KERNEL);
832 			if (!node) {
833 				ret = -ENOMEM;
834 				typec_unregister_altmode(amode);
835 				goto err_cleanup;
836 			}
837 
838 			node->amode = amode;
839 
840 			if (is_partner)
841 				list_add_tail(&node->list, &port->partner_mode_list);
842 			else
843 				list_add_tail(&node->list, &port->plug_mode_list);
844 			num_altmodes++;
845 		}
846 	}
847 
848 	if (is_partner)
849 		ret = typec_partner_set_num_altmodes(port->partner, num_altmodes);
850 	else
851 		ret = typec_plug_set_num_altmodes(port->plug, num_altmodes);
852 
853 	if (ret < 0) {
854 		dev_err(typec->dev, "Unable to set %s num_altmodes for port: %d\n",
855 			is_partner ? "partner" : "plug", port_num);
856 		goto err_cleanup;
857 	}
858 
859 	return 0;
860 
861 err_cleanup:
862 	cros_typec_unregister_altmodes(typec, port_num, is_partner);
863 	return ret;
864 }
865 
866 /*
867  * Parse the PD identity data from the EC PD discovery responses and copy that to the supplied
868  * PD identity struct.
869  */
cros_typec_parse_pd_identity(struct usb_pd_identity * id,struct ec_response_typec_discovery * disc)870 static void cros_typec_parse_pd_identity(struct usb_pd_identity *id,
871 					 struct ec_response_typec_discovery *disc)
872 {
873 	int i;
874 
875 	/* First, update the PD identity VDOs for the partner. */
876 	if (disc->identity_count > 0)
877 		id->id_header = disc->discovery_vdo[0];
878 	if (disc->identity_count > 1)
879 		id->cert_stat = disc->discovery_vdo[1];
880 	if (disc->identity_count > 2)
881 		id->product = disc->discovery_vdo[2];
882 
883 	/* Copy the remaining identity VDOs till a maximum of 6. */
884 	for (i = 3; i < disc->identity_count && i < VDO_MAX_OBJECTS; i++)
885 		id->vdo[i - 3] = disc->discovery_vdo[i];
886 }
887 
cros_typec_handle_sop_prime_disc(struct cros_typec_data * typec,int port_num,u16 pd_revision)888 static int cros_typec_handle_sop_prime_disc(struct cros_typec_data *typec, int port_num, u16 pd_revision)
889 {
890 	struct cros_typec_port *port = typec->ports[port_num];
891 	struct ec_response_typec_discovery *disc = port->disc_data;
892 	struct typec_cable_desc c_desc = {};
893 	struct typec_plug_desc p_desc;
894 	struct ec_params_typec_discovery req = {
895 		.port = port_num,
896 		.partner_type = TYPEC_PARTNER_SOP_PRIME,
897 	};
898 	u32 cable_plug_type;
899 	int ret = 0;
900 
901 	memset(disc, 0, EC_PROTO2_MAX_RESPONSE_SIZE);
902 	ret = cros_ec_cmd(typec->ec, 0, EC_CMD_TYPEC_DISCOVERY, &req, sizeof(req),
903 			  disc, EC_PROTO2_MAX_RESPONSE_SIZE);
904 	if (ret < 0) {
905 		dev_err(typec->dev, "Failed to get SOP' discovery data for port: %d\n", port_num);
906 		goto sop_prime_disc_exit;
907 	}
908 
909 	/* Parse the PD identity data, even if only 0s were returned. */
910 	cros_typec_parse_pd_identity(&port->c_identity, disc);
911 
912 	if (disc->identity_count != 0) {
913 		cable_plug_type = VDO_TYPEC_CABLE_TYPE(port->c_identity.vdo[0]);
914 		switch (cable_plug_type) {
915 		case CABLE_ATYPE:
916 			c_desc.type = USB_PLUG_TYPE_A;
917 			break;
918 		case CABLE_BTYPE:
919 			c_desc.type = USB_PLUG_TYPE_B;
920 			break;
921 		case CABLE_CTYPE:
922 			c_desc.type = USB_PLUG_TYPE_C;
923 			break;
924 		case CABLE_CAPTIVE:
925 			c_desc.type = USB_PLUG_CAPTIVE;
926 			break;
927 		default:
928 			c_desc.type = USB_PLUG_NONE;
929 		}
930 		c_desc.active = PD_IDH_PTYPE(port->c_identity.id_header) == IDH_PTYPE_ACABLE;
931 	}
932 
933 	c_desc.identity = &port->c_identity;
934 	c_desc.pd_revision = pd_revision;
935 
936 	port->cable = typec_register_cable(port->port, &c_desc);
937 	if (IS_ERR(port->cable)) {
938 		ret = PTR_ERR(port->cable);
939 		port->cable = NULL;
940 		goto sop_prime_disc_exit;
941 	}
942 
943 	p_desc.index = TYPEC_PLUG_SOP_P;
944 	port->plug = typec_register_plug(port->cable, &p_desc);
945 	if (IS_ERR(port->plug)) {
946 		ret = PTR_ERR(port->plug);
947 		port->plug = NULL;
948 		goto sop_prime_disc_exit;
949 	}
950 
951 	ret = cros_typec_register_altmodes(typec, port_num, false);
952 	if (ret < 0) {
953 		dev_err(typec->dev, "Failed to register plug altmodes, port: %d\n", port_num);
954 		goto sop_prime_disc_exit;
955 	}
956 
957 	return 0;
958 
959 sop_prime_disc_exit:
960 	cros_typec_remove_cable(typec, port_num);
961 	return ret;
962 }
963 
cros_typec_handle_sop_disc(struct cros_typec_data * typec,int port_num,u16 pd_revision)964 static int cros_typec_handle_sop_disc(struct cros_typec_data *typec, int port_num, u16 pd_revision)
965 {
966 	struct cros_typec_port *port = typec->ports[port_num];
967 	struct ec_response_typec_discovery *sop_disc = port->disc_data;
968 	struct ec_params_typec_discovery req = {
969 		.port = port_num,
970 		.partner_type = TYPEC_PARTNER_SOP,
971 	};
972 	int ret = 0;
973 
974 	if (!port->partner) {
975 		dev_err(typec->dev,
976 			"SOP Discovery received without partner registered, port: %d\n",
977 			port_num);
978 		ret = -EINVAL;
979 		goto disc_exit;
980 	}
981 
982 	typec_partner_set_pd_revision(port->partner, pd_revision);
983 
984 	memset(sop_disc, 0, EC_PROTO2_MAX_RESPONSE_SIZE);
985 	ret = cros_ec_cmd(typec->ec, 0, EC_CMD_TYPEC_DISCOVERY, &req, sizeof(req),
986 			  sop_disc, EC_PROTO2_MAX_RESPONSE_SIZE);
987 	if (ret < 0) {
988 		dev_err(typec->dev, "Failed to get SOP discovery data for port: %d\n", port_num);
989 		goto disc_exit;
990 	}
991 
992 	cros_typec_parse_pd_identity(&port->p_identity, sop_disc);
993 
994 	ret = typec_partner_set_identity(port->partner);
995 	if (ret < 0) {
996 		dev_err(typec->dev, "Failed to update partner PD identity, port: %d\n", port_num);
997 		goto disc_exit;
998 	}
999 
1000 	ret = cros_typec_register_altmodes(typec, port_num, true);
1001 	if (ret < 0) {
1002 		dev_err(typec->dev, "Failed to register partner altmodes, port: %d\n", port_num);
1003 		goto disc_exit;
1004 	}
1005 
1006 disc_exit:
1007 	return ret;
1008 }
1009 
cros_typec_send_clear_event(struct cros_typec_data * typec,int port_num,u32 events_mask)1010 static int cros_typec_send_clear_event(struct cros_typec_data *typec, int port_num, u32 events_mask)
1011 {
1012 	struct ec_params_typec_control req = {
1013 		.port = port_num,
1014 		.command = TYPEC_CONTROL_COMMAND_CLEAR_EVENTS,
1015 		.clear_events_mask = events_mask,
1016 	};
1017 
1018 	return cros_ec_cmd(typec->ec, 0, EC_CMD_TYPEC_CONTROL, &req,
1019 			   sizeof(req), NULL, 0);
1020 }
1021 
cros_typec_register_partner_pdos(struct cros_typec_data * typec,struct ec_response_typec_status * resp,int port_num)1022 static void cros_typec_register_partner_pdos(struct cros_typec_data *typec,
1023 					     struct ec_response_typec_status *resp, int port_num)
1024 {
1025 	struct usb_power_delivery_capabilities_desc caps_desc = {};
1026 	struct usb_power_delivery_desc desc = {
1027 		.revision = (le16_to_cpu(resp->sop_revision) & 0xff00) >> 4,
1028 	};
1029 	struct cros_typec_port *port = typec->ports[port_num];
1030 
1031 	if (!port->partner || port->partner_pd)
1032 		return;
1033 
1034 	/* If no caps are available, don't bother creating a device. */
1035 	if (!resp->source_cap_count && !resp->sink_cap_count)
1036 		return;
1037 
1038 	port->partner_pd = typec_partner_usb_power_delivery_register(port->partner, &desc);
1039 	if (IS_ERR(port->partner_pd)) {
1040 		dev_warn(typec->dev, "Failed to register partner PD device, port: %d\n", port_num);
1041 		return;
1042 	}
1043 
1044 	typec_partner_set_usb_power_delivery(port->partner, port->partner_pd);
1045 
1046 	memcpy(caps_desc.pdo, resp->source_cap_pdos, sizeof(u32) * resp->source_cap_count);
1047 	caps_desc.role = TYPEC_SOURCE;
1048 	port->partner_src_caps = usb_power_delivery_register_capabilities(port->partner_pd,
1049 									  &caps_desc);
1050 	if (IS_ERR(port->partner_src_caps))
1051 		dev_warn(typec->dev, "Failed to register source caps, port: %d\n", port_num);
1052 
1053 	memset(&caps_desc, 0, sizeof(caps_desc));
1054 	memcpy(caps_desc.pdo, resp->sink_cap_pdos, sizeof(u32) * resp->sink_cap_count);
1055 	caps_desc.role = TYPEC_SINK;
1056 	port->partner_sink_caps = usb_power_delivery_register_capabilities(port->partner_pd,
1057 									   &caps_desc);
1058 	if (IS_ERR(port->partner_sink_caps))
1059 		dev_warn(typec->dev, "Failed to register sink caps, port: %d\n", port_num);
1060 }
1061 
cros_typec_handle_status(struct cros_typec_data * typec,int port_num)1062 static void cros_typec_handle_status(struct cros_typec_data *typec, int port_num)
1063 {
1064 	struct ec_response_typec_status resp;
1065 	struct ec_params_typec_status req = {
1066 		.port = port_num,
1067 	};
1068 	int ret;
1069 
1070 	ret = cros_ec_cmd(typec->ec, 0, EC_CMD_TYPEC_STATUS, &req, sizeof(req),
1071 			  &resp, sizeof(resp));
1072 	if (ret < 0) {
1073 		dev_warn(typec->dev, "EC_CMD_TYPEC_STATUS failed for port: %d\n", port_num);
1074 		return;
1075 	}
1076 
1077 	/* If we got a hard reset, unregister everything and return. */
1078 	if (resp.events & PD_STATUS_EVENT_HARD_RESET) {
1079 		cros_typec_remove_partner(typec, port_num);
1080 		cros_typec_remove_cable(typec, port_num);
1081 
1082 		ret = cros_typec_send_clear_event(typec, port_num,
1083 						  PD_STATUS_EVENT_HARD_RESET);
1084 		if (ret < 0)
1085 			dev_warn(typec->dev,
1086 				 "Failed hard reset event clear, port: %d\n", port_num);
1087 		return;
1088 	}
1089 
1090 	/* Handle any events appropriately. */
1091 	if (resp.events & PD_STATUS_EVENT_SOP_DISC_DONE && !typec->ports[port_num]->sop_disc_done) {
1092 		u16 sop_revision;
1093 
1094 		/* Convert BCD to the format preferred by the TypeC framework */
1095 		sop_revision = (le16_to_cpu(resp.sop_revision) & 0xff00) >> 4;
1096 		ret = cros_typec_handle_sop_disc(typec, port_num, sop_revision);
1097 		if (ret < 0)
1098 			dev_err(typec->dev, "Couldn't parse SOP Disc data, port: %d\n", port_num);
1099 		else {
1100 			typec->ports[port_num]->sop_disc_done = true;
1101 			ret = cros_typec_send_clear_event(typec, port_num,
1102 							  PD_STATUS_EVENT_SOP_DISC_DONE);
1103 			if (ret < 0)
1104 				dev_warn(typec->dev,
1105 					 "Failed SOP Disc event clear, port: %d\n", port_num);
1106 		}
1107 		if (resp.sop_connected)
1108 			typec_set_pwr_opmode(typec->ports[port_num]->port, TYPEC_PWR_MODE_PD);
1109 
1110 		cros_typec_register_partner_pdos(typec, &resp, port_num);
1111 	}
1112 
1113 	if (resp.events & PD_STATUS_EVENT_SOP_PRIME_DISC_DONE &&
1114 	    !typec->ports[port_num]->sop_prime_disc_done) {
1115 		u16 sop_prime_revision;
1116 
1117 		/* Convert BCD to the format preferred by the TypeC framework */
1118 		sop_prime_revision = (le16_to_cpu(resp.sop_prime_revision) & 0xff00) >> 4;
1119 		ret = cros_typec_handle_sop_prime_disc(typec, port_num, sop_prime_revision);
1120 		if (ret < 0)
1121 			dev_err(typec->dev, "Couldn't parse SOP' Disc data, port: %d\n", port_num);
1122 		else {
1123 			typec->ports[port_num]->sop_prime_disc_done = true;
1124 			ret = cros_typec_send_clear_event(typec, port_num,
1125 							  PD_STATUS_EVENT_SOP_PRIME_DISC_DONE);
1126 			if (ret < 0)
1127 				dev_warn(typec->dev,
1128 					 "Failed SOP Disc event clear, port: %d\n", port_num);
1129 		}
1130 	}
1131 
1132 	if (resp.events & PD_STATUS_EVENT_VDM_REQ_REPLY) {
1133 		cros_typec_handle_vdm_response(typec, port_num);
1134 		ret = cros_typec_send_clear_event(typec, port_num, PD_STATUS_EVENT_VDM_REQ_REPLY);
1135 		if (ret < 0)
1136 			dev_warn(typec->dev, "Failed VDM Reply event clear, port: %d\n", port_num);
1137 	}
1138 
1139 	if (resp.events & PD_STATUS_EVENT_VDM_ATTENTION) {
1140 		cros_typec_handle_vdm_attention(typec, port_num);
1141 		ret = cros_typec_send_clear_event(typec, port_num, PD_STATUS_EVENT_VDM_ATTENTION);
1142 		if (ret < 0)
1143 			dev_warn(typec->dev, "Failed VDM attention event clear, port: %d\n",
1144 				 port_num);
1145 	}
1146 }
1147 
cros_typec_port_update(struct cros_typec_data * typec,int port_num)1148 static int cros_typec_port_update(struct cros_typec_data *typec, int port_num)
1149 {
1150 	struct ec_params_usb_pd_control req;
1151 	struct ec_response_usb_pd_control_v2 resp;
1152 	int ret;
1153 
1154 	if (port_num < 0 || port_num >= typec->num_ports) {
1155 		dev_err(typec->dev, "cannot get status for invalid port %d\n",
1156 			port_num);
1157 		return -EINVAL;
1158 	}
1159 
1160 	req.port = port_num;
1161 	req.role = USB_PD_CTRL_ROLE_NO_CHANGE;
1162 	req.mux = USB_PD_CTRL_MUX_NO_CHANGE;
1163 	req.swap = USB_PD_CTRL_SWAP_NONE;
1164 
1165 	ret = cros_ec_cmd(typec->ec, typec->pd_ctrl_ver,
1166 			  EC_CMD_USB_PD_CONTROL, &req, sizeof(req),
1167 			  &resp, sizeof(resp));
1168 	if (ret < 0)
1169 		return ret;
1170 
1171 	/* Update the switches if they exist, according to requested state */
1172 	ret = cros_typec_configure_mux(typec, port_num, &resp);
1173 	if (ret)
1174 		dev_warn(typec->dev, "Configure muxes failed, err = %d\n", ret);
1175 
1176 	dev_dbg(typec->dev, "Enabled %d: 0x%hhx\n", port_num, resp.enabled);
1177 	dev_dbg(typec->dev, "Role %d: 0x%hhx\n", port_num, resp.role);
1178 	dev_dbg(typec->dev, "Polarity %d: 0x%hhx\n", port_num, resp.polarity);
1179 	dev_dbg(typec->dev, "State %d: %s\n", port_num, resp.state);
1180 
1181 	if (typec->pd_ctrl_ver != 0)
1182 		cros_typec_set_port_params_v1(typec, port_num,
1183 			(struct ec_response_usb_pd_control_v1 *)&resp);
1184 	else
1185 		cros_typec_set_port_params_v0(typec, port_num,
1186 			(struct ec_response_usb_pd_control *) &resp);
1187 
1188 	if (typec->typec_cmd_supported)
1189 		cros_typec_handle_status(typec, port_num);
1190 
1191 	return 0;
1192 }
1193 
cros_typec_get_cmd_version(struct cros_typec_data * typec)1194 static int cros_typec_get_cmd_version(struct cros_typec_data *typec)
1195 {
1196 	struct ec_params_get_cmd_versions_v1 req_v1;
1197 	struct ec_response_get_cmd_versions resp;
1198 	int ret;
1199 
1200 	/* We're interested in the PD control command version. */
1201 	req_v1.cmd = EC_CMD_USB_PD_CONTROL;
1202 	ret = cros_ec_cmd(typec->ec, 1, EC_CMD_GET_CMD_VERSIONS,
1203 			  &req_v1, sizeof(req_v1), &resp, sizeof(resp));
1204 	if (ret < 0)
1205 		return ret;
1206 
1207 	if (resp.version_mask & EC_VER_MASK(2))
1208 		typec->pd_ctrl_ver = 2;
1209 	else if (resp.version_mask & EC_VER_MASK(1))
1210 		typec->pd_ctrl_ver = 1;
1211 	else
1212 		typec->pd_ctrl_ver = 0;
1213 
1214 	dev_dbg(typec->dev, "PD Control has version mask 0x%02x\n",
1215 		typec->pd_ctrl_ver & 0xff);
1216 
1217 	return 0;
1218 }
1219 
cros_typec_port_work(struct work_struct * work)1220 static void cros_typec_port_work(struct work_struct *work)
1221 {
1222 	struct cros_typec_data *typec = container_of(work, struct cros_typec_data, port_work);
1223 	int ret, i;
1224 
1225 	for (i = 0; i < typec->num_ports; i++) {
1226 		ret = cros_typec_port_update(typec, i);
1227 		if (ret < 0)
1228 			dev_warn(typec->dev, "Update failed for port: %d\n", i);
1229 	}
1230 }
1231 
cros_ec_typec_event(struct notifier_block * nb,unsigned long host_event,void * _notify)1232 static int cros_ec_typec_event(struct notifier_block *nb,
1233 			       unsigned long host_event, void *_notify)
1234 {
1235 	struct cros_typec_data *typec = container_of(nb, struct cros_typec_data, nb);
1236 
1237 	flush_work(&typec->port_work);
1238 	schedule_work(&typec->port_work);
1239 
1240 	return NOTIFY_OK;
1241 }
1242 
1243 #ifdef CONFIG_ACPI
1244 static const struct acpi_device_id cros_typec_acpi_id[] = {
1245 	{ "GOOG0014", 0 },
1246 	{}
1247 };
1248 MODULE_DEVICE_TABLE(acpi, cros_typec_acpi_id);
1249 #endif
1250 
1251 #ifdef CONFIG_OF
1252 static const struct of_device_id cros_typec_of_match[] = {
1253 	{ .compatible = "google,cros-ec-typec", },
1254 	{}
1255 };
1256 MODULE_DEVICE_TABLE(of, cros_typec_of_match);
1257 #endif
1258 
cros_typec_probe(struct platform_device * pdev)1259 static int cros_typec_probe(struct platform_device *pdev)
1260 {
1261 	struct cros_ec_dev *ec_dev = NULL;
1262 	struct device *dev = &pdev->dev;
1263 	struct cros_typec_data *typec;
1264 	struct ec_response_usb_pd_ports resp;
1265 	int ret, i;
1266 
1267 	typec = devm_kzalloc(dev, sizeof(*typec), GFP_KERNEL);
1268 	if (!typec)
1269 		return -ENOMEM;
1270 
1271 	typec->dev = dev;
1272 
1273 	typec->ec = dev_get_drvdata(pdev->dev.parent);
1274 	if (!typec->ec) {
1275 		dev_err(dev, "couldn't find parent EC device\n");
1276 		return -ENODEV;
1277 	}
1278 
1279 	platform_set_drvdata(pdev, typec);
1280 
1281 	ret = cros_typec_get_cmd_version(typec);
1282 	if (ret < 0) {
1283 		dev_err(dev, "failed to get PD command version info\n");
1284 		return ret;
1285 	}
1286 
1287 	ec_dev = dev_get_drvdata(&typec->ec->ec->dev);
1288 	if (!ec_dev)
1289 		return -EPROBE_DEFER;
1290 
1291 	typec->typec_cmd_supported = cros_ec_check_features(ec_dev, EC_FEATURE_TYPEC_CMD);
1292 	typec->needs_mux_ack = cros_ec_check_features(ec_dev, EC_FEATURE_TYPEC_MUX_REQUIRE_AP_ACK);
1293 	typec->ap_driven_altmode = cros_ec_check_features(
1294 		ec_dev, EC_FEATURE_TYPEC_REQUIRE_AP_MODE_ENTRY);
1295 
1296 	ret = cros_ec_cmd(typec->ec, 0, EC_CMD_USB_PD_PORTS, NULL, 0,
1297 			  &resp, sizeof(resp));
1298 	if (ret < 0)
1299 		return ret;
1300 
1301 	typec->num_ports = resp.num_ports;
1302 	if (typec->num_ports > EC_USB_PD_MAX_PORTS) {
1303 		dev_warn(typec->dev,
1304 			 "Too many ports reported: %d, limiting to max: %d\n",
1305 			 typec->num_ports, EC_USB_PD_MAX_PORTS);
1306 		typec->num_ports = EC_USB_PD_MAX_PORTS;
1307 	}
1308 
1309 	ret = cros_typec_init_ports(typec);
1310 	if (ret < 0)
1311 		return ret;
1312 
1313 	INIT_WORK(&typec->port_work, cros_typec_port_work);
1314 
1315 	/*
1316 	 * Safe to call port update here, since we haven't registered the
1317 	 * PD notifier yet.
1318 	 */
1319 	for (i = 0; i < typec->num_ports; i++) {
1320 		ret = cros_typec_port_update(typec, i);
1321 		if (ret < 0)
1322 			goto unregister_ports;
1323 	}
1324 
1325 	typec->nb.notifier_call = cros_ec_typec_event;
1326 	ret = cros_usbpd_register_notify(&typec->nb);
1327 	if (ret < 0)
1328 		goto unregister_ports;
1329 
1330 	return 0;
1331 
1332 unregister_ports:
1333 	cros_unregister_ports(typec);
1334 	return ret;
1335 }
1336 
cros_typec_remove(struct platform_device * pdev)1337 static void cros_typec_remove(struct platform_device *pdev)
1338 {
1339 	struct cros_typec_data *typec = platform_get_drvdata(pdev);
1340 
1341 	cros_usbpd_unregister_notify(&typec->nb);
1342 	cancel_work_sync(&typec->port_work);
1343 	cros_unregister_ports(typec);
1344 }
1345 
cros_typec_suspend(struct device * dev)1346 static int __maybe_unused cros_typec_suspend(struct device *dev)
1347 {
1348 	struct cros_typec_data *typec = dev_get_drvdata(dev);
1349 
1350 	cancel_work_sync(&typec->port_work);
1351 
1352 	return 0;
1353 }
1354 
cros_typec_resume(struct device * dev)1355 static int __maybe_unused cros_typec_resume(struct device *dev)
1356 {
1357 	struct cros_typec_data *typec = dev_get_drvdata(dev);
1358 
1359 	/* Refresh port state. */
1360 	schedule_work(&typec->port_work);
1361 
1362 	return 0;
1363 }
1364 
1365 static const struct dev_pm_ops cros_typec_pm_ops = {
1366 	SET_SYSTEM_SLEEP_PM_OPS(cros_typec_suspend, cros_typec_resume)
1367 };
1368 
1369 static struct platform_driver cros_typec_driver = {
1370 	.driver	= {
1371 		.name = DRV_NAME,
1372 		.acpi_match_table = ACPI_PTR(cros_typec_acpi_id),
1373 		.of_match_table = of_match_ptr(cros_typec_of_match),
1374 		.pm = &cros_typec_pm_ops,
1375 	},
1376 	.probe = cros_typec_probe,
1377 	.remove = cros_typec_remove,
1378 };
1379 
1380 module_platform_driver(cros_typec_driver);
1381 
1382 MODULE_AUTHOR("Prashant Malani <pmalani@chromium.org>");
1383 MODULE_DESCRIPTION("Chrome OS EC Type C control");
1384 MODULE_LICENSE("GPL");
1385