1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (c) 2012-2020, The Linux Foundation. All rights reserved.
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun
6*4882a593Smuzhiyun #define pr_fmt(fmt) "[drm-dp] %s: " fmt, __func__
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/slab.h>
9*4882a593Smuzhiyun #include <linux/device.h>
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun #include "dp_hpd.h"
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun /* DP specific VDM commands */
14*4882a593Smuzhiyun #define DP_USBPD_VDM_STATUS 0x10
15*4882a593Smuzhiyun #define DP_USBPD_VDM_CONFIGURE 0x11
16*4882a593Smuzhiyun
17*4882a593Smuzhiyun /* USBPD-TypeC specific Macros */
18*4882a593Smuzhiyun #define VDM_VERSION 0x0
19*4882a593Smuzhiyun #define USB_C_DP_SID 0xFF01
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun struct dp_hpd_private {
22*4882a593Smuzhiyun struct device *dev;
23*4882a593Smuzhiyun struct dp_usbpd_cb *dp_cb;
24*4882a593Smuzhiyun struct dp_usbpd dp_usbpd;
25*4882a593Smuzhiyun };
26*4882a593Smuzhiyun
dp_hpd_connect(struct dp_usbpd * dp_usbpd,bool hpd)27*4882a593Smuzhiyun int dp_hpd_connect(struct dp_usbpd *dp_usbpd, bool hpd)
28*4882a593Smuzhiyun {
29*4882a593Smuzhiyun int rc = 0;
30*4882a593Smuzhiyun struct dp_hpd_private *hpd_priv;
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun hpd_priv = container_of(dp_usbpd, struct dp_hpd_private,
33*4882a593Smuzhiyun dp_usbpd);
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun dp_usbpd->hpd_high = hpd;
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun if (!hpd_priv->dp_cb || !hpd_priv->dp_cb->configure
38*4882a593Smuzhiyun || !hpd_priv->dp_cb->disconnect) {
39*4882a593Smuzhiyun pr_err("hpd dp_cb not initialized\n");
40*4882a593Smuzhiyun return -EINVAL;
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun if (hpd)
43*4882a593Smuzhiyun hpd_priv->dp_cb->configure(hpd_priv->dev);
44*4882a593Smuzhiyun else
45*4882a593Smuzhiyun hpd_priv->dp_cb->disconnect(hpd_priv->dev);
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun return rc;
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun
dp_hpd_get(struct device * dev,struct dp_usbpd_cb * cb)50*4882a593Smuzhiyun struct dp_usbpd *dp_hpd_get(struct device *dev, struct dp_usbpd_cb *cb)
51*4882a593Smuzhiyun {
52*4882a593Smuzhiyun struct dp_hpd_private *dp_hpd;
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun if (!cb) {
55*4882a593Smuzhiyun pr_err("invalid cb data\n");
56*4882a593Smuzhiyun return ERR_PTR(-EINVAL);
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun dp_hpd = devm_kzalloc(dev, sizeof(*dp_hpd), GFP_KERNEL);
60*4882a593Smuzhiyun if (!dp_hpd)
61*4882a593Smuzhiyun return ERR_PTR(-ENOMEM);
62*4882a593Smuzhiyun
63*4882a593Smuzhiyun dp_hpd->dev = dev;
64*4882a593Smuzhiyun dp_hpd->dp_cb = cb;
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun dp_hpd->dp_usbpd.connect = dp_hpd_connect;
67*4882a593Smuzhiyun
68*4882a593Smuzhiyun return &dp_hpd->dp_usbpd;
69*4882a593Smuzhiyun }
70