Implement RFM95 sanity check (#963)

tekka007 · tbowmo · commit e6cef8ba631b · 2017-10-29T15:08:39.000+01:00
diff --git a/drivers/RFM95/RFM95.cpp b/drivers/RFM95/RFM95.cpp
@@ -584,8 +584,12 @@ LOCAL void RFM95_ATCmode(const bool OnOff, const int16_t targetRSSI)
 
 LOCAL bool RFM95_sanityCheck(void)
 {
-	// not implemented yet
-	return true;
+	bool result = true;
+	result &= RFM95_readReg(RFM95_REG_0F_FIFO_RX_BASE_ADDR) == RFM95_RX_FIFO_ADDR;
+	result &= RFM95_readReg(RFM95_REG_0E_FIFO_TX_BASE_ADDR) == RFM95_TX_FIFO_ADDR;
+	result &= RFM95_readReg(RFM95_REG_23_MAX_PAYLOAD_LENGTH) == RFM95_MAX_PACKET_LEN;
+
+	return result;
 }
 
 

Original file line number	Diff line number	Diff line change
`@@ -584,8 +584,12 @@ LOCAL void RFM95_ATCmode(const bool OnOff, const int16_t targetRSSI)`
`584`	`584`
`585`	`585`	`LOCAL bool RFM95_sanityCheck(void)`
`586`	`586`	`{`
`587`		`- // not implemented yet`
`588`		`- return true;`
	`587`	`+ bool result = true;`
	`588`	`+ result &= RFM95_readReg(RFM95_REG_0F_FIFO_RX_BASE_ADDR) == RFM95_RX_FIFO_ADDR;`
	`589`	`+ result &= RFM95_readReg(RFM95_REG_0E_FIFO_TX_BASE_ADDR) == RFM95_TX_FIFO_ADDR;`
	`590`	`+ result &= RFM95_readReg(RFM95_REG_23_MAX_PAYLOAD_LENGTH) == RFM95_MAX_PACKET_LEN;`
	`591`	`+`
	`592`	`+ return result;`
`589`	`593`	`}`
`590`	`594`
`591`	`595`