typec/altmodes/displayport.c

20 #define DP_HEADER(_dp, ver, cmd)	(VDO((_dp)->alt->svid, 1, ver, cmd)	\
71 	struct typec_altmode *alt;
89 	return typec_altmode_notify(dp->alt, conf, &dp->data);
105 		pin_assign = DP_CAP_UFP_D_PIN_ASSIGN(dp->alt->vdo) &
114 		pin_assign = DP_CAP_PIN_ASSIGN_UFP_D(dp->alt->vdo) &
179 		sysfs_notify(&dp->alt->dev.kobj, "displayport", "hpd");
187 	sysfs_notify(&dp->alt->dev.kobj, "displayport", "configuration");
188 	sysfs_notify(&dp->alt->dev.kobj, "displayport", "pin_assignment");
197 		sysfs_notify(&dp->alt->dev.kobj, "displayport", "hpd");
206 	int svdm_version = typec_altmode_get_svdm_version(dp->alt);
214 	ret = typec_altmode_notify(dp->alt, TYPEC_STATE_SAFE, &dp->data);
216 		dev_err(&dp->alt->dev,
221 	ret = typec_altmode_vdm(dp->alt, header, &conf, 2);
253 		ret = typec_altmode_enter(dp->alt, NULL);
255 			dev_err(&dp->alt->dev, "failed to enter mode\n");
258 		ret = typec_cable_altmode_enter(dp->alt, TYPEC_PLUG_SOP_P, NULL);
265 			dev_err(&dp->alt->dev, "plug failed to enter mode\n");
271 		svdm_version = typec_altmode_get_svdm_version(dp->alt);
276 		ret = typec_altmode_vdm(dp->alt, header, &vdo, 2);
278 			dev_err(&dp->alt->dev,
285 			dev_err(&dp->alt->dev,
299 		if (typec_altmode_exit(dp->alt))
300 			dev_err(&dp->alt->dev, "Exit Mode Failed!\n");
322 static void dp_altmode_attention(struct typec_altmode *alt, const u32 vdo)
324 	struct dp_altmode *dp = typec_altmode_get_drvdata(alt);
333 		dev_warn(&alt->dev, "ATTENTION while processing state %d\n",
337 		dev_warn(&alt->dev, "%s: status update failed\n", __func__);
340 		dev_err(&alt->dev, "%s: notification failed\n", __func__);
348 static int dp_altmode_vdm(struct typec_altmode *alt,
351 	struct dp_altmode *dp = typec_altmode_get_drvdata(alt);
367 			typec_altmode_update_active(alt, true);
371 			typec_altmode_update_active(alt, false);
378 				sysfs_notify(&dp->alt->dev.kobj, "displayport", "hpd");
416 static int dp_cable_altmode_vdm(struct typec_altmode *alt, enum typec_plug_index sop,
419 	struct dp_altmode *dp = typec_altmode_get_drvdata(alt);
475 static int dp_altmode_activate(struct typec_altmode *alt, int activate)
477 	struct dp_altmode *dp = typec_altmode_get_drvdata(alt);
482 			ret = typec_cable_altmode_enter(alt, TYPEC_PLUG_SOP_P, NULL);
490 		return typec_altmode_enter(alt, NULL);
492 		return typec_altmode_exit(alt);
533 	cap = DP_CAP_CAPABILITY(dp->alt->vdo);
544 	if (dp->alt->active) {
569 	cap = DP_CAP_CAPABILITY(dp->alt->vdo);
605 		return DP_CAP_PIN_ASSIGN_DFP_D(dp->alt->vdo);
607 		return DP_CAP_PIN_ASSIGN_UFP_D(dp->alt->vdo);
646 	if (dp->alt->active && DP_CONF_CURRENTLY(dp->data.conf)) {
723 int dp_altmode_probe(struct typec_altmode *alt)
725 	const struct typec_altmode *port = typec_altmode_get_partner(alt);
726 	struct typec_altmode *plug = typec_altmode_get_plug(alt, TYPEC_PLUG_SOP_P);
734 	      DP_CAP_PIN_ASSIGN_UFP_D(alt->vdo)) &&
736 	      DP_CAP_PIN_ASSIGN_DFP_D(alt->vdo)))
739 	dp = devm_kzalloc(&alt->dev, sizeof(*dp), GFP_KERNEL);
746 	dp->alt = alt;
748 	alt->desc = "DisplayPort";
749 	alt->ops = &dp_altmode_ops;
758 	fwnode = dev_fwnode(alt->dev.parent->parent); /* typec_port fwnode */
766 	typec_altmode_set_drvdata(alt, dp);
777 void dp_altmode_remove(struct typec_altmode *alt)
779 	struct dp_altmode *dp = typec_altmode_get_drvdata(alt);