Commit d1fc4e39 authored by Imre Deak's avatar Imre Deak

drm/i915/tc: Add generic TC PHY connect/disconnect handlers

Add generic handlers to connect/disconnect a PHY.

Setting the TC mode to the target mode deducted from the HPD state and -
if connecting to this mode fails - falling back to connecting to the
default (TBT) mode are common to all platforms; move the logic for this
from the ICL specific connect / disconnect handlers to the generic ones.
Reviewed-by: default avatarMika Kahola <mika.kahola@intel.com>
Signed-off-by: default avatarImre Deak <imre.deak@intel.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20230323142035.1432621-12-imre.deak@intel.com
parent ab639f32
...@@ -434,41 +434,35 @@ static void icl_tc_phy_get_hw_state(struct intel_tc_port *tc) ...@@ -434,41 +434,35 @@ static void icl_tc_phy_get_hw_state(struct intel_tc_port *tc)
* connect and disconnect to cleanly transfer ownership with the controller and * connect and disconnect to cleanly transfer ownership with the controller and
* set the type-C power state. * set the type-C power state.
*/ */
static void icl_tc_phy_connect(struct intel_tc_port *tc, static bool icl_tc_phy_connect(struct intel_tc_port *tc,
int required_lanes) int required_lanes)
{ {
struct drm_i915_private *i915 = tc_to_i915(tc); struct drm_i915_private *i915 = tc_to_i915(tc);
struct intel_digital_port *dig_port = tc->dig_port; struct intel_digital_port *dig_port = tc->dig_port;
u32 live_status_mask;
int max_lanes; int max_lanes;
if (tc->mode == TC_PORT_TBT_ALT)
return true;
if (!tc_phy_is_ready(tc) && if (!tc_phy_is_ready(tc) &&
!drm_WARN_ON(&i915->drm, tc->legacy_port)) { !drm_WARN_ON(&i915->drm, tc->legacy_port)) {
drm_dbg_kms(&i915->drm, "Port %s: PHY not ready\n", drm_dbg_kms(&i915->drm, "Port %s: PHY not ready\n",
tc->port_name); tc->port_name);
goto out_set_tbt_alt_mode; return false;
}
live_status_mask = tc_phy_hpd_live_status(tc);
if (!(live_status_mask & (BIT(TC_PORT_DP_ALT) | BIT(TC_PORT_LEGACY))) &&
!tc->legacy_port) {
drm_dbg_kms(&i915->drm, "Port %s: PHY ownership not required (live status %02x)\n",
tc->port_name, live_status_mask);
goto out_set_tbt_alt_mode;
} }
if (!tc_phy_take_ownership(tc, true) && if (!tc_phy_take_ownership(tc, true) &&
!drm_WARN_ON(&i915->drm, tc->legacy_port)) !drm_WARN_ON(&i915->drm, tc->legacy_port))
goto out_set_tbt_alt_mode; return false;
max_lanes = intel_tc_port_fia_max_lane_count(dig_port); max_lanes = intel_tc_port_fia_max_lane_count(dig_port);
if (tc->legacy_port) { if (tc->legacy_port) {
drm_WARN_ON(&i915->drm, max_lanes != 4); drm_WARN_ON(&i915->drm, max_lanes != 4);
tc->mode = TC_PORT_LEGACY; return true;
return;
} }
drm_WARN_ON(&i915->drm, tc->mode != TC_PORT_DP_ALT);
/* /*
* Now we have to re-check the live state, in case the port recently * Now we have to re-check the live state, in case the port recently
* became disconnected. Not necessary for legacy mode. * became disconnected. Not necessary for legacy mode.
...@@ -487,14 +481,12 @@ static void icl_tc_phy_connect(struct intel_tc_port *tc, ...@@ -487,14 +481,12 @@ static void icl_tc_phy_connect(struct intel_tc_port *tc,
goto out_release_phy; goto out_release_phy;
} }
tc->mode = TC_PORT_DP_ALT; return true;
return;
out_release_phy: out_release_phy:
tc_phy_take_ownership(tc, false); tc_phy_take_ownership(tc, false);
out_set_tbt_alt_mode:
tc->mode = TC_PORT_TBT_ALT; return false;
} }
/* /*
...@@ -509,9 +501,6 @@ static void icl_tc_phy_disconnect(struct intel_tc_port *tc) ...@@ -509,9 +501,6 @@ static void icl_tc_phy_disconnect(struct intel_tc_port *tc)
tc_phy_take_ownership(tc, false); tc_phy_take_ownership(tc, false);
fallthrough; fallthrough;
case TC_PORT_TBT_ALT: case TC_PORT_TBT_ALT:
tc->mode = TC_PORT_DISCONNECTED;
fallthrough;
case TC_PORT_DISCONNECTED:
break; break;
default: default:
MISSING_CASE(tc->mode); MISSING_CASE(tc->mode);
...@@ -817,6 +806,30 @@ tc_phy_get_target_mode(struct intel_tc_port *tc) ...@@ -817,6 +806,30 @@ tc_phy_get_target_mode(struct intel_tc_port *tc)
return hpd_mask_to_target_mode(tc, live_status_mask); return hpd_mask_to_target_mode(tc, live_status_mask);
} }
static void tc_phy_connect(struct intel_tc_port *tc, int required_lanes)
{
struct drm_i915_private *i915 = tc_to_i915(tc);
bool connected;
tc->mode = tc_phy_get_target_mode(tc);
connected = icl_tc_phy_connect(tc, required_lanes);
if (!connected && tc->mode != default_tc_mode(tc)) {
tc->mode = default_tc_mode(tc);
connected = icl_tc_phy_connect(tc, required_lanes);
}
drm_WARN_ON(&i915->drm, !connected);
}
static void tc_phy_disconnect(struct intel_tc_port *tc)
{
if (tc->mode != TC_PORT_DISCONNECTED) {
icl_tc_phy_disconnect(tc);
tc->mode = TC_PORT_DISCONNECTED;
}
}
static void intel_tc_port_reset_mode(struct intel_tc_port *tc, static void intel_tc_port_reset_mode(struct intel_tc_port *tc,
int required_lanes, bool force_disconnect) int required_lanes, bool force_disconnect)
{ {
...@@ -834,9 +847,9 @@ static void intel_tc_port_reset_mode(struct intel_tc_port *tc, ...@@ -834,9 +847,9 @@ static void intel_tc_port_reset_mode(struct intel_tc_port *tc,
drm_WARN_ON(&i915->drm, aux_powered); drm_WARN_ON(&i915->drm, aux_powered);
} }
icl_tc_phy_disconnect(tc); tc_phy_disconnect(tc);
if (!force_disconnect) if (!force_disconnect)
icl_tc_phy_connect(tc, required_lanes); tc_phy_connect(tc, required_lanes);
drm_dbg_kms(&i915->drm, "Port %s: TC port mode reset (%s -> %s)\n", drm_dbg_kms(&i915->drm, "Port %s: TC port mode reset (%s -> %s)\n",
tc->port_name, tc->port_name,
...@@ -1015,7 +1028,7 @@ void intel_tc_port_sanitize_mode(struct intel_digital_port *dig_port, ...@@ -1015,7 +1028,7 @@ void intel_tc_port_sanitize_mode(struct intel_digital_port *dig_port,
"Port %s: PHY left in %s mode on disabled port, disconnecting it\n", "Port %s: PHY left in %s mode on disabled port, disconnecting it\n",
tc->port_name, tc->port_name,
tc_port_mode_name(tc->init_mode)); tc_port_mode_name(tc->init_mode));
icl_tc_phy_disconnect(tc); tc_phy_disconnect(tc);
__intel_tc_port_put_link(tc); __intel_tc_port_put_link(tc);
tc_cold_unblock(tc, tc->lock_power_domain, tc_cold_unblock(tc, tc->lock_power_domain,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment