23b65c3a24
git-subtree-dir: techpack/display git-subtree-mainline:2d46776923git-subtree-split:64f31403b4Change-Id: I7f4c42a3ba6b11a8db861cdd171a52d8f58f2e06
112 lines
2.3 KiB
C
112 lines
2.3 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright (c) 2012-2020, The Linux Foundation. All rights reserved.
|
|
*/
|
|
|
|
#include <linux/slab.h>
|
|
#include <linux/device.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/err.h>
|
|
|
|
#include "dp_hpd.h"
|
|
#include "dp_altmode.h"
|
|
#include "dp_usbpd.h"
|
|
#include "dp_gpio_hpd.h"
|
|
#include "dp_lphw_hpd.h"
|
|
#include "dp_debug.h"
|
|
|
|
static void dp_hpd_host_init(struct dp_hpd *dp_hpd,
|
|
struct dp_catalog_hpd *catalog)
|
|
{
|
|
if (!catalog) {
|
|
DP_ERR("invalid input\n");
|
|
return;
|
|
}
|
|
catalog->config_hpd(catalog, true);
|
|
}
|
|
|
|
static void dp_hpd_host_deinit(struct dp_hpd *dp_hpd,
|
|
struct dp_catalog_hpd *catalog)
|
|
{
|
|
if (!catalog) {
|
|
DP_ERR("invalid input\n");
|
|
return;
|
|
}
|
|
catalog->config_hpd(catalog, false);
|
|
}
|
|
|
|
static void dp_hpd_isr(struct dp_hpd *dp_hpd)
|
|
{
|
|
}
|
|
|
|
struct dp_hpd *dp_hpd_get(struct device *dev, struct dp_parser *parser,
|
|
struct dp_catalog_hpd *catalog, struct dp_hpd_cb *cb)
|
|
{
|
|
struct dp_hpd *dp_hpd;
|
|
|
|
if (parser->no_aux_switch && parser->lphw_hpd) {
|
|
dp_hpd = dp_lphw_hpd_get(dev, parser, catalog, cb);
|
|
if (IS_ERR_OR_NULL(dp_hpd)) {
|
|
DP_ERR("failed to get lphw hpd\n");
|
|
return dp_hpd;
|
|
}
|
|
dp_hpd->type = DP_HPD_LPHW;
|
|
} else if (parser->no_aux_switch) {
|
|
dp_hpd = dp_gpio_hpd_get(dev, cb);
|
|
if (IS_ERR_OR_NULL(dp_hpd)) {
|
|
DP_ERR("failed to get gpio hpd\n");
|
|
return dp_hpd;
|
|
}
|
|
dp_hpd->type = DP_HPD_GPIO;
|
|
} else {
|
|
dp_hpd = dp_altmode_get(dev, cb);
|
|
if (!IS_ERR_OR_NULL(dp_hpd)) {
|
|
dp_hpd->type = DP_HPD_ALTMODE;
|
|
goto config;
|
|
}
|
|
DP_WARN("dp_altmode failed (%ld), falling back to dp_usbpd\n",
|
|
PTR_ERR(dp_hpd));
|
|
|
|
dp_hpd = dp_usbpd_get(dev, cb);
|
|
if (IS_ERR_OR_NULL(dp_hpd)) {
|
|
DP_ERR("failed to get usbpd\n");
|
|
return dp_hpd;
|
|
}
|
|
dp_hpd->type = DP_HPD_USBPD;
|
|
}
|
|
|
|
config:
|
|
if (!dp_hpd->host_init)
|
|
dp_hpd->host_init = dp_hpd_host_init;
|
|
if (!dp_hpd->host_deinit)
|
|
dp_hpd->host_deinit = dp_hpd_host_deinit;
|
|
if (!dp_hpd->isr)
|
|
dp_hpd->isr = dp_hpd_isr;
|
|
|
|
return dp_hpd;
|
|
}
|
|
|
|
void dp_hpd_put(struct dp_hpd *dp_hpd)
|
|
{
|
|
if (!dp_hpd)
|
|
return;
|
|
|
|
switch (dp_hpd->type) {
|
|
case DP_HPD_USBPD:
|
|
dp_usbpd_put(dp_hpd);
|
|
break;
|
|
case DP_HPD_ALTMODE:
|
|
dp_altmode_put(dp_hpd);
|
|
break;
|
|
case DP_HPD_GPIO:
|
|
dp_gpio_hpd_put(dp_hpd);
|
|
break;
|
|
case DP_HPD_LPHW:
|
|
dp_lphw_hpd_put(dp_hpd);
|
|
break;
|
|
default:
|
|
DP_ERR("unknown hpd type %d\n", dp_hpd->type);
|
|
break;
|
|
}
|
|
}
|