#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: krpc_subr.c,v 1.44 2024/10/20 14:01:52 mlelstv Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/ioctl.h>
#include <sys/proc.h>
#include <sys/mount.h>
#include <sys/mbuf.h>
#include <sys/reboot.h>
#include <sys/socket.h>
#include <sys/socketvar.h>
#include <netinet/in.h>
#include <nfs/rpcv2.h>
#include <nfs/krpc.h>
#include <nfs/xdr_subs.h>
#include <nfs/nfsproto.h>
#include <nfs/nfs.h>
#include <nfs/nfsmount.h>
#include <nfs/nfsdiskless.h>
struct auth_info {
u_int32_t authtype;
u_int32_t authlen;
};
struct auth_unix {
int32_t ua_time;
int32_t ua_hostname;
int32_t ua_uid;
int32_t ua_gid;
int32_t ua_gidlist;
};
struct rpc_call {
u_int32_t rp_xid;
int32_t rp_direction;
u_int32_t rp_rpcvers;
u_int32_t rp_prog;
u_int32_t rp_vers;
u_int32_t rp_proc;
struct auth_info rpc_auth;
struct auth_unix rpc_unix;
struct auth_info rpc_verf;
};
struct rpc_reply {
u_int32_t rp_xid;
int32_t rp_direction;
int32_t rp_astatus;
union {
struct {
u_int32_t rej_stat;
u_int32_t rej_val1;
u_int32_t rej_val2;
} rpu_rej;
struct {
struct auth_info rok_auth;
u_int32_t rok_status;
} rpu_rok;
} rp_u;
};
#define rp_rstat rp_u.rpu_rej.rej_stat
#define rp_auth rp_u.rpu_rok.rok_auth
#define rp_status rp_u.rpu_rok.rok_status
#define MIN_REPLY_HDR 16
static int krpccheck(struct mbuf**, void*);
int
krpc_portmap(struct sockaddr_in *sin, u_int prog, u_int vers, u_int proto, u_int16_t *portp, struct lwp *l)
{
struct sdata {
u_int32_t prog;
u_int32_t vers;
u_int32_t proto;
u_int32_t port;
} *sdata;
struct rdata {
u_int16_t pad;
u_int16_t port;
} *rdata;
struct mbuf *m;
int error;
if (prog == PMAPPROG) {
*portp = htons(PMAPPORT);
return 0;
}
m = m_get(M_WAIT, MT_DATA);
sdata = mtod(m, struct sdata *);
m->m_len = sizeof(*sdata);
sdata->prog = txdr_unsigned(prog);
sdata->vers = txdr_unsigned(vers);
sdata->proto = txdr_unsigned(proto);
sdata->port = 0;
sin->sin_port = htons(PMAPPORT);
error = krpc_call(sin, PMAPPROG, PMAPVERS,
PMAPPROC_GETPORT, &m, NULL, l);
if (error)
return error;
if (m->m_len < sizeof(*rdata)) {
m = m_pullup(m, sizeof(*rdata));
if (m == NULL)
return ENOBUFS;
}
rdata = mtod(m, struct rdata *);
*portp = rdata->port;
m_freem(m);
return 0;
}
static int krpccheck(struct mbuf **mp, void *context)
{
struct rpc_reply *reply;
struct mbuf *m = *mp;
if (m->m_pkthdr.len < MIN_REPLY_HDR)
return(-1);
if (m->m_len < sizeof(struct rpc_reply)) {
m = *mp = m_pullup(m, sizeof(struct rpc_reply));
if (m == NULL)
return(-1);
}
reply = mtod(m, struct rpc_reply *);
if (reply->rp_direction != txdr_unsigned(RPC_REPLY))
return(-1);
if (reply->rp_xid != txdr_unsigned(*(u_int32_t*)context))
return(-1);
return(0);
}
int
krpc_call(struct sockaddr_in *sa, u_int prog, u_int vers, u_int func, struct mbuf **data, struct mbuf **from_p, struct lwp *l)
{
struct socket *so;
struct sockaddr_in sin;
struct mbuf *m, *mhead, *from;
struct rpc_call *call;
struct rpc_reply *reply;
int error, len;
static u_int32_t xid = ~0xFF;
u_int16_t tport;
if (sa->sin_family != AF_INET)
return (EAFNOSUPPORT);
mhead = NULL;
from = NULL;
if ((error = socreate(AF_INET, &so, SOCK_DGRAM, 0, l, NULL)))
return error;
if ((error = nfs_boot_setrecvtimo(so)))
goto out;
if (from_p) {
if ((error = nfs_boot_enbroadcast(so)))
goto out;
}
tport = IPPORT_RESERVED;
do {
tport--;
error = nfs_boot_sobind_ipport(so, tport, l);
} while (error == EADDRINUSE &&
tport > IPPORT_RESERVED / 2);
if (error) {
printf("bind failed\n");
goto out;
}
sin = *sa;
mhead = m_gethdr(M_WAIT, MT_DATA);
MCLAIM(mhead, &nfs_mowner);
mhead->m_next = *data;
call = mtod(mhead, struct rpc_call *);
mhead->m_len = sizeof(*call);
memset((void *)call, 0, sizeof(*call));
xid++;
call->rp_xid = txdr_unsigned(xid);
call->rp_rpcvers = txdr_unsigned(2);
call->rp_prog = txdr_unsigned(prog);
call->rp_vers = txdr_unsigned(vers);
call->rp_proc = txdr_unsigned(func);
call->rpc_auth.authtype = txdr_unsigned(RPCAUTH_UNIX);
call->rpc_auth.authlen = txdr_unsigned(sizeof(struct auth_unix));
call->rpc_verf.authtype = 0;
call->rpc_verf.authlen = 0;
len = 0;
m = mhead;
while (m) {
len += m->m_len;
m = m->m_next;
}
mhead->m_pkthdr.len = len;
m_reset_rcvif(mhead);
error = nfs_boot_sendrecv(so, &sin, NULL, mhead, krpccheck, &m, &from,
&xid, l);
if (error)
goto out;
reply = mtod(m, struct rpc_reply *);
if (reply->rp_astatus != 0) {
error = fxdr_unsigned(u_int32_t, reply->rp_rstat);
switch (error) {
case RPC_MISMATCH:
error = ERPCMISMATCH;
break;
case RPC_AUTHERR:
error = EAUTH;
break;
default:
error = EBADRPC;
break;
}
goto out;
}
if (reply->rp_status != 0) {
error = fxdr_unsigned(u_int32_t, reply->rp_status);
switch (error) {
case RPC_PROGUNAVAIL:
error = EPROGUNAVAIL;
break;
case RPC_PROGMISMATCH:
error = EPROGMISMATCH;
break;
case RPC_PROCUNAVAIL:
error = EPROCUNAVAIL;
break;
case RPC_GARBAGE:
default:
error = EBADRPC;
}
goto out;
}
len = sizeof(*reply);
if (reply->rp_auth.authtype != 0) {
len += fxdr_unsigned(u_int32_t, reply->rp_auth.authlen);
len = (len + 3) & ~3;
}
m_adj(m, len);
*data = m;
if (from_p && error == 0) {
*from_p = from;
from = NULL;
}
out:
m_freem(mhead);
m_freem(from);
soclose(so);
return error;
}
struct xdr_string {
u_int32_t len;
char data[4];
};
struct mbuf *
xdr_string_encode(char *str, int len)
{
struct mbuf *m;
struct xdr_string *xs;
int dlen;
int mlen;
dlen = (len + 3) & ~3;
mlen = dlen + 4;
if (mlen > MCLBYTES)
return (NULL);
m = m_get(M_WAIT, MT_DATA);
if (mlen > MLEN) {
m_clget(m, M_WAIT);
if ((m->m_flags & M_EXT) == 0) {
(void) m_free(m);
return (NULL);
}
}
xs = mtod(m, struct xdr_string *);
m->m_len = mlen;
xs->len = txdr_unsigned(len);
memcpy(xs->data, str, len);
return (m);
}
struct mbuf *
xdr_string_decode(struct mbuf *m, char *str, int *len_p)
{
struct xdr_string *xs;
int mlen;
int slen;
if (m->m_len < 4) {
m = m_pullup(m, 4);
if (m == NULL)
return (NULL);
}
xs = mtod(m, struct xdr_string *);
slen = fxdr_unsigned(u_int32_t, xs->len);
mlen = 4 + ((slen + 3) & ~3);
if (slen > *len_p)
slen = *len_p;
m_copydata(m, 4, slen, str);
m_adj(m, mlen);
str[slen] = '\0';
*len_p = slen;
return (m);
}
struct xdr_inaddr {
u_int32_t atype;
u_int32_t addr[4];
};
struct mbuf *
xdr_inaddr_encode(struct in_addr *ia)
{
struct mbuf *m;
struct xdr_inaddr *xi;
u_int8_t *cp;
u_int32_t *ip;
m = m_get(M_WAIT, MT_DATA);
xi = mtod(m, struct xdr_inaddr *);
m->m_len = sizeof(*xi);
xi->atype = txdr_unsigned(1);
ip = xi->addr;
cp = (u_int8_t *)&ia->s_addr;
*ip++ = txdr_unsigned(*cp++);
*ip++ = txdr_unsigned(*cp++);
*ip++ = txdr_unsigned(*cp++);
*ip++ = txdr_unsigned(*cp++);
return (m);
}
struct mbuf *
xdr_inaddr_decode(struct mbuf *m, struct in_addr *ia)
{
struct xdr_inaddr *xi;
u_int8_t *cp;
u_int32_t *ip;
if (m->m_len < sizeof(*xi)) {
m = m_pullup(m, sizeof(*xi));
if (m == NULL)
return (NULL);
}
xi = mtod(m, struct xdr_inaddr *);
if (xi->atype != txdr_unsigned(1)) {
ia->s_addr = INADDR_ANY;
goto out;
}
ip = xi->addr;
cp = (u_int8_t *)&ia->s_addr;
*cp++ = fxdr_unsigned(u_int8_t, *ip++);
*cp++ = fxdr_unsigned(u_int8_t, *ip++);
*cp++ = fxdr_unsigned(u_int8_t, *ip++);
*cp++ = fxdr_unsigned(u_int8_t, *ip++);
out:
m_adj(m, sizeof(*xi));
return (m);
}