6 #include "qemu/osdep.h"
7 #include "qemu-common.h"
9 #include "qemu/osdep.h"
12 void udp6_input(struct mbuf
*m
)
14 Slirp
*slirp
= m
->slirp
;
15 struct ip6
*ip
, save_ip
;
17 int iphlen
= sizeof(struct ip6
);
20 struct sockaddr_in6 lhost
;
22 DEBUG_CALL("udp6_input");
23 DEBUG_ARG("m = %lx", (long)m
);
25 if (slirp
->restricted
) {
29 ip
= mtod(m
, struct ip6
*);
32 uh
= mtod(m
, struct udphdr
*);
40 len
= ntohs((uint16_t)uh
->uh_ulen
);
43 * Make mbuf data length reflect UDP length.
44 * If not enough data to reflect UDP length, drop.
46 if (ntohs(ip
->ip_pl
) != len
) {
47 if (len
> ntohs(ip
->ip_pl
)) {
50 m_adj(m
, len
- ntohs(ip
->ip_pl
));
51 ip
->ip_pl
= htons(len
);
55 * Save a copy of the IP header in case we want restore it
56 * for sending an ICMP error message in response.
60 /* Locate pcb for datagram. */
61 lhost
.sin6_family
= AF_INET6
;
62 lhost
.sin6_addr
= ip
->ip_src
;
63 lhost
.sin6_port
= uh
->uh_sport
;
65 /* TODO handle DHCP/BOOTP */
68 if (ntohs(uh
->uh_dport
) == TFTP_SERVER
&&
69 !memcmp(ip
->ip_dst
.s6_addr
, slirp
->vhost_addr6
.s6_addr
, 16)) {
72 tftp_input((struct sockaddr_storage
*)&lhost
, m
);
78 so
= solookup(&slirp
->udp_last_so
, &slirp
->udb
,
79 (struct sockaddr_storage
*) &lhost
, NULL
);
82 /* If there's no socket for this packet, create one. */
87 if (udp_attach(so
, AF_INET6
) == -1) {
88 DEBUG_MISC((dfd
, " udp6_attach errno = %d-%s\n",
89 errno
, strerror(errno
)));
95 so
->so_lfamily
= AF_INET6
;
96 so
->so_laddr6
= ip
->ip_src
;
97 so
->so_lport6
= uh
->uh_sport
;
100 so
->so_ffamily
= AF_INET6
;
101 so
->so_faddr6
= ip
->ip_dst
; /* XXX */
102 so
->so_fport6
= uh
->uh_dport
; /* XXX */
104 iphlen
+= sizeof(struct udphdr
);
109 * Now we sendto() the packet.
111 if (sosendto(so
, m
) == -1) {
115 DEBUG_MISC((dfd
, "udp tx errno = %d-%s\n", errno
, strerror(errno
)));
116 /* TODO: ICMPv6 error */
117 /*icmp_error(m, ICMP_UNREACH,ICMP_UNREACH_NET, 0,strerror(errno));*/
121 m_free(so
->so_m
); /* used for ICMP if error on sorecvfrom */
123 /* restore the orig mbuf packet */
134 int udp6_output(struct socket
*so
, struct mbuf
*m
,
135 struct sockaddr_in6
*saddr
, struct sockaddr_in6
*daddr
)
140 DEBUG_CALL("udp6_output");
141 DEBUG_ARG("so = %lx", (long)so
);
142 DEBUG_ARG("m = %lx", (long)m
);
144 /* adjust for header */
145 m
->m_data
-= sizeof(struct udphdr
);
146 m
->m_len
+= sizeof(struct udphdr
);
147 uh
= mtod(m
, struct udphdr
*);
148 m
->m_data
-= sizeof(struct ip6
);
149 m
->m_len
+= sizeof(struct ip6
);
150 ip
= mtod(m
, struct ip6
*);
152 /* Build IP header */
153 ip
->ip_pl
= htons(m
->m_len
- sizeof(struct ip6
));
154 ip
->ip_nh
= IPPROTO_UDP
;
155 ip
->ip_src
= saddr
->sin6_addr
;
156 ip
->ip_dst
= daddr
->sin6_addr
;
158 /* Build UDP header */
159 uh
->uh_sport
= saddr
->sin6_port
;
160 uh
->uh_dport
= daddr
->sin6_port
;
161 uh
->uh_ulen
= ip
->ip_pl
;
163 uh
->uh_sum
= ip6_cksum(m
);
164 if (uh
->uh_sum
== 0) {
168 return ip6_output(so
, m
, 0);