#include <sys/sysmacros.h>
#include <sys/types.h>
#include <sys/stream.h>
#include <sys/stropts.h>
#include <sys/strlog.h>
#include <sys/strsun.h>
#define _SUN_TPI_VERSION 2
#include <sys/tihdr.h>
#include <sys/timod.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/strsubr.h>
#include <sys/suntpi.h>
#include <sys/xti_inet.h>
#include <sys/kmem.h>
#include <sys/cred_impl.h>
#include <sys/policy.h>
#include <sys/priv.h>
#include <sys/ucred.h>
#include <sys/zone.h>
#include <sys/socket.h>
#include <sys/socketvar.h>
#include <sys/sockio.h>
#include <sys/vtrace.h>
#include <sys/sdt.h>
#include <sys/debug.h>
#include <sys/isa_defs.h>
#include <sys/random.h>
#include <netinet/in.h>
#include <netinet/ip6.h>
#include <netinet/icmp6.h>
#include <netinet/udp.h>
#include <inet/common.h>
#include <inet/ip.h>
#include <inet/ip_impl.h>
#include <inet/ipsec_impl.h>
#include <inet/ip6.h>
#include <inet/ip_ire.h>
#include <inet/ip_if.h>
#include <inet/ip_multi.h>
#include <inet/ip_ndp.h>
#include <inet/proto_set.h>
#include <inet/mib2.h>
#include <inet/optcom.h>
#include <inet/snmpcom.h>
#include <inet/kstatcom.h>
#include <inet/ipclassifier.h>
#include <sys/squeue_impl.h>
#include <inet/ipnet.h>
#include <sys/vxlan.h>
#include <inet/inet_hash.h>
#include <sys/tsol/label.h>
#include <sys/tsol/tnet.h>
#include <rpc/pmap_prot.h>
#include <inet/udp_impl.h>
uint_t udp_bind_fanout_size = UDP_BIND_FANOUT_SIZE;
static void udp_addr_req(queue_t *q, mblk_t *mp);
static void udp_tpi_bind(queue_t *q, mblk_t *mp);
static void udp_bind_hash_insert(udp_fanout_t *uf, udp_t *udp);
static void udp_bind_hash_remove(udp_t *udp, boolean_t caller_holds_lock);
static int udp_build_hdr_template(conn_t *, const in6_addr_t *,
const in6_addr_t *, in_port_t, uint32_t);
static void udp_capability_req(queue_t *q, mblk_t *mp);
static int udp_tpi_close(queue_t *q, int flags, cred_t *);
static void udp_close_free(conn_t *);
static void udp_tpi_connect(queue_t *q, mblk_t *mp);
static void udp_tpi_disconnect(queue_t *q, mblk_t *mp);
static void udp_err_ack(queue_t *q, mblk_t *mp, t_scalar_t t_error,
int sys_error);
static void udp_err_ack_prim(queue_t *q, mblk_t *mp, t_scalar_t primitive,
t_scalar_t tlierr, int sys_error);
static int udp_extra_priv_ports_get(queue_t *q, mblk_t *mp, caddr_t cp,
cred_t *cr);
static int udp_extra_priv_ports_add(queue_t *q, mblk_t *mp,
char *value, caddr_t cp, cred_t *cr);
static int udp_extra_priv_ports_del(queue_t *q, mblk_t *mp,
char *value, caddr_t cp, cred_t *cr);
static void udp_icmp_input(void *, mblk_t *, void *, ip_recv_attr_t *);
static void udp_icmp_error_ipv6(conn_t *connp, mblk_t *mp,
ip_recv_attr_t *ira);
static void udp_info_req(queue_t *q, mblk_t *mp);
static void udp_input(void *, mblk_t *, void *, ip_recv_attr_t *);
static int udp_lrput(queue_t *, mblk_t *);
static int udp_lwput(queue_t *, mblk_t *);
static int udp_open(queue_t *q, dev_t *devp, int flag, int sflag,
cred_t *credp, boolean_t isv6);
static int udp_openv4(queue_t *q, dev_t *devp, int flag, int sflag,
cred_t *credp);
static int udp_openv6(queue_t *q, dev_t *devp, int flag, int sflag,
cred_t *credp);
static boolean_t udp_opt_allow_udr_set(t_scalar_t level, t_scalar_t name);
int udp_opt_set(conn_t *connp, uint_t optset_context,
int level, int name, uint_t inlen,
uchar_t *invalp, uint_t *outlenp, uchar_t *outvalp,
void *thisdg_attrs, cred_t *cr);
int udp_opt_get(conn_t *connp, int level, int name,
uchar_t *ptr);
static int udp_output_connected(conn_t *connp, mblk_t *mp, cred_t *cr,
pid_t pid);
static int udp_output_lastdst(conn_t *connp, mblk_t *mp, cred_t *cr,
pid_t pid, ip_xmit_attr_t *ixa);
static int udp_output_newdst(conn_t *connp, mblk_t *data_mp, sin_t *sin,
sin6_t *sin6, ushort_t ipversion, cred_t *cr, pid_t,
ip_xmit_attr_t *ixa);
static mblk_t *udp_prepend_hdr(conn_t *, ip_xmit_attr_t *, const ip_pkt_t *,
const in6_addr_t *, const in6_addr_t *, in_port_t, uint32_t, mblk_t *,
int *);
static mblk_t *udp_prepend_header_template(conn_t *, ip_xmit_attr_t *,
mblk_t *, const in6_addr_t *, in_port_t, uint32_t, int *);
static void udp_ud_err(queue_t *q, mblk_t *mp, t_scalar_t err);
static void udp_ud_err_connected(conn_t *, t_scalar_t);
static void udp_tpi_unbind(queue_t *q, mblk_t *mp);
static in_port_t udp_update_next_port(udp_t *udp, in_port_t port,
boolean_t random);
static void udp_wput_other(queue_t *q, mblk_t *mp);
static void udp_wput_iocdata(queue_t *q, mblk_t *mp);
static int udp_wput_fallback(queue_t *q, mblk_t *mp);
static size_t udp_set_rcv_hiwat(udp_t *udp, size_t size);
static void *udp_stack_init(netstackid_t stackid, netstack_t *ns);
static void udp_stack_fini(netstackid_t stackid, void *arg);
static void udp_ulp_recv(conn_t *, mblk_t *, uint_t, ip_recv_attr_t *);
static conn_t *udp_do_open(cred_t *, boolean_t, int, int *);
static void udp_do_close(conn_t *);
static int udp_do_bind(conn_t *, struct sockaddr *, socklen_t, cred_t *,
boolean_t);
static int udp_do_unbind(conn_t *);
int udp_getsockname(sock_lower_handle_t,
struct sockaddr *, socklen_t *, cred_t *);
int udp_getpeername(sock_lower_handle_t,
struct sockaddr *, socklen_t *, cred_t *);
static int udp_do_connect(conn_t *, const struct sockaddr *, socklen_t,
cred_t *, pid_t);
#define CL_INET_UDP_CONNECT(cp, is_outgoing, faddrp, fport, err) { \
(err) = 0; \
\
if ((cp)->conn_ipversion == IPV4_VERSION) \
(err) = (*cl_inet_connect2)( \
(cp)->conn_netstack->netstack_stackid, \
IPPROTO_UDP, is_outgoing, AF_INET, \
(uint8_t *)&((cp)->conn_laddr_v4), \
(cp)->conn_lport, \
(uint8_t *)&(V4_PART_OF_V6(*faddrp)), \
(in_port_t)(fport), NULL); \
else \
(err) = (*cl_inet_connect2)( \
(cp)->conn_netstack->netstack_stackid, \
IPPROTO_UDP, is_outgoing, AF_INET6, \
(uint8_t *)&((cp)->conn_laddr_v6), \
(cp)->conn_lport, \
(uint8_t *)(faddrp), (in_port_t)(fport), NULL); \
}
static struct module_info udp_mod_info = {
UDP_MOD_ID, UDP_MOD_NAME, 1, INFPSZ, UDP_RECV_HIWATER, UDP_RECV_LOWATER
};
static struct qinit udp_rinitv4 = {
NULL, NULL, udp_openv4, udp_tpi_close, NULL, &udp_mod_info, NULL
};
static struct qinit udp_rinitv6 = {
NULL, NULL, udp_openv6, udp_tpi_close, NULL, &udp_mod_info, NULL
};
static struct qinit udp_winit = {
udp_wput, ip_wsrv, NULL, NULL, NULL, &udp_mod_info
};
struct qinit udp_fallback_sock_winit = {
udp_wput_fallback, NULL, NULL, NULL, NULL, &udp_mod_info
};
static struct qinit udp_lrinit = {
udp_lrput, NULL, udp_openv4, udp_tpi_close, NULL, &udp_mod_info
};
static struct qinit udp_lwinit = {
udp_lwput, NULL, udp_openv4, udp_tpi_close, NULL, &udp_mod_info
};
struct streamtab udpinfov4 = {
&udp_rinitv4, &udp_winit, &udp_lrinit, &udp_lwinit
};
struct streamtab udpinfov6 = {
&udp_rinitv6, &udp_winit, &udp_lrinit, &udp_lwinit
};
#define UDP_MAXPACKET_IPV4 (IP_MAXPACKET - UDPH_SIZE - IP_SIMPLE_HDR_LENGTH)
static struct T_info_ack udp_g_t_info_ack_ipv4 = {
T_INFO_ACK,
UDP_MAXPACKET_IPV4,
T_INVALID,
T_INVALID,
T_INVALID,
sizeof (sin_t),
0,
UDP_MAXPACKET_IPV4,
T_CLTS,
TS_UNBND,
(XPG4_1|SENDZERO)
};
#define UDP_MAXPACKET_IPV6 (IP_MAXPACKET - UDPH_SIZE - IPV6_HDR_LEN)
static struct T_info_ack udp_g_t_info_ack_ipv6 = {
T_INFO_ACK,
UDP_MAXPACKET_IPV6,
T_INVALID,
T_INVALID,
T_INVALID,
sizeof (sin6_t),
0,
UDP_MAXPACKET_IPV6,
T_CLTS,
TS_UNBND,
(XPG4_1|SENDZERO)
};
extern mod_prop_info_t udp_propinfo_tbl[];
extern int udp_propinfo_count;
uint32_t udp_random_anon_port = 1;
void (*cl_inet_bind)(netstackid_t stack_id, uchar_t protocol,
sa_family_t addr_family, uint8_t *laddrp, in_port_t lport,
void *args) = NULL;
void (*cl_inet_unbind)(netstackid_t stack_id, uint8_t protocol,
sa_family_t addr_family, uint8_t *laddrp, in_port_t lport,
void *args) = NULL;
typedef union T_primitives *t_primp_t;
uint16_t
udp_srcport_hash(mblk_t *mp, int type, uint16_t min, uint16_t max,
uint16_t def)
{
size_t szused = 0;
ip6_t *ip6h;
ipha_t *ipha;
uint16_t sap;
uint64_t hash;
uint32_t mod;
ASSERT(min <= max);
if (type != UDP_HASH_VXLAN)
return (def);
if (!IS_P2ALIGNED(mp->b_rptr, sizeof (uint16_t)))
return (def);
if (MBLKL(mp) == VXLAN_HDR_LEN) {
if (mp->b_cont == NULL)
return (def);
mp = mp->b_cont;
} else if (MBLKL(mp) < VXLAN_HDR_LEN) {
return (def);
} else {
szused = VXLAN_HDR_LEN;
}
if (MBLKL(mp) + szused < sizeof (struct ether_header))
return (def);
mp->b_rptr += szused;
hash = inet_pkt_hash(DL_ETHER, mp, INET_PKT_HASH_L2 |
INET_PKT_HASH_L3 | INET_PKT_HASH_L4);
mp->b_rptr -= szused;
if (hash == 0)
return (def);
mod = max - min + 1;
return ((hash % mod) + min);
}
static in_port_t
udp_get_next_priv_port(udp_t *udp)
{
static in_port_t next_priv_port = IPPORT_RESERVED - 1;
in_port_t nextport;
boolean_t restart = B_FALSE;
udp_stack_t *us = udp->udp_us;
retry:
if (next_priv_port < us->us_min_anonpriv_port ||
next_priv_port >= IPPORT_RESERVED) {
next_priv_port = IPPORT_RESERVED - 1;
if (restart)
return (0);
restart = B_TRUE;
}
if (is_system_labeled() &&
(nextport = tsol_next_port(crgetzone(udp->udp_connp->conn_cred),
next_priv_port, IPPROTO_UDP, B_FALSE)) != 0) {
next_priv_port = nextport;
goto retry;
}
return (next_priv_port--);
}
static void
udp_bind_hash_remove(udp_t *udp, boolean_t caller_holds_lock)
{
udp_t *udpnext;
kmutex_t *lockp;
udp_stack_t *us = udp->udp_us;
conn_t *connp = udp->udp_connp;
if (udp->udp_ptpbhn == NULL)
return;
ASSERT(connp->conn_lport != 0);
if (!caller_holds_lock) {
lockp = &us->us_bind_fanout[UDP_BIND_HASH(connp->conn_lport,
us->us_bind_fanout_size)].uf_lock;
ASSERT(lockp != NULL);
mutex_enter(lockp);
}
if (udp->udp_ptpbhn != NULL) {
udpnext = udp->udp_bind_hash;
if (udpnext != NULL) {
udpnext->udp_ptpbhn = udp->udp_ptpbhn;
udp->udp_bind_hash = NULL;
}
*udp->udp_ptpbhn = udpnext;
udp->udp_ptpbhn = NULL;
}
if (!caller_holds_lock) {
mutex_exit(lockp);
}
}
static void
udp_bind_hash_insert(udp_fanout_t *uf, udp_t *udp)
{
conn_t *connp = udp->udp_connp;
udp_t **udpp;
udp_t *udpnext;
conn_t *connext;
ASSERT(MUTEX_HELD(&uf->uf_lock));
ASSERT(udp->udp_ptpbhn == NULL);
udpp = &uf->uf_udp;
udpnext = udpp[0];
if (udpnext != NULL) {
connext = udpnext->udp_connp;
if (V6_OR_V4_INADDR_ANY(connp->conn_bound_addr_v6) &&
!V6_OR_V4_INADDR_ANY(connext->conn_bound_addr_v6)) {
while ((udpnext = udpp[0]) != NULL &&
!V6_OR_V4_INADDR_ANY(connext->conn_bound_addr_v6)) {
udpp = &(udpnext->udp_bind_hash);
}
if (udpnext != NULL)
udpnext->udp_ptpbhn = &udp->udp_bind_hash;
} else {
udpnext->udp_ptpbhn = &udp->udp_bind_hash;
}
}
udp->udp_bind_hash = udpnext;
udp->udp_ptpbhn = udpp;
udpp[0] = udp;
}
static void
udp_tpi_bind(queue_t *q, mblk_t *mp)
{
sin_t *sin;
sin6_t *sin6;
mblk_t *mp1;
struct T_bind_req *tbr;
conn_t *connp;
udp_t *udp;
int error;
struct sockaddr *sa;
cred_t *cr;
cr = msg_getcred(mp, NULL);
ASSERT(cr != NULL);
if (cr == NULL) {
udp_err_ack(q, mp, TSYSERR, EINVAL);
return;
}
connp = Q_TO_CONN(q);
udp = connp->conn_udp;
if ((mp->b_wptr - mp->b_rptr) < sizeof (*tbr)) {
(void) mi_strlog(q, 1, SL_ERROR|SL_TRACE,
"udp_bind: bad req, len %u",
(uint_t)(mp->b_wptr - mp->b_rptr));
udp_err_ack(q, mp, TPROTO, 0);
return;
}
if (udp->udp_state != TS_UNBND) {
(void) mi_strlog(q, 1, SL_ERROR|SL_TRACE,
"udp_bind: bad state, %u", udp->udp_state);
udp_err_ack(q, mp, TOUTSTATE, 0);
return;
}
mp1 = reallocb(mp, sizeof (struct T_bind_ack) + sizeof (sin6_t), 1);
if (mp1 == NULL) {
udp_err_ack(q, mp, TSYSERR, ENOMEM);
return;
}
mp = mp1;
DB_TYPE(mp) = M_PCPROTO;
tbr = (struct T_bind_req *)mp->b_rptr;
switch (tbr->ADDR_length) {
case 0:
tbr->ADDR_offset = sizeof (struct T_bind_req);
if (connp->conn_family == AF_INET) {
tbr->ADDR_length = sizeof (sin_t);
sin = (sin_t *)&tbr[1];
*sin = sin_null;
sin->sin_family = AF_INET;
mp->b_wptr = (uchar_t *)&sin[1];
sa = (struct sockaddr *)sin;
} else {
ASSERT(connp->conn_family == AF_INET6);
tbr->ADDR_length = sizeof (sin6_t);
sin6 = (sin6_t *)&tbr[1];
*sin6 = sin6_null;
sin6->sin6_family = AF_INET6;
mp->b_wptr = (uchar_t *)&sin6[1];
sa = (struct sockaddr *)sin6;
}
break;
case sizeof (sin_t):
sa = (struct sockaddr *)mi_offset_param(mp, tbr->ADDR_offset,
sizeof (sin_t));
if (sa == NULL || !OK_32PTR((char *)sa)) {
udp_err_ack(q, mp, TSYSERR, EINVAL);
return;
}
if (connp->conn_family != AF_INET ||
sa->sa_family != AF_INET) {
udp_err_ack(q, mp, TSYSERR, EAFNOSUPPORT);
return;
}
break;
case sizeof (sin6_t):
sa = (struct sockaddr *)mi_offset_param(mp, tbr->ADDR_offset,
sizeof (sin6_t));
if (sa == NULL || !OK_32PTR((char *)sa)) {
udp_err_ack(q, mp, TSYSERR, EINVAL);
return;
}
if (connp->conn_family != AF_INET6 ||
sa->sa_family != AF_INET6) {
udp_err_ack(q, mp, TSYSERR, EAFNOSUPPORT);
return;
}
break;
default:
(void) mi_strlog(q, 1, SL_ERROR|SL_TRACE,
"udp_bind: bad ADDR_length length %u", tbr->ADDR_length);
udp_err_ack(q, mp, TBADADDR, 0);
return;
}
error = udp_do_bind(connp, sa, tbr->ADDR_length, cr,
tbr->PRIM_type != O_T_BIND_REQ);
if (error != 0) {
if (error > 0) {
udp_err_ack(q, mp, TSYSERR, error);
} else {
udp_err_ack(q, mp, -error, 0);
}
} else {
tbr->PRIM_type = T_BIND_ACK;
qreply(q, mp);
}
}
static void
udp_tpi_connect(queue_t *q, mblk_t *mp)
{
conn_t *connp = Q_TO_CONN(q);
int error;
socklen_t len;
struct sockaddr *sa;
struct T_conn_req *tcr;
cred_t *cr;
pid_t pid;
cr = msg_getcred(mp, &pid);
ASSERT(cr != NULL);
if (cr == NULL) {
udp_err_ack(q, mp, TSYSERR, EINVAL);
return;
}
tcr = (struct T_conn_req *)mp->b_rptr;
if ((mp->b_wptr - mp->b_rptr) < sizeof (struct T_conn_req)) {
udp_err_ack(q, mp, TPROTO, 0);
return;
}
if (tcr->OPT_length != 0) {
udp_err_ack(q, mp, TBADOPT, 0);
return;
}
len = tcr->DEST_length;
switch (tcr->DEST_length) {
default:
udp_err_ack(q, mp, TBADADDR, 0);
return;
case sizeof (sin_t):
sa = (struct sockaddr *)mi_offset_param(mp, tcr->DEST_offset,
sizeof (sin_t));
break;
case sizeof (sin6_t):
sa = (struct sockaddr *)mi_offset_param(mp, tcr->DEST_offset,
sizeof (sin6_t));
break;
}
error = proto_verify_ip_addr(connp->conn_family, sa, len);
if (error != 0) {
udp_err_ack(q, mp, TSYSERR, error);
return;
}
error = udp_do_connect(connp, sa, len, cr, pid);
if (error != 0) {
if (error < 0)
udp_err_ack(q, mp, -error, 0);
else
udp_err_ack(q, mp, TSYSERR, error);
} else {
mblk_t *mp1;
if (connp->conn_family == AF_INET) {
mp1 = mi_tpi_conn_con(NULL, (char *)sa,
sizeof (sin_t), NULL, 0);
} else {
mp1 = mi_tpi_conn_con(NULL, (char *)sa,
sizeof (sin6_t), NULL, 0);
}
if (mp1 == NULL) {
udp_err_ack(q, mp, TSYSERR, ENOMEM);
return;
}
mp = mi_tpi_ok_ack_alloc(mp);
if (mp == NULL) {
udp_err_ack_prim(q, mp1, T_CONN_REQ, TSYSERR, ENOMEM);
return;
}
putnext(connp->conn_rq, mp);
putnext(connp->conn_rq, mp1);
}
}
static int
udp_tpi_close(queue_t *q, int flags, cred_t *credp __unused)
{
conn_t *connp;
if (flags & SO_FALLBACK) {
inet_minor_free(WR(q)->q_ptr, (dev_t)(RD(q)->q_ptr));
qprocsoff(q);
goto done;
}
connp = Q_TO_CONN(q);
udp_do_close(connp);
done:
q->q_ptr = WR(q)->q_ptr = NULL;
return (0);
}
static void
udp_close_free(conn_t *connp)
{
udp_t *udp = connp->conn_udp;
if (udp->udp_recv_ipp.ipp_fields != 0)
ip_pkt_free(&udp->udp_recv_ipp);
ASSERT(udp->udp_connp == connp);
bzero(udp, sizeof (udp_t));
udp->udp_connp = connp;
}
static int
udp_do_disconnect(conn_t *connp)
{
udp_t *udp;
udp_fanout_t *udpf;
udp_stack_t *us;
int error;
udp = connp->conn_udp;
us = udp->udp_us;
mutex_enter(&connp->conn_lock);
if (udp->udp_state != TS_DATA_XFER) {
mutex_exit(&connp->conn_lock);
return (-TOUTSTATE);
}
udpf = &us->us_bind_fanout[UDP_BIND_HASH(connp->conn_lport,
us->us_bind_fanout_size)];
mutex_enter(&udpf->uf_lock);
if (connp->conn_mcbc_bind)
connp->conn_saddr_v6 = ipv6_all_zeros;
else
connp->conn_saddr_v6 = connp->conn_bound_addr_v6;
connp->conn_laddr_v6 = connp->conn_bound_addr_v6;
connp->conn_faddr_v6 = ipv6_all_zeros;
connp->conn_fport = 0;
udp->udp_state = TS_IDLE;
mutex_exit(&udpf->uf_lock);
if (connp->conn_family == AF_INET6)
connp->conn_ipversion = IPV6_VERSION;
connp->conn_v6lastdst = ipv6_all_zeros;
error = udp_build_hdr_template(connp, &connp->conn_saddr_v6,
&connp->conn_faddr_v6, connp->conn_fport, connp->conn_flowinfo);
mutex_exit(&connp->conn_lock);
if (error != 0)
return (error);
return (ip_laddr_fanout_insert(connp));
}
static void
udp_tpi_disconnect(queue_t *q, mblk_t *mp)
{
conn_t *connp = Q_TO_CONN(q);
int error;
mp = reallocb(mp, sizeof (struct T_error_ack), 1);
if (mp == NULL) {
udp_err_ack_prim(q, mp, T_DISCON_REQ, TSYSERR, ENOMEM);
return;
}
error = udp_do_disconnect(connp);
if (error != 0) {
if (error < 0) {
udp_err_ack(q, mp, -error, 0);
} else {
udp_err_ack(q, mp, TSYSERR, error);
}
} else {
mp = mi_tpi_ok_ack_alloc(mp);
ASSERT(mp != NULL);
qreply(q, mp);
}
}
int
udp_disconnect(conn_t *connp)
{
int error;
connp->conn_dgram_errind = B_FALSE;
error = udp_do_disconnect(connp);
if (error < 0)
error = proto_tlitosyserr(-error);
return (error);
}
static void
udp_err_ack(queue_t *q, mblk_t *mp, t_scalar_t t_error, int sys_error)
{
if ((mp = mi_tpi_err_ack_alloc(mp, t_error, sys_error)) != NULL)
qreply(q, mp);
}
static void
udp_err_ack_prim(queue_t *q, mblk_t *mp, t_scalar_t primitive,
t_scalar_t t_error, int sys_error)
{
struct T_error_ack *teackp;
if ((mp = tpi_ack_alloc(mp, sizeof (struct T_error_ack),
M_PCPROTO, T_ERROR_ACK)) != NULL) {
teackp = (struct T_error_ack *)mp->b_rptr;
teackp->ERROR_prim = primitive;
teackp->TLI_error = t_error;
teackp->UNIX_error = sys_error;
qreply(q, mp);
}
}
#define ICMP_MIN_UDP_HDR 4
static void
udp_icmp_input(void *arg1, mblk_t *mp, void *arg2, ip_recv_attr_t *ira)
{
conn_t *connp = (conn_t *)arg1;
icmph_t *icmph;
ipha_t *ipha;
int iph_hdr_length;
udpha_t *udpha;
sin_t sin;
sin6_t sin6;
mblk_t *mp1;
int error = 0;
udp_t *udp = connp->conn_udp;
ipha = (ipha_t *)mp->b_rptr;
ASSERT(OK_32PTR(mp->b_rptr));
if (IPH_HDR_VERSION(ipha) != IPV4_VERSION) {
ASSERT(IPH_HDR_VERSION(ipha) == IPV6_VERSION);
udp_icmp_error_ipv6(connp, mp, ira);
return;
}
ASSERT(IPH_HDR_VERSION(ipha) == IPV4_VERSION);
ASSERT(IPH_HDR_LENGTH(ipha) == ira->ira_ip_hdr_length);
iph_hdr_length = ira->ira_ip_hdr_length;
icmph = (icmph_t *)&mp->b_rptr[iph_hdr_length];
ipha = (ipha_t *)&icmph[1];
iph_hdr_length = IPH_HDR_LENGTH(ipha);
udpha = (udpha_t *)((char *)ipha + iph_hdr_length);
switch (icmph->icmph_type) {
case ICMP_DEST_UNREACHABLE:
switch (icmph->icmph_code) {
case ICMP_FRAGMENTATION_NEEDED: {
ipha_t *ipha;
ip_xmit_attr_t *ixa;
if (connp->conn_ipversion != IPV4_VERSION)
break;
ixa = conn_get_ixa(connp, B_FALSE);
if (ixa == NULL || ixa->ixa_ire == NULL) {
if (ixa != NULL)
ixa_refrele(ixa);
break;
}
(void) ip_get_pmtu(ixa);
mutex_enter(&connp->conn_lock);
ipha = (ipha_t *)connp->conn_ht_iphc;
if (ixa->ixa_flags & IXAF_PMTU_IPV4_DF) {
ipha->ipha_fragment_offset_and_flags |=
IPH_DF_HTONS;
} else {
ipha->ipha_fragment_offset_and_flags &=
~IPH_DF_HTONS;
}
mutex_exit(&connp->conn_lock);
ixa_refrele(ixa);
break;
}
case ICMP_PORT_UNREACHABLE:
case ICMP_PROTOCOL_UNREACHABLE:
error = ECONNREFUSED;
break;
default:
break;
}
break;
default:
break;
}
if (error == 0) {
freemsg(mp);
return;
}
if (!connp->conn_dgram_errind) {
freemsg(mp);
return;
}
switch (connp->conn_family) {
case AF_INET:
sin = sin_null;
sin.sin_family = AF_INET;
sin.sin_addr.s_addr = ipha->ipha_dst;
sin.sin_port = udpha->uha_dst_port;
if (IPCL_IS_NONSTR(connp)) {
mutex_enter(&connp->conn_lock);
if (udp->udp_state == TS_DATA_XFER) {
if (sin.sin_port == connp->conn_fport &&
sin.sin_addr.s_addr ==
connp->conn_faddr_v4) {
mutex_exit(&connp->conn_lock);
(*connp->conn_upcalls->su_set_error)
(connp->conn_upper_handle, error);
goto done;
}
} else {
udp->udp_delayed_error = error;
*((sin_t *)&udp->udp_delayed_addr) = sin;
}
mutex_exit(&connp->conn_lock);
} else {
mp1 = mi_tpi_uderror_ind((char *)&sin, sizeof (sin_t),
NULL, 0, error);
if (mp1 != NULL)
putnext(connp->conn_rq, mp1);
}
break;
case AF_INET6:
sin6 = sin6_null;
sin6.sin6_family = AF_INET6;
IN6_IPADDR_TO_V4MAPPED(ipha->ipha_dst, &sin6.sin6_addr);
sin6.sin6_port = udpha->uha_dst_port;
if (IPCL_IS_NONSTR(connp)) {
mutex_enter(&connp->conn_lock);
if (udp->udp_state == TS_DATA_XFER) {
if (sin6.sin6_port == connp->conn_fport &&
IN6_ARE_ADDR_EQUAL(&sin6.sin6_addr,
&connp->conn_faddr_v6)) {
mutex_exit(&connp->conn_lock);
(*connp->conn_upcalls->su_set_error)
(connp->conn_upper_handle, error);
goto done;
}
} else {
udp->udp_delayed_error = error;
*((sin6_t *)&udp->udp_delayed_addr) = sin6;
}
mutex_exit(&connp->conn_lock);
} else {
mp1 = mi_tpi_uderror_ind((char *)&sin6, sizeof (sin6_t),
NULL, 0, error);
if (mp1 != NULL)
putnext(connp->conn_rq, mp1);
}
break;
}
done:
freemsg(mp);
}
static void
udp_icmp_error_ipv6(conn_t *connp, mblk_t *mp, ip_recv_attr_t *ira)
{
icmp6_t *icmp6;
ip6_t *ip6h, *outer_ip6h;
uint16_t iph_hdr_length;
uint8_t *nexthdrp;
udpha_t *udpha;
sin6_t sin6;
mblk_t *mp1;
int error = 0;
udp_t *udp = connp->conn_udp;
udp_stack_t *us = udp->udp_us;
outer_ip6h = (ip6_t *)mp->b_rptr;
#ifdef DEBUG
if (outer_ip6h->ip6_nxt != IPPROTO_ICMPV6)
iph_hdr_length = ip_hdr_length_v6(mp, outer_ip6h);
else
iph_hdr_length = IPV6_HDR_LEN;
ASSERT(iph_hdr_length == ira->ira_ip_hdr_length);
#endif
iph_hdr_length = ira->ira_ip_hdr_length;
icmp6 = (icmp6_t *)&mp->b_rptr[iph_hdr_length];
ip6h = (ip6_t *)&icmp6[1];
if (!ip_hdr_length_nexthdr_v6(mp, ip6h, &iph_hdr_length, &nexthdrp)) {
freemsg(mp);
return;
}
udpha = (udpha_t *)((char *)ip6h + iph_hdr_length);
switch (icmp6->icmp6_type) {
case ICMP6_DST_UNREACH:
switch (icmp6->icmp6_code) {
case ICMP6_DST_UNREACH_NOPORT:
error = ECONNREFUSED;
break;
case ICMP6_DST_UNREACH_ADMIN:
case ICMP6_DST_UNREACH_NOROUTE:
case ICMP6_DST_UNREACH_BEYONDSCOPE:
case ICMP6_DST_UNREACH_ADDR:
break;
default:
break;
}
break;
case ICMP6_PACKET_TOO_BIG: {
struct T_unitdata_ind *tudi;
struct T_opthdr *toh;
size_t udi_size;
mblk_t *newmp;
t_scalar_t opt_length = sizeof (struct T_opthdr) +
sizeof (struct ip6_mtuinfo);
sin6_t *sin6;
struct ip6_mtuinfo *mtuinfo;
if (!connp->conn_ipv6_recvpathmtu)
break;
udi_size = sizeof (struct T_unitdata_ind) + sizeof (sin6_t) +
opt_length;
if ((newmp = allocb(udi_size, BPRI_MED)) == NULL) {
UDPS_BUMP_MIB(us, udpInErrors);
break;
}
newmp->b_datap->db_type = M_PROTO;
tudi = (struct T_unitdata_ind *)newmp->b_rptr;
newmp->b_wptr = (uchar_t *)tudi + udi_size;
tudi->PRIM_type = T_UNITDATA_IND;
tudi->SRC_length = sizeof (sin6_t);
tudi->SRC_offset = sizeof (struct T_unitdata_ind);
tudi->OPT_offset = tudi->SRC_offset + sizeof (sin6_t);
tudi->OPT_length = opt_length;
sin6 = (sin6_t *)&tudi[1];
bzero(sin6, sizeof (sin6_t));
sin6->sin6_family = AF_INET6;
sin6->sin6_addr = connp->conn_faddr_v6;
toh = (struct T_opthdr *)&sin6[1];
toh->level = IPPROTO_IPV6;
toh->name = IPV6_PATHMTU;
toh->len = opt_length;
toh->status = 0;
mtuinfo = (struct ip6_mtuinfo *)&toh[1];
bzero(mtuinfo, sizeof (struct ip6_mtuinfo));
mtuinfo->ip6m_addr.sin6_family = AF_INET6;
mtuinfo->ip6m_addr.sin6_addr = ip6h->ip6_dst;
mtuinfo->ip6m_mtu = icmp6->icmp6_mtu;
freemsg(mp);
udp_ulp_recv(connp, newmp, msgdsize(newmp), ira);
return;
}
case ICMP6_TIME_EXCEEDED:
break;
case ICMP6_PARAM_PROB:
if (icmp6->icmp6_code == ICMP6_PARAMPROB_NEXTHEADER &&
(uchar_t *)ip6h + icmp6->icmp6_pptr ==
(uchar_t *)nexthdrp) {
error = ECONNREFUSED;
break;
}
break;
}
if (error == 0) {
freemsg(mp);
return;
}
if (!connp->conn_dgram_errind) {
freemsg(mp);
return;
}
sin6 = sin6_null;
sin6.sin6_family = AF_INET6;
sin6.sin6_addr = ip6h->ip6_dst;
sin6.sin6_port = udpha->uha_dst_port;
sin6.sin6_flowinfo = ip6h->ip6_vcf & ~IPV6_VERS_AND_FLOW_MASK;
if (IPCL_IS_NONSTR(connp)) {
mutex_enter(&connp->conn_lock);
if (udp->udp_state == TS_DATA_XFER) {
if (sin6.sin6_port == connp->conn_fport &&
IN6_ARE_ADDR_EQUAL(&sin6.sin6_addr,
&connp->conn_faddr_v6)) {
mutex_exit(&connp->conn_lock);
(*connp->conn_upcalls->su_set_error)
(connp->conn_upper_handle, error);
goto done;
}
} else {
udp->udp_delayed_error = error;
*((sin6_t *)&udp->udp_delayed_addr) = sin6;
}
mutex_exit(&connp->conn_lock);
} else {
mp1 = mi_tpi_uderror_ind((char *)&sin6, sizeof (sin6_t),
NULL, 0, error);
if (mp1 != NULL)
putnext(connp->conn_rq, mp1);
}
done:
freemsg(mp);
}
static void
udp_addr_req(queue_t *q, mblk_t *mp)
{
struct sockaddr *sa;
mblk_t *ackmp;
struct T_addr_ack *taa;
udp_t *udp = Q_TO_UDP(q);
conn_t *connp = udp->udp_connp;
uint_t addrlen;
ackmp = reallocb(mp, sizeof (struct T_addr_ack) +
2 * sizeof (sin6_t), 1);
if (ackmp == NULL) {
udp_err_ack(q, mp, TSYSERR, ENOMEM);
return;
}
taa = (struct T_addr_ack *)ackmp->b_rptr;
bzero(taa, sizeof (struct T_addr_ack));
ackmp->b_wptr = (uchar_t *)&taa[1];
taa->PRIM_type = T_ADDR_ACK;
ackmp->b_datap->db_type = M_PCPROTO;
if (connp->conn_family == AF_INET)
addrlen = sizeof (sin_t);
else
addrlen = sizeof (sin6_t);
mutex_enter(&connp->conn_lock);
if (udp->udp_state != TS_UNBND) {
taa->LOCADDR_offset = sizeof (*taa);
taa->LOCADDR_length = addrlen;
sa = (struct sockaddr *)&taa[1];
(void) conn_getsockname(connp, sa, &addrlen);
ackmp->b_wptr += addrlen;
}
if (udp->udp_state == TS_DATA_XFER) {
taa->REMADDR_length = addrlen;
taa->REMADDR_offset = taa->LOCADDR_offset + taa->LOCADDR_length;
sa = (struct sockaddr *)(ackmp->b_rptr + taa->REMADDR_offset);
(void) conn_getpeername(connp, sa, &addrlen);
ackmp->b_wptr += addrlen;
}
mutex_exit(&connp->conn_lock);
ASSERT(ackmp->b_wptr <= ackmp->b_datap->db_lim);
qreply(q, ackmp);
}
static void
udp_copy_info(struct T_info_ack *tap, udp_t *udp)
{
conn_t *connp = udp->udp_connp;
if (connp->conn_family == AF_INET) {
*tap = udp_g_t_info_ack_ipv4;
} else {
*tap = udp_g_t_info_ack_ipv6;
}
tap->CURRENT_state = udp->udp_state;
tap->OPT_size = udp_max_optsize;
}
static void
udp_do_capability_ack(udp_t *udp, struct T_capability_ack *tcap,
t_uscalar_t cap_bits1)
{
tcap->CAP_bits1 = 0;
if (cap_bits1 & TC1_INFO) {
udp_copy_info(&tcap->INFO_ack, udp);
tcap->CAP_bits1 |= TC1_INFO;
}
}
static void
udp_capability_req(queue_t *q, mblk_t *mp)
{
t_uscalar_t cap_bits1;
struct T_capability_ack *tcap;
udp_t *udp = Q_TO_UDP(q);
cap_bits1 = ((struct T_capability_req *)mp->b_rptr)->CAP_bits1;
mp = tpi_ack_alloc(mp, sizeof (struct T_capability_ack),
mp->b_datap->db_type, T_CAPABILITY_ACK);
if (!mp)
return;
tcap = (struct T_capability_ack *)mp->b_rptr;
udp_do_capability_ack(udp, tcap, cap_bits1);
qreply(q, mp);
}
static void
udp_info_req(queue_t *q, mblk_t *mp)
{
udp_t *udp = Q_TO_UDP(q);
mp = tpi_ack_alloc(mp, sizeof (struct T_info_ack), M_PCPROTO,
T_INFO_ACK);
if (!mp)
return;
udp_copy_info((struct T_info_ack *)mp->b_rptr, udp);
qreply(q, mp);
}
static int
udp_openv4(queue_t *q, dev_t *devp, int flag, int sflag, cred_t *credp)
{
return (udp_open(q, devp, flag, sflag, credp, B_FALSE));
}
static int
udp_openv6(queue_t *q, dev_t *devp, int flag, int sflag, cred_t *credp)
{
return (udp_open(q, devp, flag, sflag, credp, B_TRUE));
}
static int
udp_open(queue_t *q, dev_t *devp, int flag, int sflag, cred_t *credp,
boolean_t isv6)
{
udp_t *udp;
conn_t *connp;
dev_t conn_dev;
vmem_t *minor_arena;
int err;
if (q->q_ptr != NULL)
return (0);
if (sflag == MODOPEN)
return (EINVAL);
if ((ip_minor_arena_la != NULL) && (flag & SO_SOCKSTR) &&
((conn_dev = inet_minor_alloc(ip_minor_arena_la)) != 0)) {
minor_arena = ip_minor_arena_la;
} else {
if ((conn_dev = inet_minor_alloc(ip_minor_arena_sa)) == 0)
return (EBUSY);
minor_arena = ip_minor_arena_sa;
}
if (flag & SO_FALLBACK) {
RD(q)->q_ptr = (void *)conn_dev;
WR(q)->q_qinfo = &udp_fallback_sock_winit;
WR(q)->q_ptr = (void *)minor_arena;
qprocson(q);
return (0);
}
connp = udp_do_open(credp, isv6, KM_SLEEP, &err);
if (connp == NULL) {
inet_minor_free(minor_arena, conn_dev);
return (err);
}
udp = connp->conn_udp;
*devp = makedevice(getemajor(*devp), (minor_t)conn_dev);
connp->conn_dev = conn_dev;
connp->conn_minor_arena = minor_arena;
q->q_ptr = connp;
WR(q)->q_ptr = connp;
connp->conn_rq = q;
connp->conn_wq = WR(q);
ASSERT(connp->conn_proto == IPPROTO_UDP);
ASSERT(connp->conn_udp == udp);
ASSERT(udp->udp_connp == connp);
if (flag & SO_SOCKSTR) {
udp->udp_issocket = B_TRUE;
}
WR(q)->q_hiwat = connp->conn_sndbuf;
WR(q)->q_lowat = connp->conn_sndlowat;
qprocson(q);
(void) proto_set_tx_wroff(q, connp, connp->conn_wroff);
(void) proto_set_rx_hiwat(q, connp,
udp_set_rcv_hiwat(udp, connp->conn_rcvbuf));
mutex_enter(&connp->conn_lock);
connp->conn_state_flags &= ~CONN_INCIPIENT;
mutex_exit(&connp->conn_lock);
return (0);
}
static boolean_t
udp_opt_allow_udr_set(t_scalar_t level, t_scalar_t name)
{
return (B_TRUE);
}
int
udp_opt_default(queue_t *q, t_scalar_t level, t_scalar_t name, uchar_t *ptr)
{
udp_t *udp = Q_TO_UDP(q);
udp_stack_t *us = udp->udp_us;
int *i1 = (int *)ptr;
switch (level) {
case IPPROTO_IP:
switch (name) {
case IP_MULTICAST_TTL:
*ptr = (uchar_t)IP_DEFAULT_MULTICAST_TTL;
return (sizeof (uchar_t));
case IP_MULTICAST_LOOP:
*ptr = (uchar_t)IP_DEFAULT_MULTICAST_LOOP;
return (sizeof (uchar_t));
}
break;
case IPPROTO_IPV6:
switch (name) {
case IPV6_MULTICAST_HOPS:
*i1 = IP_DEFAULT_MULTICAST_TTL;
return (sizeof (int));
case IPV6_MULTICAST_LOOP:
*i1 = IP_DEFAULT_MULTICAST_LOOP;
return (sizeof (int));
case IPV6_UNICAST_HOPS:
*i1 = us->us_ipv6_hoplimit;
return (sizeof (int));
}
break;
}
return (-1);
}
int
udp_opt_get(conn_t *connp, t_scalar_t level, t_scalar_t name,
uchar_t *ptr)
{
int *i1 = (int *)ptr;
udp_t *udp = connp->conn_udp;
int len;
conn_opt_arg_t coas;
int retval;
coas.coa_connp = connp;
coas.coa_ixa = connp->conn_ixa;
coas.coa_ipp = &connp->conn_xmit_ipp;
coas.coa_ancillary = B_FALSE;
coas.coa_changed = 0;
switch (level) {
case IPPROTO_IP:
if (connp->conn_family != AF_INET)
return (-1);
switch (name) {
case IP_OPTIONS:
case T_IP_OPTIONS:
mutex_enter(&connp->conn_lock);
if (!(udp->udp_recv_ipp.ipp_fields &
IPPF_IPV4_OPTIONS)) {
mutex_exit(&connp->conn_lock);
return (0);
}
len = udp->udp_recv_ipp.ipp_ipv4_options_len;
ASSERT(len != 0);
bcopy(udp->udp_recv_ipp.ipp_ipv4_options, ptr, len);
mutex_exit(&connp->conn_lock);
return (len);
}
break;
case IPPROTO_UDP:
switch (name) {
case UDP_NAT_T_ENDPOINT:
mutex_enter(&connp->conn_lock);
*i1 = udp->udp_nat_t_endpoint;
mutex_exit(&connp->conn_lock);
return (sizeof (int));
case UDP_RCVHDR:
mutex_enter(&connp->conn_lock);
*i1 = udp->udp_rcvhdr ? 1 : 0;
mutex_exit(&connp->conn_lock);
return (sizeof (int));
case UDP_SRCPORT_HASH:
mutex_enter(&connp->conn_lock);
*i1 = udp->udp_vxlanhash;
mutex_exit(&connp->conn_lock);
return (sizeof (int));
}
}
mutex_enter(&connp->conn_lock);
retval = conn_opt_get(&coas, level, name, ptr);
mutex_exit(&connp->conn_lock);
return (retval);
}
int
udp_tpi_opt_get(queue_t *q, t_scalar_t level, t_scalar_t name, uchar_t *ptr)
{
conn_t *connp = Q_TO_CONN(q);
int err;
err = udp_opt_get(connp, level, name, ptr);
return (err);
}
int
udp_do_opt_set(conn_opt_arg_t *coa, int level, int name,
uint_t inlen, uchar_t *invalp, cred_t *cr, boolean_t checkonly)
{
conn_t *connp = coa->coa_connp;
ip_xmit_attr_t *ixa = coa->coa_ixa;
udp_t *udp = connp->conn_udp;
udp_stack_t *us = udp->udp_us;
int *i1 = (int *)invalp;
boolean_t onoff = (*i1 == 0) ? 0 : 1;
int error;
ASSERT(MUTEX_NOT_HELD(&coa->coa_connp->conn_lock));
switch (level) {
case SOL_SOCKET:
switch (name) {
case SO_SNDBUF:
if (*i1 > us->us_max_buf) {
return (ENOBUFS);
}
break;
case SO_RCVBUF:
if (*i1 > us->us_max_buf) {
return (ENOBUFS);
}
break;
case SCM_UCRED: {
struct ucred_s *ucr;
cred_t *newcr;
ts_label_t *tsl;
if (connp->conn_mlp_type == mlptSingle)
break;
ucr = (struct ucred_s *)invalp;
if (inlen < sizeof (*ucr) + sizeof (bslabel_t) ||
ucr->uc_labeloff < sizeof (*ucr) ||
ucr->uc_labeloff + sizeof (bslabel_t) > inlen)
return (EINVAL);
if (!checkonly) {
ASSERT(cr != NULL);
if ((tsl = crgetlabel(cr)) == NULL)
return (EINVAL);
newcr = copycred_from_bslabel(cr, UCLABEL(ucr),
tsl->tsl_doi, KM_NOSLEEP);
if (newcr == NULL)
return (ENOSR);
ASSERT(newcr->cr_label != NULL);
ip_xmit_attr_replace_tsl(ixa, newcr->cr_label);
ixa->ixa_flags |= IXAF_UCRED_TSL;
newcr->cr_label = NULL;
crfree(newcr);
coa->coa_changed |= COA_HEADER_CHANGED;
coa->coa_changed |= COA_WROFF_CHANGED;
}
return (0);
}
}
break;
case IPPROTO_UDP:
switch (name) {
case UDP_NAT_T_ENDPOINT:
if ((error = secpolicy_ip_config(cr, B_FALSE)) != 0) {
return (error);
}
if (connp->conn_family != AF_INET) {
return (EAFNOSUPPORT);
}
if (!checkonly) {
mutex_enter(&connp->conn_lock);
udp->udp_nat_t_endpoint = onoff;
mutex_exit(&connp->conn_lock);
coa->coa_changed |= COA_HEADER_CHANGED;
coa->coa_changed |= COA_WROFF_CHANGED;
}
return (0);
case UDP_RCVHDR:
mutex_enter(&connp->conn_lock);
udp->udp_rcvhdr = onoff;
mutex_exit(&connp->conn_lock);
return (0);
case UDP_SRCPORT_HASH:
if ((error = secpolicy_ip_config(cr, B_FALSE)) != 0) {
return (error);
}
if (*i1 != UDP_HASH_DISABLE && *i1 != UDP_HASH_VXLAN)
return (EINVAL);
if (!checkonly) {
mutex_enter(&connp->conn_lock);
udp->udp_vxlanhash = *i1;
mutex_exit(&connp->conn_lock);
}
return (0);
}
break;
}
error = conn_opt_set(coa, level, name, inlen, invalp,
checkonly, cr);
return (error);
}
int
udp_opt_set(conn_t *connp, uint_t optset_context, int level,
int name, uint_t inlen, uchar_t *invalp, uint_t *outlenp,
uchar_t *outvalp, void *thisdg_attrs, cred_t *cr)
{
udp_t *udp = connp->conn_udp;
int err;
conn_opt_arg_t coas, *coa;
boolean_t checkonly;
udp_stack_t *us = udp->udp_us;
switch (optset_context) {
case SETFN_OPTCOM_CHECKONLY:
checkonly = B_TRUE;
if (inlen == 0) {
*outlenp = 0;
return (0);
}
break;
case SETFN_OPTCOM_NEGOTIATE:
checkonly = B_FALSE;
break;
case SETFN_UD_NEGOTIATE:
case SETFN_CONN_NEGOTIATE:
checkonly = B_FALSE;
if (!udp_opt_allow_udr_set(level, name)) {
*outlenp = 0;
return (EINVAL);
}
break;
default:
*outlenp = 0;
return (EINVAL);
}
ASSERT((optset_context != SETFN_OPTCOM_CHECKONLY) ||
(optset_context == SETFN_OPTCOM_CHECKONLY && inlen != 0));
if (thisdg_attrs != NULL) {
coa = (conn_opt_arg_t *)thisdg_attrs;
ASSERT(coa->coa_connp == connp);
ASSERT(coa->coa_ixa != NULL);
ASSERT(coa->coa_ipp != NULL);
ASSERT(coa->coa_ancillary);
} else {
coa = &coas;
coas.coa_connp = connp;
coas.coa_ixa = conn_get_ixa(connp, B_TRUE);
if (coas.coa_ixa == NULL) {
*outlenp = 0;
return (ENOMEM);
}
coas.coa_ipp = &connp->conn_xmit_ipp;
coas.coa_ancillary = B_FALSE;
coas.coa_changed = 0;
}
err = udp_do_opt_set(coa, level, name, inlen, invalp,
cr, checkonly);
if (err != 0) {
errout:
if (!coa->coa_ancillary)
ixa_refrele(coa->coa_ixa);
*outlenp = 0;
return (err);
}
if (level == IPPROTO_IP && name == IP_DHCPINIT_IF) {
uint_t ifindex;
ill_t *ill;
ifindex = *(uint_t *)invalp;
if (ifindex == 0) {
ill = NULL;
} else {
ill = ill_lookup_on_ifindex(ifindex, B_FALSE,
coa->coa_ixa->ixa_ipst);
if (ill == NULL) {
err = ENXIO;
goto errout;
}
mutex_enter(&ill->ill_lock);
if (ill->ill_state_flags & ILL_CONDEMNED) {
mutex_exit(&ill->ill_lock);
ill_refrele(ill);
err = ENXIO;
goto errout;
}
if (IS_VNI(ill)) {
mutex_exit(&ill->ill_lock);
ill_refrele(ill);
err = EINVAL;
goto errout;
}
}
mutex_enter(&connp->conn_lock);
if (connp->conn_dhcpinit_ill != NULL) {
ill_t *oill = connp->conn_dhcpinit_ill;
ASSERT(oill->ill_dhcpinit != 0);
atomic_dec_32(&oill->ill_dhcpinit);
ill_set_inputfn(connp->conn_dhcpinit_ill);
connp->conn_dhcpinit_ill = NULL;
}
if (ill != NULL) {
connp->conn_dhcpinit_ill = ill;
atomic_inc_32(&ill->ill_dhcpinit);
ill_set_inputfn(ill);
mutex_exit(&connp->conn_lock);
mutex_exit(&ill->ill_lock);
ill_refrele(ill);
} else {
mutex_exit(&connp->conn_lock);
}
}
if (invalp != outvalp) {
(void) bcopy(invalp, outvalp, inlen);
}
*outlenp = inlen;
if (coa->coa_ancillary) {
return (0);
}
if (coa->coa_changed & COA_ROUTE_CHANGED) {
in6_addr_t saddr, faddr, nexthop;
in_port_t fport;
mutex_enter(&connp->conn_lock);
connp->conn_v6lastdst = ipv6_all_zeros;
ip_attr_nexthop(coa->coa_ipp, coa->coa_ixa,
&connp->conn_faddr_v6, &nexthop);
saddr = connp->conn_saddr_v6;
faddr = connp->conn_faddr_v6;
fport = connp->conn_fport;
mutex_exit(&connp->conn_lock);
if (!IN6_IS_ADDR_UNSPECIFIED(&faddr) &&
!IN6_IS_ADDR_V4MAPPED_ANY(&faddr)) {
(void) ip_attr_connect(connp, coa->coa_ixa,
&saddr, &faddr, &nexthop, fport, NULL, NULL,
IPDF_ALLOW_MCBC | IPDF_VERIFY_DST);
}
}
ixa_refrele(coa->coa_ixa);
if (coa->coa_changed & COA_HEADER_CHANGED) {
mutex_enter(&connp->conn_lock);
if (!IN6_IS_ADDR_UNSPECIFIED(&connp->conn_faddr_v6) &&
!IN6_IS_ADDR_V4MAPPED_ANY(&connp->conn_faddr_v6)) {
err = udp_build_hdr_template(connp,
&connp->conn_saddr_v6, &connp->conn_faddr_v6,
connp->conn_fport, connp->conn_flowinfo);
if (err != 0) {
mutex_exit(&connp->conn_lock);
return (err);
}
} else {
connp->conn_v6lastdst = ipv6_all_zeros;
}
mutex_exit(&connp->conn_lock);
}
if (coa->coa_changed & COA_RCVBUF_CHANGED) {
(void) proto_set_rx_hiwat(connp->conn_rq, connp,
connp->conn_rcvbuf);
}
if ((coa->coa_changed & COA_SNDBUF_CHANGED) && !IPCL_IS_NONSTR(connp)) {
connp->conn_wq->q_hiwat = connp->conn_sndbuf;
}
if (coa->coa_changed & COA_WROFF_CHANGED) {
uint_t wroff;
mutex_enter(&connp->conn_lock);
wroff = connp->conn_ht_iphc_allocated + us->us_wroff_extra;
if (udp->udp_nat_t_endpoint)
wroff += sizeof (uint32_t);
if (wroff > connp->conn_wroff) {
connp->conn_wroff = wroff;
mutex_exit(&connp->conn_lock);
(void) proto_set_tx_wroff(connp->conn_rq, connp, wroff);
} else {
mutex_exit(&connp->conn_lock);
}
}
return (err);
}
int
udp_tpi_opt_set(queue_t *q, uint_t optset_context, int level, int name,
uint_t inlen, uchar_t *invalp, uint_t *outlenp, uchar_t *outvalp,
void *thisdg_attrs, cred_t *cr)
{
conn_t *connp = Q_TO_CONN(q);
int error;
error = udp_opt_set(connp, optset_context, level, name, inlen, invalp,
outlenp, outvalp, thisdg_attrs, cr);
return (error);
}
mblk_t *
udp_prepend_hdr(conn_t *connp, ip_xmit_attr_t *ixa, const ip_pkt_t *ipp,
const in6_addr_t *v6src, const in6_addr_t *v6dst, in_port_t dstport,
uint32_t flowinfo, mblk_t *data_mp, int *errorp)
{
mblk_t *mp;
udpha_t *udpha;
udp_stack_t *us = connp->conn_netstack->netstack_udp;
uint_t data_len;
uint32_t cksum;
udp_t *udp = connp->conn_udp;
boolean_t insert_spi = udp->udp_nat_t_endpoint;
boolean_t hash_srcport = udp->udp_vxlanhash;
uint_t ulp_hdr_len;
uint16_t srcport;
data_len = msgdsize(data_mp);
ulp_hdr_len = UDPH_SIZE;
if (insert_spi)
ulp_hdr_len += sizeof (uint32_t);
if (hash_srcport == B_TRUE) {
srcport = udp_srcport_hash(mp, UDP_HASH_VXLAN,
IPPORT_DYNAMIC_MIN, IPPORT_DYNAMIC_MAX,
ntohs(connp->conn_lport));
}
mp = conn_prepend_hdr(ixa, ipp, v6src, v6dst, IPPROTO_UDP, flowinfo,
ulp_hdr_len, data_mp, data_len, us->us_wroff_extra, &cksum, errorp);
if (mp == NULL) {
ASSERT(*errorp != 0);
return (NULL);
}
data_len += ulp_hdr_len;
ixa->ixa_pktlen = data_len + ixa->ixa_ip_hdr_length;
udpha = (udpha_t *)(mp->b_rptr + ixa->ixa_ip_hdr_length);
if (hash_srcport == B_TRUE) {
udpha->uha_src_port = htons(srcport);
} else {
udpha->uha_src_port = connp->conn_lport;
}
udpha->uha_dst_port = dstport;
udpha->uha_checksum = 0;
udpha->uha_length = htons(data_len);
cksum += data_len;
cksum = (cksum >> 16) + (cksum & 0xFFFF);
ASSERT(cksum < 0x10000);
if (ixa->ixa_flags & IXAF_IS_IPV4) {
ipha_t *ipha = (ipha_t *)mp->b_rptr;
ASSERT(ntohs(ipha->ipha_length) == ixa->ixa_pktlen);
if (us->us_do_checksum) {
if (cksum == 0)
udpha->uha_checksum = 0xffff;
else
udpha->uha_checksum = htons(cksum);
} else {
udpha->uha_checksum = 0;
}
} else {
ip6_t *ip6h = (ip6_t *)mp->b_rptr;
ASSERT(ntohs(ip6h->ip6_plen) + IPV6_HDR_LEN == ixa->ixa_pktlen);
if (cksum == 0)
udpha->uha_checksum = 0xffff;
else
udpha->uha_checksum = htons(cksum);
}
if (insert_spi)
*((uint32_t *)(udpha + 1)) = 0;
return (mp);
}
static int
udp_build_hdr_template(conn_t *connp, const in6_addr_t *v6src,
const in6_addr_t *v6dst, in_port_t dstport, uint32_t flowinfo)
{
udpha_t *udpha;
int error;
ASSERT(MUTEX_HELD(&connp->conn_lock));
connp->conn_v6lastdst = ipv6_all_zeros;
error = conn_build_hdr_template(connp, UDPH_SIZE, 0, v6src, v6dst,
flowinfo);
if (error != 0)
return (error);
udpha = (udpha_t *)connp->conn_ht_ulp;
udpha->uha_src_port = connp->conn_lport;
udpha->uha_dst_port = dstport;
udpha->uha_checksum = 0;
udpha->uha_length = htons(UDPH_SIZE);
return (0);
}
static mblk_t *
udp_queue_fallback(udp_t *udp, mblk_t *mp)
{
ASSERT(MUTEX_HELD(&udp->udp_recv_lock));
if (IPCL_IS_NONSTR(udp->udp_connp)) {
if (udp->udp_fallback_queue_head == NULL) {
ASSERT(udp->udp_fallback_queue_tail == NULL);
udp->udp_fallback_queue_head = mp;
udp->udp_fallback_queue_tail = mp;
} else {
ASSERT(udp->udp_fallback_queue_tail != NULL);
udp->udp_fallback_queue_tail->b_next = mp;
udp->udp_fallback_queue_tail = mp;
}
return (NULL);
} else {
return (mp);
}
}
static void
udp_ulp_recv(conn_t *connp, mblk_t *mp, uint_t len, ip_recv_attr_t *ira)
{
if (IPCL_IS_NONSTR(connp)) {
udp_t *udp = connp->conn_udp;
int error;
ASSERT(len == msgdsize(mp));
if ((*connp->conn_upcalls->su_recv)
(connp->conn_upper_handle, mp, len, 0, &error, NULL) < 0) {
mutex_enter(&udp->udp_recv_lock);
if (error == ENOSPC) {
if ((*connp->conn_upcalls->su_recv)
(connp->conn_upper_handle, NULL, 0, 0,
&error, NULL) < 0) {
ASSERT(error == ENOSPC);
if (error == ENOSPC) {
connp->conn_flow_cntrld =
B_TRUE;
}
}
mutex_exit(&udp->udp_recv_lock);
} else {
ASSERT(error == EOPNOTSUPP);
mp = udp_queue_fallback(udp, mp);
mutex_exit(&udp->udp_recv_lock);
if (mp != NULL)
putnext(connp->conn_rq, mp);
}
}
ASSERT(MUTEX_NOT_HELD(&udp->udp_recv_lock));
} else {
if (is_system_labeled()) {
ASSERT(ira->ira_cred != NULL);
mblk_setcred(mp, ira->ira_cred, NOPID);
}
putnext(connp->conn_rq, mp);
}
}
static void
udp_input(void *arg1, mblk_t *mp, void *arg2, ip_recv_attr_t *ira)
{
conn_t *connp = (conn_t *)arg1;
struct T_unitdata_ind *tudi;
uchar_t *rptr;
int hdr_length;
int udi_size;
int pkt_len;
udp_t *udp;
udpha_t *udpha;
ip_pkt_t ipps;
ip6_t *ip6h;
mblk_t *mp1;
uint32_t udp_ipv4_options_len;
crb_t recv_ancillary;
udp_stack_t *us;
ASSERT(connp->conn_flags & IPCL_UDPCONN);
udp = connp->conn_udp;
us = udp->udp_us;
rptr = mp->b_rptr;
ASSERT(DB_TYPE(mp) == M_DATA);
ASSERT(OK_32PTR(rptr));
ASSERT(ira->ira_pktlen == msgdsize(mp));
pkt_len = ira->ira_pktlen;
mutex_enter(&connp->conn_lock);
udp_ipv4_options_len = udp->udp_recv_ipp.ipp_ipv4_options_len;
recv_ancillary = connp->conn_recv_ancillary;
mutex_exit(&connp->conn_lock);
hdr_length = ira->ira_ip_hdr_length;
udpha = (udpha_t *)(rptr + hdr_length);
if (pkt_len != ntohs(udpha->uha_length) + hdr_length)
goto tossit;
hdr_length += UDPH_SIZE;
ASSERT(MBLKL(mp) >= hdr_length);
ipps.ipp_fields = 0;
if (((ira->ira_flags & IRAF_IPV4_OPTIONS) ||
udp_ipv4_options_len > 0) &&
connp->conn_family == AF_INET) {
int err;
mutex_enter(&connp->conn_lock);
err = ip_find_hdr_v4((ipha_t *)rptr, &udp->udp_recv_ipp,
B_TRUE);
if (err != 0) {
mutex_exit(&connp->conn_lock);
freemsg(mp);
UDPS_BUMP_MIB(us, udpInErrors);
return;
}
mutex_exit(&connp->conn_lock);
}
if (recv_ancillary.crb_all != 0) {
if (ira->ira_flags & IRAF_IS_IPV4) {
ASSERT(IPH_HDR_VERSION(rptr) == IPV4_VERSION);
ASSERT(MBLKL(mp) >= sizeof (ipha_t));
ASSERT(((ipha_t *)rptr)->ipha_protocol == IPPROTO_UDP);
ASSERT(ira->ira_ip_hdr_length == IPH_HDR_LENGTH(rptr));
(void) ip_find_hdr_v4((ipha_t *)rptr, &ipps, B_FALSE);
} else {
uint8_t nexthdrp;
ASSERT(IPH_HDR_VERSION(rptr) == IPV6_VERSION);
ASSERT(connp->conn_family == AF_INET6);
ip6h = (ip6_t *)rptr;
hdr_length = ip_find_hdr_v6(mp, ip6h, B_TRUE, &ipps,
&nexthdrp);
ASSERT(hdr_length == ira->ira_ip_hdr_length);
hdr_length = ira->ira_ip_hdr_length + UDPH_SIZE;
ASSERT(nexthdrp == IPPROTO_UDP);
}
}
if (connp->conn_family == AF_INET) {
sin_t *sin;
ASSERT(IPH_HDR_VERSION((ipha_t *)rptr) == IPV4_VERSION);
udi_size = sizeof (struct T_unitdata_ind) + sizeof (sin_t);
if (recv_ancillary.crb_all != 0) {
udi_size += conn_recvancillary_size(connp,
recv_ancillary, ira, mp, &ipps);
}
mp1 = allocb(udi_size, BPRI_MED);
if (mp1 == NULL) {
freemsg(mp);
UDPS_BUMP_MIB(us, udpInErrors);
return;
}
mp1->b_cont = mp;
mp1->b_datap->db_type = M_PROTO;
tudi = (struct T_unitdata_ind *)mp1->b_rptr;
mp1->b_wptr = (uchar_t *)tudi + udi_size;
tudi->PRIM_type = T_UNITDATA_IND;
tudi->SRC_length = sizeof (sin_t);
tudi->SRC_offset = sizeof (struct T_unitdata_ind);
tudi->OPT_offset = sizeof (struct T_unitdata_ind) +
sizeof (sin_t);
udi_size -= (sizeof (struct T_unitdata_ind) + sizeof (sin_t));
tudi->OPT_length = udi_size;
sin = (sin_t *)&tudi[1];
sin->sin_addr.s_addr = ((ipha_t *)rptr)->ipha_src;
sin->sin_port = udpha->uha_src_port;
sin->sin_family = connp->conn_family;
*(uint32_t *)&sin->sin_zero[0] = 0;
*(uint32_t *)&sin->sin_zero[4] = 0;
if (udi_size != 0) {
conn_recvancillary_add(connp, recv_ancillary, ira,
&ipps, (uchar_t *)&sin[1], udi_size);
}
} else {
sin6_t *sin6;
udi_size = sizeof (struct T_unitdata_ind) + sizeof (sin6_t);
if (recv_ancillary.crb_all != 0) {
udi_size += conn_recvancillary_size(connp,
recv_ancillary, ira, mp, &ipps);
}
mp1 = allocb(udi_size, BPRI_MED);
if (mp1 == NULL) {
freemsg(mp);
UDPS_BUMP_MIB(us, udpInErrors);
return;
}
mp1->b_cont = mp;
mp1->b_datap->db_type = M_PROTO;
tudi = (struct T_unitdata_ind *)mp1->b_rptr;
mp1->b_wptr = (uchar_t *)tudi + udi_size;
tudi->PRIM_type = T_UNITDATA_IND;
tudi->SRC_length = sizeof (sin6_t);
tudi->SRC_offset = sizeof (struct T_unitdata_ind);
tudi->OPT_offset = sizeof (struct T_unitdata_ind) +
sizeof (sin6_t);
udi_size -= (sizeof (struct T_unitdata_ind) + sizeof (sin6_t));
tudi->OPT_length = udi_size;
sin6 = (sin6_t *)&tudi[1];
if (ira->ira_flags & IRAF_IS_IPV4) {
in6_addr_t v6dst;
IN6_IPADDR_TO_V4MAPPED(((ipha_t *)rptr)->ipha_src,
&sin6->sin6_addr);
IN6_IPADDR_TO_V4MAPPED(((ipha_t *)rptr)->ipha_dst,
&v6dst);
sin6->sin6_flowinfo = 0;
sin6->sin6_scope_id = 0;
sin6->__sin6_src_id = ip_srcid_find_addr(&v6dst,
IPCL_ZONEID(connp), us->us_netstack);
} else {
ip6h = (ip6_t *)rptr;
sin6->sin6_addr = ip6h->ip6_src;
sin6->sin6_flowinfo = 0;
if (IN6_IS_ADDR_LINKSCOPE(&ip6h->ip6_src))
sin6->sin6_scope_id = ira->ira_ruifindex;
else
sin6->sin6_scope_id = 0;
sin6->__sin6_src_id = ip_srcid_find_addr(
&ip6h->ip6_dst, IPCL_ZONEID(connp),
us->us_netstack);
}
sin6->sin6_port = udpha->uha_src_port;
sin6->sin6_family = connp->conn_family;
if (udi_size != 0) {
conn_recvancillary_add(connp, recv_ancillary, ira,
&ipps, (uchar_t *)&sin6[1], udi_size);
}
}
DTRACE_UDP5(receive, mblk_t *, NULL, ip_xmit_attr_t *, connp->conn_ixa,
void_ip_t *, rptr, udp_t *, udp, udpha_t *, udpha);
if (!udp->udp_rcvhdr) {
mp->b_rptr = rptr + hdr_length;
pkt_len -= hdr_length;
}
UDPS_BUMP_MIB(us, udpHCInDatagrams);
udp_ulp_recv(connp, mp1, pkt_len, ira);
return;
tossit:
freemsg(mp);
UDPS_BUMP_MIB(us, udpInErrors);
}
static void
udp_ud_err(queue_t *q, mblk_t *mp, t_scalar_t err)
{
struct T_unitdata_req *tudr;
mblk_t *mp1;
uchar_t *destaddr;
t_scalar_t destlen;
uchar_t *optaddr;
t_scalar_t optlen;
if ((mp->b_wptr < mp->b_rptr) ||
(MBLKL(mp)) < sizeof (struct T_unitdata_req)) {
goto done;
}
tudr = (struct T_unitdata_req *)mp->b_rptr;
destaddr = mp->b_rptr + tudr->DEST_offset;
if (destaddr < mp->b_rptr || destaddr >= mp->b_wptr ||
destaddr + tudr->DEST_length < mp->b_rptr ||
destaddr + tudr->DEST_length > mp->b_wptr) {
goto done;
}
optaddr = mp->b_rptr + tudr->OPT_offset;
if (optaddr < mp->b_rptr || optaddr >= mp->b_wptr ||
optaddr + tudr->OPT_length < mp->b_rptr ||
optaddr + tudr->OPT_length > mp->b_wptr) {
goto done;
}
destlen = tudr->DEST_length;
optlen = tudr->OPT_length;
mp1 = mi_tpi_uderror_ind((char *)destaddr, destlen,
(char *)optaddr, optlen, err);
if (mp1 != NULL)
qreply(q, mp1);
done:
freemsg(mp);
}
static void
udp_tpi_unbind(queue_t *q, mblk_t *mp)
{
conn_t *connp = Q_TO_CONN(q);
int error;
error = udp_do_unbind(connp);
if (error) {
if (error < 0)
udp_err_ack(q, mp, -error, 0);
else
udp_err_ack(q, mp, TSYSERR, error);
return;
}
mp = mi_tpi_ok_ack_alloc(mp);
ASSERT(mp != NULL);
ASSERT(((struct T_ok_ack *)mp->b_rptr)->PRIM_type == T_OK_ACK);
qreply(q, mp);
}
static in_port_t
udp_update_next_port(udp_t *udp, in_port_t port, boolean_t random)
{
int i, bump;
in_port_t nextport;
boolean_t restart = B_FALSE;
udp_stack_t *us = udp->udp_us;
if (random && udp_random_anon_port != 0) {
(void) random_get_pseudo_bytes((uint8_t *)&port,
sizeof (in_port_t));
if ((port < us->us_smallest_anon_port) ||
(port > us->us_largest_anon_port)) {
if (us->us_smallest_anon_port ==
us->us_largest_anon_port) {
bump = 0;
} else {
bump = port % (us->us_largest_anon_port -
us->us_smallest_anon_port);
}
port = us->us_smallest_anon_port + bump;
}
}
retry:
if (port < us->us_smallest_anon_port)
port = us->us_smallest_anon_port;
if (port > us->us_largest_anon_port) {
port = us->us_smallest_anon_port;
if (restart)
return (0);
restart = B_TRUE;
}
if (port < us->us_smallest_nonpriv_port)
port = us->us_smallest_nonpriv_port;
for (i = 0; i < us->us_num_epriv_ports; i++) {
if (port == us->us_epriv_ports[i]) {
port++;
goto retry;
}
}
if (is_system_labeled() &&
(nextport = tsol_next_port(crgetzone(udp->udp_connp->conn_cred),
port, IPPROTO_UDP, B_TRUE)) != 0) {
port = nextport;
goto retry;
}
return (port);
}
static int
udp_output_ancillary(conn_t *connp, sin_t *sin, sin6_t *sin6, mblk_t *mp,
mblk_t *tudr_mp, struct nmsghdr *msg, cred_t *cr, pid_t pid)
{
udp_t *udp = connp->conn_udp;
udp_stack_t *us = udp->udp_us;
int error;
ip_xmit_attr_t *ixa;
ip_pkt_t *ipp;
in6_addr_t v6src;
in6_addr_t v6dst;
in6_addr_t v6nexthop;
in_port_t dstport;
uint32_t flowinfo;
uint_t srcid;
int is_absreq_failure = 0;
conn_opt_arg_t coas, *coa;
ASSERT(tudr_mp != NULL || msg != NULL);
ixa = conn_get_ixa_exclusive(connp);
if (ixa == NULL) {
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
return (ENOMEM);
}
ASSERT(cr != NULL);
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = cr;
ixa->ixa_cpid = pid;
if (is_system_labeled()) {
ip_xmit_attr_restore_tsl(ixa, ixa->ixa_cred);
}
ip_attr_newdst(ixa);
ipp = kmem_zalloc(sizeof (*ipp), KM_NOSLEEP);
if (ipp == NULL) {
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
return (ENOMEM);
}
mutex_enter(&connp->conn_lock);
error = ip_pkt_copy(&connp->conn_xmit_ipp, ipp, KM_NOSLEEP);
mutex_exit(&connp->conn_lock);
if (error != 0) {
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
goto done;
}
coa = &coas;
coa->coa_connp = connp;
coa->coa_ixa = ixa;
coa->coa_ipp = ipp;
coa->coa_ancillary = B_TRUE;
coa->coa_changed = 0;
if (msg != NULL) {
error = process_auxiliary_options(connp, msg->msg_control,
msg->msg_controllen, coa, &udp_opt_obj, udp_opt_set, cr);
} else {
struct T_unitdata_req *tudr;
tudr = (struct T_unitdata_req *)tudr_mp->b_rptr;
ASSERT(tudr->PRIM_type == T_UNITDATA_REQ);
error = tpi_optcom_buf(connp->conn_wq, tudr_mp,
&tudr->OPT_length, tudr->OPT_offset, cr, &udp_opt_obj,
coa, &is_absreq_failure);
}
if (error != 0) {
freemsg(mp);
UDPS_BUMP_MIB(us, udpOutErrors);
goto done;
}
ASSERT(is_absreq_failure == 0);
mutex_enter(&connp->conn_lock);
v6src = connp->conn_saddr_v6;
if (sin != NULL) {
IN6_IPADDR_TO_V4MAPPED(sin->sin_addr.s_addr, &v6dst);
dstport = sin->sin_port;
flowinfo = 0;
ixa->ixa_flags &= ~IXAF_SCOPEID_SET;
ixa->ixa_flags |= IXAF_IS_IPV4;
} else if (sin6 != NULL) {
boolean_t v4mapped;
v6dst = sin6->sin6_addr;
dstport = sin6->sin6_port;
flowinfo = sin6->sin6_flowinfo;
srcid = sin6->__sin6_src_id;
if (IN6_IS_ADDR_LINKSCOPE(&v6dst) && sin6->sin6_scope_id != 0) {
ixa->ixa_scopeid = sin6->sin6_scope_id;
ixa->ixa_flags |= IXAF_SCOPEID_SET;
} else {
ixa->ixa_flags &= ~IXAF_SCOPEID_SET;
}
v4mapped = IN6_IS_ADDR_V4MAPPED(&v6dst);
if (v4mapped)
ixa->ixa_flags |= IXAF_IS_IPV4;
else
ixa->ixa_flags &= ~IXAF_IS_IPV4;
if (srcid != 0 && IN6_IS_ADDR_UNSPECIFIED(&v6src)) {
if (!ip_srcid_find_id(srcid, &v6src, IPCL_ZONEID(connp),
v4mapped, connp->conn_netstack)) {
mutex_exit(&connp->conn_lock);
error = EADDRNOTAVAIL;
goto failed;
}
}
} else {
v6dst = connp->conn_faddr_v6;
dstport = connp->conn_fport;
flowinfo = connp->conn_flowinfo;
}
mutex_exit(&connp->conn_lock);
if (ipp->ipp_fields & IPPF_ADDR) {
if (ixa->ixa_flags & IXAF_IS_IPV4) {
if (IN6_IS_ADDR_V4MAPPED(&ipp->ipp_addr))
v6src = ipp->ipp_addr;
} else {
if (!IN6_IS_ADDR_V4MAPPED(&ipp->ipp_addr))
v6src = ipp->ipp_addr;
}
}
ip_attr_nexthop(ipp, ixa, &v6dst, &v6nexthop);
error = ip_attr_connect(connp, ixa, &v6src, &v6dst, &v6nexthop, dstport,
&v6src, NULL, IPDF_ALLOW_MCBC | IPDF_VERIFY_DST | IPDF_IPSEC);
switch (error) {
case 0:
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
goto failed;
case ENETDOWN:
error = 0;
goto failed;
case EHOSTUNREACH:
case ENETUNREACH:
if (ixa->ixa_ire != NULL) {
error = 0;
break;
}
default:
failed:
freemsg(mp);
UDPS_BUMP_MIB(us, udpOutErrors);
goto done;
}
if (is_system_labeled()) {
if (connp->conn_mlp_type != mlptSingle &&
!((ixa->ixa_flags & IXAF_UCRED_TSL))) {
UDPS_BUMP_MIB(us, udpOutErrors);
error = ECONNREFUSED;
freemsg(mp);
goto done;
}
error = conn_update_label(connp, ixa, &v6dst, ipp);
if (error != 0) {
freemsg(mp);
UDPS_BUMP_MIB(us, udpOutErrors);
goto done;
}
}
mp = udp_prepend_hdr(connp, ixa, ipp, &v6src, &v6dst, dstport,
flowinfo, mp, &error);
if (mp == NULL) {
ASSERT(error != 0);
UDPS_BUMP_MIB(us, udpOutErrors);
goto done;
}
if (ixa->ixa_pktlen > IP_MAXPACKET) {
error = EMSGSIZE;
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
goto done;
}
UDPS_BUMP_MIB(us, udpHCOutDatagrams);
DTRACE_UDP5(send, mblk_t *, NULL, ip_xmit_attr_t *, ixa,
void_ip_t *, mp->b_rptr, udp_t *, udp, udpha_t *,
&mp->b_rptr[ixa->ixa_ip_hdr_length]);
error = conn_ip_output(mp, ixa);
switch (error) {
case 0:
break;
case EWOULDBLOCK:
(void) ixa_check_drain_insert(connp, ixa);
error = 0;
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
default:
mutex_enter(&connp->conn_lock);
if (connp->conn_mcbc_bind)
connp->conn_saddr_v6 = ipv6_all_zeros;
else
connp->conn_saddr_v6 = connp->conn_bound_addr_v6;
connp->conn_v6lastdst = ipv6_all_zeros;
mutex_exit(&connp->conn_lock);
break;
}
done:
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
ip_pkt_free(ipp);
kmem_free(ipp, sizeof (*ipp));
return (error);
}
static int
udp_output_connected(conn_t *connp, mblk_t *mp, cred_t *cr, pid_t pid)
{
udp_t *udp = connp->conn_udp;
udp_stack_t *us = udp->udp_us;
int error;
ip_xmit_attr_t *ixa;
ixa = conn_get_ixa(connp, B_FALSE);
if (ixa == NULL) {
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
return (ENOMEM);
}
ASSERT(cr != NULL);
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = cr;
ixa->ixa_cpid = pid;
mutex_enter(&connp->conn_lock);
mp = udp_prepend_header_template(connp, ixa, mp, &connp->conn_saddr_v6,
connp->conn_fport, connp->conn_flowinfo, &error);
if (mp == NULL) {
ASSERT(error != 0);
mutex_exit(&connp->conn_lock);
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
return (error);
}
if (ixa->ixa_ire == NULL) {
in6_addr_t faddr, saddr;
in6_addr_t nexthop;
in_port_t fport;
saddr = connp->conn_saddr_v6;
faddr = connp->conn_faddr_v6;
fport = connp->conn_fport;
ip_attr_nexthop(&connp->conn_xmit_ipp, ixa, &faddr, &nexthop);
mutex_exit(&connp->conn_lock);
error = ip_attr_connect(connp, ixa, &saddr, &faddr, &nexthop,
fport, NULL, NULL, IPDF_ALLOW_MCBC | IPDF_VERIFY_DST |
IPDF_IPSEC);
switch (error) {
case 0:
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
goto failed;
case ENETDOWN:
error = 0;
goto failed;
case EHOSTUNREACH:
case ENETUNREACH:
if (ixa->ixa_ire != NULL) {
error = 0;
break;
}
default:
failed:
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
freemsg(mp);
UDPS_BUMP_MIB(us, udpOutErrors);
return (error);
}
} else {
mutex_exit(&connp->conn_lock);
}
ASSERT(ixa->ixa_ire != NULL);
UDPS_BUMP_MIB(us, udpHCOutDatagrams);
DTRACE_UDP5(send, mblk_t *, NULL, ip_xmit_attr_t *, ixa,
void_ip_t *, mp->b_rptr, udp_t *, udp, udpha_t *,
&mp->b_rptr[ixa->ixa_ip_hdr_length]);
error = conn_ip_output(mp, ixa);
switch (error) {
case 0:
break;
case EWOULDBLOCK:
(void) ixa_check_drain_insert(connp, ixa);
error = 0;
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
break;
}
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
return (error);
}
static int
udp_output_lastdst(conn_t *connp, mblk_t *mp, cred_t *cr, pid_t pid,
ip_xmit_attr_t *ixa)
{
udp_t *udp = connp->conn_udp;
udp_stack_t *us = udp->udp_us;
int error;
ASSERT(MUTEX_HELD(&connp->conn_lock));
ASSERT(ixa != NULL);
ASSERT(cr != NULL);
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = cr;
ixa->ixa_cpid = pid;
mp = udp_prepend_header_template(connp, ixa, mp, &connp->conn_v6lastsrc,
connp->conn_lastdstport, connp->conn_lastflowinfo, &error);
if (mp == NULL) {
ASSERT(error != 0);
mutex_exit(&connp->conn_lock);
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
return (error);
}
if (ixa->ixa_ire == NULL) {
in6_addr_t lastdst, lastsrc;
in6_addr_t nexthop;
in_port_t lastport;
lastsrc = connp->conn_v6lastsrc;
lastdst = connp->conn_v6lastdst;
lastport = connp->conn_lastdstport;
ip_attr_nexthop(&connp->conn_xmit_ipp, ixa, &lastdst, &nexthop);
mutex_exit(&connp->conn_lock);
error = ip_attr_connect(connp, ixa, &lastsrc, &lastdst,
&nexthop, lastport, NULL, NULL, IPDF_ALLOW_MCBC |
IPDF_VERIFY_DST | IPDF_IPSEC);
switch (error) {
case 0:
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
goto failed;
case ENETDOWN:
error = 0;
goto failed;
case EHOSTUNREACH:
case ENETUNREACH:
if (ixa->ixa_ire != NULL) {
error = 0;
break;
}
default:
failed:
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
freemsg(mp);
UDPS_BUMP_MIB(us, udpOutErrors);
return (error);
}
} else {
mutex_exit(&connp->conn_lock);
}
UDPS_BUMP_MIB(us, udpHCOutDatagrams);
DTRACE_UDP5(send, mblk_t *, NULL, ip_xmit_attr_t *, ixa,
void_ip_t *, mp->b_rptr, udp_t *, udp, udpha_t *,
&mp->b_rptr[ixa->ixa_ip_hdr_length]);
error = conn_ip_output(mp, ixa);
switch (error) {
case 0:
break;
case EWOULDBLOCK:
(void) ixa_check_drain_insert(connp, ixa);
error = 0;
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
default:
mutex_enter(&connp->conn_lock);
if (connp->conn_mcbc_bind)
connp->conn_saddr_v6 = ipv6_all_zeros;
else
connp->conn_saddr_v6 = connp->conn_bound_addr_v6;
connp->conn_v6lastdst = ipv6_all_zeros;
mutex_exit(&connp->conn_lock);
break;
}
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
return (error);
}
static mblk_t *
udp_prepend_header_template(conn_t *connp, ip_xmit_attr_t *ixa, mblk_t *mp,
const in6_addr_t *v6src, in_port_t dstport, uint32_t flowinfo, int *errorp)
{
udp_t *udp = connp->conn_udp;
udp_stack_t *us = udp->udp_us;
boolean_t insert_spi = udp->udp_nat_t_endpoint;
boolean_t hash_srcport = udp->udp_vxlanhash;
uint_t pktlen;
uint_t alloclen;
uint_t copylen;
uint8_t *iph;
uint_t ip_hdr_length;
udpha_t *udpha;
uint32_t cksum;
ip_pkt_t *ipp;
uint16_t srcport;
ASSERT(MUTEX_HELD(&connp->conn_lock));
if (hash_srcport == B_TRUE) {
srcport = udp_srcport_hash(mp, UDP_HASH_VXLAN,
IPPORT_DYNAMIC_MIN, IPPORT_DYNAMIC_MAX,
ntohs(connp->conn_lport));
}
copylen = connp->conn_ht_iphc_len;
alloclen = copylen + (insert_spi ? sizeof (uint32_t) : 0);
pktlen = alloclen + msgdsize(mp);
if (pktlen > IP_MAXPACKET) {
freemsg(mp);
*errorp = EMSGSIZE;
return (NULL);
}
ixa->ixa_pktlen = pktlen;
iph = mp->b_rptr - alloclen;
if (DB_REF(mp) != 1 || iph < DB_BASE(mp) || !OK_32PTR(iph)) {
mblk_t *mp1;
mp1 = allocb(alloclen + us->us_wroff_extra, BPRI_MED);
if (mp1 == NULL) {
freemsg(mp);
*errorp = ENOMEM;
return (NULL);
}
mp1->b_wptr = DB_LIM(mp1);
mp1->b_cont = mp;
mp = mp1;
iph = (mp->b_wptr - alloclen);
}
mp->b_rptr = iph;
bcopy(connp->conn_ht_iphc, iph, copylen);
ip_hdr_length = (uint_t)(connp->conn_ht_ulp - connp->conn_ht_iphc);
ixa->ixa_ip_hdr_length = ip_hdr_length;
udpha = (udpha_t *)(iph + ip_hdr_length);
cksum = pktlen - ip_hdr_length;
udpha->uha_length = htons(cksum);
cksum += connp->conn_sum;
cksum = (cksum >> 16) + (cksum & 0xFFFF);
ASSERT(cksum < 0x10000);
ipp = &connp->conn_xmit_ipp;
if (ixa->ixa_flags & IXAF_IS_IPV4) {
ipha_t *ipha = (ipha_t *)iph;
ipha->ipha_length = htons((uint16_t)pktlen);
if (us->us_do_checksum)
udpha->uha_checksum = htons(cksum);
if ((ipp->ipp_fields & IPPF_ADDR) &&
IN6_IS_ADDR_V4MAPPED(&ipp->ipp_addr)) {
ASSERT(ipp->ipp_addr_v4 != INADDR_ANY);
ipha->ipha_src = ipp->ipp_addr_v4;
} else {
IN6_V4MAPPED_TO_IPADDR(v6src, ipha->ipha_src);
}
} else {
ip6_t *ip6h = (ip6_t *)iph;
ip6h->ip6_plen = htons((uint16_t)(pktlen - IPV6_HDR_LEN));
udpha->uha_checksum = htons(cksum);
if ((ipp->ipp_fields & IPPF_ADDR) &&
!IN6_IS_ADDR_V4MAPPED(&ipp->ipp_addr)) {
ASSERT(!IN6_IS_ADDR_UNSPECIFIED(&ipp->ipp_addr));
ip6h->ip6_src = ipp->ipp_addr;
} else {
ip6h->ip6_src = *v6src;
}
ip6h->ip6_vcf =
(IPV6_DEFAULT_VERS_AND_FLOW & IPV6_VERS_AND_FLOW_MASK) |
(flowinfo & ~IPV6_VERS_AND_FLOW_MASK);
if (ipp->ipp_fields & IPPF_TCLASS) {
ip6h->ip6_vcf = IPV6_TCLASS_FLOW(ip6h->ip6_vcf,
ipp->ipp_tclass);
}
}
if (insert_spi)
*((uint32_t *)(udpha + 1)) = 0;
udpha->uha_dst_port = dstport;
if (hash_srcport == B_TRUE)
udpha->uha_src_port = htons(srcport);
return (mp);
}
static void
udp_ud_err_connected(conn_t *connp, t_scalar_t error)
{
struct sockaddr_storage ss;
sin_t *sin;
sin6_t *sin6;
struct sockaddr *addr;
socklen_t addrlen;
mblk_t *mp1;
mutex_enter(&connp->conn_lock);
if (connp->conn_family == AF_INET) {
sin = (sin_t *)&ss;
*sin = sin_null;
sin->sin_family = AF_INET;
sin->sin_port = connp->conn_fport;
sin->sin_addr.s_addr = connp->conn_faddr_v4;
addr = (struct sockaddr *)sin;
addrlen = sizeof (*sin);
} else {
sin6 = (sin6_t *)&ss;
*sin6 = sin6_null;
sin6->sin6_family = AF_INET6;
sin6->sin6_port = connp->conn_fport;
sin6->sin6_flowinfo = connp->conn_flowinfo;
sin6->sin6_addr = connp->conn_faddr_v6;
if (IN6_IS_ADDR_LINKSCOPE(&connp->conn_faddr_v6) &&
(connp->conn_ixa->ixa_flags & IXAF_SCOPEID_SET)) {
sin6->sin6_scope_id = connp->conn_ixa->ixa_scopeid;
} else {
sin6->sin6_scope_id = 0;
}
sin6->__sin6_src_id = 0;
addr = (struct sockaddr *)sin6;
addrlen = sizeof (*sin6);
}
mutex_exit(&connp->conn_lock);
mp1 = mi_tpi_uderror_ind((char *)addr, addrlen, NULL, 0, error);
if (mp1 != NULL)
putnext(connp->conn_rq, mp1);
}
int
udp_wput(queue_t *q, mblk_t *mp)
{
sin6_t *sin6;
sin_t *sin = NULL;
uint_t srcid;
conn_t *connp = Q_TO_CONN(q);
udp_t *udp = connp->conn_udp;
int error = 0;
struct sockaddr *addr = NULL;
socklen_t addrlen;
udp_stack_t *us = udp->udp_us;
struct T_unitdata_req *tudr;
mblk_t *data_mp;
ushort_t ipversion;
cred_t *cr;
pid_t pid;
switch (DB_TYPE(mp)) {
case M_DATA:
if (!udp->udp_issocket || udp->udp_state != TS_DATA_XFER) {
UDPS_BUMP_MIB(us, udpOutErrors);
UDP_DBGSTAT(us, udp_data_notconn);
UDP_STAT(us, udp_out_err_notconn);
freemsg(mp);
return (0);
}
cr = msg_getcred(mp, &pid);
ASSERT(cr != NULL);
if (cr == NULL) {
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(mp);
return (0);
}
ASSERT(udp->udp_issocket);
UDP_DBGSTAT(us, udp_data_conn);
error = udp_output_connected(connp, mp, cr, pid);
if (error != 0) {
UDP_STAT(us, udp_out_err_output);
if (connp->conn_rq != NULL)
udp_ud_err_connected(connp, (t_scalar_t)error);
#ifdef DEBUG
printf("udp_output_connected returned %d\n", error);
#endif
}
return (0);
case M_PROTO:
case M_PCPROTO:
tudr = (struct T_unitdata_req *)mp->b_rptr;
if (MBLKL(mp) < sizeof (*tudr) ||
((t_primp_t)mp->b_rptr)->type != T_UNITDATA_REQ) {
udp_wput_other(q, mp);
return (0);
}
break;
default:
udp_wput_other(q, mp);
return (0);
}
data_mp = mp->b_cont;
if (data_mp == NULL) {
error = EPROTO;
goto ud_error2;
}
mp->b_cont = NULL;
if (!MBLKIN(mp, 0, tudr->DEST_offset + tudr->DEST_length)) {
error = EADDRNOTAVAIL;
goto ud_error2;
}
cr = msg_getcred(mp, &pid);
if (cr == NULL) {
cr = connp->conn_cred;
pid = connp->conn_cpid;
}
if (udp->udp_state == TS_UNBND) {
error = EPROTO;
goto ud_error2;
}
addr = (struct sockaddr *)&mp->b_rptr[tudr->DEST_offset];
addrlen = tudr->DEST_length;
switch (connp->conn_family) {
case AF_INET6:
sin6 = (sin6_t *)addr;
if (!OK_32PTR((char *)sin6) || (addrlen != sizeof (sin6_t)) ||
(sin6->sin6_family != AF_INET6)) {
error = EADDRNOTAVAIL;
goto ud_error2;
}
srcid = sin6->__sin6_src_id;
if (!IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
if (IN6_IS_ADDR_V4MAPPED(&connp->conn_saddr_v6)) {
error = EADDRNOTAVAIL;
goto ud_error2;
}
UDP_DBGSTAT(us, udp_out_ipv6);
if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr))
sin6->sin6_addr = ipv6_loopback;
ipversion = IPV6_VERSION;
} else {
if (connp->conn_ipv6_v6only) {
error = EADDRNOTAVAIL;
goto ud_error2;
}
if (!IN6_IS_ADDR_V4MAPPED(&connp->conn_saddr_v6) &&
!IN6_IS_ADDR_UNSPECIFIED(&connp->conn_saddr_v6)) {
error = EADDRNOTAVAIL;
goto ud_error2;
}
UDP_DBGSTAT(us, udp_out_mapped);
if (V4_PART_OF_V6(sin6->sin6_addr) == INADDR_ANY) {
V4_PART_OF_V6(sin6->sin6_addr) =
htonl(INADDR_LOOPBACK);
}
ipversion = IPV4_VERSION;
}
if (tudr->OPT_length != 0) {
if (udp->udp_state == TS_DATA_XFER &&
!conn_same_as_last_v6(connp, sin6)) {
error = EISCONN;
goto ud_error2;
}
UDP_STAT(us, udp_out_opt);
error = udp_output_ancillary(connp, NULL, sin6,
data_mp, mp, NULL, cr, pid);
} else {
ip_xmit_attr_t *ixa;
ixa = conn_get_ixa(connp, B_FALSE);
if (ixa == NULL) {
error = ENOMEM;
goto ud_error2;
}
mutex_enter(&connp->conn_lock);
if (conn_same_as_last_v6(connp, sin6) &&
connp->conn_lastsrcid == srcid &&
ipsec_outbound_policy_current(ixa)) {
UDP_DBGSTAT(us, udp_out_lastdst);
error = udp_output_lastdst(connp, data_mp, cr,
pid, ixa);
} else {
UDP_DBGSTAT(us, udp_out_diffdst);
error = udp_output_newdst(connp, data_mp, NULL,
sin6, ipversion, cr, pid, ixa);
}
ASSERT(MUTEX_NOT_HELD(&connp->conn_lock));
}
if (error == 0) {
freeb(mp);
return (0);
}
break;
case AF_INET:
sin = (sin_t *)addr;
if ((!OK_32PTR((char *)sin) || addrlen != sizeof (sin_t)) ||
(sin->sin_family != AF_INET)) {
error = EADDRNOTAVAIL;
goto ud_error2;
}
UDP_DBGSTAT(us, udp_out_ipv4);
if (sin->sin_addr.s_addr == INADDR_ANY)
sin->sin_addr.s_addr = htonl(INADDR_LOOPBACK);
ipversion = IPV4_VERSION;
srcid = 0;
if (tudr->OPT_length != 0) {
if (udp->udp_state == TS_DATA_XFER &&
!conn_same_as_last_v4(connp, sin)) {
error = EISCONN;
goto ud_error2;
}
UDP_STAT(us, udp_out_opt);
error = udp_output_ancillary(connp, sin, NULL,
data_mp, mp, NULL, cr, pid);
} else {
ip_xmit_attr_t *ixa;
ixa = conn_get_ixa(connp, B_FALSE);
if (ixa == NULL) {
error = ENOMEM;
goto ud_error2;
}
mutex_enter(&connp->conn_lock);
if (conn_same_as_last_v4(connp, sin) &&
ipsec_outbound_policy_current(ixa)) {
UDP_DBGSTAT(us, udp_out_lastdst);
error = udp_output_lastdst(connp, data_mp, cr,
pid, ixa);
} else {
UDP_DBGSTAT(us, udp_out_diffdst);
error = udp_output_newdst(connp, data_mp, sin,
NULL, ipversion, cr, pid, ixa);
}
ASSERT(MUTEX_NOT_HELD(&connp->conn_lock));
}
if (error == 0) {
freeb(mp);
return (0);
}
break;
}
UDP_STAT(us, udp_out_err_output);
ASSERT(mp != NULL);
udp_ud_err(q, mp, (t_scalar_t)error);
return (0);
ud_error2:
UDPS_BUMP_MIB(us, udpOutErrors);
freemsg(data_mp);
UDP_STAT(us, udp_out_err_output);
ASSERT(mp != NULL);
udp_ud_err(q, mp, (t_scalar_t)error);
return (0);
}
static int
udp_output_newdst(conn_t *connp, mblk_t *data_mp, sin_t *sin, sin6_t *sin6,
ushort_t ipversion, cred_t *cr, pid_t pid, ip_xmit_attr_t *ixa)
{
uint_t srcid;
uint32_t flowinfo;
udp_t *udp = connp->conn_udp;
int error = 0;
ip_xmit_attr_t *oldixa;
udp_stack_t *us = udp->udp_us;
in6_addr_t v6src;
in6_addr_t v6dst;
in6_addr_t v6nexthop;
in_port_t dstport;
ASSERT(MUTEX_HELD(&connp->conn_lock));
ASSERT(ixa != NULL);
ASSERT(cr != NULL);
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = cr;
ixa->ixa_cpid = pid;
if (is_system_labeled()) {
ip_xmit_attr_restore_tsl(ixa, ixa->ixa_cred);
}
if (udp->udp_state == TS_DATA_XFER) {
mutex_exit(&connp->conn_lock);
error = EISCONN;
goto ud_error;
}
connp->conn_v6lastdst = ipv6_all_zeros;
ip_attr_newdst(ixa);
v6src = connp->conn_saddr_v6;
if (sin != NULL) {
IN6_IPADDR_TO_V4MAPPED(sin->sin_addr.s_addr, &v6dst);
dstport = sin->sin_port;
flowinfo = 0;
srcid = 0;
ixa->ixa_flags &= ~IXAF_SCOPEID_SET;
ixa->ixa_flags |= IXAF_IS_IPV4;
} else {
boolean_t v4mapped;
v6dst = sin6->sin6_addr;
dstport = sin6->sin6_port;
flowinfo = sin6->sin6_flowinfo;
srcid = sin6->__sin6_src_id;
if (IN6_IS_ADDR_LINKSCOPE(&v6dst) && sin6->sin6_scope_id != 0) {
ixa->ixa_scopeid = sin6->sin6_scope_id;
ixa->ixa_flags |= IXAF_SCOPEID_SET;
} else {
ixa->ixa_flags &= ~IXAF_SCOPEID_SET;
}
v4mapped = IN6_IS_ADDR_V4MAPPED(&v6dst);
if (v4mapped)
ixa->ixa_flags |= IXAF_IS_IPV4;
else
ixa->ixa_flags &= ~IXAF_IS_IPV4;
if (srcid != 0 && IN6_IS_ADDR_UNSPECIFIED(&v6src)) {
if (!ip_srcid_find_id(srcid, &v6src, IPCL_ZONEID(connp),
v4mapped, connp->conn_netstack)) {
mutex_exit(&connp->conn_lock);
error = EADDRNOTAVAIL;
goto ud_error;
}
}
}
if (connp->conn_xmit_ipp.ipp_fields & IPPF_ADDR) {
ip_pkt_t *ipp = &connp->conn_xmit_ipp;
if (ixa->ixa_flags & IXAF_IS_IPV4) {
if (IN6_IS_ADDR_V4MAPPED(&ipp->ipp_addr))
v6src = ipp->ipp_addr;
} else {
if (!IN6_IS_ADDR_V4MAPPED(&ipp->ipp_addr))
v6src = ipp->ipp_addr;
}
}
ip_attr_nexthop(&connp->conn_xmit_ipp, ixa, &v6dst, &v6nexthop);
mutex_exit(&connp->conn_lock);
error = ip_attr_connect(connp, ixa, &v6src, &v6dst, &v6nexthop, dstport,
&v6src, NULL, IPDF_ALLOW_MCBC | IPDF_VERIFY_DST | IPDF_IPSEC);
switch (error) {
case 0:
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
goto failed;
case ENETDOWN:
error = 0;
goto failed;
case EHOSTUNREACH:
case ENETUNREACH:
if (ixa->ixa_ire != NULL) {
error = 0;
break;
}
failed:
default:
goto ud_error;
}
if (cl_inet_connect2 != NULL) {
CL_INET_UDP_CONNECT(connp, B_TRUE, &v6dst, dstport, error);
if (error != 0) {
error = EHOSTUNREACH;
goto ud_error;
}
}
mutex_enter(&connp->conn_lock);
if (udp->udp_state == TS_DATA_XFER) {
mutex_exit(&connp->conn_lock);
error = EISCONN;
goto ud_error;
}
if (is_system_labeled()) {
if (connp->conn_mlp_type != mlptSingle) {
mutex_exit(&connp->conn_lock);
error = ECONNREFUSED;
goto ud_error;
}
error = conn_update_label(connp, ixa, &v6dst,
&connp->conn_xmit_ipp);
if (error != 0) {
mutex_exit(&connp->conn_lock);
goto ud_error;
}
error = udp_build_hdr_template(connp, &v6src, &v6dst, dstport,
flowinfo);
if (error != 0) {
mutex_exit(&connp->conn_lock);
goto ud_error;
}
} else if ((connp->conn_xmit_ipp.ipp_fields &
(IPPF_IPV4_OPTIONS|IPPF_RTHDR)) ||
ipversion != connp->conn_lastipversion ||
IN6_IS_ADDR_UNSPECIFIED(&connp->conn_v6lastdst)) {
error = udp_build_hdr_template(connp, &v6src, &v6dst, dstport,
flowinfo);
if (error != 0) {
mutex_exit(&connp->conn_lock);
goto ud_error;
}
} else {
if (ixa->ixa_flags & IXAF_IS_IPV4) {
ipha_t *ipha = (ipha_t *)connp->conn_ht_iphc;
IN6_V4MAPPED_TO_IPADDR(&v6dst, ipha->ipha_dst);
if (ixa->ixa_flags & IXAF_PMTU_IPV4_DF) {
ipha->ipha_fragment_offset_and_flags |=
IPH_DF_HTONS;
} else {
ipha->ipha_fragment_offset_and_flags &=
~IPH_DF_HTONS;
}
} else {
ip6_t *ip6h = (ip6_t *)connp->conn_ht_iphc;
ip6h->ip6_dst = v6dst;
}
}
oldixa = conn_replace_ixa(connp, ixa);
connp->conn_v6lastdst = v6dst;
connp->conn_lastipversion = ipversion;
connp->conn_lastdstport = dstport;
connp->conn_lastflowinfo = flowinfo;
connp->conn_lastscopeid = ixa->ixa_scopeid;
connp->conn_lastsrcid = srcid;
connp->conn_v6lastsrc = v6src;
data_mp = udp_prepend_header_template(connp, ixa, data_mp, &v6src,
dstport, flowinfo, &error);
mutex_exit(&connp->conn_lock);
ixa_refrele(oldixa);
if (data_mp == NULL) {
ASSERT(error != 0);
goto ud_error;
}
UDPS_BUMP_MIB(us, udpHCOutDatagrams);
DTRACE_UDP5(send, mblk_t *, NULL, ip_xmit_attr_t *, ixa,
void_ip_t *, data_mp->b_rptr, udp_t *, udp, udpha_t *,
&data_mp->b_rptr[ixa->ixa_ip_hdr_length]);
error = conn_ip_output(data_mp, ixa);
switch (error) {
case 0:
break;
case EWOULDBLOCK:
(void) ixa_check_drain_insert(connp, ixa);
error = 0;
break;
case EADDRNOTAVAIL:
error = ENETUNREACH;
default:
mutex_enter(&connp->conn_lock);
if (connp->conn_mcbc_bind)
connp->conn_saddr_v6 = ipv6_all_zeros;
else
connp->conn_saddr_v6 = connp->conn_bound_addr_v6;
connp->conn_v6lastdst = ipv6_all_zeros;
mutex_exit(&connp->conn_lock);
break;
}
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
return (error);
ud_error:
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = connp->conn_cred;
ixa->ixa_cpid = connp->conn_cpid;
ixa_refrele(ixa);
freemsg(data_mp);
UDPS_BUMP_MIB(us, udpOutErrors);
UDP_STAT(us, udp_out_err_output);
return (error);
}
static int
udp_wput_fallback(queue_t *wq, mblk_t *mp)
{
#ifdef DEBUG
cmn_err(CE_CONT, "udp_wput_fallback: Message in fallback \n");
#endif
freemsg(mp);
return (0);
}
static void
udp_wput_cmdblk(queue_t *q, mblk_t *mp)
{
void *data;
mblk_t *datamp = mp->b_cont;
conn_t *connp = Q_TO_CONN(q);
udp_t *udp = connp->conn_udp;
cmdblk_t *cmdp = (cmdblk_t *)mp->b_rptr;
if (datamp == NULL || MBLKL(datamp) < cmdp->cb_len) {
cmdp->cb_error = EPROTO;
qreply(q, mp);
return;
}
data = datamp->b_rptr;
mutex_enter(&connp->conn_lock);
switch (cmdp->cb_cmd) {
case TI_GETPEERNAME:
if (udp->udp_state != TS_DATA_XFER)
cmdp->cb_error = ENOTCONN;
else
cmdp->cb_error = conn_getpeername(connp, data,
&cmdp->cb_len);
break;
case TI_GETMYNAME:
cmdp->cb_error = conn_getsockname(connp, data, &cmdp->cb_len);
break;
default:
cmdp->cb_error = EINVAL;
break;
}
mutex_exit(&connp->conn_lock);
qreply(q, mp);
}
static void
udp_use_pure_tpi(udp_t *udp)
{
conn_t *connp = udp->udp_connp;
mutex_enter(&connp->conn_lock);
udp->udp_issocket = B_FALSE;
mutex_exit(&connp->conn_lock);
UDP_STAT(udp->udp_us, udp_sock_fallback);
}
static void
udp_wput_other(queue_t *q, mblk_t *mp)
{
uchar_t *rptr = mp->b_rptr;
struct iocblk *iocp;
conn_t *connp = Q_TO_CONN(q);
udp_t *udp = connp->conn_udp;
cred_t *cr;
switch (mp->b_datap->db_type) {
case M_CMD:
udp_wput_cmdblk(q, mp);
return;
case M_PROTO:
case M_PCPROTO:
if (mp->b_wptr - rptr < sizeof (t_scalar_t)) {
freemsg(mp);
return;
}
switch (((t_primp_t)rptr)->type) {
case T_ADDR_REQ:
udp_addr_req(q, mp);
return;
case O_T_BIND_REQ:
case T_BIND_REQ:
udp_tpi_bind(q, mp);
return;
case T_CONN_REQ:
udp_tpi_connect(q, mp);
return;
case T_CAPABILITY_REQ:
udp_capability_req(q, mp);
return;
case T_INFO_REQ:
udp_info_req(q, mp);
return;
case T_UNITDATA_REQ:
udp_ud_err(q, mp, EADDRNOTAVAIL);
return;
case T_UNBIND_REQ:
udp_tpi_unbind(q, mp);
return;
case T_SVR4_OPTMGMT_REQ:
cr = msg_getcred(mp, NULL);
ASSERT(cr != NULL);
if (cr == NULL) {
udp_err_ack(q, mp, TSYSERR, EINVAL);
return;
}
if (!snmpcom_req(q, mp, udp_snmp_set, ip_snmp_get,
cr)) {
svr4_optcom_req(q, mp, cr, &udp_opt_obj);
}
return;
case T_OPTMGMT_REQ:
cr = msg_getcred(mp, NULL);
ASSERT(cr != NULL);
if (cr == NULL) {
udp_err_ack(q, mp, TSYSERR, EINVAL);
return;
}
tpi_optcom_req(q, mp, cr, &udp_opt_obj);
return;
case T_DISCON_REQ:
udp_tpi_disconnect(q, mp);
return;
case O_T_CONN_RES:
case T_CONN_RES:
udp_err_ack(q, mp, TNOTSUPPORT, 0);
return;
case T_DATA_REQ:
case T_EXDATA_REQ:
case T_ORDREL_REQ:
udp_err_ack(q, mp, TNOTSUPPORT, 0);
return;
default:
break;
}
break;
case M_FLUSH:
if (*rptr & FLUSHW)
flushq(q, FLUSHDATA);
break;
case M_IOCTL:
iocp = (struct iocblk *)mp->b_rptr;
switch (iocp->ioc_cmd) {
case TI_GETPEERNAME:
if (udp->udp_state != TS_DATA_XFER) {
iocp->ioc_error = ENOTCONN;
iocp->ioc_count = 0;
mp->b_datap->db_type = M_IOCACK;
qreply(q, mp);
return;
}
case TI_GETMYNAME:
mi_copyin(q, mp, NULL,
SIZEOF_STRUCT(strbuf, iocp->ioc_flag));
return;
case _SIOCSOCKFALLBACK:
if (!udp->udp_issocket) {
DB_TYPE(mp) = M_IOCNAK;
iocp->ioc_error = EINVAL;
} else {
udp_use_pure_tpi(udp);
DB_TYPE(mp) = M_IOCACK;
iocp->ioc_error = 0;
}
iocp->ioc_count = 0;
iocp->ioc_rval = 0;
qreply(q, mp);
return;
default:
break;
}
break;
case M_IOCDATA:
udp_wput_iocdata(q, mp);
return;
default:
break;
}
ip_wput_nondata(q, mp);
}
static void
udp_wput_iocdata(queue_t *q, mblk_t *mp)
{
mblk_t *mp1;
struct iocblk *iocp = (struct iocblk *)mp->b_rptr;
STRUCT_HANDLE(strbuf, sb);
uint_t addrlen;
conn_t *connp = Q_TO_CONN(q);
udp_t *udp = connp->conn_udp;
switch (iocp->ioc_cmd) {
case TI_GETMYNAME:
case TI_GETPEERNAME:
break;
default:
ip_wput_nondata(q, mp);
return;
}
switch (mi_copy_state(q, mp, &mp1)) {
case -1:
return;
case MI_COPY_CASE(MI_COPY_IN, 1):
break;
case MI_COPY_CASE(MI_COPY_OUT, 1):
mi_copyout(q, mp);
return;
case MI_COPY_CASE(MI_COPY_OUT, 2):
mi_copy_done(q, mp, 0);
return;
default:
mi_copy_done(q, mp, EPROTO);
return;
}
STRUCT_SET_HANDLE(sb, iocp->ioc_flag, (void *)mp1->b_rptr);
if (connp->conn_family == AF_INET)
addrlen = sizeof (sin_t);
else
addrlen = sizeof (sin6_t);
if (STRUCT_FGET(sb, maxlen) < addrlen) {
mi_copy_done(q, mp, EINVAL);
return;
}
switch (iocp->ioc_cmd) {
case TI_GETMYNAME:
break;
case TI_GETPEERNAME:
if (udp->udp_state != TS_DATA_XFER) {
mi_copy_done(q, mp, ENOTCONN);
return;
}
break;
}
mp1 = mi_copyout_alloc(q, mp, STRUCT_FGETP(sb, buf), addrlen, B_TRUE);
if (!mp1)
return;
STRUCT_FSET(sb, len, addrlen);
switch (((struct iocblk *)mp->b_rptr)->ioc_cmd) {
case TI_GETMYNAME:
(void) conn_getsockname(connp, (struct sockaddr *)mp1->b_wptr,
&addrlen);
break;
case TI_GETPEERNAME:
(void) conn_getpeername(connp, (struct sockaddr *)mp1->b_wptr,
&addrlen);
break;
}
mp1->b_wptr += addrlen;
mi_copyout(q, mp);
}
void
udp_ddi_g_init(void)
{
udp_max_optsize = optcom_max_optsize(udp_opt_obj.odb_opt_des_arr,
udp_opt_obj.odb_opt_arr_cnt);
netstack_register(NS_UDP, udp_stack_init, NULL, udp_stack_fini);
}
void
udp_ddi_g_destroy(void)
{
netstack_unregister(NS_UDP);
}
#define INET_NAME "ip"
static void *
udp_stack_init(netstackid_t stackid, netstack_t *ns)
{
udp_stack_t *us;
int i;
int error = 0;
major_t major;
size_t arrsz;
us = (udp_stack_t *)kmem_zalloc(sizeof (*us), KM_SLEEP);
us->us_netstack = ns;
mutex_init(&us->us_epriv_port_lock, NULL, MUTEX_DEFAULT, NULL);
us->us_num_epriv_ports = UDP_NUM_EPRIV_PORTS;
us->us_epriv_ports[0] = ULP_DEF_EPRIV_PORT1;
us->us_epriv_ports[1] = ULP_DEF_EPRIV_PORT2;
us->us_min_anonpriv_port = 512;
us->us_bind_fanout_size = udp_bind_fanout_size;
if (!ISP2(us->us_bind_fanout_size)) {
for (i = 0; i < 31; i++) {
if (us->us_bind_fanout_size < (1 << i))
break;
}
us->us_bind_fanout_size = 1 << i;
}
us->us_bind_fanout = kmem_zalloc(us->us_bind_fanout_size *
sizeof (udp_fanout_t), KM_SLEEP);
for (i = 0; i < us->us_bind_fanout_size; i++) {
mutex_init(&us->us_bind_fanout[i].uf_lock, NULL, MUTEX_DEFAULT,
NULL);
}
arrsz = udp_propinfo_count * sizeof (mod_prop_info_t);
us->us_propinfo_tbl = (mod_prop_info_t *)kmem_alloc(arrsz,
KM_SLEEP);
bcopy(udp_propinfo_tbl, us->us_propinfo_tbl, arrsz);
mutex_enter(&cpu_lock);
us->us_sc_cnt = MAX(ncpus, boot_ncpus);
mutex_exit(&cpu_lock);
us->us_sc = kmem_zalloc(max_ncpus * sizeof (udp_stats_cpu_t *),
KM_SLEEP);
for (i = 0; i < us->us_sc_cnt; i++) {
us->us_sc[i] = kmem_zalloc(sizeof (udp_stats_cpu_t),
KM_SLEEP);
}
us->us_kstat = udp_kstat2_init(stackid);
us->us_mibkp = udp_kstat_init(stackid);
major = mod_name_to_major(INET_NAME);
error = ldi_ident_from_major(major, &us->us_ldi_ident);
ASSERT(error == 0);
return (us);
}
static void
udp_stack_fini(netstackid_t stackid, void *arg)
{
udp_stack_t *us = (udp_stack_t *)arg;
int i;
for (i = 0; i < us->us_bind_fanout_size; i++) {
mutex_destroy(&us->us_bind_fanout[i].uf_lock);
}
kmem_free(us->us_bind_fanout, us->us_bind_fanout_size *
sizeof (udp_fanout_t));
us->us_bind_fanout = NULL;
for (i = 0; i < us->us_sc_cnt; i++)
kmem_free(us->us_sc[i], sizeof (udp_stats_cpu_t));
kmem_free(us->us_sc, max_ncpus * sizeof (udp_stats_cpu_t *));
kmem_free(us->us_propinfo_tbl,
udp_propinfo_count * sizeof (mod_prop_info_t));
us->us_propinfo_tbl = NULL;
udp_kstat_fini(stackid, us->us_mibkp);
us->us_mibkp = NULL;
udp_kstat2_fini(stackid, us->us_kstat);
us->us_kstat = NULL;
mutex_destroy(&us->us_epriv_port_lock);
ldi_ident_release(us->us_ldi_ident);
kmem_free(us, sizeof (*us));
}
static size_t
udp_set_rcv_hiwat(udp_t *udp, size_t size)
{
udp_stack_t *us = udp->udp_us;
size += size >> 1;
if (size > us->us_max_buf)
size = us->us_max_buf;
udp->udp_rcv_hiwat = size;
return (size);
}
static int
udp_lrput(queue_t *q, mblk_t *mp)
{
switch (mp->b_datap->db_type) {
case M_FLUSH:
if (*mp->b_rptr & FLUSHW) {
*mp->b_rptr &= ~FLUSHR;
qreply(q, mp);
return (0);
}
break;
}
freemsg(mp);
return (0);
}
int
udp_lwput(queue_t *q, mblk_t *mp)
{
freemsg(mp);
return (0);
}
void
udp_stack_cpu_add(udp_stack_t *us, processorid_t cpu_seqid)
{
int i;
if (cpu_seqid < us->us_sc_cnt)
return;
for (i = us->us_sc_cnt; i <= cpu_seqid; i++) {
ASSERT(us->us_sc[i] == NULL);
us->us_sc[i] = kmem_zalloc(sizeof (udp_stats_cpu_t),
KM_SLEEP);
}
membar_producer();
us->us_sc_cnt = cpu_seqid + 1;
}
static conn_t *
udp_do_open(cred_t *credp, boolean_t isv6, int flags, int *errorp)
{
udp_t *udp;
conn_t *connp;
zoneid_t zoneid;
netstack_t *ns;
udp_stack_t *us;
int len;
ASSERT(errorp != NULL);
if ((*errorp = secpolicy_basic_net_access(credp)) != 0)
return (NULL);
ns = netstack_find_by_cred(credp);
ASSERT(ns != NULL);
us = ns->netstack_udp;
ASSERT(us != NULL);
if (ns->netstack_stackid != GLOBAL_NETSTACKID)
zoneid = GLOBAL_ZONEID;
else
zoneid = crgetzoneid(credp);
ASSERT(flags == KM_SLEEP || flags == KM_NOSLEEP);
connp = ipcl_conn_create(IPCL_UDPCONN, flags, ns);
if (connp == NULL) {
netstack_rele(ns);
*errorp = ENOMEM;
return (NULL);
}
udp = connp->conn_udp;
netstack_rele(ns);
ASSERT(connp->conn_proto == IPPROTO_UDP);
ASSERT(connp->conn_udp == udp);
ASSERT(udp->udp_connp == connp);
udp->udp_state = TS_UNBND;
connp->conn_ixa->ixa_flags |= IXAF_VERIFY_SOURCE;
if (isv6) {
connp->conn_family = AF_INET6;
connp->conn_ipversion = IPV6_VERSION;
connp->conn_ixa->ixa_flags &= ~IXAF_IS_IPV4;
connp->conn_default_ttl = us->us_ipv6_hoplimit;
len = sizeof (ip6_t) + UDPH_SIZE;
} else {
connp->conn_family = AF_INET;
connp->conn_ipversion = IPV4_VERSION;
connp->conn_ixa->ixa_flags |= IXAF_IS_IPV4;
connp->conn_default_ttl = us->us_ipv4_ttl;
len = sizeof (ipha_t) + UDPH_SIZE;
}
ASSERT(connp->conn_ixa->ixa_protocol == connp->conn_proto);
connp->conn_xmit_ipp.ipp_unicast_hops = connp->conn_default_ttl;
connp->conn_ixa->ixa_multicast_ttl = IP_DEFAULT_MULTICAST_TTL;
connp->conn_ixa->ixa_flags |= IXAF_MULTICAST_LOOP | IXAF_SET_ULP_CKSUM;
connp->conn_ixa->ixa_zoneid = zoneid;
connp->conn_zoneid = zoneid;
if (getpflags(NET_MAC_AWARE, credp) != 0)
connp->conn_mac_mode = CONN_MAC_AWARE;
connp->conn_zone_is_global = (crgetzoneid(credp) == GLOBAL_ZONEID);
udp->udp_us = us;
connp->conn_rcvbuf = us->us_recv_hiwat;
connp->conn_sndbuf = us->us_xmit_hiwat;
connp->conn_sndlowat = us->us_xmit_lowat;
connp->conn_rcvlowat = udp_mod_info.mi_lowat;
connp->conn_wroff = len + us->us_wroff_extra;
connp->conn_so_type = SOCK_DGRAM;
connp->conn_recv = udp_input;
connp->conn_recvicmp = udp_icmp_input;
crhold(credp);
connp->conn_cred = credp;
connp->conn_cpid = curproc->p_pid;
connp->conn_open_time = ddi_get_lbolt64();
ASSERT(!(connp->conn_ixa->ixa_free_flags & IXA_FREE_CRED));
connp->conn_ixa->ixa_cred = connp->conn_cred;
connp->conn_ixa->ixa_cpid = connp->conn_cpid;
if (is_system_labeled())
connp->conn_ixa->ixa_tsl = crgetlabel(connp->conn_cred);
*((sin6_t *)&udp->udp_delayed_addr) = sin6_null;
if (us->us_pmtu_discovery)
connp->conn_ixa->ixa_flags |= IXAF_PMTU_DISCOVERY;
return (connp);
}
sock_lower_handle_t
udp_create(int family, int type, int proto, sock_downcalls_t **sock_downcalls,
uint_t *smodep, int *errorp, int flags, cred_t *credp)
{
udp_t *udp = NULL;
udp_stack_t *us;
conn_t *connp;
boolean_t isv6;
if (type != SOCK_DGRAM || (family != AF_INET && family != AF_INET6) ||
(proto != 0 && proto != IPPROTO_UDP)) {
*errorp = EPROTONOSUPPORT;
return (NULL);
}
if (family == AF_INET6)
isv6 = B_TRUE;
else
isv6 = B_FALSE;
connp = udp_do_open(credp, isv6, flags, errorp);
if (connp == NULL)
return (NULL);
udp = connp->conn_udp;
ASSERT(udp != NULL);
us = udp->udp_us;
ASSERT(us != NULL);
udp->udp_issocket = B_TRUE;
connp->conn_flags |= IPCL_NONSTR;
(void) udp_set_rcv_hiwat(udp, connp->conn_rcvbuf);
udp->udp_rcv_disply_hiwat = connp->conn_rcvbuf;
connp->conn_flow_cntrld = B_FALSE;
mutex_enter(&connp->conn_lock);
connp->conn_state_flags &= ~CONN_INCIPIENT;
mutex_exit(&connp->conn_lock);
*errorp = 0;
*smodep = SM_ATOMIC;
*sock_downcalls = &sock_udp_downcalls;
return ((sock_lower_handle_t)connp);
}
void
udp_activate(sock_lower_handle_t proto_handle, sock_upper_handle_t sock_handle,
sock_upcalls_t *sock_upcalls, int flags, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
struct sock_proto_props sopp;
ASSERT(cr != NULL);
connp->conn_upcalls = sock_upcalls;
connp->conn_upper_handle = sock_handle;
sopp.sopp_flags = SOCKOPT_WROFF | SOCKOPT_RCVHIWAT | SOCKOPT_RCVLOWAT |
SOCKOPT_MAXBLK | SOCKOPT_MAXPSZ | SOCKOPT_MINPSZ;
sopp.sopp_wroff = connp->conn_wroff;
sopp.sopp_maxblk = INFPSZ;
sopp.sopp_rxhiwat = connp->conn_rcvbuf;
sopp.sopp_rxlowat = connp->conn_rcvlowat;
sopp.sopp_maxaddrlen = sizeof (sin6_t);
sopp.sopp_maxpsz =
(connp->conn_family == AF_INET) ? UDP_MAXPACKET_IPV4 :
UDP_MAXPACKET_IPV6;
sopp.sopp_minpsz = (udp_mod_info.mi_minpsz == 1) ? 0 :
udp_mod_info.mi_minpsz;
(*connp->conn_upcalls->su_set_proto_props)(connp->conn_upper_handle,
&sopp);
}
static void
udp_do_close(conn_t *connp)
{
udp_t *udp;
ASSERT(connp != NULL && IPCL_IS_UDP(connp));
udp = connp->conn_udp;
if (cl_inet_unbind != NULL && udp->udp_state == TS_IDLE) {
if (connp->conn_ipversion == IPV4_VERSION) {
(*cl_inet_unbind)(
connp->conn_netstack->netstack_stackid,
IPPROTO_UDP, AF_INET,
(uint8_t *)(&V4_PART_OF_V6(connp->conn_laddr_v6)),
(in_port_t)connp->conn_lport, NULL);
} else {
(*cl_inet_unbind)(
connp->conn_netstack->netstack_stackid,
IPPROTO_UDP, AF_INET6,
(uint8_t *)&(connp->conn_laddr_v6),
(in_port_t)connp->conn_lport, NULL);
}
}
udp_bind_hash_remove(udp, B_FALSE);
ip_quiesce_conn(connp);
if (!IPCL_IS_NONSTR(connp)) {
ASSERT(connp->conn_wq != NULL);
ASSERT(connp->conn_rq != NULL);
qprocsoff(connp->conn_rq);
}
udp_close_free(connp);
ASSERT(connp->conn_ref == 1);
if (!IPCL_IS_NONSTR(connp)) {
inet_minor_free(connp->conn_minor_arena, connp->conn_dev);
} else {
ip_free_helper_stream(connp);
}
connp->conn_ref--;
ipcl_conn_destroy(connp);
}
int
udp_close(sock_lower_handle_t proto_handle, int flags, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
ASSERT(cr != NULL);
udp_do_close(connp);
return (0);
}
static int
udp_do_bind(conn_t *connp, struct sockaddr *sa, socklen_t len, cred_t *cr,
boolean_t bind_to_req_port_only)
{
sin_t *sin;
sin6_t *sin6;
udp_t *udp = connp->conn_udp;
int error = 0;
ip_laddr_t laddr_type = IPVL_UNICAST_UP;
in_port_t port;
in_port_t requested_port;
int count;
ipaddr_t v4src;
in6_addr_t v6src;
int loopmax;
udp_fanout_t *udpf;
in_port_t lport;
uint_t scopeid = 0;
zoneid_t zoneid = IPCL_ZONEID(connp);
ip_stack_t *ipst = connp->conn_netstack->netstack_ip;
boolean_t is_inaddr_any;
mlp_type_t addrtype, mlptype;
udp_stack_t *us = udp->udp_us;
sin = NULL;
sin6 = NULL;
switch (len) {
case sizeof (sin_t):
sin = (sin_t *)sa;
if (sin == NULL || !OK_32PTR((char *)sin))
return (EINVAL);
if (connp->conn_family != AF_INET ||
sin->sin_family != AF_INET) {
return (EAFNOSUPPORT);
}
v4src = sin->sin_addr.s_addr;
IN6_IPADDR_TO_V4MAPPED(v4src, &v6src);
if (v4src != INADDR_ANY) {
laddr_type = ip_laddr_verify_v4(v4src, zoneid, ipst,
B_TRUE);
}
port = ntohs(sin->sin_port);
break;
case sizeof (sin6_t):
sin6 = (sin6_t *)sa;
if (sin6 == NULL || !OK_32PTR((char *)sin6))
return (EINVAL);
if (connp->conn_family != AF_INET6 ||
sin6->sin6_family != AF_INET6) {
return (EAFNOSUPPORT);
}
v6src = sin6->sin6_addr;
if (IN6_IS_ADDR_V4MAPPED(&v6src)) {
if (connp->conn_ipv6_v6only)
return (EADDRNOTAVAIL);
IN6_V4MAPPED_TO_IPADDR(&v6src, v4src);
if (v4src != INADDR_ANY) {
laddr_type = ip_laddr_verify_v4(v4src,
zoneid, ipst, B_FALSE);
}
} else {
if (!IN6_IS_ADDR_UNSPECIFIED(&v6src)) {
if (IN6_IS_ADDR_LINKSCOPE(&v6src))
scopeid = sin6->sin6_scope_id;
laddr_type = ip_laddr_verify_v6(&v6src,
zoneid, ipst, B_TRUE, scopeid);
}
}
port = ntohs(sin6->sin6_port);
break;
default:
(void) strlog(UDP_MOD_ID, 0, 1, SL_ERROR|SL_TRACE,
"udp_bind: bad ADDR_length length %u", len);
return (-TBADADDR);
}
if (laddr_type == IPVL_BAD)
return (EADDRNOTAVAIL);
requested_port = port;
if (requested_port == 0 || !bind_to_req_port_only)
bind_to_req_port_only = B_FALSE;
else
bind_to_req_port_only = B_TRUE;
if (requested_port == 0) {
if (connp->conn_anon_priv_bind) {
port = udp_get_next_priv_port(udp);
} else {
port = udp_update_next_port(udp,
us->us_next_port_to_try, B_TRUE);
}
} else {
int i;
boolean_t priv = B_FALSE;
if (port < us->us_smallest_nonpriv_port) {
priv = B_TRUE;
} else {
for (i = 0; i < us->us_num_epriv_ports; i++) {
if (port == us->us_epriv_ports[i]) {
priv = B_TRUE;
break;
}
}
}
if (priv) {
if (secpolicy_net_privaddr(cr, port, IPPROTO_UDP) != 0)
return (-TACCES);
}
}
if (port == 0)
return (-TNOADDR);
mutex_enter(&connp->conn_lock);
if (udp->udp_state != TS_UNBND) {
mutex_exit(&connp->conn_lock);
(void) strlog(UDP_MOD_ID, 0, 1, SL_ERROR|SL_TRACE,
"udp_bind: bad state, %u", udp->udp_state);
return (-TOUTSTATE);
}
if (connp->conn_family == AF_INET) {
ASSERT(sin != NULL);
ASSERT(connp->conn_ixa->ixa_flags & IXAF_IS_IPV4);
} else {
if (IN6_IS_ADDR_V4MAPPED(&v6src)) {
connp->conn_ipversion = IPV4_VERSION;
connp->conn_ixa->ixa_flags |= IXAF_IS_IPV4;
} else {
connp->conn_ipversion = IPV6_VERSION;
connp->conn_ixa->ixa_flags &= ~IXAF_IS_IPV4;
}
}
count = 0;
if (connp->conn_anon_priv_bind) {
loopmax = IPPORT_RESERVED - us->us_min_anonpriv_port;
} else {
loopmax = us->us_largest_anon_port -
us->us_smallest_anon_port + 1;
}
is_inaddr_any = V6_OR_V4_INADDR_ANY(v6src);
for (;;) {
udp_t *udp1;
boolean_t found_exclbind = B_FALSE;
conn_t *connp1;
lport = htons(port);
udpf = &us->us_bind_fanout[UDP_BIND_HASH(lport,
us->us_bind_fanout_size)];
mutex_enter(&udpf->uf_lock);
for (udp1 = udpf->uf_udp; udp1 != NULL;
udp1 = udp1->udp_bind_hash) {
connp1 = udp1->udp_connp;
if (lport != connp1->conn_lport)
continue;
if (!IPCL_BIND_ZONE_MATCH(connp1, connp))
continue;
if (connp1->conn_exclbind || connp->conn_exclbind ||
IPCL_CONNS_MAC(udp1->udp_connp, connp)) {
if (V6_OR_V4_INADDR_ANY(
connp1->conn_bound_addr_v6) ||
is_inaddr_any ||
IN6_ARE_ADDR_EQUAL(
&connp1->conn_bound_addr_v6,
&v6src)) {
found_exclbind = B_TRUE;
break;
}
continue;
}
if (connp->conn_ipversion != connp1->conn_ipversion) {
if (count == 0 && requested_port != 0)
continue;
}
if (!is_inaddr_any &&
!V6_OR_V4_INADDR_ANY(connp1->conn_bound_addr_v6) &&
!IN6_ARE_ADDR_EQUAL(&connp1->conn_laddr_v6,
&v6src)) {
continue;
}
break;
}
if (!found_exclbind &&
(connp->conn_reuseaddr && requested_port != 0)) {
break;
}
if (udp1 == NULL) {
break;
}
mutex_exit(&udpf->uf_lock);
if (bind_to_req_port_only) {
mutex_exit(&connp->conn_lock);
return (-TADDRBUSY);
}
if (connp->conn_anon_priv_bind) {
port = udp_get_next_priv_port(udp);
} else {
if ((count == 0) && (requested_port != 0)) {
port = udp_update_next_port(udp,
us->us_next_port_to_try, B_TRUE);
requested_port = 0;
} else {
port = udp_update_next_port(udp, port + 1,
B_FALSE);
}
}
if (port == 0 || ++count >= loopmax) {
mutex_exit(&connp->conn_lock);
return (-TNOADDR);
}
}
connp->conn_bound_addr_v6 = v6src;
connp->conn_laddr_v6 = v6src;
if (scopeid != 0) {
connp->conn_ixa->ixa_flags |= IXAF_SCOPEID_SET;
connp->conn_ixa->ixa_scopeid = scopeid;
connp->conn_incoming_ifindex = scopeid;
} else {
connp->conn_ixa->ixa_flags &= ~IXAF_SCOPEID_SET;
connp->conn_incoming_ifindex = connp->conn_bound_if;
}
switch (laddr_type) {
case IPVL_UNICAST_UP:
case IPVL_UNICAST_DOWN:
connp->conn_saddr_v6 = v6src;
connp->conn_mcbc_bind = B_FALSE;
break;
case IPVL_MCAST:
case IPVL_BCAST:
connp->conn_saddr_v6 = ipv6_all_zeros;
connp->conn_mcbc_bind = B_TRUE;
break;
}
connp->conn_lport = lport;
if ((requested_port == 0) && (!connp->conn_anon_priv_bind)) {
us->us_next_port_to_try = port + 1;
}
if (connp->conn_family == AF_INET) {
sin->sin_port = connp->conn_lport;
} else {
sin6->sin6_port = connp->conn_lport;
}
udp->udp_state = TS_IDLE;
udp_bind_hash_insert(udpf, udp);
mutex_exit(&udpf->uf_lock);
mutex_exit(&connp->conn_lock);
if (cl_inet_bind) {
if (connp->conn_ipversion == IPV4_VERSION) {
(*cl_inet_bind)(connp->conn_netstack->netstack_stackid,
IPPROTO_UDP, AF_INET, (uint8_t *)&v4src,
(in_port_t)connp->conn_lport, NULL);
} else {
(*cl_inet_bind)(connp->conn_netstack->netstack_stackid,
IPPROTO_UDP, AF_INET6, (uint8_t *)&v6src,
(in_port_t)connp->conn_lport, NULL);
}
}
mutex_enter(&connp->conn_lock);
connp->conn_anon_port = (is_system_labeled() && requested_port == 0);
if (is_system_labeled() && (!connp->conn_anon_port ||
connp->conn_anon_mlp)) {
uint16_t mlpport;
zone_t *zone;
zone = crgetzone(cr);
connp->conn_mlp_type =
connp->conn_recv_ancillary.crb_recvucred ? mlptBoth :
mlptSingle;
addrtype = tsol_mlp_addr_type(
connp->conn_allzones ? ALL_ZONES : zone->zone_id,
IPV6_VERSION, &v6src, us->us_netstack->netstack_ip);
if (addrtype == mlptSingle) {
error = -TNOADDR;
mutex_exit(&connp->conn_lock);
goto late_error;
}
mlpport = connp->conn_anon_port ? PMAPPORT : port;
mlptype = tsol_mlp_port_type(zone, IPPROTO_UDP, mlpport,
addrtype);
if (mlptype != mlptSingle &&
connp->conn_mlp_type == mlptSingle) {
error = EINVAL;
mutex_exit(&connp->conn_lock);
goto late_error;
}
if (mlptype != mlptSingle &&
secpolicy_net_bindmlp(cr) != 0) {
if (connp->conn_debug) {
(void) strlog(UDP_MOD_ID, 0, 1,
SL_ERROR|SL_TRACE,
"udp_bind: no priv for multilevel port %d",
mlpport);
}
error = -TACCES;
mutex_exit(&connp->conn_lock);
goto late_error;
}
if (mlptype == mlptShared && addrtype == mlptShared) {
zoneid_t mlpzone;
mlpzone = tsol_mlp_findzone(IPPROTO_UDP,
htons(mlpport));
if (connp->conn_zoneid != mlpzone) {
if (connp->conn_debug) {
(void) strlog(UDP_MOD_ID, 0, 1,
SL_ERROR|SL_TRACE,
"udp_bind: attempt to bind port "
"%d on shared addr in zone %d "
"(should be %d)",
mlpport, connp->conn_zoneid,
mlpzone);
}
error = -TACCES;
mutex_exit(&connp->conn_lock);
goto late_error;
}
}
if (connp->conn_anon_port) {
error = tsol_mlp_anon(zone, mlptype, connp->conn_proto,
port, B_TRUE);
if (error != 0) {
if (connp->conn_debug) {
(void) strlog(UDP_MOD_ID, 0, 1,
SL_ERROR|SL_TRACE,
"udp_bind: cannot establish anon "
"MLP for port %d", port);
}
error = -TACCES;
mutex_exit(&connp->conn_lock);
goto late_error;
}
}
connp->conn_mlp_type = mlptype;
}
error = udp_build_hdr_template(connp, &connp->conn_saddr_v6,
&connp->conn_faddr_v6, connp->conn_fport, connp->conn_flowinfo);
if (error != 0) {
mutex_exit(&connp->conn_lock);
goto late_error;
}
connp->conn_faddr_v6 = ipv6_all_zeros;
connp->conn_fport = 0;
connp->conn_v6lastdst = ipv6_all_zeros;
mutex_exit(&connp->conn_lock);
error = ip_laddr_fanout_insert(connp);
if (error != 0)
goto late_error;
return (0);
late_error:
mutex_enter(&connp->conn_lock);
udpf = &us->us_bind_fanout[
UDP_BIND_HASH(connp->conn_lport,
us->us_bind_fanout_size)];
mutex_enter(&udpf->uf_lock);
connp->conn_saddr_v6 = ipv6_all_zeros;
connp->conn_bound_addr_v6 = ipv6_all_zeros;
connp->conn_laddr_v6 = ipv6_all_zeros;
if (scopeid != 0) {
connp->conn_ixa->ixa_flags &= ~IXAF_SCOPEID_SET;
connp->conn_incoming_ifindex = connp->conn_bound_if;
}
udp->udp_state = TS_UNBND;
udp_bind_hash_remove(udp, B_TRUE);
connp->conn_lport = 0;
mutex_exit(&udpf->uf_lock);
connp->conn_anon_port = B_FALSE;
connp->conn_mlp_type = mlptSingle;
connp->conn_v6lastdst = ipv6_all_zeros;
(void) udp_build_hdr_template(connp, &connp->conn_saddr_v6,
&connp->conn_faddr_v6, connp->conn_fport, connp->conn_flowinfo);
mutex_exit(&connp->conn_lock);
return (error);
}
int
udp_bind(sock_lower_handle_t proto_handle, struct sockaddr *sa,
socklen_t len, cred_t *cr)
{
int error;
conn_t *connp;
ASSERT(cr != NULL);
connp = (conn_t *)proto_handle;
if (sa == NULL)
error = udp_do_unbind(connp);
else
error = udp_do_bind(connp, sa, len, cr, B_TRUE);
if (error < 0) {
if (error == -TOUTSTATE)
error = EINVAL;
else
error = proto_tlitosyserr(-error);
}
return (error);
}
static int
udp_implicit_bind(conn_t *connp, cred_t *cr)
{
sin6_t sin6addr;
sin_t *sin;
sin6_t *sin6;
socklen_t len;
int error;
ASSERT(cr != NULL);
if (connp->conn_family == AF_INET) {
len = sizeof (struct sockaddr_in);
sin = (sin_t *)&sin6addr;
*sin = sin_null;
sin->sin_family = AF_INET;
sin->sin_addr.s_addr = INADDR_ANY;
} else {
ASSERT(connp->conn_family == AF_INET6);
len = sizeof (sin6_t);
sin6 = (sin6_t *)&sin6addr;
*sin6 = sin6_null;
sin6->sin6_family = AF_INET6;
V6_SET_ZERO(sin6->sin6_addr);
}
error = udp_do_bind(connp, (struct sockaddr *)&sin6addr, len,
cr, B_FALSE);
return ((error < 0) ? proto_tlitosyserr(-error) : error);
}
static int
udp_do_unbind(conn_t *connp)
{
udp_t *udp = connp->conn_udp;
udp_fanout_t *udpf;
udp_stack_t *us = udp->udp_us;
if (cl_inet_unbind != NULL) {
if (connp->conn_ipversion == IPV4_VERSION) {
(*cl_inet_unbind)(
connp->conn_netstack->netstack_stackid,
IPPROTO_UDP, AF_INET,
(uint8_t *)(&V4_PART_OF_V6(connp->conn_laddr_v6)),
(in_port_t)connp->conn_lport, NULL);
} else {
(*cl_inet_unbind)(
connp->conn_netstack->netstack_stackid,
IPPROTO_UDP, AF_INET6,
(uint8_t *)&(connp->conn_laddr_v6),
(in_port_t)connp->conn_lport, NULL);
}
}
mutex_enter(&connp->conn_lock);
if (udp->udp_state == TS_UNBND) {
mutex_exit(&connp->conn_lock);
return (-TOUTSTATE);
}
udpf = &us->us_bind_fanout[UDP_BIND_HASH(connp->conn_lport,
us->us_bind_fanout_size)];
mutex_enter(&udpf->uf_lock);
udp_bind_hash_remove(udp, B_TRUE);
connp->conn_saddr_v6 = ipv6_all_zeros;
connp->conn_bound_addr_v6 = ipv6_all_zeros;
connp->conn_laddr_v6 = ipv6_all_zeros;
connp->conn_mcbc_bind = B_FALSE;
connp->conn_lport = 0;
connp->conn_faddr_v6 = ipv6_all_zeros;
connp->conn_fport = 0;
mutex_exit(&udpf->uf_lock);
connp->conn_v6lastdst = ipv6_all_zeros;
udp->udp_state = TS_UNBND;
(void) udp_build_hdr_template(connp, &connp->conn_saddr_v6,
&connp->conn_faddr_v6, connp->conn_fport, connp->conn_flowinfo);
mutex_exit(&connp->conn_lock);
ip_unbind(connp);
return (0);
}
static int
udp_do_connect(conn_t *connp, const struct sockaddr *sa, socklen_t len,
cred_t *cr, pid_t pid)
{
sin6_t *sin6;
sin_t *sin;
in6_addr_t v6dst;
ipaddr_t v4dst;
uint16_t dstport;
uint32_t flowinfo;
udp_fanout_t *udpf;
udp_t *udp, *udp1;
ushort_t ipversion;
udp_stack_t *us;
int error;
conn_t *connp1;
ip_xmit_attr_t *ixa;
ip_xmit_attr_t *oldixa;
uint_t scopeid = 0;
uint_t srcid = 0;
in6_addr_t v6src = connp->conn_saddr_v6;
boolean_t v4mapped;
udp = connp->conn_udp;
us = udp->udp_us;
sin = NULL;
sin6 = NULL;
v4dst = INADDR_ANY;
flowinfo = 0;
switch (len) {
default:
return (EINVAL);
case sizeof (sin_t):
sin = (sin_t *)sa;
v4dst = sin->sin_addr.s_addr;
dstport = sin->sin_port;
IN6_IPADDR_TO_V4MAPPED(v4dst, &v6dst);
ASSERT(connp->conn_ipversion == IPV4_VERSION);
ipversion = IPV4_VERSION;
break;
case sizeof (sin6_t):
sin6 = (sin6_t *)sa;
v6dst = sin6->sin6_addr;
dstport = sin6->sin6_port;
srcid = sin6->__sin6_src_id;
v4mapped = IN6_IS_ADDR_V4MAPPED(&v6dst);
if (srcid != 0 && IN6_IS_ADDR_UNSPECIFIED(&v6src)) {
if (!ip_srcid_find_id(srcid, &v6src, IPCL_ZONEID(connp),
v4mapped, connp->conn_netstack)) {
return (EADDRNOTAVAIL);
}
}
if (v4mapped) {
if (connp->conn_ipv6_v6only)
return (EADDRNOTAVAIL);
if (!IN6_IS_ADDR_UNSPECIFIED(
&connp->conn_bound_addr_v6) &&
!IN6_IS_ADDR_V4MAPPED(&connp->conn_bound_addr_v6)) {
return (EADDRNOTAVAIL);
}
IN6_V4MAPPED_TO_IPADDR(&v6dst, v4dst);
ipversion = IPV4_VERSION;
flowinfo = 0;
} else {
ipversion = IPV6_VERSION;
flowinfo = sin6->sin6_flowinfo;
if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))
scopeid = sin6->sin6_scope_id;
}
break;
}
if (dstport == 0)
return (-TBADADDR);
ixa = conn_get_ixa(connp, B_FALSE);
if (ixa == NULL)
return (ENOMEM);
mutex_enter(&connp->conn_lock);
if (udp->udp_state == TS_UNBND || udp->udp_state == TS_WCON_CREQ) {
mutex_exit(&connp->conn_lock);
(void) strlog(UDP_MOD_ID, 0, 1, SL_ERROR|SL_TRACE,
"udp_connect: bad state, %u", udp->udp_state);
ixa_refrele(ixa);
return (-TOUTSTATE);
}
ASSERT(connp->conn_lport != 0 && udp->udp_ptpbhn != NULL);
udpf = &us->us_bind_fanout[UDP_BIND_HASH(connp->conn_lport,
us->us_bind_fanout_size)];
mutex_enter(&udpf->uf_lock);
if (udp->udp_state == TS_DATA_XFER) {
if (connp->conn_mcbc_bind)
connp->conn_saddr_v6 = ipv6_all_zeros;
else
connp->conn_saddr_v6 = connp->conn_bound_addr_v6;
connp->conn_laddr_v6 = connp->conn_bound_addr_v6;
connp->conn_faddr_v6 = ipv6_all_zeros;
connp->conn_fport = 0;
udp->udp_state = TS_IDLE;
}
connp->conn_fport = dstport;
connp->conn_ipversion = ipversion;
if (ipversion == IPV4_VERSION) {
if (v4dst == INADDR_ANY) {
v4dst = htonl(INADDR_LOOPBACK);
IN6_IPADDR_TO_V4MAPPED(v4dst, &v6dst);
if (connp->conn_family == AF_INET) {
sin->sin_addr.s_addr = v4dst;
} else {
sin6->sin6_addr = v6dst;
}
}
connp->conn_faddr_v6 = v6dst;
connp->conn_flowinfo = 0;
} else {
ASSERT(connp->conn_ipversion == IPV6_VERSION);
if (IN6_IS_ADDR_UNSPECIFIED(&v6dst)) {
v6dst = ipv6_loopback;
sin6->sin6_addr = v6dst;
}
connp->conn_faddr_v6 = v6dst;
connp->conn_flowinfo = flowinfo;
}
mutex_exit(&udpf->uf_lock);
if (connp->conn_cred != cr) {
crhold(cr);
crfree(connp->conn_cred);
connp->conn_cred = cr;
}
connp->conn_cpid = pid;
ASSERT(!(ixa->ixa_free_flags & IXA_FREE_CRED));
ixa->ixa_cred = cr;
ixa->ixa_cpid = pid;
if (is_system_labeled()) {
ip_xmit_attr_restore_tsl(ixa, ixa->ixa_cred);
}
if (scopeid != 0) {
ixa->ixa_flags |= IXAF_SCOPEID_SET;
ixa->ixa_scopeid = scopeid;
connp->conn_incoming_ifindex = scopeid;
} else {
ixa->ixa_flags &= ~IXAF_SCOPEID_SET;
connp->conn_incoming_ifindex = connp->conn_bound_if;
}
connp->conn_v6lastdst = ipv6_all_zeros;
udp->udp_state = TS_WCON_CREQ;
error = conn_connect(connp, NULL, IPDF_ALLOW_MCBC);
mutex_exit(&connp->conn_lock);
if (error != 0)
goto connect_failed;
error = ipcl_conn_insert(connp);
if (error != 0)
goto connect_failed;
mutex_enter(&connp->conn_lock);
error = udp_build_hdr_template(connp, &connp->conn_saddr_v6,
&connp->conn_faddr_v6, connp->conn_fport, connp->conn_flowinfo);
if (error != 0) {
mutex_exit(&connp->conn_lock);
goto connect_failed;
}
udp->udp_state = TS_DATA_XFER;
connp->conn_v6lastdst = connp->conn_faddr_v6;
connp->conn_lastipversion = connp->conn_ipversion;
connp->conn_lastdstport = connp->conn_fport;
connp->conn_lastflowinfo = connp->conn_flowinfo;
connp->conn_lastscopeid = scopeid;
connp->conn_lastsrcid = srcid;
connp->conn_v6lastsrc = v6src;
oldixa = conn_replace_ixa(connp, ixa);
mutex_exit(&connp->conn_lock);
ixa_refrele(oldixa);
mutex_enter(&udpf->uf_lock);
for (udp1 = udpf->uf_udp; udp1 != NULL; udp1 = udp1->udp_bind_hash) {
if (udp1->udp_state != TS_DATA_XFER)
continue;
if (udp1 == udp)
continue;
connp1 = udp1->udp_connp;
if (connp->conn_lport != connp1->conn_lport ||
connp->conn_ipversion != connp1->conn_ipversion ||
dstport != connp1->conn_fport ||
!IN6_ARE_ADDR_EQUAL(&connp->conn_laddr_v6,
&connp1->conn_laddr_v6) ||
!IN6_ARE_ADDR_EQUAL(&v6dst, &connp1->conn_faddr_v6) ||
!(IPCL_ZONE_MATCH(connp, connp1->conn_zoneid) ||
IPCL_ZONE_MATCH(connp1, connp->conn_zoneid)))
continue;
mutex_exit(&udpf->uf_lock);
error = -TBADADDR;
goto connect_failed;
}
if (cl_inet_connect2 != NULL) {
CL_INET_UDP_CONNECT(connp, B_TRUE, &v6dst, dstport, error);
if (error != 0) {
mutex_exit(&udpf->uf_lock);
error = -TBADADDR;
goto connect_failed;
}
}
mutex_exit(&udpf->uf_lock);
ixa_refrele(ixa);
return (0);
connect_failed:
if (ixa != NULL)
ixa_refrele(ixa);
mutex_enter(&connp->conn_lock);
mutex_enter(&udpf->uf_lock);
udp->udp_state = TS_IDLE;
connp->conn_faddr_v6 = ipv6_all_zeros;
connp->conn_fport = 0;
if (connp->conn_mcbc_bind)
connp->conn_saddr_v6 = ipv6_all_zeros;
else
connp->conn_saddr_v6 = connp->conn_bound_addr_v6;
connp->conn_laddr_v6 = connp->conn_bound_addr_v6;
mutex_exit(&udpf->uf_lock);
connp->conn_v6lastdst = ipv6_all_zeros;
connp->conn_flowinfo = 0;
(void) udp_build_hdr_template(connp, &connp->conn_saddr_v6,
&connp->conn_faddr_v6, connp->conn_fport, connp->conn_flowinfo);
mutex_exit(&connp->conn_lock);
return (error);
}
static int
udp_connect(sock_lower_handle_t proto_handle, const struct sockaddr *sa,
socklen_t len, sock_connid_t *id, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
udp_t *udp = connp->conn_udp;
int error;
boolean_t did_bind = B_FALSE;
pid_t pid = curproc->p_pid;
ASSERT(cr != NULL);
if (sa == NULL) {
if (udp->udp_state != TS_DATA_XFER)
return (EINVAL);
error = udp_disconnect(connp);
return (error);
}
error = proto_verify_ip_addr(connp->conn_family, sa, len);
if (error != 0)
goto done;
if (udp->udp_state == TS_UNBND) {
error = udp_implicit_bind(connp, cr);
if (!(error == 0 || error == EPROTO))
goto done;
did_bind = B_TRUE;
}
connp->conn_dgram_errind = B_TRUE;
error = udp_do_connect(connp, sa, len, cr, pid);
if (error != 0 && did_bind) {
int unbind_err;
unbind_err = udp_do_unbind(connp);
ASSERT(unbind_err == 0);
}
if (error == 0) {
*id = 0;
(*connp->conn_upcalls->su_connected)
(connp->conn_upper_handle, 0, NULL, -1);
} else if (error < 0) {
error = proto_tlitosyserr(-error);
}
done:
if (error != 0 && udp->udp_state == TS_DATA_XFER) {
udp->udp_state = TS_IDLE;
}
return (error);
}
int
udp_send(sock_lower_handle_t proto_handle, mblk_t *mp, struct nmsghdr *msg,
cred_t *cr)
{
sin6_t *sin6;
sin_t *sin = NULL;
uint_t srcid;
conn_t *connp = (conn_t *)proto_handle;
udp_t *udp = connp->conn_udp;
int error = 0;
udp_stack_t *us = udp->udp_us;
ushort_t ipversion;
pid_t pid = curproc->p_pid;
ip_xmit_attr_t *ixa;
ASSERT(DB_TYPE(mp) == M_DATA);
ASSERT(cr != NULL);
if (udp->udp_state == TS_UNBND) {
error = udp_implicit_bind(connp, cr);
if (!(error == 0 || error == EPROTO)) {
freemsg(mp);
return (error);
}
}
if (msg->msg_name == NULL) {
if (udp->udp_state != TS_DATA_XFER) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (EDESTADDRREQ);
}
if (msg->msg_controllen != 0) {
error = udp_output_ancillary(connp, NULL, NULL, mp,
NULL, msg, cr, pid);
} else {
error = udp_output_connected(connp, mp, cr, pid);
}
if (us->us_sendto_ignerr)
return (0);
else
return (error);
}
if (udp->udp_state == TS_DATA_XFER) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (EISCONN);
}
error = proto_verify_ip_addr(connp->conn_family,
(struct sockaddr *)msg->msg_name, msg->msg_namelen);
if (error != 0) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (error);
}
switch (connp->conn_family) {
case AF_INET6:
sin6 = (sin6_t *)msg->msg_name;
srcid = sin6->__sin6_src_id;
if (!IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
if (IN6_IS_ADDR_V4MAPPED(&connp->conn_saddr_v6)) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (EADDRNOTAVAIL);
}
if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr))
sin6->sin6_addr = ipv6_loopback;
ipversion = IPV6_VERSION;
} else {
if (connp->conn_ipv6_v6only) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (EADDRNOTAVAIL);
}
if (!IN6_IS_ADDR_V4MAPPED(&connp->conn_saddr_v6) &&
!IN6_IS_ADDR_UNSPECIFIED(&connp->conn_saddr_v6)) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (EADDRNOTAVAIL);
}
if (V4_PART_OF_V6(sin6->sin6_addr) == INADDR_ANY) {
V4_PART_OF_V6(sin6->sin6_addr) =
htonl(INADDR_LOOPBACK);
}
ipversion = IPV4_VERSION;
}
if (msg->msg_controllen == 0) {
ixa = conn_get_ixa(connp, B_FALSE);
if (ixa == NULL) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (ENOMEM);
}
} else {
ixa = NULL;
}
mutex_enter(&connp->conn_lock);
if (udp->udp_delayed_error != 0) {
sin6_t *sin2 = (sin6_t *)&udp->udp_delayed_addr;
error = udp->udp_delayed_error;
udp->udp_delayed_error = 0;
if (sin6->sin6_port == sin2->sin6_port &&
IN6_ARE_ADDR_EQUAL(&sin6->sin6_addr,
&sin2->sin6_addr) &&
sin6->sin6_family == sin2->sin6_family) {
mutex_exit(&connp->conn_lock);
UDPS_BUMP_MIB(us, udpOutErrors);
if (ixa != NULL)
ixa_refrele(ixa);
return (error);
}
}
if (msg->msg_controllen != 0) {
mutex_exit(&connp->conn_lock);
ASSERT(ixa == NULL);
error = udp_output_ancillary(connp, NULL, sin6, mp,
NULL, msg, cr, pid);
} else if (conn_same_as_last_v6(connp, sin6) &&
connp->conn_lastsrcid == srcid &&
ipsec_outbound_policy_current(ixa)) {
error = udp_output_lastdst(connp, mp, cr, pid, ixa);
} else {
error = udp_output_newdst(connp, mp, NULL, sin6,
ipversion, cr, pid, ixa);
}
ASSERT(MUTEX_NOT_HELD(&connp->conn_lock));
if (us->us_sendto_ignerr)
return (0);
else
return (error);
case AF_INET:
sin = (sin_t *)msg->msg_name;
ipversion = IPV4_VERSION;
if (sin->sin_addr.s_addr == INADDR_ANY)
sin->sin_addr.s_addr = htonl(INADDR_LOOPBACK);
if (msg->msg_controllen == 0) {
ixa = conn_get_ixa(connp, B_FALSE);
if (ixa == NULL) {
UDPS_BUMP_MIB(us, udpOutErrors);
return (ENOMEM);
}
} else {
ixa = NULL;
}
mutex_enter(&connp->conn_lock);
if (udp->udp_delayed_error != 0) {
sin_t *sin2 = (sin_t *)&udp->udp_delayed_addr;
error = udp->udp_delayed_error;
udp->udp_delayed_error = 0;
if (sin->sin_port == sin2->sin_port &&
sin->sin_addr.s_addr == sin2->sin_addr.s_addr) {
mutex_exit(&connp->conn_lock);
UDPS_BUMP_MIB(us, udpOutErrors);
if (ixa != NULL)
ixa_refrele(ixa);
return (error);
}
}
if (msg->msg_controllen != 0) {
mutex_exit(&connp->conn_lock);
ASSERT(ixa == NULL);
error = udp_output_ancillary(connp, sin, NULL, mp,
NULL, msg, cr, pid);
} else if (conn_same_as_last_v4(connp, sin) &&
ipsec_outbound_policy_current(ixa)) {
error = udp_output_lastdst(connp, mp, cr, pid, ixa);
} else {
error = udp_output_newdst(connp, mp, sin, NULL,
ipversion, cr, pid, ixa);
}
ASSERT(MUTEX_NOT_HELD(&connp->conn_lock));
if (us->us_sendto_ignerr)
return (0);
else
return (error);
default:
return (EINVAL);
}
}
int
udp_fallback(sock_lower_handle_t proto_handle, queue_t *q,
boolean_t issocket, so_proto_quiesced_cb_t quiesced_cb,
sock_quiesce_arg_t *arg)
{
conn_t *connp = (conn_t *)proto_handle;
udp_t *udp;
struct T_capability_ack tca;
struct sockaddr_in6 laddr, faddr;
socklen_t laddrlen, faddrlen;
short opts;
struct stroptions *stropt;
mblk_t *mp, *stropt_mp;
int error;
udp = connp->conn_udp;
stropt_mp = allocb_wait(sizeof (*stropt), BPRI_HI, STR_NOSIG, NULL);
connp->conn_dev = (dev_t)RD(q)->q_ptr;
connp->conn_minor_arena = WR(q)->q_ptr;
RD(q)->q_ptr = WR(q)->q_ptr = connp;
WR(q)->q_qinfo = &udp_winit;
connp->conn_rq = RD(q);
connp->conn_wq = WR(q);
stropt_mp->b_datap->db_type = M_SETOPTS;
stropt_mp->b_wptr += sizeof (*stropt);
stropt = (struct stroptions *)stropt_mp->b_rptr;
stropt->so_flags = SO_WROFF | SO_HIWAT;
stropt->so_wroff = connp->conn_wroff;
stropt->so_hiwat = udp->udp_rcv_disply_hiwat;
putnext(RD(q), stropt_mp);
ip_free_helper_stream(connp);
if (!issocket)
udp_use_pure_tpi(udp);
udp_do_capability_ack(udp, &tca, TC1_INFO);
laddrlen = faddrlen = sizeof (sin6_t);
(void) udp_getsockname((sock_lower_handle_t)connp,
(struct sockaddr *)&laddr, &laddrlen, CRED());
error = udp_getpeername((sock_lower_handle_t)connp,
(struct sockaddr *)&faddr, &faddrlen, CRED());
if (error != 0)
faddrlen = 0;
opts = 0;
if (connp->conn_dgram_errind)
opts |= SO_DGRAM_ERRIND;
if (connp->conn_ixa->ixa_flags & IXAF_DONTROUTE)
opts |= SO_DONTROUTE;
mp = (*quiesced_cb)(connp->conn_upper_handle, arg, &tca,
(struct sockaddr *)&laddr, laddrlen,
(struct sockaddr *)&faddr, faddrlen, opts);
mutex_enter(&udp->udp_recv_lock);
if (mp != NULL) {
mp->b_next = udp->udp_fallback_queue_head;
udp->udp_fallback_queue_head = mp;
}
while (udp->udp_fallback_queue_head != NULL) {
mp = udp->udp_fallback_queue_head;
udp->udp_fallback_queue_head = mp->b_next;
mutex_exit(&udp->udp_recv_lock);
mp->b_next = NULL;
putnext(RD(q), mp);
mutex_enter(&udp->udp_recv_lock);
}
udp->udp_fallback_queue_tail = udp->udp_fallback_queue_head;
mutex_enter(&connp->conn_lock);
connp->conn_flags &= ~IPCL_NONSTR;
mutex_exit(&connp->conn_lock);
mutex_exit(&udp->udp_recv_lock);
ASSERT(connp->conn_ref >= 1);
return (0);
}
int
udp_getpeername(sock_lower_handle_t proto_handle, struct sockaddr *sa,
socklen_t *salenp, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
udp_t *udp = connp->conn_udp;
int error;
ASSERT(cr != NULL);
mutex_enter(&connp->conn_lock);
if (udp->udp_state != TS_DATA_XFER)
error = ENOTCONN;
else
error = conn_getpeername(connp, sa, salenp);
mutex_exit(&connp->conn_lock);
return (error);
}
int
udp_getsockname(sock_lower_handle_t proto_handle, struct sockaddr *sa,
socklen_t *salenp, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
int error;
ASSERT(cr != NULL);
mutex_enter(&connp->conn_lock);
error = conn_getsockname(connp, sa, salenp);
mutex_exit(&connp->conn_lock);
return (error);
}
int
udp_getsockopt(sock_lower_handle_t proto_handle, int level, int option_name,
void *optvalp, socklen_t *optlen, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
int error;
t_uscalar_t max_optbuf_len;
void *optvalp_buf;
int len;
ASSERT(cr != NULL);
error = proto_opt_check(level, option_name, *optlen, &max_optbuf_len,
udp_opt_obj.odb_opt_des_arr,
udp_opt_obj.odb_opt_arr_cnt,
B_FALSE, B_TRUE, cr);
if (error != 0) {
if (error < 0)
error = proto_tlitosyserr(-error);
return (error);
}
optvalp_buf = kmem_alloc(max_optbuf_len, KM_SLEEP);
len = udp_opt_get(connp, level, option_name, optvalp_buf);
if (len == -1) {
kmem_free(optvalp_buf, max_optbuf_len);
return (EINVAL);
}
t_uscalar_t size = MIN(len, *optlen);
bcopy(optvalp_buf, optvalp, size);
bcopy(&size, optlen, sizeof (size));
kmem_free(optvalp_buf, max_optbuf_len);
return (0);
}
int
udp_setsockopt(sock_lower_handle_t proto_handle, int level, int option_name,
const void *optvalp, socklen_t optlen, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
int error;
ASSERT(cr != NULL);
error = proto_opt_check(level, option_name, optlen, NULL,
udp_opt_obj.odb_opt_des_arr,
udp_opt_obj.odb_opt_arr_cnt,
B_TRUE, B_FALSE, cr);
if (error != 0) {
if (error < 0)
error = proto_tlitosyserr(-error);
return (error);
}
error = udp_opt_set(connp, SETFN_OPTCOM_NEGOTIATE, level, option_name,
optlen, (uchar_t *)optvalp, (uint_t *)&optlen, (uchar_t *)optvalp,
NULL, cr);
ASSERT(error >= 0);
return (error);
}
void
udp_clr_flowctrl(sock_lower_handle_t proto_handle)
{
conn_t *connp = (conn_t *)proto_handle;
udp_t *udp = connp->conn_udp;
mutex_enter(&udp->udp_recv_lock);
connp->conn_flow_cntrld = B_FALSE;
mutex_exit(&udp->udp_recv_lock);
}
int
udp_shutdown(sock_lower_handle_t proto_handle, int how, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
ASSERT(cr != NULL);
if (how != SHUT_RD)
(*connp->conn_upcalls->su_opctl)(connp->conn_upper_handle,
SOCK_OPCTL_SHUT_SEND, 0);
if (how != SHUT_WR)
(*connp->conn_upcalls->su_opctl)(connp->conn_upper_handle,
SOCK_OPCTL_SHUT_RECV, 0);
return (0);
}
int
udp_ioctl(sock_lower_handle_t proto_handle, int cmd, intptr_t arg,
int mode, int32_t *rvalp, cred_t *cr)
{
conn_t *connp = (conn_t *)proto_handle;
int error;
ASSERT(cr != NULL);
if (connp->conn_helper_info == NULL) {
udp_stack_t *us = connp->conn_udp->udp_us;
ASSERT(us->us_ldi_ident != NULL);
error = ip_create_helper_stream(connp, us->us_ldi_ident);
if (error != 0) {
ip0dbg(("udp_ioctl: create of IP helper stream "
"failed %d\n", error));
return (error);
}
}
switch (cmd) {
case _SIOCSOCKFALLBACK:
case TI_GETPEERNAME:
case TI_GETMYNAME:
ip1dbg(("udp_ioctl: cmd 0x%x on non streams socket",
cmd));
error = EINVAL;
break;
default:
error = ldi_ioctl(connp->conn_helper_info->iphs_handle,
cmd, arg, mode, cr, rvalp);
break;
}
return (error);
}
int
udp_accept(sock_lower_handle_t lproto_handle,
sock_lower_handle_t eproto_handle, sock_upper_handle_t sock_handle,
cred_t *cr)
{
return (EOPNOTSUPP);
}
int
udp_listen(sock_lower_handle_t proto_handle, int backlog, cred_t *cr)
{
return (EOPNOTSUPP);
}
sock_downcalls_t sock_udp_downcalls = {
udp_activate,
udp_accept,
udp_bind,
udp_listen,
udp_connect,
udp_getpeername,
udp_getsockname,
udp_getsockopt,
udp_setsockopt,
udp_send,
NULL,
NULL,
NULL,
udp_shutdown,
udp_clr_flowctrl,
udp_ioctl,
udp_close
};