samples: esb: Fix not reading all payloads

Make esb_prx and esb_monitor samples read all received payloads
in esb event handler

Signed-off-by: Szymon Antkowiak <[email protected]>

Author: Szynkaa

samples/esb/esb_monitor/src/main.c

@@ -91,16 +91,20 @@ void event_handler(struct esb_evt const *event)
 	switch (event->evt_id) {
 	case ESB_EVENT_RX_RECEIVED:
 #if defined(CONFIG_ESB_SNIFFER)
-		if (esb_read_rx_payload(&packet.payload) == 0) {
+		struct esb_payload *payload = &packet.payload;
 #else
-		if (esb_read_rx_payload(&rx_payload) == 0) {
+		struct esb_payload *payload = &rx_payload;
 #endif /* !defined(CONFIG_ESB_SNIFFER) */
+		int err;
+
+		while ((err = esb_read_rx_payload(payload)) == 0) {
 			log_packet();
 
 #if defined(CONFIG_LED_ENABLE) && !defined(CONFIG_ESB_SNIFFER)
 			leds_update(rx_payload.data[1]);
 #endif /* defined(CONFIG_LED_ENABLE) && !defined(CONFIG_ESB_SNIFFER) */
-		} else {
+		}
+		if (err && err != -ENODATA) {
 			LOG_ERR("Error while reading rx packet");
 		}
 		break;

samples/esb/esb_prx/src/main.c

@@ -54,7 +54,9 @@ void event_handler(struct esb_evt const *event)
 		LOG_DBG("TX FAILED EVENT");
 		break;
 	case ESB_EVENT_RX_RECEIVED:
-		if (esb_read_rx_payload(&rx_payload) == 0) {
+		int err;
+
+		while ((err = esb_read_rx_payload(&rx_payload)) == 0) {
 			LOG_DBG("Packet received, len %d : "
 				"0x%02x, 0x%02x, 0x%02x, 0x%02x, "
 				"0x%02x, 0x%02x, 0x%02x, 0x%02x",
@@ -65,7 +67,8 @@ void event_handler(struct esb_evt const *event)
 				rx_payload.data[7]);
 
 			leds_update(rx_payload.data[1]);
-		} else {
+		}
+		if (err && err != -ENODATA) {
 			LOG_ERR("Error while reading rx packet");
 		}
 		break;