return 0;
}
-static unsigned char analogix_dp_get_lane_status(u8 link_status[2], int lane)
-{
- int shift = (lane & 1) * 4;
- u8 link_value = link_status[lane >> 1];
-
- return (link_value >> shift) & 0xf;
-}
-
-static int analogix_dp_channel_eq_ok(u8 link_status[2], u8 link_align,
- int lane_count)
-{
- int lane;
- u8 lane_status;
-
- if ((link_align & DP_INTERLANE_ALIGN_DONE) == 0)
- return -EINVAL;
-
- for (lane = 0; lane < lane_count; lane++) {
- lane_status = analogix_dp_get_lane_status(link_status, lane);
- lane_status &= DP_CHANNEL_EQ_BITS;
- if (lane_status != DP_CHANNEL_EQ_BITS)
- return -EINVAL;
- }
-
- return 0;
-}
-
static unsigned char
analogix_dp_get_adjust_request_voltage(u8 adjust_request[2], int lane)
{
{
int lane_count, retval;
u32 reg;
- u8 link_align, link_status[DP_LINK_STATUS_SIZE], adjust_request[2];
+ u8 link_status[DP_LINK_STATUS_SIZE], adjust_request[2];
usleep_range(400, 401);
if (retval < 0)
return retval;
- retval = drm_dp_dpcd_readb(&dp->aux, DP_LANE_ALIGN_STATUS_UPDATED,
- &link_align);
- if (retval < 0)
- return retval;
-
analogix_dp_get_adjust_training_lane(dp, adjust_request);
- if (!analogix_dp_channel_eq_ok(link_status, link_align, lane_count)) {
+ if (drm_dp_channel_eq_ok(link_status, lane_count)) {
/* traing pattern Set to Normal */
retval = analogix_dp_training_pattern_dis(dp);
if (retval < 0)
static int analogix_dp_fast_link_train(struct analogix_dp_device *dp)
{
int ret;
- u8 link_align, link_status[DP_LINK_STATUS_SIZE];
+ u8 link_status[DP_LINK_STATUS_SIZE];
analogix_dp_set_link_bandwidth(dp, dp->link_train.link_rate);
ret = analogix_dp_wait_pll_locked(dp);
* speed
*/
if (verify_fast_training) {
- ret = drm_dp_dpcd_readb(&dp->aux, DP_LANE_ALIGN_STATUS_UPDATED,
- &link_align);
- if (ret < 0) {
- DRM_DEV_ERROR(dp->dev, "Read align status failed %d\n",
- ret);
- return ret;
- }
-
ret = drm_dp_dpcd_read_link_status(&dp->aux, link_status);
if (ret < 0) {
DRM_DEV_ERROR(dp->dev, "Read link status failed %d\n",
return -EIO;
}
- if (analogix_dp_channel_eq_ok(link_status, link_align,
- dp->link_train.lane_count)) {
+ if (!drm_dp_channel_eq_ok(link_status, dp->link_train.lane_count)) {
DRM_DEV_ERROR(dp->dev, "Channel EQ failed\n");
analogix_dp_reduce_link_rate(dp);
return -EIO;