iio: adc: ad9081: adi_ad9081_jesd: JRX PHY PRBS toggle LINK_EN

Make sure we enable the link after the PRBS after it is configured and
the error counters are cleared. The adi_ad9081_jesd_rx_phy_prbs_test()
function assumes the Links to be enabled, log error and return in
case no link is enabled.

Signed-off-by: Michael Hennerich <[email protected]>

Author: mhennerich

drivers/iio/adc/ad9081.c

@@ -3078,6 +3078,9 @@ static int ad9081_status_show(struct seq_file *file, void *offset)
 	return 0;
 }
 
+
+
+
 static void ad9081_work_func(struct work_struct *work)
 {
 	u8 status;
@@ -3612,10 +3615,14 @@ static ssize_t ad9081_debugfs_write(struct file *file,
 			val2 = 1; /* 1 second */
 
 		if (val == 0)
-			adi_ad9081_jesd_rx_phy_prbs_test_disable_set(&phy->ad9081);
+			ret = adi_ad9081_jesd_rx_phy_prbs_test_disable_set(&phy->ad9081);
 		else
-			adi_ad9081_jesd_rx_phy_prbs_test(&phy->ad9081,
+			ret = adi_ad9081_jesd_rx_phy_prbs_test(&phy->ad9081,
 				ad9081_val_to_prbs(val), val2);
+
+		if (ret)
+			return ret;
+
 		entry->val = val;
 
 		return count;

drivers/iio/adc/ad9081/adi_ad9081_jesd.c

@@ -3653,6 +3653,7 @@ adi_ad9081_jesd_rx_phy_prbs_test(adi_ad9081_device_t *device,
 	int32_t err;
 	uint32_t i;
 	uint8_t tmp_reg;
+	uint8_t link_en;
 	AD9081_NULL_POINTER_RETURN(device);
 	AD9081_LOG_FUNC();
 
@@ -3674,6 +3675,25 @@ adi_ad9081_jesd_rx_phy_prbs_test(adi_ad9081_device_t *device,
 		return API_CMS_ERROR_INVALID_PARAM;
 	}
 
+	err = adi_ad9081_hal_bf_get(
+		device, REG_GENERAL_JRX_CTRL_ADDR, BF_LINK_EN_INFO,
+		&link_en, 1);
+	AD9081_ERROR_RETURN(err);
+
+	if (!link_en) {
+		err = adi_ad9081_hal_log_write(
+			device, ADI_CMS_LOG_ERR,
+			"jesd_rx_phy_prbs_test(): link not enabled\n");
+		AD9081_ERROR_RETURN(err);
+
+		return API_CMS_ERROR_ERROR;
+	}
+
+	err = adi_ad9081_hal_bf_set(
+		device, REG_GENERAL_JRX_CTRL_ADDR, BF_LINK_EN_INFO,
+		0); /* LINK_EN use 2bits for link0 & link1 */
+	AD9081_ERROR_RETURN(err);
+
 	/* select phy prbs test source and mode */
 	err = adi_ad9081_hal_bf_set(
 		device, REG_JRX_TEST_2_ADDR, BF_JRX_PRBS_SOURCE_INFO,
@@ -3684,11 +3704,23 @@ adi_ad9081_jesd_rx_phy_prbs_test(adi_ad9081_device_t *device,
 				    tmp_reg); /* not paged */
 	AD9081_ERROR_RETURN(err);
 
+	err = adi_ad9081_hal_bf_set(
+		device, REG_GENERAL_JRX_CTRL_ADDR, BF_LINK_EN_INFO,
+		link_en); /* LINK_EN use 2bits for link0 & link1 */
+	AD9081_ERROR_RETURN(err);
+
+	err = adi_ad9081_hal_delay_us(device, 1);
+	AD9081_ERROR_RETURN(err);
+
 	/* clear prbs error count */
 	err = adi_ad9081_hal_bf_set(device, REG_JRX_TEST_0_ADDR,
 				    BF_JRX_PRBS_LANE_CLEAR_ERRORS_INFO,
 				    1); /* not paged */
 	AD9081_ERROR_RETURN(err);
+
+	err = adi_ad9081_hal_delay_us(device, 500000); /* 500 ms */
+	AD9081_ERROR_RETURN(err);
+
 	err = adi_ad9081_hal_bf_set(device, REG_JRX_TEST_0_ADDR,
 				    BF_JRX_PRBS_LANE_CLEAR_ERRORS_INFO,
 				    0); /* not paged */