|
 |
57e1455 |
From 2d7d80e8dc160904fa7276cc05da26c062a50066 Mon Sep 17 00:00:00 2001
|
|
|
57e1455 |
From: Stefan Hajnoczi <stefanha@redhat.com>
|
|
|
57e1455 |
Date: Wed, 15 Jul 2015 18:16:59 +0100
|
|
|
57e1455 |
Subject: [PATCH 2/7] rtl8139: drop tautologous if (ip) {...} statement
|
|
|
57e1455 |
|
|
|
57e1455 |
The previous patch stopped using the ip pointer as an indicator that the
|
|
|
57e1455 |
IP header is present. When we reach the if (ip) {...} statement we know
|
|
|
57e1455 |
ip is always non-NULL.
|
|
|
57e1455 |
|
|
|
57e1455 |
Remove the if statement to reduce nesting.
|
|
|
57e1455 |
|
|
|
57e1455 |
Signed-off-by: Stefan Hajnoczi <stefanha@redhat.com>
|
|
|
57e1455 |
---
|
|
|
57e1455 |
hw/net/rtl8139.c | 305 +++++++++++++++++++++++++++----------------------------
|
|
|
57e1455 |
1 file changed, 151 insertions(+), 154 deletions(-)
|
|
|
57e1455 |
|
|
|
57e1455 |
diff --git a/tools/qemu-xen/hw/net/rtl8139.c b/tools/qemu-xen/hw/net/rtl8139.c
|
|
|
57e1455 |
index 91ba33b..2f12d42 100644
|
|
|
57e1455 |
--- a/tools/qemu-xen/hw/net/rtl8139.c
|
|
|
57e1455 |
+++ b/tools/qemu-xen/hw/net/rtl8139.c
|
|
|
57e1455 |
@@ -2198,198 +2198,195 @@ static int rtl8139_cplus_transmit_one(RTL8139State *s)
|
|
|
57e1455 |
ip_protocol = ip->ip_p;
|
|
|
57e1455 |
ip_data_len = be16_to_cpu(ip->ip_len) - hlen;
|
|
|
57e1455 |
|
|
|
57e1455 |
- if (ip)
|
|
|
57e1455 |
+ if (txdw0 & CP_TX_IPCS)
|
|
|
57e1455 |
{
|
|
|
57e1455 |
- if (txdw0 & CP_TX_IPCS)
|
|
|
57e1455 |
- {
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode need IP checksum\n");
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode need IP checksum\n");
|
|
|
57e1455 |
|
|
|
57e1455 |
- if (hlen<sizeof(ip_header) || hlen>eth_payload_len) {/* min header length */
|
|
|
57e1455 |
- /* bad packet header len */
|
|
|
57e1455 |
- /* or packet too short */
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
- else
|
|
|
57e1455 |
- {
|
|
|
57e1455 |
- ip->ip_sum = 0;
|
|
|
57e1455 |
- ip->ip_sum = ip_checksum(ip, hlen);
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode IP header len=%d checksum=%04x\n",
|
|
|
57e1455 |
- hlen, ip->ip_sum);
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
+ if (hlen<sizeof(ip_header) || hlen>eth_payload_len) {/* min header length */
|
|
|
57e1455 |
+ /* bad packet header len */
|
|
|
57e1455 |
+ /* or packet too short */
|
|
|
57e1455 |
}
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- if ((txdw0 & CP_TX_LGSEN) && ip_protocol == IP_PROTO_TCP)
|
|
|
57e1455 |
+ else
|
|
|
57e1455 |
{
|
|
|
57e1455 |
- int large_send_mss = (txdw0 >> 16) & CP_TC_LGSEN_MSS_MASK;
|
|
|
57e1455 |
+ ip->ip_sum = 0;
|
|
|
57e1455 |
+ ip->ip_sum = ip_checksum(ip, hlen);
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode IP header len=%d checksum=%04x\n",
|
|
|
57e1455 |
+ hlen, ip->ip_sum);
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode offloaded task TSO MTU=%d IP data %d "
|
|
|
57e1455 |
- "frame data %d specified MSS=%d\n", ETH_MTU,
|
|
|
57e1455 |
- ip_data_len, saved_size - ETH_HLEN, large_send_mss);
|
|
|
57e1455 |
+ if ((txdw0 & CP_TX_LGSEN) && ip_protocol == IP_PROTO_TCP)
|
|
|
57e1455 |
+ {
|
|
|
57e1455 |
+ int large_send_mss = (txdw0 >> 16) & CP_TC_LGSEN_MSS_MASK;
|
|
|
57e1455 |
|
|
|
57e1455 |
- int tcp_send_offset = 0;
|
|
|
57e1455 |
- int send_count = 0;
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode offloaded task TSO MTU=%d IP data %d "
|
|
|
57e1455 |
+ "frame data %d specified MSS=%d\n", ETH_MTU,
|
|
|
57e1455 |
+ ip_data_len, saved_size - ETH_HLEN, large_send_mss);
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* maximum IP header length is 60 bytes */
|
|
|
57e1455 |
- uint8_t saved_ip_header[60];
|
|
|
57e1455 |
+ int tcp_send_offset = 0;
|
|
|
57e1455 |
+ int send_count = 0;
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* save IP header template; data area is used in tcp checksum calculation */
|
|
|
57e1455 |
- memcpy(saved_ip_header, eth_payload_data, hlen);
|
|
|
57e1455 |
+ /* maximum IP header length is 60 bytes */
|
|
|
57e1455 |
+ uint8_t saved_ip_header[60];
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* a placeholder for checksum calculation routine in tcp case */
|
|
|
57e1455 |
- uint8_t *data_to_checksum = eth_payload_data + hlen - 12;
|
|
|
57e1455 |
- // size_t data_to_checksum_len = eth_payload_len - hlen + 12;
|
|
|
57e1455 |
+ /* save IP header template; data area is used in tcp checksum calculation */
|
|
|
57e1455 |
+ memcpy(saved_ip_header, eth_payload_data, hlen);
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* pointer to TCP header */
|
|
|
57e1455 |
- tcp_header *p_tcp_hdr = (tcp_header*)(eth_payload_data + hlen);
|
|
|
57e1455 |
+ /* a placeholder for checksum calculation routine in tcp case */
|
|
|
57e1455 |
+ uint8_t *data_to_checksum = eth_payload_data + hlen - 12;
|
|
|
57e1455 |
+ // size_t data_to_checksum_len = eth_payload_len - hlen + 12;
|
|
|
57e1455 |
|
|
|
57e1455 |
- int tcp_hlen = TCP_HEADER_DATA_OFFSET(p_tcp_hdr);
|
|
|
57e1455 |
+ /* pointer to TCP header */
|
|
|
57e1455 |
+ tcp_header *p_tcp_hdr = (tcp_header*)(eth_payload_data + hlen);
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* ETH_MTU = ip header len + tcp header len + payload */
|
|
|
57e1455 |
- int tcp_data_len = ip_data_len - tcp_hlen;
|
|
|
57e1455 |
- int tcp_chunk_size = ETH_MTU - hlen - tcp_hlen;
|
|
|
57e1455 |
+ int tcp_hlen = TCP_HEADER_DATA_OFFSET(p_tcp_hdr);
|
|
|
57e1455 |
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode TSO IP data len %d TCP hlen %d TCP "
|
|
|
57e1455 |
- "data len %d TCP chunk size %d\n", ip_data_len,
|
|
|
57e1455 |
- tcp_hlen, tcp_data_len, tcp_chunk_size);
|
|
|
57e1455 |
+ /* ETH_MTU = ip header len + tcp header len + payload */
|
|
|
57e1455 |
+ int tcp_data_len = ip_data_len - tcp_hlen;
|
|
|
57e1455 |
+ int tcp_chunk_size = ETH_MTU - hlen - tcp_hlen;
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* note the cycle below overwrites IP header data,
|
|
|
57e1455 |
- but restores it from saved_ip_header before sending packet */
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode TSO IP data len %d TCP hlen %d TCP "
|
|
|
57e1455 |
+ "data len %d TCP chunk size %d\n", ip_data_len,
|
|
|
57e1455 |
+ tcp_hlen, tcp_data_len, tcp_chunk_size);
|
|
|
57e1455 |
|
|
|
57e1455 |
- int is_last_frame = 0;
|
|
|
57e1455 |
+ /* note the cycle below overwrites IP header data,
|
|
|
57e1455 |
+ but restores it from saved_ip_header before sending packet */
|
|
|
57e1455 |
|
|
|
57e1455 |
- for (tcp_send_offset = 0; tcp_send_offset < tcp_data_len; tcp_send_offset += tcp_chunk_size)
|
|
|
57e1455 |
- {
|
|
|
57e1455 |
- uint16_t chunk_size = tcp_chunk_size;
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* check if this is the last frame */
|
|
|
57e1455 |
- if (tcp_send_offset + tcp_chunk_size >= tcp_data_len)
|
|
|
57e1455 |
- {
|
|
|
57e1455 |
- is_last_frame = 1;
|
|
|
57e1455 |
- chunk_size = tcp_data_len - tcp_send_offset;
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode TSO TCP seqno %08x\n",
|
|
|
57e1455 |
- be32_to_cpu(p_tcp_hdr->th_seq));
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* add 4 TCP pseudoheader fields */
|
|
|
57e1455 |
- /* copy IP source and destination fields */
|
|
|
57e1455 |
- memcpy(data_to_checksum, saved_ip_header + 12, 8);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode TSO calculating TCP checksum for "
|
|
|
57e1455 |
- "packet with %d bytes data\n", tcp_hlen +
|
|
|
57e1455 |
- chunk_size);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- if (tcp_send_offset)
|
|
|
57e1455 |
- {
|
|
|
57e1455 |
- memcpy((uint8_t*)p_tcp_hdr + tcp_hlen, (uint8_t*)p_tcp_hdr + tcp_hlen + tcp_send_offset, chunk_size);
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* keep PUSH and FIN flags only for the last frame */
|
|
|
57e1455 |
- if (!is_last_frame)
|
|
|
57e1455 |
- {
|
|
|
57e1455 |
- TCP_HEADER_CLEAR_FLAGS(p_tcp_hdr, TCP_FLAG_PUSH|TCP_FLAG_FIN);
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* recalculate TCP checksum */
|
|
|
57e1455 |
- ip_pseudo_header *p_tcpip_hdr = (ip_pseudo_header *)data_to_checksum;
|
|
|
57e1455 |
- p_tcpip_hdr->zeros = 0;
|
|
|
57e1455 |
- p_tcpip_hdr->ip_proto = IP_PROTO_TCP;
|
|
|
57e1455 |
- p_tcpip_hdr->ip_payload = cpu_to_be16(tcp_hlen + chunk_size);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- p_tcp_hdr->th_sum = 0;
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- int tcp_checksum = ip_checksum(data_to_checksum, tcp_hlen + chunk_size + 12);
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode TSO TCP checksum %04x\n",
|
|
|
57e1455 |
- tcp_checksum);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- p_tcp_hdr->th_sum = tcp_checksum;
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* restore IP header */
|
|
|
57e1455 |
- memcpy(eth_payload_data, saved_ip_header, hlen);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* set IP data length and recalculate IP checksum */
|
|
|
57e1455 |
- ip->ip_len = cpu_to_be16(hlen + tcp_hlen + chunk_size);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* increment IP id for subsequent frames */
|
|
|
57e1455 |
- ip->ip_id = cpu_to_be16(tcp_send_offset/tcp_chunk_size + be16_to_cpu(ip->ip_id));
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- ip->ip_sum = 0;
|
|
|
57e1455 |
- ip->ip_sum = ip_checksum(eth_payload_data, hlen);
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode TSO IP header len=%d "
|
|
|
57e1455 |
- "checksum=%04x\n", hlen, ip->ip_sum);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- int tso_send_size = ETH_HLEN + hlen + tcp_hlen + chunk_size;
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode TSO transferring packet size "
|
|
|
57e1455 |
- "%d\n", tso_send_size);
|
|
|
57e1455 |
- rtl8139_transfer_frame(s, saved_buffer, tso_send_size,
|
|
|
57e1455 |
- 0, (uint8_t *) dot1q_buffer);
|
|
|
57e1455 |
-
|
|
|
57e1455 |
- /* add transferred count to TCP sequence number */
|
|
|
57e1455 |
- p_tcp_hdr->th_seq = cpu_to_be32(chunk_size + be32_to_cpu(p_tcp_hdr->th_seq));
|
|
|
57e1455 |
- ++send_count;
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
+ int is_last_frame = 0;
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* Stop sending this frame */
|
|
|
57e1455 |
- saved_size = 0;
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
- else if (txdw0 & (CP_TX_TCPCS|CP_TX_UDPCS))
|
|
|
57e1455 |
+ for (tcp_send_offset = 0; tcp_send_offset < tcp_data_len; tcp_send_offset += tcp_chunk_size)
|
|
|
57e1455 |
{
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode need TCP or UDP checksum\n");
|
|
|
57e1455 |
+ uint16_t chunk_size = tcp_chunk_size;
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* maximum IP header length is 60 bytes */
|
|
|
57e1455 |
- uint8_t saved_ip_header[60];
|
|
|
57e1455 |
- memcpy(saved_ip_header, eth_payload_data, hlen);
|
|
|
57e1455 |
+ /* check if this is the last frame */
|
|
|
57e1455 |
+ if (tcp_send_offset + tcp_chunk_size >= tcp_data_len)
|
|
|
57e1455 |
+ {
|
|
|
57e1455 |
+ is_last_frame = 1;
|
|
|
57e1455 |
+ chunk_size = tcp_data_len - tcp_send_offset;
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
|
|
|
57e1455 |
- uint8_t *data_to_checksum = eth_payload_data + hlen - 12;
|
|
|
57e1455 |
- // size_t data_to_checksum_len = eth_payload_len - hlen + 12;
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode TSO TCP seqno %08x\n",
|
|
|
57e1455 |
+ be32_to_cpu(p_tcp_hdr->th_seq));
|
|
|
57e1455 |
|
|
|
57e1455 |
/* add 4 TCP pseudoheader fields */
|
|
|
57e1455 |
/* copy IP source and destination fields */
|
|
|
57e1455 |
memcpy(data_to_checksum, saved_ip_header + 12, 8);
|
|
|
57e1455 |
|
|
|
57e1455 |
- if ((txdw0 & CP_TX_TCPCS) && ip_protocol == IP_PROTO_TCP)
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode TSO calculating TCP checksum for "
|
|
|
57e1455 |
+ "packet with %d bytes data\n", tcp_hlen +
|
|
|
57e1455 |
+ chunk_size);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ if (tcp_send_offset)
|
|
|
57e1455 |
{
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode calculating TCP checksum for "
|
|
|
57e1455 |
- "packet with %d bytes data\n", ip_data_len);
|
|
|
57e1455 |
+ memcpy((uint8_t*)p_tcp_hdr + tcp_hlen, (uint8_t*)p_tcp_hdr + tcp_hlen + tcp_send_offset, chunk_size);
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
|
|
|
57e1455 |
- ip_pseudo_header *p_tcpip_hdr = (ip_pseudo_header *)data_to_checksum;
|
|
|
57e1455 |
- p_tcpip_hdr->zeros = 0;
|
|
|
57e1455 |
- p_tcpip_hdr->ip_proto = IP_PROTO_TCP;
|
|
|
57e1455 |
- p_tcpip_hdr->ip_payload = cpu_to_be16(ip_data_len);
|
|
|
57e1455 |
+ /* keep PUSH and FIN flags only for the last frame */
|
|
|
57e1455 |
+ if (!is_last_frame)
|
|
|
57e1455 |
+ {
|
|
|
57e1455 |
+ TCP_HEADER_CLEAR_FLAGS(p_tcp_hdr, TCP_FLAG_PUSH|TCP_FLAG_FIN);
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
|
|
|
57e1455 |
- tcp_header* p_tcp_hdr = (tcp_header *) (data_to_checksum+12);
|
|
|
57e1455 |
+ /* recalculate TCP checksum */
|
|
|
57e1455 |
+ ip_pseudo_header *p_tcpip_hdr = (ip_pseudo_header *)data_to_checksum;
|
|
|
57e1455 |
+ p_tcpip_hdr->zeros = 0;
|
|
|
57e1455 |
+ p_tcpip_hdr->ip_proto = IP_PROTO_TCP;
|
|
|
57e1455 |
+ p_tcpip_hdr->ip_payload = cpu_to_be16(tcp_hlen + chunk_size);
|
|
|
57e1455 |
|
|
|
57e1455 |
- p_tcp_hdr->th_sum = 0;
|
|
|
57e1455 |
+ p_tcp_hdr->th_sum = 0;
|
|
|
57e1455 |
|
|
|
57e1455 |
- int tcp_checksum = ip_checksum(data_to_checksum, ip_data_len + 12);
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode TCP checksum %04x\n",
|
|
|
57e1455 |
- tcp_checksum);
|
|
|
57e1455 |
+ int tcp_checksum = ip_checksum(data_to_checksum, tcp_hlen + chunk_size + 12);
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode TSO TCP checksum %04x\n",
|
|
|
57e1455 |
+ tcp_checksum);
|
|
|
57e1455 |
|
|
|
57e1455 |
- p_tcp_hdr->th_sum = tcp_checksum;
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
- else if ((txdw0 & CP_TX_UDPCS) && ip_protocol == IP_PROTO_UDP)
|
|
|
57e1455 |
- {
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode calculating UDP checksum for "
|
|
|
57e1455 |
- "packet with %d bytes data\n", ip_data_len);
|
|
|
57e1455 |
+ p_tcp_hdr->th_sum = tcp_checksum;
|
|
|
57e1455 |
|
|
|
57e1455 |
- ip_pseudo_header *p_udpip_hdr = (ip_pseudo_header *)data_to_checksum;
|
|
|
57e1455 |
- p_udpip_hdr->zeros = 0;
|
|
|
57e1455 |
- p_udpip_hdr->ip_proto = IP_PROTO_UDP;
|
|
|
57e1455 |
- p_udpip_hdr->ip_payload = cpu_to_be16(ip_data_len);
|
|
|
57e1455 |
+ /* restore IP header */
|
|
|
57e1455 |
+ memcpy(eth_payload_data, saved_ip_header, hlen);
|
|
|
57e1455 |
|
|
|
57e1455 |
- udp_header *p_udp_hdr = (udp_header *) (data_to_checksum+12);
|
|
|
57e1455 |
+ /* set IP data length and recalculate IP checksum */
|
|
|
57e1455 |
+ ip->ip_len = cpu_to_be16(hlen + tcp_hlen + chunk_size);
|
|
|
57e1455 |
|
|
|
57e1455 |
- p_udp_hdr->uh_sum = 0;
|
|
|
57e1455 |
+ /* increment IP id for subsequent frames */
|
|
|
57e1455 |
+ ip->ip_id = cpu_to_be16(tcp_send_offset/tcp_chunk_size + be16_to_cpu(ip->ip_id));
|
|
|
57e1455 |
|
|
|
57e1455 |
- int udp_checksum = ip_checksum(data_to_checksum, ip_data_len + 12);
|
|
|
57e1455 |
- DPRINTF("+++ C+ mode UDP checksum %04x\n",
|
|
|
57e1455 |
- udp_checksum);
|
|
|
57e1455 |
+ ip->ip_sum = 0;
|
|
|
57e1455 |
+ ip->ip_sum = ip_checksum(eth_payload_data, hlen);
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode TSO IP header len=%d "
|
|
|
57e1455 |
+ "checksum=%04x\n", hlen, ip->ip_sum);
|
|
|
57e1455 |
|
|
|
57e1455 |
- p_udp_hdr->uh_sum = udp_checksum;
|
|
|
57e1455 |
- }
|
|
|
57e1455 |
+ int tso_send_size = ETH_HLEN + hlen + tcp_hlen + chunk_size;
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode TSO transferring packet size "
|
|
|
57e1455 |
+ "%d\n", tso_send_size);
|
|
|
57e1455 |
+ rtl8139_transfer_frame(s, saved_buffer, tso_send_size,
|
|
|
57e1455 |
+ 0, (uint8_t *) dot1q_buffer);
|
|
|
57e1455 |
|
|
|
57e1455 |
- /* restore IP header */
|
|
|
57e1455 |
- memcpy(eth_payload_data, saved_ip_header, hlen);
|
|
|
57e1455 |
+ /* add transferred count to TCP sequence number */
|
|
|
57e1455 |
+ p_tcp_hdr->th_seq = cpu_to_be32(chunk_size + be32_to_cpu(p_tcp_hdr->th_seq));
|
|
|
57e1455 |
+ ++send_count;
|
|
|
57e1455 |
}
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ /* Stop sending this frame */
|
|
|
57e1455 |
+ saved_size = 0;
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
+ else if (txdw0 & (CP_TX_TCPCS|CP_TX_UDPCS))
|
|
|
57e1455 |
+ {
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode need TCP or UDP checksum\n");
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ /* maximum IP header length is 60 bytes */
|
|
|
57e1455 |
+ uint8_t saved_ip_header[60];
|
|
|
57e1455 |
+ memcpy(saved_ip_header, eth_payload_data, hlen);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ uint8_t *data_to_checksum = eth_payload_data + hlen - 12;
|
|
|
57e1455 |
+ // size_t data_to_checksum_len = eth_payload_len - hlen + 12;
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ /* add 4 TCP pseudoheader fields */
|
|
|
57e1455 |
+ /* copy IP source and destination fields */
|
|
|
57e1455 |
+ memcpy(data_to_checksum, saved_ip_header + 12, 8);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ if ((txdw0 & CP_TX_TCPCS) && ip_protocol == IP_PROTO_TCP)
|
|
|
57e1455 |
+ {
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode calculating TCP checksum for "
|
|
|
57e1455 |
+ "packet with %d bytes data\n", ip_data_len);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ ip_pseudo_header *p_tcpip_hdr = (ip_pseudo_header *)data_to_checksum;
|
|
|
57e1455 |
+ p_tcpip_hdr->zeros = 0;
|
|
|
57e1455 |
+ p_tcpip_hdr->ip_proto = IP_PROTO_TCP;
|
|
|
57e1455 |
+ p_tcpip_hdr->ip_payload = cpu_to_be16(ip_data_len);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ tcp_header* p_tcp_hdr = (tcp_header *) (data_to_checksum+12);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ p_tcp_hdr->th_sum = 0;
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ int tcp_checksum = ip_checksum(data_to_checksum, ip_data_len + 12);
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode TCP checksum %04x\n",
|
|
|
57e1455 |
+ tcp_checksum);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ p_tcp_hdr->th_sum = tcp_checksum;
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
+ else if ((txdw0 & CP_TX_UDPCS) && ip_protocol == IP_PROTO_UDP)
|
|
|
57e1455 |
+ {
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode calculating UDP checksum for "
|
|
|
57e1455 |
+ "packet with %d bytes data\n", ip_data_len);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ ip_pseudo_header *p_udpip_hdr = (ip_pseudo_header *)data_to_checksum;
|
|
|
57e1455 |
+ p_udpip_hdr->zeros = 0;
|
|
|
57e1455 |
+ p_udpip_hdr->ip_proto = IP_PROTO_UDP;
|
|
|
57e1455 |
+ p_udpip_hdr->ip_payload = cpu_to_be16(ip_data_len);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ udp_header *p_udp_hdr = (udp_header *) (data_to_checksum+12);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ p_udp_hdr->uh_sum = 0;
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ int udp_checksum = ip_checksum(data_to_checksum, ip_data_len + 12);
|
|
|
57e1455 |
+ DPRINTF("+++ C+ mode UDP checksum %04x\n",
|
|
|
57e1455 |
+ udp_checksum);
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ p_udp_hdr->uh_sum = udp_checksum;
|
|
|
57e1455 |
+ }
|
|
|
57e1455 |
+
|
|
|
57e1455 |
+ /* restore IP header */
|
|
|
57e1455 |
+ memcpy(eth_payload_data, saved_ip_header, hlen);
|
|
|
57e1455 |
}
|
|
|
57e1455 |
}
|
|
|
57e1455 |
|
|
|
57e1455 |
--
|
|
|
57e1455 |
2.1.4
|
|
|
57e1455 |
|