int
ikev1_dispatch_ikev2(int fd, struct privsep_proc *p, struct imsg *imsg)
{
struct iked *env = p->p_env;
struct iked_message msg;
uint8_t *buf;
ssize_t len;
switch (imsg->hdr.type) {
case IMSG_IKE_MESSAGE:
log_debug("%s: message", __func__);
IMSG_SIZE_CHECK(imsg, &msg);
memcpy(&msg, imsg->data, sizeof(msg));
len = IMSG_DATA_SIZE(imsg) - sizeof(msg);
buf = (uint8_t *)imsg->data + sizeof(msg);
if (len <= 0 || (msg.msg_data = ibuf_new(buf, len)) == NULL) {
log_debug("%s: short message", __func__);
return (0);
}
log_debug("%s: message length %zd", __func__, len);
ikev1_recv(env, &msg);
ikev2_msg_cleanup(env, &msg);
return (0);
default:
break;
}
return (-1);
}
void
ikev2_msg_cb(int fd, short event, void *arg)
{
struct iked_socket *sock = arg;
struct iked *env = sock->sock_env;
struct iked_message msg;
struct ike_header hdr;
uint32_t natt = 0x00000000;
uint8_t buf[IKED_MSGBUF_MAX];
ssize_t len;
off_t off;
bzero(&msg, sizeof(msg));
bzero(buf, sizeof(buf));
msg.msg_peerlen = sizeof(msg.msg_peer);
msg.msg_locallen = sizeof(msg.msg_local);
msg.msg_parent = &msg;
memcpy(&msg.msg_local, &sock->sock_addr, sizeof(sock->sock_addr));
if ((len = recvfromto(fd, buf, sizeof(buf), 0,
(struct sockaddr *)&msg.msg_peer, &msg.msg_peerlen,
(struct sockaddr *)&msg.msg_local, &msg.msg_locallen)) <
(ssize_t)sizeof(natt))
return;
if (socket_getport((struct sockaddr *)&msg.msg_local) ==
IKED_NATT_PORT) {
if (memcmp(&natt, buf, sizeof(natt)) != 0)
return;
msg.msg_natt = 1;
off = sizeof(natt);
} else
off = 0;
if ((size_t)(len - off) <= sizeof(hdr))
return;
memcpy(&hdr, buf + off, sizeof(hdr));
if ((msg.msg_data = ibuf_new(buf + off, len - off)) == NULL)
return;
TAILQ_INIT(&msg.msg_proposals);
msg.msg_fd = fd;
if (hdr.ike_version == IKEV1_VERSION)
ikev1_recv(env, &msg);
else
ikev2_recv(env, &msg);
ikev2_msg_cleanup(env, &msg);
}
void
ikev1_msg_cb(int fd, short event, void *arg)
{
struct iked_socket *sock = arg;
struct iked *env = sock->sock_env;
struct iked_message msg;
struct ike_header hdr;
uint8_t buf[IKED_MSGBUF_MAX];
size_t len;
struct iovec iov[2];
msg.msg_peerlen = sizeof(msg.msg_peer);
msg.msg_locallen = sizeof(msg.msg_local);
if ((len = recvfromto(fd, buf, sizeof(buf), 0,
(struct sockaddr*)&msg.msg_peer, &msg.msg_peerlen,
(struct sockaddr*)&msg.msg_local, &msg.msg_locallen)) < 1)
return;
if ((size_t)len <= sizeof(hdr))
return;
memcpy(&hdr, buf, sizeof(hdr));
if ((msg.msg_data = ibuf_new(buf, len)) == NULL)
return;
if (hdr.ike_version == IKEV2_VERSION) {
iov[0].iov_base = &msg;
iov[0].iov_len = sizeof(msg);
iov[1].iov_base = buf;
iov[1].iov_len = len;
proc_composev_imsg(&env->sc_ps, PROC_IKEV2, -1,
IMSG_IKE_MESSAGE, -1, iov, 2);
goto done;
}
ikev1_recv(env, &msg);
done:
ikev2_msg_cleanup(env, &msg);
}
