882 lines
22 KiB
C
882 lines
22 KiB
C
/*
|
|
* linux/fs/ncpfs/sock.c
|
|
*
|
|
* Copyright (C) 1992, 1993 Rick Sladkey
|
|
*
|
|
* Modified 1995, 1996 by Volker Lendecke to be usable for ncp
|
|
* Modified 1997 Peter Waltenberg, Bill Hawes, David Woodhouse for 2.1 dcache
|
|
*
|
|
*/
|
|
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
|
|
|
|
#include <linux/time.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/socket.h>
|
|
#include <linux/fcntl.h>
|
|
#include <linux/stat.h>
|
|
#include <linux/string.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/in.h>
|
|
#include <linux/net.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/signal.h>
|
|
#include <linux/slab.h>
|
|
#include <net/scm.h>
|
|
#include <net/sock.h>
|
|
#include <linux/ipx.h>
|
|
#include <linux/poll.h>
|
|
#include <linux/file.h>
|
|
|
|
#include "ncp_fs.h"
|
|
|
|
#include "ncpsign_kernel.h"
|
|
|
|
static int _recv(struct socket *sock, void *buf, int size, unsigned flags)
|
|
{
|
|
struct msghdr msg = {NULL, };
|
|
struct kvec iov = {buf, size};
|
|
return kernel_recvmsg(sock, &msg, &iov, 1, size, flags);
|
|
}
|
|
|
|
static inline int do_send(struct socket *sock, struct kvec *vec, int count,
|
|
int len, unsigned flags)
|
|
{
|
|
struct msghdr msg = { .msg_flags = flags };
|
|
return kernel_sendmsg(sock, &msg, vec, count, len);
|
|
}
|
|
|
|
static int _send(struct socket *sock, const void *buff, int len)
|
|
{
|
|
struct kvec vec;
|
|
vec.iov_base = (void *) buff;
|
|
vec.iov_len = len;
|
|
return do_send(sock, &vec, 1, len, 0);
|
|
}
|
|
|
|
struct ncp_request_reply {
|
|
struct list_head req;
|
|
wait_queue_head_t wq;
|
|
atomic_t refs;
|
|
unsigned char* reply_buf;
|
|
size_t datalen;
|
|
int result;
|
|
enum { RQ_DONE, RQ_INPROGRESS, RQ_QUEUED, RQ_IDLE, RQ_ABANDONED } status;
|
|
struct kvec* tx_ciov;
|
|
size_t tx_totallen;
|
|
size_t tx_iovlen;
|
|
struct kvec tx_iov[3];
|
|
u_int16_t tx_type;
|
|
u_int32_t sign[6];
|
|
};
|
|
|
|
static inline struct ncp_request_reply* ncp_alloc_req(void)
|
|
{
|
|
struct ncp_request_reply *req;
|
|
|
|
req = kmalloc(sizeof(struct ncp_request_reply), GFP_KERNEL);
|
|
if (!req)
|
|
return NULL;
|
|
|
|
init_waitqueue_head(&req->wq);
|
|
atomic_set(&req->refs, (1));
|
|
req->status = RQ_IDLE;
|
|
|
|
return req;
|
|
}
|
|
|
|
static void ncp_req_get(struct ncp_request_reply *req)
|
|
{
|
|
atomic_inc(&req->refs);
|
|
}
|
|
|
|
static void ncp_req_put(struct ncp_request_reply *req)
|
|
{
|
|
if (atomic_dec_and_test(&req->refs))
|
|
kfree(req);
|
|
}
|
|
|
|
void ncp_tcp_data_ready(struct sock *sk)
|
|
{
|
|
struct ncp_server *server = sk->sk_user_data;
|
|
|
|
server->data_ready(sk);
|
|
schedule_work(&server->rcv.tq);
|
|
}
|
|
|
|
void ncp_tcp_error_report(struct sock *sk)
|
|
{
|
|
struct ncp_server *server = sk->sk_user_data;
|
|
|
|
server->error_report(sk);
|
|
schedule_work(&server->rcv.tq);
|
|
}
|
|
|
|
void ncp_tcp_write_space(struct sock *sk)
|
|
{
|
|
struct ncp_server *server = sk->sk_user_data;
|
|
|
|
/* We do not need any locking: we first set tx.creq, and then we do sendmsg,
|
|
not vice versa... */
|
|
server->write_space(sk);
|
|
if (server->tx.creq)
|
|
schedule_work(&server->tx.tq);
|
|
}
|
|
|
|
void ncpdgram_timeout_call(unsigned long v)
|
|
{
|
|
struct ncp_server *server = (void*)v;
|
|
|
|
schedule_work(&server->timeout_tq);
|
|
}
|
|
|
|
static inline void ncp_finish_request(struct ncp_server *server, struct ncp_request_reply *req, int result)
|
|
{
|
|
req->result = result;
|
|
if (req->status != RQ_ABANDONED)
|
|
memcpy(req->reply_buf, server->rxbuf, req->datalen);
|
|
req->status = RQ_DONE;
|
|
wake_up_all(&req->wq);
|
|
ncp_req_put(req);
|
|
}
|
|
|
|
static void __abort_ncp_connection(struct ncp_server *server)
|
|
{
|
|
struct ncp_request_reply *req;
|
|
|
|
ncp_invalidate_conn(server);
|
|
del_timer(&server->timeout_tm);
|
|
while (!list_empty(&server->tx.requests)) {
|
|
req = list_entry(server->tx.requests.next, struct ncp_request_reply, req);
|
|
|
|
list_del_init(&req->req);
|
|
ncp_finish_request(server, req, -EIO);
|
|
}
|
|
req = server->rcv.creq;
|
|
if (req) {
|
|
server->rcv.creq = NULL;
|
|
ncp_finish_request(server, req, -EIO);
|
|
server->rcv.ptr = NULL;
|
|
server->rcv.state = 0;
|
|
}
|
|
req = server->tx.creq;
|
|
if (req) {
|
|
server->tx.creq = NULL;
|
|
ncp_finish_request(server, req, -EIO);
|
|
}
|
|
}
|
|
|
|
static inline int get_conn_number(struct ncp_reply_header *rp)
|
|
{
|
|
return rp->conn_low | (rp->conn_high << 8);
|
|
}
|
|
|
|
static inline void __ncp_abort_request(struct ncp_server *server, struct ncp_request_reply *req, int err)
|
|
{
|
|
/* If req is done, we got signal, but we also received answer... */
|
|
switch (req->status) {
|
|
case RQ_IDLE:
|
|
case RQ_DONE:
|
|
break;
|
|
case RQ_QUEUED:
|
|
list_del_init(&req->req);
|
|
ncp_finish_request(server, req, err);
|
|
break;
|
|
case RQ_INPROGRESS:
|
|
req->status = RQ_ABANDONED;
|
|
break;
|
|
case RQ_ABANDONED:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static inline void ncp_abort_request(struct ncp_server *server, struct ncp_request_reply *req, int err)
|
|
{
|
|
mutex_lock(&server->rcv.creq_mutex);
|
|
__ncp_abort_request(server, req, err);
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
}
|
|
|
|
static inline void __ncptcp_abort(struct ncp_server *server)
|
|
{
|
|
__abort_ncp_connection(server);
|
|
}
|
|
|
|
static int ncpdgram_send(struct socket *sock, struct ncp_request_reply *req)
|
|
{
|
|
struct kvec vec[3];
|
|
/* sock_sendmsg updates iov pointers for us :-( */
|
|
memcpy(vec, req->tx_ciov, req->tx_iovlen * sizeof(vec[0]));
|
|
return do_send(sock, vec, req->tx_iovlen,
|
|
req->tx_totallen, MSG_DONTWAIT);
|
|
}
|
|
|
|
static void __ncptcp_try_send(struct ncp_server *server)
|
|
{
|
|
struct ncp_request_reply *rq;
|
|
struct kvec *iov;
|
|
struct kvec iovc[3];
|
|
int result;
|
|
|
|
rq = server->tx.creq;
|
|
if (!rq)
|
|
return;
|
|
|
|
/* sock_sendmsg updates iov pointers for us :-( */
|
|
memcpy(iovc, rq->tx_ciov, rq->tx_iovlen * sizeof(iov[0]));
|
|
result = do_send(server->ncp_sock, iovc, rq->tx_iovlen,
|
|
rq->tx_totallen, MSG_NOSIGNAL | MSG_DONTWAIT);
|
|
|
|
if (result == -EAGAIN)
|
|
return;
|
|
|
|
if (result < 0) {
|
|
pr_err("tcp: Send failed: %d\n", result);
|
|
__ncp_abort_request(server, rq, result);
|
|
return;
|
|
}
|
|
if (result >= rq->tx_totallen) {
|
|
server->rcv.creq = rq;
|
|
server->tx.creq = NULL;
|
|
return;
|
|
}
|
|
rq->tx_totallen -= result;
|
|
iov = rq->tx_ciov;
|
|
while (iov->iov_len <= result) {
|
|
result -= iov->iov_len;
|
|
iov++;
|
|
rq->tx_iovlen--;
|
|
}
|
|
iov->iov_base += result;
|
|
iov->iov_len -= result;
|
|
rq->tx_ciov = iov;
|
|
}
|
|
|
|
static inline void ncp_init_header(struct ncp_server *server, struct ncp_request_reply *req, struct ncp_request_header *h)
|
|
{
|
|
req->status = RQ_INPROGRESS;
|
|
h->conn_low = server->connection;
|
|
h->conn_high = server->connection >> 8;
|
|
h->sequence = ++server->sequence;
|
|
}
|
|
|
|
static void ncpdgram_start_request(struct ncp_server *server, struct ncp_request_reply *req)
|
|
{
|
|
size_t signlen;
|
|
struct ncp_request_header* h;
|
|
|
|
req->tx_ciov = req->tx_iov + 1;
|
|
|
|
h = req->tx_iov[1].iov_base;
|
|
ncp_init_header(server, req, h);
|
|
signlen = sign_packet(server, req->tx_iov[1].iov_base + sizeof(struct ncp_request_header) - 1,
|
|
req->tx_iov[1].iov_len - sizeof(struct ncp_request_header) + 1,
|
|
cpu_to_le32(req->tx_totallen), req->sign);
|
|
if (signlen) {
|
|
req->tx_ciov[1].iov_base = req->sign;
|
|
req->tx_ciov[1].iov_len = signlen;
|
|
req->tx_iovlen += 1;
|
|
req->tx_totallen += signlen;
|
|
}
|
|
server->rcv.creq = req;
|
|
server->timeout_last = server->m.time_out;
|
|
server->timeout_retries = server->m.retry_count;
|
|
ncpdgram_send(server->ncp_sock, req);
|
|
mod_timer(&server->timeout_tm, jiffies + server->m.time_out);
|
|
}
|
|
|
|
#define NCP_TCP_XMIT_MAGIC (0x446D6454)
|
|
#define NCP_TCP_XMIT_VERSION (1)
|
|
#define NCP_TCP_RCVD_MAGIC (0x744E6350)
|
|
|
|
static void ncptcp_start_request(struct ncp_server *server, struct ncp_request_reply *req)
|
|
{
|
|
size_t signlen;
|
|
struct ncp_request_header* h;
|
|
|
|
req->tx_ciov = req->tx_iov;
|
|
h = req->tx_iov[1].iov_base;
|
|
ncp_init_header(server, req, h);
|
|
signlen = sign_packet(server, req->tx_iov[1].iov_base + sizeof(struct ncp_request_header) - 1,
|
|
req->tx_iov[1].iov_len - sizeof(struct ncp_request_header) + 1,
|
|
cpu_to_be32(req->tx_totallen + 24), req->sign + 4) + 16;
|
|
|
|
req->sign[0] = htonl(NCP_TCP_XMIT_MAGIC);
|
|
req->sign[1] = htonl(req->tx_totallen + signlen);
|
|
req->sign[2] = htonl(NCP_TCP_XMIT_VERSION);
|
|
req->sign[3] = htonl(req->datalen + 8);
|
|
req->tx_iov[0].iov_base = req->sign;
|
|
req->tx_iov[0].iov_len = signlen;
|
|
req->tx_iovlen += 1;
|
|
req->tx_totallen += signlen;
|
|
|
|
server->tx.creq = req;
|
|
__ncptcp_try_send(server);
|
|
}
|
|
|
|
static inline void __ncp_start_request(struct ncp_server *server, struct ncp_request_reply *req)
|
|
{
|
|
/* we copy the data so that we do not depend on the caller
|
|
staying alive */
|
|
memcpy(server->txbuf, req->tx_iov[1].iov_base, req->tx_iov[1].iov_len);
|
|
req->tx_iov[1].iov_base = server->txbuf;
|
|
|
|
if (server->ncp_sock->type == SOCK_STREAM)
|
|
ncptcp_start_request(server, req);
|
|
else
|
|
ncpdgram_start_request(server, req);
|
|
}
|
|
|
|
static int ncp_add_request(struct ncp_server *server, struct ncp_request_reply *req)
|
|
{
|
|
mutex_lock(&server->rcv.creq_mutex);
|
|
if (!ncp_conn_valid(server)) {
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
pr_err("tcp: Server died\n");
|
|
return -EIO;
|
|
}
|
|
ncp_req_get(req);
|
|
if (server->tx.creq || server->rcv.creq) {
|
|
req->status = RQ_QUEUED;
|
|
list_add_tail(&req->req, &server->tx.requests);
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
return 0;
|
|
}
|
|
__ncp_start_request(server, req);
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
return 0;
|
|
}
|
|
|
|
static void __ncp_next_request(struct ncp_server *server)
|
|
{
|
|
struct ncp_request_reply *req;
|
|
|
|
server->rcv.creq = NULL;
|
|
if (list_empty(&server->tx.requests)) {
|
|
return;
|
|
}
|
|
req = list_entry(server->tx.requests.next, struct ncp_request_reply, req);
|
|
list_del_init(&req->req);
|
|
__ncp_start_request(server, req);
|
|
}
|
|
|
|
static void info_server(struct ncp_server *server, unsigned int id, const void * data, size_t len)
|
|
{
|
|
if (server->info_sock) {
|
|
struct kvec iov[2];
|
|
__be32 hdr[2];
|
|
|
|
hdr[0] = cpu_to_be32(len + 8);
|
|
hdr[1] = cpu_to_be32(id);
|
|
|
|
iov[0].iov_base = hdr;
|
|
iov[0].iov_len = 8;
|
|
iov[1].iov_base = (void *) data;
|
|
iov[1].iov_len = len;
|
|
|
|
do_send(server->info_sock, iov, 2, len + 8, MSG_NOSIGNAL);
|
|
}
|
|
}
|
|
|
|
void ncpdgram_rcv_proc(struct work_struct *work)
|
|
{
|
|
struct ncp_server *server =
|
|
container_of(work, struct ncp_server, rcv.tq);
|
|
struct socket* sock;
|
|
|
|
sock = server->ncp_sock;
|
|
|
|
while (1) {
|
|
struct ncp_reply_header reply;
|
|
int result;
|
|
|
|
result = _recv(sock, &reply, sizeof(reply), MSG_PEEK | MSG_DONTWAIT);
|
|
if (result < 0) {
|
|
break;
|
|
}
|
|
if (result >= sizeof(reply)) {
|
|
struct ncp_request_reply *req;
|
|
|
|
if (reply.type == NCP_WATCHDOG) {
|
|
unsigned char buf[10];
|
|
|
|
if (server->connection != get_conn_number(&reply)) {
|
|
goto drop;
|
|
}
|
|
result = _recv(sock, buf, sizeof(buf), MSG_DONTWAIT);
|
|
if (result < 0) {
|
|
ncp_dbg(1, "recv failed with %d\n", result);
|
|
continue;
|
|
}
|
|
if (result < 10) {
|
|
ncp_dbg(1, "too short (%u) watchdog packet\n", result);
|
|
continue;
|
|
}
|
|
if (buf[9] != '?') {
|
|
ncp_dbg(1, "bad signature (%02X) in watchdog packet\n", buf[9]);
|
|
continue;
|
|
}
|
|
buf[9] = 'Y';
|
|
_send(sock, buf, sizeof(buf));
|
|
continue;
|
|
}
|
|
if (reply.type != NCP_POSITIVE_ACK && reply.type != NCP_REPLY) {
|
|
result = _recv(sock, server->unexpected_packet.data, sizeof(server->unexpected_packet.data), MSG_DONTWAIT);
|
|
if (result < 0) {
|
|
continue;
|
|
}
|
|
info_server(server, 0, server->unexpected_packet.data, result);
|
|
continue;
|
|
}
|
|
mutex_lock(&server->rcv.creq_mutex);
|
|
req = server->rcv.creq;
|
|
if (req && (req->tx_type == NCP_ALLOC_SLOT_REQUEST || (server->sequence == reply.sequence &&
|
|
server->connection == get_conn_number(&reply)))) {
|
|
if (reply.type == NCP_POSITIVE_ACK) {
|
|
server->timeout_retries = server->m.retry_count;
|
|
server->timeout_last = NCP_MAX_RPC_TIMEOUT;
|
|
mod_timer(&server->timeout_tm, jiffies + NCP_MAX_RPC_TIMEOUT);
|
|
} else if (reply.type == NCP_REPLY) {
|
|
result = _recv(sock, server->rxbuf, req->datalen, MSG_DONTWAIT);
|
|
#ifdef CONFIG_NCPFS_PACKET_SIGNING
|
|
if (result >= 0 && server->sign_active && req->tx_type != NCP_DEALLOC_SLOT_REQUEST) {
|
|
if (result < 8 + 8) {
|
|
result = -EIO;
|
|
} else {
|
|
unsigned int hdrl;
|
|
|
|
result -= 8;
|
|
hdrl = sock->sk->sk_family == AF_INET ? 8 : 6;
|
|
if (sign_verify_reply(server, server->rxbuf + hdrl, result - hdrl, cpu_to_le32(result), server->rxbuf + result)) {
|
|
pr_info("Signature violation\n");
|
|
result = -EIO;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
del_timer(&server->timeout_tm);
|
|
server->rcv.creq = NULL;
|
|
ncp_finish_request(server, req, result);
|
|
__ncp_next_request(server);
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
continue;
|
|
}
|
|
}
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
}
|
|
drop:;
|
|
_recv(sock, &reply, sizeof(reply), MSG_DONTWAIT);
|
|
}
|
|
}
|
|
|
|
static void __ncpdgram_timeout_proc(struct ncp_server *server)
|
|
{
|
|
/* If timer is pending, we are processing another request... */
|
|
if (!timer_pending(&server->timeout_tm)) {
|
|
struct ncp_request_reply* req;
|
|
|
|
req = server->rcv.creq;
|
|
if (req) {
|
|
int timeout;
|
|
|
|
if (server->m.flags & NCP_MOUNT_SOFT) {
|
|
if (server->timeout_retries-- == 0) {
|
|
__ncp_abort_request(server, req, -ETIMEDOUT);
|
|
return;
|
|
}
|
|
}
|
|
/* Ignore errors */
|
|
ncpdgram_send(server->ncp_sock, req);
|
|
timeout = server->timeout_last << 1;
|
|
if (timeout > NCP_MAX_RPC_TIMEOUT) {
|
|
timeout = NCP_MAX_RPC_TIMEOUT;
|
|
}
|
|
server->timeout_last = timeout;
|
|
mod_timer(&server->timeout_tm, jiffies + timeout);
|
|
}
|
|
}
|
|
}
|
|
|
|
void ncpdgram_timeout_proc(struct work_struct *work)
|
|
{
|
|
struct ncp_server *server =
|
|
container_of(work, struct ncp_server, timeout_tq);
|
|
mutex_lock(&server->rcv.creq_mutex);
|
|
__ncpdgram_timeout_proc(server);
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
}
|
|
|
|
static int do_tcp_rcv(struct ncp_server *server, void *buffer, size_t len)
|
|
{
|
|
int result;
|
|
|
|
if (buffer) {
|
|
result = _recv(server->ncp_sock, buffer, len, MSG_DONTWAIT);
|
|
} else {
|
|
static unsigned char dummy[1024];
|
|
|
|
if (len > sizeof(dummy)) {
|
|
len = sizeof(dummy);
|
|
}
|
|
result = _recv(server->ncp_sock, dummy, len, MSG_DONTWAIT);
|
|
}
|
|
if (result < 0) {
|
|
return result;
|
|
}
|
|
if (result > len) {
|
|
pr_err("tcp: bug in recvmsg (%u > %Zu)\n", result, len);
|
|
return -EIO;
|
|
}
|
|
return result;
|
|
}
|
|
|
|
static int __ncptcp_rcv_proc(struct ncp_server *server)
|
|
{
|
|
/* We have to check the result, so store the complete header */
|
|
while (1) {
|
|
int result;
|
|
struct ncp_request_reply *req;
|
|
int datalen;
|
|
int type;
|
|
|
|
while (server->rcv.len) {
|
|
result = do_tcp_rcv(server, server->rcv.ptr, server->rcv.len);
|
|
if (result == -EAGAIN) {
|
|
return 0;
|
|
}
|
|
if (result <= 0) {
|
|
req = server->rcv.creq;
|
|
if (req) {
|
|
__ncp_abort_request(server, req, -EIO);
|
|
} else {
|
|
__ncptcp_abort(server);
|
|
}
|
|
if (result < 0) {
|
|
pr_err("tcp: error in recvmsg: %d\n", result);
|
|
} else {
|
|
ncp_dbg(1, "tcp: EOF\n");
|
|
}
|
|
return -EIO;
|
|
}
|
|
if (server->rcv.ptr) {
|
|
server->rcv.ptr += result;
|
|
}
|
|
server->rcv.len -= result;
|
|
}
|
|
switch (server->rcv.state) {
|
|
case 0:
|
|
if (server->rcv.buf.magic != htonl(NCP_TCP_RCVD_MAGIC)) {
|
|
pr_err("tcp: Unexpected reply type %08X\n", ntohl(server->rcv.buf.magic));
|
|
__ncptcp_abort(server);
|
|
return -EIO;
|
|
}
|
|
datalen = ntohl(server->rcv.buf.len) & 0x0FFFFFFF;
|
|
if (datalen < 10) {
|
|
pr_err("tcp: Unexpected reply len %d\n", datalen);
|
|
__ncptcp_abort(server);
|
|
return -EIO;
|
|
}
|
|
#ifdef CONFIG_NCPFS_PACKET_SIGNING
|
|
if (server->sign_active) {
|
|
if (datalen < 18) {
|
|
pr_err("tcp: Unexpected reply len %d\n", datalen);
|
|
__ncptcp_abort(server);
|
|
return -EIO;
|
|
}
|
|
server->rcv.buf.len = datalen - 8;
|
|
server->rcv.ptr = (unsigned char*)&server->rcv.buf.p1;
|
|
server->rcv.len = 8;
|
|
server->rcv.state = 4;
|
|
break;
|
|
}
|
|
#endif
|
|
type = ntohs(server->rcv.buf.type);
|
|
#ifdef CONFIG_NCPFS_PACKET_SIGNING
|
|
cont:;
|
|
#endif
|
|
if (type != NCP_REPLY) {
|
|
if (datalen - 8 <= sizeof(server->unexpected_packet.data)) {
|
|
*(__u16*)(server->unexpected_packet.data) = htons(type);
|
|
server->unexpected_packet.len = datalen - 8;
|
|
|
|
server->rcv.state = 5;
|
|
server->rcv.ptr = server->unexpected_packet.data + 2;
|
|
server->rcv.len = datalen - 10;
|
|
break;
|
|
}
|
|
ncp_dbg(1, "tcp: Unexpected NCP type %02X\n", type);
|
|
skipdata2:;
|
|
server->rcv.state = 2;
|
|
skipdata:;
|
|
server->rcv.ptr = NULL;
|
|
server->rcv.len = datalen - 10;
|
|
break;
|
|
}
|
|
req = server->rcv.creq;
|
|
if (!req) {
|
|
ncp_dbg(1, "Reply without appropriate request\n");
|
|
goto skipdata2;
|
|
}
|
|
if (datalen > req->datalen + 8) {
|
|
pr_err("tcp: Unexpected reply len %d (expected at most %Zd)\n", datalen, req->datalen + 8);
|
|
server->rcv.state = 3;
|
|
goto skipdata;
|
|
}
|
|
req->datalen = datalen - 8;
|
|
((struct ncp_reply_header*)server->rxbuf)->type = NCP_REPLY;
|
|
server->rcv.ptr = server->rxbuf + 2;
|
|
server->rcv.len = datalen - 10;
|
|
server->rcv.state = 1;
|
|
break;
|
|
#ifdef CONFIG_NCPFS_PACKET_SIGNING
|
|
case 4:
|
|
datalen = server->rcv.buf.len;
|
|
type = ntohs(server->rcv.buf.type2);
|
|
goto cont;
|
|
#endif
|
|
case 1:
|
|
req = server->rcv.creq;
|
|
if (req->tx_type != NCP_ALLOC_SLOT_REQUEST) {
|
|
if (((struct ncp_reply_header*)server->rxbuf)->sequence != server->sequence) {
|
|
pr_err("tcp: Bad sequence number\n");
|
|
__ncp_abort_request(server, req, -EIO);
|
|
return -EIO;
|
|
}
|
|
if ((((struct ncp_reply_header*)server->rxbuf)->conn_low | (((struct ncp_reply_header*)server->rxbuf)->conn_high << 8)) != server->connection) {
|
|
pr_err("tcp: Connection number mismatch\n");
|
|
__ncp_abort_request(server, req, -EIO);
|
|
return -EIO;
|
|
}
|
|
}
|
|
#ifdef CONFIG_NCPFS_PACKET_SIGNING
|
|
if (server->sign_active && req->tx_type != NCP_DEALLOC_SLOT_REQUEST) {
|
|
if (sign_verify_reply(server, server->rxbuf + 6, req->datalen - 6, cpu_to_be32(req->datalen + 16), &server->rcv.buf.type)) {
|
|
pr_err("tcp: Signature violation\n");
|
|
__ncp_abort_request(server, req, -EIO);
|
|
return -EIO;
|
|
}
|
|
}
|
|
#endif
|
|
ncp_finish_request(server, req, req->datalen);
|
|
nextreq:;
|
|
__ncp_next_request(server);
|
|
case 2:
|
|
next:;
|
|
server->rcv.ptr = (unsigned char*)&server->rcv.buf;
|
|
server->rcv.len = 10;
|
|
server->rcv.state = 0;
|
|
break;
|
|
case 3:
|
|
ncp_finish_request(server, server->rcv.creq, -EIO);
|
|
goto nextreq;
|
|
case 5:
|
|
info_server(server, 0, server->unexpected_packet.data, server->unexpected_packet.len);
|
|
goto next;
|
|
}
|
|
}
|
|
}
|
|
|
|
void ncp_tcp_rcv_proc(struct work_struct *work)
|
|
{
|
|
struct ncp_server *server =
|
|
container_of(work, struct ncp_server, rcv.tq);
|
|
|
|
mutex_lock(&server->rcv.creq_mutex);
|
|
__ncptcp_rcv_proc(server);
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
}
|
|
|
|
void ncp_tcp_tx_proc(struct work_struct *work)
|
|
{
|
|
struct ncp_server *server =
|
|
container_of(work, struct ncp_server, tx.tq);
|
|
|
|
mutex_lock(&server->rcv.creq_mutex);
|
|
__ncptcp_try_send(server);
|
|
mutex_unlock(&server->rcv.creq_mutex);
|
|
}
|
|
|
|
static int do_ncp_rpc_call(struct ncp_server *server, int size,
|
|
unsigned char* reply_buf, int max_reply_size)
|
|
{
|
|
int result;
|
|
struct ncp_request_reply *req;
|
|
|
|
req = ncp_alloc_req();
|
|
if (!req)
|
|
return -ENOMEM;
|
|
|
|
req->reply_buf = reply_buf;
|
|
req->datalen = max_reply_size;
|
|
req->tx_iov[1].iov_base = server->packet;
|
|
req->tx_iov[1].iov_len = size;
|
|
req->tx_iovlen = 1;
|
|
req->tx_totallen = size;
|
|
req->tx_type = *(u_int16_t*)server->packet;
|
|
|
|
result = ncp_add_request(server, req);
|
|
if (result < 0)
|
|
goto out;
|
|
|
|
if (wait_event_interruptible(req->wq, req->status == RQ_DONE)) {
|
|
ncp_abort_request(server, req, -EINTR);
|
|
result = -EINTR;
|
|
goto out;
|
|
}
|
|
|
|
result = req->result;
|
|
|
|
out:
|
|
ncp_req_put(req);
|
|
|
|
return result;
|
|
}
|
|
|
|
/*
|
|
* We need the server to be locked here, so check!
|
|
*/
|
|
|
|
static int ncp_do_request(struct ncp_server *server, int size,
|
|
void* reply, int max_reply_size)
|
|
{
|
|
int result;
|
|
|
|
if (server->lock == 0) {
|
|
pr_err("Server not locked!\n");
|
|
return -EIO;
|
|
}
|
|
if (!ncp_conn_valid(server)) {
|
|
return -EIO;
|
|
}
|
|
{
|
|
sigset_t old_set;
|
|
unsigned long mask, flags;
|
|
|
|
spin_lock_irqsave(¤t->sighand->siglock, flags);
|
|
old_set = current->blocked;
|
|
if (current->flags & PF_EXITING)
|
|
mask = 0;
|
|
else
|
|
mask = sigmask(SIGKILL);
|
|
if (server->m.flags & NCP_MOUNT_INTR) {
|
|
/* FIXME: This doesn't seem right at all. So, like,
|
|
we can't handle SIGINT and get whatever to stop?
|
|
What if we've blocked it ourselves? What about
|
|
alarms? Why, in fact, are we mucking with the
|
|
sigmask at all? -- r~ */
|
|
if (current->sighand->action[SIGINT - 1].sa.sa_handler == SIG_DFL)
|
|
mask |= sigmask(SIGINT);
|
|
if (current->sighand->action[SIGQUIT - 1].sa.sa_handler == SIG_DFL)
|
|
mask |= sigmask(SIGQUIT);
|
|
}
|
|
siginitsetinv(¤t->blocked, mask);
|
|
recalc_sigpending();
|
|
spin_unlock_irqrestore(¤t->sighand->siglock, flags);
|
|
|
|
result = do_ncp_rpc_call(server, size, reply, max_reply_size);
|
|
|
|
spin_lock_irqsave(¤t->sighand->siglock, flags);
|
|
current->blocked = old_set;
|
|
recalc_sigpending();
|
|
spin_unlock_irqrestore(¤t->sighand->siglock, flags);
|
|
}
|
|
|
|
ncp_dbg(2, "do_ncp_rpc_call returned %d\n", result);
|
|
|
|
return result;
|
|
}
|
|
|
|
/* ncp_do_request assures that at least a complete reply header is
|
|
* received. It assumes that server->current_size contains the ncp
|
|
* request size
|
|
*/
|
|
int ncp_request2(struct ncp_server *server, int function,
|
|
void* rpl, int size)
|
|
{
|
|
struct ncp_request_header *h;
|
|
struct ncp_reply_header* reply = rpl;
|
|
int result;
|
|
|
|
h = (struct ncp_request_header *) (server->packet);
|
|
if (server->has_subfunction != 0) {
|
|
*(__u16 *) & (h->data[0]) = htons(server->current_size - sizeof(*h) - 2);
|
|
}
|
|
h->type = NCP_REQUEST;
|
|
/*
|
|
* The server shouldn't know or care what task is making a
|
|
* request, so we always use the same task number.
|
|
*/
|
|
h->task = 2; /* (current->pid) & 0xff; */
|
|
h->function = function;
|
|
|
|
result = ncp_do_request(server, server->current_size, reply, size);
|
|
if (result < 0) {
|
|
ncp_dbg(1, "ncp_request_error: %d\n", result);
|
|
goto out;
|
|
}
|
|
server->completion = reply->completion_code;
|
|
server->conn_status = reply->connection_state;
|
|
server->reply_size = result;
|
|
server->ncp_reply_size = result - sizeof(struct ncp_reply_header);
|
|
|
|
result = reply->completion_code;
|
|
|
|
if (result != 0)
|
|
ncp_vdbg("completion code=%x\n", result);
|
|
out:
|
|
return result;
|
|
}
|
|
|
|
int ncp_connect(struct ncp_server *server)
|
|
{
|
|
struct ncp_request_header *h;
|
|
int result;
|
|
|
|
server->connection = 0xFFFF;
|
|
server->sequence = 255;
|
|
|
|
h = (struct ncp_request_header *) (server->packet);
|
|
h->type = NCP_ALLOC_SLOT_REQUEST;
|
|
h->task = 2; /* see above */
|
|
h->function = 0;
|
|
|
|
result = ncp_do_request(server, sizeof(*h), server->packet, server->packet_size);
|
|
if (result < 0)
|
|
goto out;
|
|
server->connection = h->conn_low + (h->conn_high * 256);
|
|
result = 0;
|
|
out:
|
|
return result;
|
|
}
|
|
|
|
int ncp_disconnect(struct ncp_server *server)
|
|
{
|
|
struct ncp_request_header *h;
|
|
|
|
h = (struct ncp_request_header *) (server->packet);
|
|
h->type = NCP_DEALLOC_SLOT_REQUEST;
|
|
h->task = 2; /* see above */
|
|
h->function = 0;
|
|
|
|
return ncp_do_request(server, sizeof(*h), server->packet, server->packet_size);
|
|
}
|
|
|
|
void ncp_lock_server(struct ncp_server *server)
|
|
{
|
|
mutex_lock(&server->mutex);
|
|
if (server->lock)
|
|
pr_warn("%s: was locked!\n", __func__);
|
|
server->lock = 1;
|
|
}
|
|
|
|
void ncp_unlock_server(struct ncp_server *server)
|
|
{
|
|
if (!server->lock) {
|
|
pr_warn("%s: was not locked!\n", __func__);
|
|
return;
|
|
}
|
|
server->lock = 0;
|
|
mutex_unlock(&server->mutex);
|
|
}
|