]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * linux/fs/ncpfs/sock.c | |
3 | * | |
4 | * Copyright (C) 1992, 1993 Rick Sladkey | |
5 | * | |
6 | * Modified 1995, 1996 by Volker Lendecke to be usable for ncp | |
7 | * Modified 1997 Peter Waltenberg, Bill Hawes, David Woodhouse for 2.1 dcache | |
8 | * | |
9 | */ | |
10 | ||
b41f8b84 | 11 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
1da177e4 LT |
12 | |
13 | #include <linux/time.h> | |
14 | #include <linux/errno.h> | |
15 | #include <linux/socket.h> | |
16 | #include <linux/fcntl.h> | |
17 | #include <linux/stat.h> | |
c5f93cf1 | 18 | #include <linux/string.h> |
1da177e4 LT |
19 | #include <asm/uaccess.h> |
20 | #include <linux/in.h> | |
21 | #include <linux/net.h> | |
22 | #include <linux/mm.h> | |
23 | #include <linux/netdevice.h> | |
24 | #include <linux/signal.h> | |
5a0e3ad6 | 25 | #include <linux/slab.h> |
1da177e4 LT |
26 | #include <net/scm.h> |
27 | #include <net/sock.h> | |
28 | #include <linux/ipx.h> | |
29 | #include <linux/poll.h> | |
30 | #include <linux/file.h> | |
31 | ||
32c419d9 | 32 | #include "ncp_fs.h" |
1da177e4 LT |
33 | |
34 | #include "ncpsign_kernel.h" | |
35 | ||
36 | static int _recv(struct socket *sock, void *buf, int size, unsigned flags) | |
37 | { | |
38 | struct msghdr msg = {NULL, }; | |
39 | struct kvec iov = {buf, size}; | |
40 | return kernel_recvmsg(sock, &msg, &iov, 1, size, flags); | |
41 | } | |
42 | ||
43 | static inline int do_send(struct socket *sock, struct kvec *vec, int count, | |
44 | int len, unsigned flags) | |
45 | { | |
46 | struct msghdr msg = { .msg_flags = flags }; | |
47 | return kernel_sendmsg(sock, &msg, vec, count, len); | |
48 | } | |
49 | ||
50 | static int _send(struct socket *sock, const void *buff, int len) | |
51 | { | |
52 | struct kvec vec; | |
53 | vec.iov_base = (void *) buff; | |
54 | vec.iov_len = len; | |
55 | return do_send(sock, &vec, 1, len, 0); | |
56 | } | |
57 | ||
58 | struct ncp_request_reply { | |
59 | struct list_head req; | |
60 | wait_queue_head_t wq; | |
c5f93cf1 PO |
61 | atomic_t refs; |
62 | unsigned char* reply_buf; | |
1da177e4 LT |
63 | size_t datalen; |
64 | int result; | |
c5f93cf1 | 65 | enum { RQ_DONE, RQ_INPROGRESS, RQ_QUEUED, RQ_IDLE, RQ_ABANDONED } status; |
1da177e4 LT |
66 | struct kvec* tx_ciov; |
67 | size_t tx_totallen; | |
68 | size_t tx_iovlen; | |
69 | struct kvec tx_iov[3]; | |
70 | u_int16_t tx_type; | |
71 | u_int32_t sign[6]; | |
72 | }; | |
73 | ||
c5f93cf1 PO |
74 | static inline struct ncp_request_reply* ncp_alloc_req(void) |
75 | { | |
76 | struct ncp_request_reply *req; | |
77 | ||
78 | req = kmalloc(sizeof(struct ncp_request_reply), GFP_KERNEL); | |
79 | if (!req) | |
80 | return NULL; | |
81 | ||
82 | init_waitqueue_head(&req->wq); | |
83 | atomic_set(&req->refs, (1)); | |
84 | req->status = RQ_IDLE; | |
85 | ||
86 | return req; | |
87 | } | |
88 | ||
89 | static void ncp_req_get(struct ncp_request_reply *req) | |
90 | { | |
91 | atomic_inc(&req->refs); | |
92 | } | |
93 | ||
94 | static void ncp_req_put(struct ncp_request_reply *req) | |
95 | { | |
96 | if (atomic_dec_and_test(&req->refs)) | |
97 | kfree(req); | |
98 | } | |
99 | ||
676d2369 | 100 | void ncp_tcp_data_ready(struct sock *sk) |
1da177e4 LT |
101 | { |
102 | struct ncp_server *server = sk->sk_user_data; | |
103 | ||
676d2369 | 104 | server->data_ready(sk); |
1da177e4 LT |
105 | schedule_work(&server->rcv.tq); |
106 | } | |
107 | ||
108 | void ncp_tcp_error_report(struct sock *sk) | |
109 | { | |
110 | struct ncp_server *server = sk->sk_user_data; | |
111 | ||
112 | server->error_report(sk); | |
113 | schedule_work(&server->rcv.tq); | |
114 | } | |
115 | ||
116 | void ncp_tcp_write_space(struct sock *sk) | |
117 | { | |
118 | struct ncp_server *server = sk->sk_user_data; | |
119 | ||
120 | /* We do not need any locking: we first set tx.creq, and then we do sendmsg, | |
121 | not vice versa... */ | |
122 | server->write_space(sk); | |
123 | if (server->tx.creq) | |
124 | schedule_work(&server->tx.tq); | |
125 | } | |
126 | ||
127 | void ncpdgram_timeout_call(unsigned long v) | |
128 | { | |
129 | struct ncp_server *server = (void*)v; | |
130 | ||
131 | schedule_work(&server->timeout_tq); | |
132 | } | |
133 | ||
c5f93cf1 | 134 | static inline void ncp_finish_request(struct ncp_server *server, struct ncp_request_reply *req, int result) |
1da177e4 LT |
135 | { |
136 | req->result = result; | |
c5f93cf1 PO |
137 | if (req->status != RQ_ABANDONED) |
138 | memcpy(req->reply_buf, server->rxbuf, req->datalen); | |
1da177e4 LT |
139 | req->status = RQ_DONE; |
140 | wake_up_all(&req->wq); | |
c5f93cf1 | 141 | ncp_req_put(req); |
1da177e4 LT |
142 | } |
143 | ||
c5f93cf1 | 144 | static void __abort_ncp_connection(struct ncp_server *server) |
1da177e4 LT |
145 | { |
146 | struct ncp_request_reply *req; | |
147 | ||
148 | ncp_invalidate_conn(server); | |
149 | del_timer(&server->timeout_tm); | |
150 | while (!list_empty(&server->tx.requests)) { | |
151 | req = list_entry(server->tx.requests.next, struct ncp_request_reply, req); | |
152 | ||
153 | list_del_init(&req->req); | |
c5f93cf1 | 154 | ncp_finish_request(server, req, -EIO); |
1da177e4 LT |
155 | } |
156 | req = server->rcv.creq; | |
157 | if (req) { | |
158 | server->rcv.creq = NULL; | |
c5f93cf1 | 159 | ncp_finish_request(server, req, -EIO); |
1da177e4 LT |
160 | server->rcv.ptr = NULL; |
161 | server->rcv.state = 0; | |
162 | } | |
163 | req = server->tx.creq; | |
164 | if (req) { | |
165 | server->tx.creq = NULL; | |
c5f93cf1 | 166 | ncp_finish_request(server, req, -EIO); |
1da177e4 LT |
167 | } |
168 | } | |
169 | ||
170 | static inline int get_conn_number(struct ncp_reply_header *rp) | |
171 | { | |
172 | return rp->conn_low | (rp->conn_high << 8); | |
173 | } | |
174 | ||
175 | static inline void __ncp_abort_request(struct ncp_server *server, struct ncp_request_reply *req, int err) | |
176 | { | |
177 | /* If req is done, we got signal, but we also received answer... */ | |
178 | switch (req->status) { | |
179 | case RQ_IDLE: | |
180 | case RQ_DONE: | |
181 | break; | |
182 | case RQ_QUEUED: | |
183 | list_del_init(&req->req); | |
c5f93cf1 | 184 | ncp_finish_request(server, req, err); |
1da177e4 LT |
185 | break; |
186 | case RQ_INPROGRESS: | |
c5f93cf1 PO |
187 | req->status = RQ_ABANDONED; |
188 | break; | |
189 | case RQ_ABANDONED: | |
1da177e4 LT |
190 | break; |
191 | } | |
192 | } | |
193 | ||
194 | static inline void ncp_abort_request(struct ncp_server *server, struct ncp_request_reply *req, int err) | |
195 | { | |
8e3f9045 | 196 | mutex_lock(&server->rcv.creq_mutex); |
1da177e4 | 197 | __ncp_abort_request(server, req, err); |
8e3f9045 | 198 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
199 | } |
200 | ||
201 | static inline void __ncptcp_abort(struct ncp_server *server) | |
202 | { | |
c5f93cf1 | 203 | __abort_ncp_connection(server); |
1da177e4 LT |
204 | } |
205 | ||
206 | static int ncpdgram_send(struct socket *sock, struct ncp_request_reply *req) | |
207 | { | |
208 | struct kvec vec[3]; | |
209 | /* sock_sendmsg updates iov pointers for us :-( */ | |
210 | memcpy(vec, req->tx_ciov, req->tx_iovlen * sizeof(vec[0])); | |
211 | return do_send(sock, vec, req->tx_iovlen, | |
212 | req->tx_totallen, MSG_DONTWAIT); | |
213 | } | |
214 | ||
215 | static void __ncptcp_try_send(struct ncp_server *server) | |
216 | { | |
217 | struct ncp_request_reply *rq; | |
218 | struct kvec *iov; | |
219 | struct kvec iovc[3]; | |
220 | int result; | |
221 | ||
222 | rq = server->tx.creq; | |
223 | if (!rq) | |
224 | return; | |
225 | ||
226 | /* sock_sendmsg updates iov pointers for us :-( */ | |
227 | memcpy(iovc, rq->tx_ciov, rq->tx_iovlen * sizeof(iov[0])); | |
228 | result = do_send(server->ncp_sock, iovc, rq->tx_iovlen, | |
229 | rq->tx_totallen, MSG_NOSIGNAL | MSG_DONTWAIT); | |
230 | ||
231 | if (result == -EAGAIN) | |
232 | return; | |
233 | ||
234 | if (result < 0) { | |
b41f8b84 | 235 | pr_err("tcp: Send failed: %d\n", result); |
1da177e4 LT |
236 | __ncp_abort_request(server, rq, result); |
237 | return; | |
238 | } | |
239 | if (result >= rq->tx_totallen) { | |
240 | server->rcv.creq = rq; | |
241 | server->tx.creq = NULL; | |
242 | return; | |
243 | } | |
244 | rq->tx_totallen -= result; | |
245 | iov = rq->tx_ciov; | |
246 | while (iov->iov_len <= result) { | |
247 | result -= iov->iov_len; | |
248 | iov++; | |
249 | rq->tx_iovlen--; | |
250 | } | |
251 | iov->iov_base += result; | |
252 | iov->iov_len -= result; | |
253 | rq->tx_ciov = iov; | |
254 | } | |
255 | ||
256 | static inline void ncp_init_header(struct ncp_server *server, struct ncp_request_reply *req, struct ncp_request_header *h) | |
257 | { | |
258 | req->status = RQ_INPROGRESS; | |
259 | h->conn_low = server->connection; | |
260 | h->conn_high = server->connection >> 8; | |
261 | h->sequence = ++server->sequence; | |
262 | } | |
263 | ||
264 | static void ncpdgram_start_request(struct ncp_server *server, struct ncp_request_reply *req) | |
265 | { | |
266 | size_t signlen; | |
267 | struct ncp_request_header* h; | |
268 | ||
269 | req->tx_ciov = req->tx_iov + 1; | |
270 | ||
271 | h = req->tx_iov[1].iov_base; | |
272 | ncp_init_header(server, req, h); | |
273 | signlen = sign_packet(server, req->tx_iov[1].iov_base + sizeof(struct ncp_request_header) - 1, | |
274 | req->tx_iov[1].iov_len - sizeof(struct ncp_request_header) + 1, | |
275 | cpu_to_le32(req->tx_totallen), req->sign); | |
276 | if (signlen) { | |
277 | req->tx_ciov[1].iov_base = req->sign; | |
278 | req->tx_ciov[1].iov_len = signlen; | |
279 | req->tx_iovlen += 1; | |
280 | req->tx_totallen += signlen; | |
281 | } | |
282 | server->rcv.creq = req; | |
283 | server->timeout_last = server->m.time_out; | |
284 | server->timeout_retries = server->m.retry_count; | |
285 | ncpdgram_send(server->ncp_sock, req); | |
286 | mod_timer(&server->timeout_tm, jiffies + server->m.time_out); | |
287 | } | |
288 | ||
289 | #define NCP_TCP_XMIT_MAGIC (0x446D6454) | |
290 | #define NCP_TCP_XMIT_VERSION (1) | |
291 | #define NCP_TCP_RCVD_MAGIC (0x744E6350) | |
292 | ||
293 | static void ncptcp_start_request(struct ncp_server *server, struct ncp_request_reply *req) | |
294 | { | |
295 | size_t signlen; | |
296 | struct ncp_request_header* h; | |
297 | ||
298 | req->tx_ciov = req->tx_iov; | |
299 | h = req->tx_iov[1].iov_base; | |
300 | ncp_init_header(server, req, h); | |
301 | signlen = sign_packet(server, req->tx_iov[1].iov_base + sizeof(struct ncp_request_header) - 1, | |
302 | req->tx_iov[1].iov_len - sizeof(struct ncp_request_header) + 1, | |
303 | cpu_to_be32(req->tx_totallen + 24), req->sign + 4) + 16; | |
304 | ||
305 | req->sign[0] = htonl(NCP_TCP_XMIT_MAGIC); | |
306 | req->sign[1] = htonl(req->tx_totallen + signlen); | |
307 | req->sign[2] = htonl(NCP_TCP_XMIT_VERSION); | |
308 | req->sign[3] = htonl(req->datalen + 8); | |
309 | req->tx_iov[0].iov_base = req->sign; | |
310 | req->tx_iov[0].iov_len = signlen; | |
311 | req->tx_iovlen += 1; | |
312 | req->tx_totallen += signlen; | |
313 | ||
314 | server->tx.creq = req; | |
315 | __ncptcp_try_send(server); | |
316 | } | |
317 | ||
318 | static inline void __ncp_start_request(struct ncp_server *server, struct ncp_request_reply *req) | |
319 | { | |
c5f93cf1 PO |
320 | /* we copy the data so that we do not depend on the caller |
321 | staying alive */ | |
322 | memcpy(server->txbuf, req->tx_iov[1].iov_base, req->tx_iov[1].iov_len); | |
323 | req->tx_iov[1].iov_base = server->txbuf; | |
324 | ||
1da177e4 LT |
325 | if (server->ncp_sock->type == SOCK_STREAM) |
326 | ncptcp_start_request(server, req); | |
327 | else | |
328 | ncpdgram_start_request(server, req); | |
329 | } | |
330 | ||
331 | static int ncp_add_request(struct ncp_server *server, struct ncp_request_reply *req) | |
332 | { | |
8e3f9045 | 333 | mutex_lock(&server->rcv.creq_mutex); |
1da177e4 | 334 | if (!ncp_conn_valid(server)) { |
8e3f9045 | 335 | mutex_unlock(&server->rcv.creq_mutex); |
b41f8b84 | 336 | pr_err("tcp: Server died\n"); |
1da177e4 LT |
337 | return -EIO; |
338 | } | |
c5f93cf1 | 339 | ncp_req_get(req); |
1da177e4 LT |
340 | if (server->tx.creq || server->rcv.creq) { |
341 | req->status = RQ_QUEUED; | |
342 | list_add_tail(&req->req, &server->tx.requests); | |
8e3f9045 | 343 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
344 | return 0; |
345 | } | |
346 | __ncp_start_request(server, req); | |
8e3f9045 | 347 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
348 | return 0; |
349 | } | |
350 | ||
351 | static void __ncp_next_request(struct ncp_server *server) | |
352 | { | |
353 | struct ncp_request_reply *req; | |
354 | ||
355 | server->rcv.creq = NULL; | |
356 | if (list_empty(&server->tx.requests)) { | |
357 | return; | |
358 | } | |
359 | req = list_entry(server->tx.requests.next, struct ncp_request_reply, req); | |
360 | list_del_init(&req->req); | |
361 | __ncp_start_request(server, req); | |
362 | } | |
363 | ||
364 | static void info_server(struct ncp_server *server, unsigned int id, const void * data, size_t len) | |
365 | { | |
366 | if (server->info_sock) { | |
367 | struct kvec iov[2]; | |
368 | __be32 hdr[2]; | |
369 | ||
370 | hdr[0] = cpu_to_be32(len + 8); | |
371 | hdr[1] = cpu_to_be32(id); | |
372 | ||
373 | iov[0].iov_base = hdr; | |
374 | iov[0].iov_len = 8; | |
375 | iov[1].iov_base = (void *) data; | |
376 | iov[1].iov_len = len; | |
377 | ||
378 | do_send(server->info_sock, iov, 2, len + 8, MSG_NOSIGNAL); | |
379 | } | |
380 | } | |
381 | ||
c4028958 | 382 | void ncpdgram_rcv_proc(struct work_struct *work) |
1da177e4 | 383 | { |
c4028958 DH |
384 | struct ncp_server *server = |
385 | container_of(work, struct ncp_server, rcv.tq); | |
1da177e4 LT |
386 | struct socket* sock; |
387 | ||
388 | sock = server->ncp_sock; | |
389 | ||
390 | while (1) { | |
391 | struct ncp_reply_header reply; | |
392 | int result; | |
393 | ||
394 | result = _recv(sock, &reply, sizeof(reply), MSG_PEEK | MSG_DONTWAIT); | |
395 | if (result < 0) { | |
396 | break; | |
397 | } | |
398 | if (result >= sizeof(reply)) { | |
399 | struct ncp_request_reply *req; | |
400 | ||
401 | if (reply.type == NCP_WATCHDOG) { | |
402 | unsigned char buf[10]; | |
403 | ||
404 | if (server->connection != get_conn_number(&reply)) { | |
405 | goto drop; | |
406 | } | |
407 | result = _recv(sock, buf, sizeof(buf), MSG_DONTWAIT); | |
408 | if (result < 0) { | |
d3b73ca1 | 409 | ncp_dbg(1, "recv failed with %d\n", result); |
1da177e4 LT |
410 | continue; |
411 | } | |
412 | if (result < 10) { | |
d3b73ca1 | 413 | ncp_dbg(1, "too short (%u) watchdog packet\n", result); |
1da177e4 LT |
414 | continue; |
415 | } | |
416 | if (buf[9] != '?') { | |
d3b73ca1 | 417 | ncp_dbg(1, "bad signature (%02X) in watchdog packet\n", buf[9]); |
1da177e4 LT |
418 | continue; |
419 | } | |
420 | buf[9] = 'Y'; | |
421 | _send(sock, buf, sizeof(buf)); | |
422 | continue; | |
423 | } | |
424 | if (reply.type != NCP_POSITIVE_ACK && reply.type != NCP_REPLY) { | |
425 | result = _recv(sock, server->unexpected_packet.data, sizeof(server->unexpected_packet.data), MSG_DONTWAIT); | |
426 | if (result < 0) { | |
427 | continue; | |
428 | } | |
429 | info_server(server, 0, server->unexpected_packet.data, result); | |
430 | continue; | |
431 | } | |
8e3f9045 | 432 | mutex_lock(&server->rcv.creq_mutex); |
1da177e4 LT |
433 | req = server->rcv.creq; |
434 | if (req && (req->tx_type == NCP_ALLOC_SLOT_REQUEST || (server->sequence == reply.sequence && | |
435 | server->connection == get_conn_number(&reply)))) { | |
436 | if (reply.type == NCP_POSITIVE_ACK) { | |
437 | server->timeout_retries = server->m.retry_count; | |
438 | server->timeout_last = NCP_MAX_RPC_TIMEOUT; | |
439 | mod_timer(&server->timeout_tm, jiffies + NCP_MAX_RPC_TIMEOUT); | |
440 | } else if (reply.type == NCP_REPLY) { | |
c5f93cf1 | 441 | result = _recv(sock, server->rxbuf, req->datalen, MSG_DONTWAIT); |
1da177e4 LT |
442 | #ifdef CONFIG_NCPFS_PACKET_SIGNING |
443 | if (result >= 0 && server->sign_active && req->tx_type != NCP_DEALLOC_SLOT_REQUEST) { | |
444 | if (result < 8 + 8) { | |
445 | result = -EIO; | |
446 | } else { | |
447 | unsigned int hdrl; | |
448 | ||
449 | result -= 8; | |
450 | hdrl = sock->sk->sk_family == AF_INET ? 8 : 6; | |
c5f93cf1 | 451 | if (sign_verify_reply(server, server->rxbuf + hdrl, result - hdrl, cpu_to_le32(result), server->rxbuf + result)) { |
b41f8b84 | 452 | pr_info("Signature violation\n"); |
1da177e4 LT |
453 | result = -EIO; |
454 | } | |
455 | } | |
456 | } | |
457 | #endif | |
458 | del_timer(&server->timeout_tm); | |
459 | server->rcv.creq = NULL; | |
c5f93cf1 | 460 | ncp_finish_request(server, req, result); |
1da177e4 | 461 | __ncp_next_request(server); |
8e3f9045 | 462 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
463 | continue; |
464 | } | |
465 | } | |
8e3f9045 | 466 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
467 | } |
468 | drop:; | |
469 | _recv(sock, &reply, sizeof(reply), MSG_DONTWAIT); | |
470 | } | |
471 | } | |
472 | ||
473 | static void __ncpdgram_timeout_proc(struct ncp_server *server) | |
474 | { | |
475 | /* If timer is pending, we are processing another request... */ | |
476 | if (!timer_pending(&server->timeout_tm)) { | |
477 | struct ncp_request_reply* req; | |
478 | ||
479 | req = server->rcv.creq; | |
480 | if (req) { | |
481 | int timeout; | |
482 | ||
483 | if (server->m.flags & NCP_MOUNT_SOFT) { | |
484 | if (server->timeout_retries-- == 0) { | |
485 | __ncp_abort_request(server, req, -ETIMEDOUT); | |
486 | return; | |
487 | } | |
488 | } | |
489 | /* Ignore errors */ | |
490 | ncpdgram_send(server->ncp_sock, req); | |
491 | timeout = server->timeout_last << 1; | |
492 | if (timeout > NCP_MAX_RPC_TIMEOUT) { | |
493 | timeout = NCP_MAX_RPC_TIMEOUT; | |
494 | } | |
495 | server->timeout_last = timeout; | |
496 | mod_timer(&server->timeout_tm, jiffies + timeout); | |
497 | } | |
498 | } | |
499 | } | |
500 | ||
c4028958 | 501 | void ncpdgram_timeout_proc(struct work_struct *work) |
1da177e4 | 502 | { |
c4028958 DH |
503 | struct ncp_server *server = |
504 | container_of(work, struct ncp_server, timeout_tq); | |
8e3f9045 | 505 | mutex_lock(&server->rcv.creq_mutex); |
1da177e4 | 506 | __ncpdgram_timeout_proc(server); |
8e3f9045 | 507 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
508 | } |
509 | ||
1da177e4 LT |
510 | static int do_tcp_rcv(struct ncp_server *server, void *buffer, size_t len) |
511 | { | |
512 | int result; | |
513 | ||
514 | if (buffer) { | |
515 | result = _recv(server->ncp_sock, buffer, len, MSG_DONTWAIT); | |
516 | } else { | |
517 | static unsigned char dummy[1024]; | |
518 | ||
519 | if (len > sizeof(dummy)) { | |
520 | len = sizeof(dummy); | |
521 | } | |
522 | result = _recv(server->ncp_sock, dummy, len, MSG_DONTWAIT); | |
523 | } | |
524 | if (result < 0) { | |
525 | return result; | |
526 | } | |
527 | if (result > len) { | |
b41f8b84 | 528 | pr_err("tcp: bug in recvmsg (%u > %Zu)\n", result, len); |
1da177e4 LT |
529 | return -EIO; |
530 | } | |
531 | return result; | |
532 | } | |
533 | ||
534 | static int __ncptcp_rcv_proc(struct ncp_server *server) | |
535 | { | |
536 | /* We have to check the result, so store the complete header */ | |
537 | while (1) { | |
538 | int result; | |
539 | struct ncp_request_reply *req; | |
540 | int datalen; | |
541 | int type; | |
542 | ||
543 | while (server->rcv.len) { | |
544 | result = do_tcp_rcv(server, server->rcv.ptr, server->rcv.len); | |
545 | if (result == -EAGAIN) { | |
546 | return 0; | |
547 | } | |
548 | if (result <= 0) { | |
549 | req = server->rcv.creq; | |
550 | if (req) { | |
551 | __ncp_abort_request(server, req, -EIO); | |
552 | } else { | |
553 | __ncptcp_abort(server); | |
554 | } | |
555 | if (result < 0) { | |
b41f8b84 | 556 | pr_err("tcp: error in recvmsg: %d\n", result); |
1da177e4 | 557 | } else { |
d3b73ca1 | 558 | ncp_dbg(1, "tcp: EOF\n"); |
1da177e4 LT |
559 | } |
560 | return -EIO; | |
561 | } | |
562 | if (server->rcv.ptr) { | |
563 | server->rcv.ptr += result; | |
564 | } | |
565 | server->rcv.len -= result; | |
566 | } | |
567 | switch (server->rcv.state) { | |
568 | case 0: | |
569 | if (server->rcv.buf.magic != htonl(NCP_TCP_RCVD_MAGIC)) { | |
b41f8b84 | 570 | pr_err("tcp: Unexpected reply type %08X\n", ntohl(server->rcv.buf.magic)); |
1da177e4 LT |
571 | __ncptcp_abort(server); |
572 | return -EIO; | |
573 | } | |
574 | datalen = ntohl(server->rcv.buf.len) & 0x0FFFFFFF; | |
575 | if (datalen < 10) { | |
b41f8b84 | 576 | pr_err("tcp: Unexpected reply len %d\n", datalen); |
1da177e4 LT |
577 | __ncptcp_abort(server); |
578 | return -EIO; | |
579 | } | |
580 | #ifdef CONFIG_NCPFS_PACKET_SIGNING | |
581 | if (server->sign_active) { | |
582 | if (datalen < 18) { | |
b41f8b84 | 583 | pr_err("tcp: Unexpected reply len %d\n", datalen); |
1da177e4 LT |
584 | __ncptcp_abort(server); |
585 | return -EIO; | |
586 | } | |
587 | server->rcv.buf.len = datalen - 8; | |
588 | server->rcv.ptr = (unsigned char*)&server->rcv.buf.p1; | |
589 | server->rcv.len = 8; | |
590 | server->rcv.state = 4; | |
591 | break; | |
592 | } | |
593 | #endif | |
594 | type = ntohs(server->rcv.buf.type); | |
595 | #ifdef CONFIG_NCPFS_PACKET_SIGNING | |
596 | cont:; | |
597 | #endif | |
598 | if (type != NCP_REPLY) { | |
599 | if (datalen - 8 <= sizeof(server->unexpected_packet.data)) { | |
600 | *(__u16*)(server->unexpected_packet.data) = htons(type); | |
601 | server->unexpected_packet.len = datalen - 8; | |
602 | ||
603 | server->rcv.state = 5; | |
604 | server->rcv.ptr = server->unexpected_packet.data + 2; | |
605 | server->rcv.len = datalen - 10; | |
606 | break; | |
607 | } | |
d3b73ca1 | 608 | ncp_dbg(1, "tcp: Unexpected NCP type %02X\n", type); |
1da177e4 LT |
609 | skipdata2:; |
610 | server->rcv.state = 2; | |
611 | skipdata:; | |
612 | server->rcv.ptr = NULL; | |
613 | server->rcv.len = datalen - 10; | |
614 | break; | |
615 | } | |
616 | req = server->rcv.creq; | |
617 | if (!req) { | |
d3b73ca1 | 618 | ncp_dbg(1, "Reply without appropriate request\n"); |
1da177e4 LT |
619 | goto skipdata2; |
620 | } | |
621 | if (datalen > req->datalen + 8) { | |
b41f8b84 | 622 | pr_err("tcp: Unexpected reply len %d (expected at most %Zd)\n", datalen, req->datalen + 8); |
1da177e4 LT |
623 | server->rcv.state = 3; |
624 | goto skipdata; | |
625 | } | |
626 | req->datalen = datalen - 8; | |
c5f93cf1 PO |
627 | ((struct ncp_reply_header*)server->rxbuf)->type = NCP_REPLY; |
628 | server->rcv.ptr = server->rxbuf + 2; | |
1da177e4 LT |
629 | server->rcv.len = datalen - 10; |
630 | server->rcv.state = 1; | |
631 | break; | |
632 | #ifdef CONFIG_NCPFS_PACKET_SIGNING | |
633 | case 4: | |
634 | datalen = server->rcv.buf.len; | |
635 | type = ntohs(server->rcv.buf.type2); | |
636 | goto cont; | |
637 | #endif | |
638 | case 1: | |
639 | req = server->rcv.creq; | |
640 | if (req->tx_type != NCP_ALLOC_SLOT_REQUEST) { | |
c5f93cf1 | 641 | if (((struct ncp_reply_header*)server->rxbuf)->sequence != server->sequence) { |
b41f8b84 | 642 | pr_err("tcp: Bad sequence number\n"); |
1da177e4 LT |
643 | __ncp_abort_request(server, req, -EIO); |
644 | return -EIO; | |
645 | } | |
c5f93cf1 | 646 | if ((((struct ncp_reply_header*)server->rxbuf)->conn_low | (((struct ncp_reply_header*)server->rxbuf)->conn_high << 8)) != server->connection) { |
b41f8b84 | 647 | pr_err("tcp: Connection number mismatch\n"); |
1da177e4 LT |
648 | __ncp_abort_request(server, req, -EIO); |
649 | return -EIO; | |
650 | } | |
651 | } | |
652 | #ifdef CONFIG_NCPFS_PACKET_SIGNING | |
653 | if (server->sign_active && req->tx_type != NCP_DEALLOC_SLOT_REQUEST) { | |
c5f93cf1 | 654 | if (sign_verify_reply(server, server->rxbuf + 6, req->datalen - 6, cpu_to_be32(req->datalen + 16), &server->rcv.buf.type)) { |
b41f8b84 | 655 | pr_err("tcp: Signature violation\n"); |
1da177e4 LT |
656 | __ncp_abort_request(server, req, -EIO); |
657 | return -EIO; | |
658 | } | |
659 | } | |
660 | #endif | |
c5f93cf1 | 661 | ncp_finish_request(server, req, req->datalen); |
1da177e4 LT |
662 | nextreq:; |
663 | __ncp_next_request(server); | |
664 | case 2: | |
665 | next:; | |
666 | server->rcv.ptr = (unsigned char*)&server->rcv.buf; | |
667 | server->rcv.len = 10; | |
668 | server->rcv.state = 0; | |
669 | break; | |
670 | case 3: | |
c5f93cf1 | 671 | ncp_finish_request(server, server->rcv.creq, -EIO); |
1da177e4 LT |
672 | goto nextreq; |
673 | case 5: | |
674 | info_server(server, 0, server->unexpected_packet.data, server->unexpected_packet.len); | |
675 | goto next; | |
676 | } | |
677 | } | |
678 | } | |
679 | ||
c4028958 | 680 | void ncp_tcp_rcv_proc(struct work_struct *work) |
1da177e4 | 681 | { |
c4028958 DH |
682 | struct ncp_server *server = |
683 | container_of(work, struct ncp_server, rcv.tq); | |
1da177e4 | 684 | |
8e3f9045 | 685 | mutex_lock(&server->rcv.creq_mutex); |
1da177e4 | 686 | __ncptcp_rcv_proc(server); |
8e3f9045 | 687 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
688 | } |
689 | ||
c4028958 | 690 | void ncp_tcp_tx_proc(struct work_struct *work) |
1da177e4 | 691 | { |
c4028958 DH |
692 | struct ncp_server *server = |
693 | container_of(work, struct ncp_server, tx.tq); | |
1da177e4 | 694 | |
8e3f9045 | 695 | mutex_lock(&server->rcv.creq_mutex); |
1da177e4 | 696 | __ncptcp_try_send(server); |
8e3f9045 | 697 | mutex_unlock(&server->rcv.creq_mutex); |
1da177e4 LT |
698 | } |
699 | ||
700 | static int do_ncp_rpc_call(struct ncp_server *server, int size, | |
c5f93cf1 | 701 | unsigned char* reply_buf, int max_reply_size) |
1da177e4 LT |
702 | { |
703 | int result; | |
c5f93cf1 PO |
704 | struct ncp_request_reply *req; |
705 | ||
706 | req = ncp_alloc_req(); | |
707 | if (!req) | |
708 | return -ENOMEM; | |
709 | ||
710 | req->reply_buf = reply_buf; | |
711 | req->datalen = max_reply_size; | |
712 | req->tx_iov[1].iov_base = server->packet; | |
713 | req->tx_iov[1].iov_len = size; | |
714 | req->tx_iovlen = 1; | |
715 | req->tx_totallen = size; | |
716 | req->tx_type = *(u_int16_t*)server->packet; | |
717 | ||
718 | result = ncp_add_request(server, req); | |
719 | if (result < 0) | |
720 | goto out; | |
721 | ||
722 | if (wait_event_interruptible(req->wq, req->status == RQ_DONE)) { | |
723 | ncp_abort_request(server, req, -EINTR); | |
724 | result = -EINTR; | |
725 | goto out; | |
1da177e4 | 726 | } |
c5f93cf1 PO |
727 | |
728 | result = req->result; | |
729 | ||
730 | out: | |
731 | ncp_req_put(req); | |
732 | ||
733 | return result; | |
1da177e4 LT |
734 | } |
735 | ||
736 | /* | |
737 | * We need the server to be locked here, so check! | |
738 | */ | |
739 | ||
740 | static int ncp_do_request(struct ncp_server *server, int size, | |
741 | void* reply, int max_reply_size) | |
742 | { | |
743 | int result; | |
744 | ||
745 | if (server->lock == 0) { | |
b41f8b84 | 746 | pr_err("Server not locked!\n"); |
1da177e4 LT |
747 | return -EIO; |
748 | } | |
749 | if (!ncp_conn_valid(server)) { | |
1da177e4 LT |
750 | return -EIO; |
751 | } | |
752 | { | |
753 | sigset_t old_set; | |
754 | unsigned long mask, flags; | |
755 | ||
756 | spin_lock_irqsave(¤t->sighand->siglock, flags); | |
757 | old_set = current->blocked; | |
758 | if (current->flags & PF_EXITING) | |
759 | mask = 0; | |
760 | else | |
761 | mask = sigmask(SIGKILL); | |
762 | if (server->m.flags & NCP_MOUNT_INTR) { | |
763 | /* FIXME: This doesn't seem right at all. So, like, | |
764 | we can't handle SIGINT and get whatever to stop? | |
765 | What if we've blocked it ourselves? What about | |
766 | alarms? Why, in fact, are we mucking with the | |
767 | sigmask at all? -- r~ */ | |
768 | if (current->sighand->action[SIGINT - 1].sa.sa_handler == SIG_DFL) | |
769 | mask |= sigmask(SIGINT); | |
770 | if (current->sighand->action[SIGQUIT - 1].sa.sa_handler == SIG_DFL) | |
771 | mask |= sigmask(SIGQUIT); | |
772 | } | |
773 | siginitsetinv(¤t->blocked, mask); | |
774 | recalc_sigpending(); | |
775 | spin_unlock_irqrestore(¤t->sighand->siglock, flags); | |
776 | ||
777 | result = do_ncp_rpc_call(server, size, reply, max_reply_size); | |
778 | ||
779 | spin_lock_irqsave(¤t->sighand->siglock, flags); | |
780 | current->blocked = old_set; | |
781 | recalc_sigpending(); | |
782 | spin_unlock_irqrestore(¤t->sighand->siglock, flags); | |
783 | } | |
784 | ||
d3b73ca1 | 785 | ncp_dbg(2, "do_ncp_rpc_call returned %d\n", result); |
1da177e4 | 786 | |
1da177e4 LT |
787 | return result; |
788 | } | |
789 | ||
790 | /* ncp_do_request assures that at least a complete reply header is | |
791 | * received. It assumes that server->current_size contains the ncp | |
792 | * request size | |
793 | */ | |
794 | int ncp_request2(struct ncp_server *server, int function, | |
795 | void* rpl, int size) | |
796 | { | |
797 | struct ncp_request_header *h; | |
798 | struct ncp_reply_header* reply = rpl; | |
799 | int result; | |
800 | ||
801 | h = (struct ncp_request_header *) (server->packet); | |
802 | if (server->has_subfunction != 0) { | |
803 | *(__u16 *) & (h->data[0]) = htons(server->current_size - sizeof(*h) - 2); | |
804 | } | |
805 | h->type = NCP_REQUEST; | |
806 | /* | |
807 | * The server shouldn't know or care what task is making a | |
808 | * request, so we always use the same task number. | |
809 | */ | |
810 | h->task = 2; /* (current->pid) & 0xff; */ | |
811 | h->function = function; | |
812 | ||
813 | result = ncp_do_request(server, server->current_size, reply, size); | |
814 | if (result < 0) { | |
d3b73ca1 | 815 | ncp_dbg(1, "ncp_request_error: %d\n", result); |
1da177e4 LT |
816 | goto out; |
817 | } | |
818 | server->completion = reply->completion_code; | |
819 | server->conn_status = reply->connection_state; | |
820 | server->reply_size = result; | |
821 | server->ncp_reply_size = result - sizeof(struct ncp_reply_header); | |
822 | ||
823 | result = reply->completion_code; | |
824 | ||
825 | if (result != 0) | |
e45ca8ba | 826 | ncp_vdbg("completion code=%x\n", result); |
1da177e4 LT |
827 | out: |
828 | return result; | |
829 | } | |
830 | ||
831 | int ncp_connect(struct ncp_server *server) | |
832 | { | |
833 | struct ncp_request_header *h; | |
834 | int result; | |
835 | ||
836 | server->connection = 0xFFFF; | |
837 | server->sequence = 255; | |
838 | ||
839 | h = (struct ncp_request_header *) (server->packet); | |
840 | h->type = NCP_ALLOC_SLOT_REQUEST; | |
841 | h->task = 2; /* see above */ | |
842 | h->function = 0; | |
843 | ||
844 | result = ncp_do_request(server, sizeof(*h), server->packet, server->packet_size); | |
845 | if (result < 0) | |
846 | goto out; | |
847 | server->connection = h->conn_low + (h->conn_high * 256); | |
848 | result = 0; | |
849 | out: | |
850 | return result; | |
851 | } | |
852 | ||
853 | int ncp_disconnect(struct ncp_server *server) | |
854 | { | |
855 | struct ncp_request_header *h; | |
856 | ||
857 | h = (struct ncp_request_header *) (server->packet); | |
858 | h->type = NCP_DEALLOC_SLOT_REQUEST; | |
859 | h->task = 2; /* see above */ | |
860 | h->function = 0; | |
861 | ||
862 | return ncp_do_request(server, sizeof(*h), server->packet, server->packet_size); | |
863 | } | |
864 | ||
865 | void ncp_lock_server(struct ncp_server *server) | |
866 | { | |
8e3f9045 | 867 | mutex_lock(&server->mutex); |
1da177e4 | 868 | if (server->lock) |
b41f8b84 | 869 | pr_warn("%s: was locked!\n", __func__); |
1da177e4 LT |
870 | server->lock = 1; |
871 | } | |
872 | ||
873 | void ncp_unlock_server(struct ncp_server *server) | |
874 | { | |
875 | if (!server->lock) { | |
b41f8b84 | 876 | pr_warn("%s: was not locked!\n", __func__); |
1da177e4 LT |
877 | return; |
878 | } | |
879 | server->lock = 0; | |
8e3f9045 | 880 | mutex_unlock(&server->mutex); |
1da177e4 | 881 | } |