[PATCH] if_atsam: Add checksum offload.

[Christian Mauderer]

---
 rtemsbsd/sys/dev/atsam/if_atsam.c | 34 +++++++++++++++++++++++++++++++++-
 1 file changed, 33 insertions(+), 1 deletion(-)

diff --git a/rtemsbsd/sys/dev/atsam/if_atsam.c b/rtemsbsd/sys/dev/atsam/if_atsam.c
index 794937be..d47a17e7 100644
--- a/rtemsbsd/sys/dev/atsam/if_atsam.c
+++ b/rtemsbsd/sys/dev/atsam/if_atsam.c
@@ -554,6 +554,23 @@ static void if_atsam_rx_daemon(void *arg)
 					m->m_data = mtod(m, char*)+ETHER_ALIGN;
 					m->m_len = frame_len;
 					m->m_pkthdr.len = frame_len;
+					/* check checksum offload result */
+					switch (buffer_desc->status.bm.typeIDMatchOrCksumResult) {
+					case GMAC_RXDESC_ST_CKSUM_RESULT_IP_CHECKED:
+						m->m_pkthdr.csum_flags |=
+						    CSUM_IP_CHECKED |
+						    CSUM_IP_VALID;
+						m->m_pkthdr.csum_data = 0xffff;
+					case GMAC_RXDESC_ST_CKSUM_RESULT_IP_AND_TCP_CHECKED:
+					case GMAC_RXDESC_ST_CKSUM_RESULT_IP_AND_UDP_CHECKED:
+						m->m_pkthdr.csum_flags |=
+						    CSUM_IP_CHECKED |
+						    CSUM_IP_VALID |
+						    CSUM_DATA_VALID |
+						    CSUM_PSEUDO_HDR;
+						m->m_pkthdr.csum_data = 0xffff;
+					}
+
 					IF_ATSAM_UNLOCK(sc);
 					sc->ifp->if_input(ifp, m);
 					IF_ATSAM_LOCK(sc);
@@ -658,6 +675,7 @@ static bool if_atsam_send_packet(if_atsam_softc *sc, struct mbuf *m)
 	uint32_t tmp_val = 0;
 	Gmac *pHw = sc->Gmac_inst.gGmacd.pHw;
 	bool success;
+	int csum_flags = m->m_pkthdr.csum_flags;
 
 	if_atsam_tx_bd_cleanup(sc);
 	/* Wait for interrupt in case no buffer descriptors are available */
@@ -706,6 +724,12 @@ static bool if_atsam_send_packet(if_atsam_softc *sc, struct mbuf *m)
 		if (m == NULL) {
 			tmp_val |= GMAC_TX_SET_EOF;
 			tmp_val &= ~GMAC_TX_SET_USED;
+			if ((csum_flags & (CSUM_IP | CSUM_TCP | CSUM_UDP |
+			    CSUM_TCP_IPV6 | CSUM_UDP_IPV6)) != 0) {
+				start_packet_tx_bd->status.bm.bNoCRC = 0;
+			} else {
+				start_packet_tx_bd->status.bm.bNoCRC = 1;
+			}
 			_ARM_Data_synchronization_barrier();
 			cur->status.val = tmp_val;
 			start_packet_tx_bd->status.val &= ~GMAC_TX_SET_USED;
@@ -979,9 +1003,13 @@ static void if_atsam_init(void *arg)
 
 	/* Configuration of DMAC */
 	dmac_cfg = (GMAC_DCFGR_DRBS(GMAC_RX_BUFFER_SIZE >> 6)) |
-	    GMAC_DCFGR_RXBMS(3) | GMAC_DCFGR_TXPBMS | GMAC_DCFGR_FBLDO_INCR16;
+	    GMAC_DCFGR_RXBMS(3) | GMAC_DCFGR_TXPBMS | GMAC_DCFGR_FBLDO_INCR16 |
+	    GMAC_DCFGR_TXCOEN;
 	GMAC_SetDMAConfig(sc->Gmac_inst.gGmacd.pHw, dmac_cfg, 0);
 
+	/* Enable hardware checksum offload for receive */
+	sc->Gmac_inst.gGmacd.pHw->GMAC_NCFGR |= GMAC_NCFGR_RXCOEN;
+
 	/* Shut down Transmit and Receive */
 	GMAC_ReceiveEnable(sc->Gmac_inst.gGmacd.pHw, 0);
 	GMAC_TransmitEnable(sc->Gmac_inst.gGmacd.pHw, 0);
@@ -1461,6 +1489,10 @@ static int if_atsam_driver_attach(device_t dev)
 	ifp->if_ioctl = if_atsam_ioctl;
 	ifp->if_start = if_atsam_enet_start;
 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX;
+	ifp->if_capabilities |= IFCAP_HWCSUM | IFCAP_HWCSUM_IPV6 |
+	    IFCAP_VLAN_HWCSUM;
+	ifp->if_hwassist = CSUM_IP | CSUM_IP_UDP | CSUM_IP_TCP |
+	    CSUM_IP6_UDP | CSUM_IP6_TCP;
 	IFQ_SET_MAXLEN(&ifp->if_snd, TXBUF_COUNT - 1);
 	ifp->if_snd.ifq_drv_maxlen = TXBUF_COUNT - 1;
 	IFQ_SET_READY(&ifp->if_snd);
-- 
2.13.6