sw:fw:fd: check if WR is present

Signed-off-by: Federico Vaga <federico.vaga@cern.ch>

sw:fw:fd: check if WR is present
Signed-off-by: Federico Vaga <federico.vaga@cern.ch>
b7da873f · Federico Vaga · c3ea4ce6 · b7da873f
Commit b7da873f authored Jul 31, 2018 by Federico Vaga
Hide whitespace changes
Inline Side-by-side

Showing with 10 additions and 0 deletions

wrtd-rt-fd.c software/firmware/fd/wrtd-rt-fd.c +10 -0

No files found.
--- a/software/firmware/fd/wrtd-rt-fd.c
+++ b/software/firmware/fd/wrtd-rt-fd.c
@@ -43,6 +43,11 @@ enum wrtd_in_wr_link {

 static int wr_state;

+int wr_present(void)
+{
+	return !!(dp_readl(FD_REG_TCR) & FD_TCR_WR_PRESENT);
+}
+
 int wr_link_up()
 {
 	return dp_readl ( FD_REG_TCR ) & FD_TCR_WR_LINK;
@@ -898,6 +903,11 @@ static int wrtd_o_init(void)
 	};
 	int i, j;

+	if (!wr_present()) {
+		pr_error("WhiteRabbit not found\n\r");
+		return -EINVAL;
+	}
+
 	promiscuous_mode = 0;
 	tlist_count = 0;
 	wr_state = WR_LINK_OFFLINE;