be2f3b10e4a92bb5d58e27418b7d8554326c276b
[ira/wip.git] / source3 / smbd / smb2_server.c
1 /*
2    Unix SMB/CIFS implementation.
3    Core SMB2 server
4
5    Copyright (C) Stefan Metzmacher 2009
6
7    This program is free software; you can redistribute it and/or modify
8    it under the terms of the GNU General Public License as published by
9    the Free Software Foundation; either version 3 of the License, or
10    (at your option) any later version.
11
12    This program is distributed in the hope that it will be useful,
13    but WITHOUT ANY WARRANTY; without even the implied warranty of
14    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15    GNU General Public License for more details.
16
17    You should have received a copy of the GNU General Public License
18    along with this program.  If not, see <http://www.gnu.org/licenses/>.
19 */
20
21 #include "includes.h"
22 #include "smbd/globals.h"
23 #include "../source4/libcli/smb2/smb2_constants.h"
24 #include "../lib/tsocket/tsocket.h"
25
26 bool smbd_is_smb2_header(const uint8_t *inbuf, size_t size)
27 {
28         if (size < (4 + SMB2_HDR_BODY)) {
29                 return false;
30         }
31
32         if (IVAL(inbuf, 4) != SMB2_MAGIC) {
33                 return false;
34         }
35
36         return true;
37 }
38
39 static NTSTATUS smbd_initialize_smb2(struct smbd_server_connection *conn)
40 {
41         NTSTATUS status;
42         int ret;
43
44         TALLOC_FREE(conn->smb1.fde);
45
46         conn->smb2.event_ctx = smbd_event_context();
47
48         conn->smb2.recv_queue = tevent_queue_create(conn, "smb2 recv queue");
49         if (conn->smb2.recv_queue == NULL) {
50                 return NT_STATUS_NO_MEMORY;
51         }
52
53         conn->smb2.send_queue = tevent_queue_create(conn, "smb2 send queue");
54         if (conn->smb2.send_queue == NULL) {
55                 return NT_STATUS_NO_MEMORY;
56         }
57
58         conn->smb2.sessions.idtree = idr_init(conn);
59         if (conn->smb2.sessions.idtree == NULL) {
60                 return NT_STATUS_NO_MEMORY;
61         }
62         conn->smb2.sessions.limit = 0x0000FFFE;
63         conn->smb2.sessions.list = NULL;
64
65         ret = tstream_bsd_existing_socket(conn, smbd_server_fd(),
66                                           &conn->smb2.stream);
67         if (ret == -1) {
68                 status = map_nt_error_from_unix(errno);
69                 return status;
70         }
71
72         /* Ensure child is set to non-blocking mode */
73         set_blocking(smbd_server_fd(),false);
74         return NT_STATUS_OK;
75 }
76
77 #define smb2_len(buf) (PVAL(buf,3)|(PVAL(buf,2)<<8)|(PVAL(buf,1)<<16))
78 #define _smb2_setlen(_buf,len) do { \
79         uint8_t *buf = (uint8_t *)_buf; \
80         buf[0] = 0; \
81         buf[1] = ((len)&0xFF0000)>>16; \
82         buf[2] = ((len)&0xFF00)>>8; \
83         buf[3] = (len)&0xFF; \
84 } while (0)
85
86 static void smb2_setup_nbt_length(struct iovec *vector, int count)
87 {
88         size_t len = 0;
89         int i;
90
91         for (i=1; i < count; i++) {
92                 len += vector[i].iov_len;
93         }
94
95         _smb2_setlen(vector[0].iov_base, len);
96 }
97
98 static NTSTATUS smbd_smb2_request_create(struct smbd_server_connection *conn,
99                                          const uint8_t *inbuf, size_t size,
100                                          struct smbd_smb2_request **_req)
101 {
102         TALLOC_CTX *mem_pool;
103         struct smbd_smb2_request *req;
104         uint32_t protocol_version;
105         const uint8_t *inhdr = NULL;
106         off_t ofs = 0;
107         uint16_t cmd;
108         uint32_t next_command_ofs;
109
110         if (size < (4 + SMB2_HDR_BODY + 2)) {
111                 DEBUG(0,("Invalid SMB2 packet length count %ld\n", (long)size));
112                 return NT_STATUS_INVALID_PARAMETER;
113         }
114
115         inhdr = inbuf + 4;
116
117         protocol_version = IVAL(inhdr, SMB2_HDR_PROTOCOL_ID);
118         if (protocol_version != SMB2_MAGIC) {
119                 DEBUG(0,("Invalid SMB packet: protocol prefix: 0x%08X\n",
120                          protocol_version));
121                 return NT_STATUS_INVALID_PARAMETER;
122         }
123
124         cmd = SVAL(inhdr, SMB2_HDR_OPCODE);
125         if (cmd != SMB2_OP_NEGPROT) {
126                 DEBUG(0,("Invalid SMB packet: first request: 0x%04X\n",
127                          cmd));
128                 return NT_STATUS_INVALID_PARAMETER;
129         }
130
131         next_command_ofs = IVAL(inhdr, SMB2_HDR_NEXT_COMMAND);
132         if (next_command_ofs != 0) {
133                 DEBUG(0,("Invalid SMB packet: next_command: 0x%08X\n",
134                          next_command_ofs));
135                 return NT_STATUS_INVALID_PARAMETER;
136         }
137
138         mem_pool = talloc_pool(conn, 8192);
139         if (mem_pool == NULL) {
140                 return NT_STATUS_NO_MEMORY;
141         }
142
143         req = talloc_zero(mem_pool, struct smbd_smb2_request);
144         if (req == NULL) {
145                 talloc_free(mem_pool);
146                 return NT_STATUS_NO_MEMORY;
147         }
148         req->mem_pool   = mem_pool;
149         req->conn       = conn;
150
151         talloc_steal(req, inbuf);
152
153         req->in.vector = talloc_array(req, struct iovec, 4);
154         if (req->in.vector == NULL) {
155                 talloc_free(mem_pool);
156                 return NT_STATUS_NO_MEMORY;
157         }
158         req->in.vector_count = 4;
159
160         memcpy(req->in.nbt_hdr, inbuf, 4);
161
162         ofs = 0;
163         req->in.vector[0].iov_base      = (void *)req->in.nbt_hdr;
164         req->in.vector[0].iov_len       = 4;
165         ofs += req->in.vector[0].iov_len;
166
167         req->in.vector[1].iov_base      = (void *)(inbuf + ofs);
168         req->in.vector[1].iov_len       = SMB2_HDR_BODY;
169         ofs += req->in.vector[1].iov_len;
170
171         req->in.vector[2].iov_base      = (void *)(inbuf + ofs);
172         req->in.vector[2].iov_len       = SVAL(inbuf, ofs) & 0xFFFE;
173         ofs += req->in.vector[2].iov_len;
174
175         if (ofs > size) {
176                 return NT_STATUS_INVALID_PARAMETER;
177         }
178
179         req->in.vector[3].iov_base      = (void *)(inbuf + ofs);
180         req->in.vector[3].iov_len       = size - ofs;
181         ofs += req->in.vector[3].iov_len;
182
183         req->current_idx = 1;
184
185         *_req = req;
186         return NT_STATUS_OK;
187 }
188
189 static NTSTATUS smbd_smb2_request_setup_out(struct smbd_smb2_request *req)
190 {
191         struct iovec *vector;
192         int count;
193         int idx;
194
195         count = req->in.vector_count;
196         vector = talloc_array(req, struct iovec, count);
197         if (vector == NULL) {
198                 return NT_STATUS_NO_MEMORY;
199         }
200
201         vector[0].iov_base      = req->out.nbt_hdr;
202         vector[0].iov_len       = 4;
203         SIVAL(req->out.nbt_hdr, 0, 0);
204
205         for (idx=1; idx < count; idx += 3) {
206                 const uint8_t *inhdr = NULL;
207                 uint8_t *outhdr = NULL;
208                 uint8_t *outbody = NULL;
209                 uint8_t *outdyn = NULL;
210                 size_t outdyn_size = 1;
211                 uint32_t next_command_ofs = 0;
212                 struct iovec *current = &vector[idx];
213
214                 if ((idx + 3) < count) {
215                         /* we have a next command */
216                         next_command_ofs = SMB2_HDR_BODY + 8 + 8;
217                         outdyn_size = 8;
218                 }
219
220                 inhdr = (const uint8_t *)req->in.vector[idx].iov_base;
221
222                 outhdr = talloc_array(vector, uint8_t,
223                                       SMB2_HDR_BODY + 8 + outdyn_size);
224                 if (outhdr == NULL) {
225                         return NT_STATUS_NO_MEMORY;
226                 }
227
228                 outbody = outhdr + SMB2_HDR_BODY;
229                 outdyn = outbody + 8;
230
231                 current[0].iov_base     = (void *)outhdr;
232                 current[0].iov_len      = SMB2_HDR_BODY;
233
234                 current[1].iov_base     = (void *)outbody;
235                 current[1].iov_len      = 8;
236
237                 current[2].iov_base     = (void *)outdyn;
238                 current[2].iov_len      = outdyn_size;
239
240                 /* setup the SMB2 header */
241                 SIVAL(outhdr, SMB2_HDR_PROTOCOL_ID,     SMB2_MAGIC);
242                 SSVAL(outhdr, SMB2_HDR_LENGTH,          SMB2_HDR_BODY);
243                 SSVAL(outhdr, SMB2_HDR_EPOCH,           0);
244                 SIVAL(outhdr, SMB2_HDR_STATUS,
245                       NT_STATUS_V(NT_STATUS_INTERNAL_ERROR));
246                 SSVAL(outhdr, SMB2_HDR_OPCODE,
247                       SVAL(inhdr, SMB2_HDR_OPCODE));
248                 /* Make up a number for now... JRA. FIXME ! FIXME !*/
249                 SSVAL(outhdr, SMB2_HDR_CREDIT,          20);
250                 SIVAL(outhdr, SMB2_HDR_FLAGS,           SMB2_HDR_FLAG_REDIRECT);
251                 SIVAL(outhdr, SMB2_HDR_NEXT_COMMAND,    next_command_ofs);
252                 SBVAL(outhdr, SMB2_HDR_MESSAGE_ID,
253                       BVAL(inhdr, SMB2_HDR_MESSAGE_ID));
254                 SIVAL(outhdr, SMB2_HDR_PID,
255                       IVAL(inhdr, SMB2_HDR_PID));
256                 SIVAL(outhdr, SMB2_HDR_TID,
257                       IVAL(inhdr, SMB2_HDR_TID));
258                 SBVAL(outhdr, SMB2_HDR_SESSION_ID,
259                       BVAL(inhdr, SMB2_HDR_SESSION_ID));
260                 memset(outhdr + SMB2_HDR_SIGNATURE, 0, 16);
261
262                 /* setup error body header */
263                 SSVAL(outbody, 0x00, 9);
264                 SSVAL(outbody, 0x02, 0);
265                 SIVAL(outbody, 0x04, 0);
266
267                 /* setup the dynamic part */
268                 SCVAL(outdyn, 0x00, 0);
269         }
270
271         req->out.vector = vector;
272         req->out.vector_count = count;
273
274         /* setup the length of the NBT packet */
275         smb2_setup_nbt_length(req->out.vector, req->out.vector_count);
276
277         return NT_STATUS_OK;
278 }
279
280 void smbd_server_connection_terminate_ex(struct smbd_server_connection *sconn,
281                                          const char *reason,
282                                          const char *location)
283 {
284         DEBUG(10,("smbd_server_connection_terminate_ex: reason[%s] at %s\n",
285                   reason, location));
286         exit_server_cleanly(reason);
287 }
288
289 static NTSTATUS smbd_smb2_request_dispatch(struct smbd_smb2_request *req)
290 {
291         const uint8_t *inhdr;
292         int i = req->current_idx;
293         uint16_t opcode;
294         uint32_t flags;
295         NTSTATUS status;
296         NTSTATUS session_status;
297
298         inhdr = (const uint8_t *)req->in.vector[i].iov_base;
299
300         /* TODO: verify more things */
301
302         flags = IVAL(inhdr, SMB2_HDR_FLAGS);
303         opcode = IVAL(inhdr, SMB2_HDR_OPCODE);
304         DEBUG(10,("smbd_smb2_request_dispatch: opcode[%u]\n", opcode));
305
306 #define TMP_SMB2_ALLOWED_FLAGS ( \
307         SMB2_HDR_FLAG_CHAINED | \
308         SMB2_HDR_FLAG_SIGNED | \
309         SMB2_HDR_FLAG_DFS)
310         if ((flags & ~TMP_SMB2_ALLOWED_FLAGS) != 0) {
311                 return smbd_smb2_request_error(req, NT_STATUS_INVALID_PARAMETER);
312         }
313 #undef TMP_SMB2_ALLOWED_FLAGS
314
315         session_status = smbd_smb2_request_check_session(req);
316
317         req->do_signing = false;
318         if (flags & SMB2_HDR_FLAG_SIGNED) {
319                 if (!NT_STATUS_IS_OK(session_status)) {
320                         return smbd_smb2_request_error(req, session_status);
321                 }
322
323                 req->do_signing = true;
324                 status = smb2_signing_check_pdu(req->session->session_key,
325                                                 &req->in.vector[i], 3);
326                 if (!NT_STATUS_IS_OK(status)) {
327                         return smbd_smb2_request_error(req, status);
328                 }
329         } else if (req->session && req->session->do_signing) {
330                 return smbd_smb2_request_error(req, NT_STATUS_ACCESS_DENIED);
331         }
332
333         switch (opcode) {
334         case SMB2_OP_NEGPROT:
335                 return smbd_smb2_request_process_negprot(req);
336
337         case SMB2_OP_SESSSETUP:
338                 return smbd_smb2_request_process_sesssetup(req);
339
340         case SMB2_OP_LOGOFF:
341                 if (!NT_STATUS_IS_OK(session_status)) {
342                         return smbd_smb2_request_error(req, session_status);
343                 }
344                 return smbd_smb2_request_process_logoff(req);
345
346         case SMB2_OP_TCON:
347                 if (!NT_STATUS_IS_OK(session_status)) {
348                         return smbd_smb2_request_error(req, session_status);
349                 }
350                 status = smbd_smb2_request_check_session(req);
351                 if (!NT_STATUS_IS_OK(status)) {
352                         return smbd_smb2_request_error(req, status);
353                 }
354                 return smbd_smb2_request_process_tcon(req);
355
356         case SMB2_OP_TDIS:
357                 if (!NT_STATUS_IS_OK(session_status)) {
358                         return smbd_smb2_request_error(req, session_status);
359                 }
360                 status = smbd_smb2_request_check_tcon(req);
361                 if (!NT_STATUS_IS_OK(status)) {
362                         return smbd_smb2_request_error(req, status);
363                 }
364                 return smbd_smb2_request_process_tdis(req);
365
366         case SMB2_OP_CREATE:
367                 if (!NT_STATUS_IS_OK(session_status)) {
368                         return smbd_smb2_request_error(req, session_status);
369                 }
370                 status = smbd_smb2_request_check_tcon(req);
371                 if (!NT_STATUS_IS_OK(status)) {
372                         return smbd_smb2_request_error(req, status);
373                 }
374                 return smbd_smb2_request_process_create(req);
375
376         case SMB2_OP_CLOSE:
377                 if (!NT_STATUS_IS_OK(session_status)) {
378                         return smbd_smb2_request_error(req, session_status);
379                 }
380                 status = smbd_smb2_request_check_tcon(req);
381                 if (!NT_STATUS_IS_OK(status)) {
382                         return smbd_smb2_request_error(req, status);
383                 }
384                 return smbd_smb2_request_process_close(req);
385
386         case SMB2_OP_FLUSH:
387                 if (!NT_STATUS_IS_OK(session_status)) {
388                         return smbd_smb2_request_error(req, session_status);
389                 }
390                 status = smbd_smb2_request_check_tcon(req);
391                 if (!NT_STATUS_IS_OK(status)) {
392                         return smbd_smb2_request_error(req, status);
393                 }
394                 return smbd_smb2_request_process_flush(req);
395
396         case SMB2_OP_READ:
397                 if (!NT_STATUS_IS_OK(session_status)) {
398                         return smbd_smb2_request_error(req, session_status);
399                 }
400                 status = smbd_smb2_request_check_tcon(req);
401                 if (!NT_STATUS_IS_OK(status)) {
402                         return smbd_smb2_request_error(req, status);
403                 }
404                 return smbd_smb2_request_process_read(req);
405
406         case SMB2_OP_WRITE:
407                 if (!NT_STATUS_IS_OK(session_status)) {
408                         return smbd_smb2_request_error(req, session_status);
409                 }
410                 status = smbd_smb2_request_check_tcon(req);
411                 if (!NT_STATUS_IS_OK(status)) {
412                         return smbd_smb2_request_error(req, status);
413                 }
414                 return smbd_smb2_request_process_write(req);
415
416         case SMB2_OP_LOCK:
417                 if (!NT_STATUS_IS_OK(session_status)) {
418                         return smbd_smb2_request_error(req, session_status);
419                 }
420                 status = smbd_smb2_request_check_tcon(req);
421                 if (!NT_STATUS_IS_OK(status)) {
422                         return smbd_smb2_request_error(req, status);
423                 }
424                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
425
426         case SMB2_OP_IOCTL:
427                 if (!NT_STATUS_IS_OK(session_status)) {
428                         return smbd_smb2_request_error(req, session_status);
429                 }
430                 status = smbd_smb2_request_check_tcon(req);
431                 if (!NT_STATUS_IS_OK(status)) {
432                         return smbd_smb2_request_error(req, status);
433                 }
434                 return smbd_smb2_request_process_ioctl(req);
435
436         case SMB2_OP_CANCEL:
437                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
438
439         case SMB2_OP_KEEPALIVE:
440                 return smbd_smb2_request_process_keepalive(req);
441
442         case SMB2_OP_FIND:
443                 if (!NT_STATUS_IS_OK(session_status)) {
444                         return smbd_smb2_request_error(req, session_status);
445                 }
446                 status = smbd_smb2_request_check_tcon(req);
447                 if (!NT_STATUS_IS_OK(status)) {
448                         return smbd_smb2_request_error(req, status);
449                 }
450                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
451
452         case SMB2_OP_NOTIFY:
453                 if (!NT_STATUS_IS_OK(session_status)) {
454                         return smbd_smb2_request_error(req, session_status);
455                 }
456                 status = smbd_smb2_request_check_tcon(req);
457                 if (!NT_STATUS_IS_OK(status)) {
458                         return smbd_smb2_request_error(req, status);
459                 }
460                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
461
462         case SMB2_OP_GETINFO:
463                 if (!NT_STATUS_IS_OK(session_status)) {
464                         return smbd_smb2_request_error(req, session_status);
465                 }
466                 status = smbd_smb2_request_check_tcon(req);
467                 if (!NT_STATUS_IS_OK(status)) {
468                         return smbd_smb2_request_error(req, status);
469                 }
470                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
471
472         case SMB2_OP_SETINFO:
473                 if (!NT_STATUS_IS_OK(session_status)) {
474                         return smbd_smb2_request_error(req, session_status);
475                 }
476                 status = smbd_smb2_request_check_tcon(req);
477                 if (!NT_STATUS_IS_OK(status)) {
478                         return smbd_smb2_request_error(req, status);
479                 }
480                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
481
482         case SMB2_OP_BREAK:
483                 if (!NT_STATUS_IS_OK(session_status)) {
484                         return smbd_smb2_request_error(req, session_status);
485                 }
486                 status = smbd_smb2_request_check_tcon(req);
487                 if (!NT_STATUS_IS_OK(status)) {
488                         return smbd_smb2_request_error(req, status);
489                 }
490                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
491         }
492
493         return smbd_smb2_request_error(req, NT_STATUS_INVALID_PARAMETER);
494 }
495
496 static void smbd_smb2_request_dispatch_compound(struct tevent_req *subreq);
497 static void smbd_smb2_request_writev_done(struct tevent_req *subreq);
498
499 static NTSTATUS smbd_smb2_request_reply(struct smbd_smb2_request *req)
500 {
501         struct tevent_req *subreq;
502
503         smb2_setup_nbt_length(req->out.vector, req->out.vector_count);
504
505         if (req->do_signing) {
506                 int i = req->current_idx;
507                 NTSTATUS status;
508                 status = smb2_signing_sign_pdu(req->session->session_key,
509                                                &req->out.vector[i], 3);
510                 if (!NT_STATUS_IS_OK(status)) {
511                         return status;
512                 }
513         }
514
515         req->current_idx += 3;
516
517         if (req->current_idx > req->in.vector_count) {
518                 struct timeval zero = timeval_zero();
519                 subreq = tevent_wakeup_send(req,
520                                             req->conn->smb2.event_ctx,
521                                             zero);
522                 if (subreq == NULL) {
523                         return NT_STATUS_NO_MEMORY;
524                 }
525                 tevent_req_set_callback(subreq,
526                                         smbd_smb2_request_dispatch_compound,
527                                         req);
528
529                 return NT_STATUS_OK;
530         }
531
532         subreq = tstream_writev_queue_send(req,
533                                            req->conn->smb2.event_ctx,
534                                            req->conn->smb2.stream,
535                                            req->conn->smb2.send_queue,
536                                            req->out.vector,
537                                            req->out.vector_count);
538         if (subreq == NULL) {
539                 return NT_STATUS_NO_MEMORY;
540         }
541         tevent_req_set_callback(subreq, smbd_smb2_request_writev_done, req);
542
543         return NT_STATUS_OK;
544 }
545
546 static void smbd_smb2_request_dispatch_compound(struct tevent_req *subreq)
547 {
548         struct smbd_smb2_request *req = tevent_req_callback_data(subreq,
549                                         struct smbd_smb2_request);
550         struct smbd_server_connection *conn = req->conn;
551         NTSTATUS status;
552
553         tevent_wakeup_recv(subreq);
554         TALLOC_FREE(subreq);
555
556         DEBUG(10,("smbd_smb2_request_dispatch_compound: idx[%d] of %d vectors\n",
557                   req->current_idx, req->in.vector_count));
558
559         status = smbd_smb2_request_dispatch(req);
560         if (!NT_STATUS_IS_OK(status)) {
561                 smbd_server_connection_terminate(conn, nt_errstr(status));
562                 return;
563         }
564 }
565
566 static void smbd_smb2_request_writev_done(struct tevent_req *subreq)
567 {
568         struct smbd_smb2_request *req = tevent_req_callback_data(subreq,
569                                         struct smbd_smb2_request);
570         struct smbd_server_connection *conn = req->conn;
571         int ret;
572         int sys_errno;
573         TALLOC_CTX *mem_pool;
574
575         ret = tstream_writev_queue_recv(subreq, &sys_errno);
576         TALLOC_FREE(subreq);
577         if (ret == -1) {
578                 NTSTATUS status = map_nt_error_from_unix(sys_errno);
579                 smbd_server_connection_terminate(conn, nt_errstr(status));
580                 return;
581         }
582
583         mem_pool = req->mem_pool;
584         req = NULL;
585         talloc_free(mem_pool);
586 }
587
588 NTSTATUS smbd_smb2_request_error_ex(struct smbd_smb2_request *req,
589                                     NTSTATUS status,
590                                     DATA_BLOB *info,
591                                     const char *location)
592 {
593         uint8_t *outhdr;
594         uint8_t *outbody;
595         int i = req->current_idx;
596
597         DEBUG(10,("smbd_smb2_request_error_ex: idx[%d] status[%s] |%s| at %s\n",
598                   i, nt_errstr(status), info ? " +info" : "",
599                   location));
600
601         outhdr = (uint8_t *)req->out.vector[i].iov_base;
602
603         SIVAL(outhdr, SMB2_HDR_STATUS, NT_STATUS_V(status));
604
605         outbody = outhdr + SMB2_HDR_BODY;
606
607         req->out.vector[i+1].iov_base = (void *)outbody;
608         req->out.vector[i+1].iov_len = 8;
609
610         if (info) {
611                 SIVAL(outbody, 0x04, info->length);
612                 req->out.vector[i+2].iov_base   = (void *)info->data;
613                 req->out.vector[i+2].iov_len    = info->length;
614         } else {
615                 req->out.vector[i+2].iov_base = (void *)(outbody + 8);
616                 req->out.vector[i+2].iov_len = 1;
617         }
618
619         /* the error packet is the last response in the chain */
620         SIVAL(outhdr, SMB2_HDR_NEXT_COMMAND, 0);
621         req->out.vector_count = req->current_idx + 3;
622
623         return smbd_smb2_request_reply(req);
624 }
625
626 NTSTATUS smbd_smb2_request_done_ex(struct smbd_smb2_request *req,
627                                    NTSTATUS status,
628                                    DATA_BLOB body, DATA_BLOB *dyn,
629                                    const char *location)
630 {
631         uint8_t *outhdr;
632         uint8_t *outdyn;
633         int i = req->current_idx;
634         uint32_t next_command_ofs;
635
636         DEBUG(10,("smbd_smb2_request_done_ex: "
637                   "idx[%d] status[%s] body[%u] dyn[%s:%u] at %s\n",
638                   i, nt_errstr(status), (unsigned int)body.length,
639                   dyn ? "yes": "no",
640                   (unsigned int)(dyn ? dyn->length : 0),
641                   location));
642
643         if (body.length < 2) {
644                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
645         }
646
647         if ((body.length % 2) != 0) {
648                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
649         }
650
651         outhdr = (uint8_t *)req->out.vector[i].iov_base;
652         /* the fallback dynamic buffer */
653         outdyn = outhdr + SMB2_HDR_BODY + 8;
654
655         next_command_ofs = IVAL(outhdr, SMB2_HDR_NEXT_COMMAND);
656         SIVAL(outhdr, SMB2_HDR_STATUS, NT_STATUS_V(status));
657
658         req->out.vector[i+1].iov_base = (void *)body.data;
659         req->out.vector[i+1].iov_len = body.length;
660
661         if (dyn) {
662                 if (dyn->length > 0) {
663                         req->out.vector[i+2].iov_base   = (void *)dyn->data;
664                         req->out.vector[i+2].iov_len    = dyn->length;
665                 } else {
666                         /* the dyn section is already initialized */
667                 }
668         } else {
669                 req->out.vector[i+2].iov_base = NULL;
670                 req->out.vector[i+2].iov_len = 0;
671         }
672
673         /* see if we need to recalculate the offset to the next response */
674         if (next_command_ofs > 0) {
675                 next_command_ofs  = SMB2_HDR_BODY;
676                 next_command_ofs += req->out.vector[i+1].iov_len;
677                 next_command_ofs += req->out.vector[i+2].iov_len;
678         }
679
680         /* TODO: we need to add padding ... */
681         if ((next_command_ofs % 8) != 0) {
682                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
683         }
684
685         /* the error packet is the last response in the chain */
686         SIVAL(outhdr, SMB2_HDR_NEXT_COMMAND, next_command_ofs);
687
688         return smbd_smb2_request_reply(req);
689 }
690
691 struct smbd_smb2_request_read_state {
692         size_t missing;
693         bool asked_for_header;
694         struct smbd_smb2_request *smb2_req;
695 };
696
697 static int smbd_smb2_request_next_vector(struct tstream_context *stream,
698                                          void *private_data,
699                                          TALLOC_CTX *mem_ctx,
700                                          struct iovec **_vector,
701                                          size_t *_count);
702 static void smbd_smb2_request_read_done(struct tevent_req *subreq);
703
704 static struct tevent_req *smbd_smb2_request_read_send(TALLOC_CTX *mem_ctx,
705                                         struct tevent_context *ev,
706                                         struct smbd_server_connection *conn)
707 {
708         struct tevent_req *req;
709         struct smbd_smb2_request_read_state *state;
710         struct tevent_req *subreq;
711         TALLOC_CTX *mem_pool;
712
713         req = tevent_req_create(mem_ctx, &state,
714                                 struct smbd_smb2_request_read_state);
715         if (req == NULL) {
716                 return NULL;
717         }
718         state->missing = 0;
719         state->asked_for_header = false;
720
721         mem_pool = talloc_pool(state, 8192);
722         if (tevent_req_nomem(mem_pool, req)) {
723                 return tevent_req_post(req, ev);
724         }
725
726         state->smb2_req = talloc_zero(mem_pool, struct smbd_smb2_request);
727         if (tevent_req_nomem(state->smb2_req, req)) {
728                 return tevent_req_post(req, ev);
729         }
730
731         state->smb2_req->mem_pool       = mem_pool;
732         state->smb2_req->conn           = conn;
733
734         subreq = tstream_readv_pdu_queue_send(state, ev, conn->smb2.stream,
735                                               conn->smb2.recv_queue,
736                                               smbd_smb2_request_next_vector,
737                                               state);
738         if (tevent_req_nomem(subreq, req)) {
739                 return tevent_req_post(req, ev);
740         }
741         tevent_req_set_callback(subreq, smbd_smb2_request_read_done, req);
742
743         return req;
744 }
745
746 static int smbd_smb2_request_next_vector(struct tstream_context *stream,
747                                          void *private_data,
748                                          TALLOC_CTX *mem_ctx,
749                                          struct iovec **_vector,
750                                          size_t *_count)
751 {
752         struct smbd_smb2_request_read_state *state =
753                 talloc_get_type_abort(private_data,
754                 struct smbd_smb2_request_read_state);
755         struct smbd_smb2_request *req = state->smb2_req;
756         struct iovec *vector;
757         int idx = req->in.vector_count;
758         size_t len = 0;
759         uint8_t *buf = NULL;
760
761         if (req->in.vector_count == 0) {
762                 /*
763                  * first we need to get the NBT header
764                  */
765                 req->in.vector = talloc_array(req, struct iovec,
766                                               req->in.vector_count + 1);
767                 if (req->in.vector == NULL) {
768                         return -1;
769                 }
770                 req->in.vector_count += 1;
771
772                 req->in.vector[idx].iov_base    = (void *)req->in.nbt_hdr;
773                 req->in.vector[idx].iov_len     = 4;
774
775                 vector = talloc_array(mem_ctx, struct iovec, 1);
776                 if (vector == NULL) {
777                         return -1;
778                 }
779
780                 vector[0] = req->in.vector[idx];
781
782                 *_vector = vector;
783                 *_count = 1;
784                 return 0;
785         }
786
787         if (req->in.vector_count == 1) {
788                 /*
789                  * Now we analyze the NBT header
790                  */
791                 state->missing = smb2_len(req->in.vector[0].iov_base);
792
793                 if (state->missing == 0) {
794                         /* if there're no remaining bytes, we're done */
795                         *_vector = NULL;
796                         *_count = 0;
797                         return 0;
798                 }
799
800                 req->in.vector = talloc_realloc(req, req->in.vector,
801                                                 struct iovec,
802                                                 req->in.vector_count + 1);
803                 if (req->in.vector == NULL) {
804                         return -1;
805                 }
806                 req->in.vector_count += 1;
807
808                 if (CVAL(req->in.vector[0].iov_base, 0) != 0) {
809                         /*
810                          * it's a special NBT message,
811                          * so get all remaining bytes
812                          */
813                         len = state->missing;
814                 } else if (state->missing < (SMB2_HDR_BODY + 2)) {
815                         /*
816                          * it's an invalid message, just read what we can get
817                          * and let the caller handle the error
818                          */
819                         len = state->missing;
820                 } else {
821                         /*
822                          * We assume it's a SMB2 request,
823                          * and we first get the header and the
824                          * first 2 bytes (the struct size) of the body
825                          */
826                         len = SMB2_HDR_BODY + 2;
827
828                         state->asked_for_header = true;
829                 }
830
831                 state->missing -= len;
832
833                 buf = talloc_array(req->in.vector, uint8_t, len);
834                 if (buf == NULL) {
835                         return -1;
836                 }
837
838                 req->in.vector[idx].iov_base    = (void *)buf;
839                 req->in.vector[idx].iov_len     = len;
840
841                 vector = talloc_array(mem_ctx, struct iovec, 1);
842                 if (vector == NULL) {
843                         return -1;
844                 }
845
846                 vector[0] = req->in.vector[idx];
847
848                 *_vector = vector;
849                 *_count = 1;
850                 return 0;
851         }
852
853         if (state->missing == 0) {
854                 /* if there're no remaining bytes, we're done */
855                 *_vector = NULL;
856                 *_count = 0;
857                 return 0;
858         }
859
860         if (state->asked_for_header) {
861                 const uint8_t *hdr;
862                 size_t full_size;
863                 size_t next_command_ofs;
864                 size_t body_size;
865                 uint8_t *body;
866                 size_t dyn_size;
867                 uint8_t *dyn;
868                 bool invalid = false;
869
870                 state->asked_for_header = false;
871
872                 /*
873                  * We got the SMB2 header and the first 2 bytes
874                  * of the body. We fix the size to just the header
875                  * and manually copy the 2 first bytes to the body section
876                  */
877                 req->in.vector[idx-1].iov_len = SMB2_HDR_BODY;
878                 hdr = (const uint8_t *)req->in.vector[idx-1].iov_base;
879
880                 /* allocate vectors for body and dynamic areas */
881                 req->in.vector = talloc_realloc(req, req->in.vector,
882                                                 struct iovec,
883                                                 req->in.vector_count + 2);
884                 if (req->in.vector == NULL) {
885                         return -1;
886                 }
887                 req->in.vector_count += 2;
888
889                 full_size = state->missing + SMB2_HDR_BODY + 2;
890                 next_command_ofs = IVAL(hdr, SMB2_HDR_NEXT_COMMAND);
891                 body_size = SVAL(hdr, SMB2_HDR_BODY);
892
893                 if (next_command_ofs != 0) {
894                         if (next_command_ofs < (SMB2_HDR_BODY + 2)) {
895                                 /*
896                                  * this is invalid, just return a zero
897                                  * body and let the caller deal with the error
898                                  */
899                                 invalid = true;
900                         } else if (next_command_ofs > full_size) {
901                                 /*
902                                  * this is invalid, just return a zero
903                                  * body and let the caller deal with the error
904                                  */
905                                 invalid = true;
906                         } else {
907                                 full_size = next_command_ofs;
908                         }
909                 }
910
911                 if (!invalid) {
912                         if (body_size < 2) {
913                                 /*
914                                  * this is invalid, just return a zero
915                                  * body and let the caller deal with the error
916                                  */
917                                 invalid = true;
918                         } else if (body_size > (full_size - SMB2_HDR_BODY)) {
919                                 /*
920                                  * this is invalid, just return a zero
921                                  * body and let the caller deal with the error
922                                  */
923                                 invalid = true;
924                         }
925                 }
926
927                 if (invalid) {
928                         /* the caller should check this */
929                         body_size = 0;
930                 }
931
932                 if ((body_size % 2) != 0) {
933                         body_size -= 1;
934                 }
935
936                 dyn_size = full_size - (SMB2_HDR_BODY + body_size);
937
938                 state->missing -= (body_size - 2) + dyn_size;
939
940                 body = talloc_array(req->in.vector, uint8_t, body_size);
941                 if (body == NULL) {
942                         return -1;
943                 }
944
945                 dyn = talloc_array(req->in.vector, uint8_t, dyn_size);
946                 if (dyn == NULL) {
947                         return -1;
948                 }
949
950                 req->in.vector[idx].iov_base    = (void *)body;
951                 req->in.vector[idx].iov_len     = body_size;
952                 req->in.vector[idx+1].iov_base  = (void *)dyn;
953                 req->in.vector[idx+1].iov_len   = dyn_size;
954
955                 vector = talloc_array(mem_ctx, struct iovec, 2);
956                 if (vector == NULL) {
957                         return -1;
958                 }
959
960                 /*
961                  * the first 2 bytes of the body were already fetched
962                  * together with the header
963                  */
964                 memcpy(body, hdr + SMB2_HDR_BODY, 2);
965                 vector[0].iov_base = body + 2;
966                 vector[0].iov_len = req->in.vector[idx].iov_len - 2;
967
968                 vector[1] = req->in.vector[idx+1];
969
970                 *_vector = vector;
971                 *_count = 2;
972                 return 0;
973         }
974
975         /*
976          * when we endup here, we're looking for a new SMB2 request
977          * next. And we ask for its header and the first 2 bytes of
978          * the body (like we did for the first SMB2 request).
979          */
980
981         req->in.vector = talloc_realloc(req, req->in.vector,
982                                         struct iovec,
983                                         req->in.vector_count + 1);
984         if (req->in.vector == NULL) {
985                 return -1;
986         }
987         req->in.vector_count += 1;
988
989         /*
990          * We assume it's a SMB2 request,
991          * and we first get the header and the
992          * first 2 bytes (the struct size) of the body
993          */
994         len = SMB2_HDR_BODY + 2;
995
996         if (len > state->missing) {
997                 /* let the caller handle the error */
998                 len = state->missing;
999         }
1000
1001         state->missing -= len;
1002         state->asked_for_header = true;
1003
1004         buf = talloc_array(req->in.vector, uint8_t, len);
1005         if (buf == NULL) {
1006                 return -1;
1007         }
1008
1009         req->in.vector[idx].iov_base    = (void *)buf;
1010         req->in.vector[idx].iov_len     = len;
1011
1012         vector = talloc_array(mem_ctx, struct iovec, 1);
1013         if (vector == NULL) {
1014                 return -1;
1015         }
1016
1017         vector[0] = req->in.vector[idx];
1018
1019         *_vector = vector;
1020         *_count = 1;
1021         return 0;
1022 }
1023
1024 static void smbd_smb2_request_read_done(struct tevent_req *subreq)
1025 {
1026         struct tevent_req *req =
1027                 tevent_req_callback_data(subreq,
1028                 struct tevent_req);
1029         int ret;
1030         int sys_errno;
1031         NTSTATUS status;
1032
1033         ret = tstream_readv_pdu_queue_recv(subreq, &sys_errno);
1034         if (ret == -1) {
1035                 status = map_nt_error_from_unix(sys_errno);
1036                 tevent_req_nterror(req, status);
1037                 return;
1038         }
1039
1040         tevent_req_done(req);
1041 }
1042
1043 static NTSTATUS smbd_smb2_request_read_recv(struct tevent_req *req,
1044                                             TALLOC_CTX *mem_ctx,
1045                                             struct smbd_smb2_request **_smb2_req)
1046 {
1047         struct smbd_smb2_request_read_state *state =
1048                 tevent_req_data(req,
1049                 struct smbd_smb2_request_read_state);
1050         NTSTATUS status;
1051
1052         if (tevent_req_is_nterror(req, &status)) {
1053                 tevent_req_received(req);
1054                 return status;
1055         }
1056
1057         talloc_steal(mem_ctx, state->smb2_req->mem_pool);
1058         *_smb2_req = state->smb2_req;
1059         tevent_req_received(req);
1060         return NT_STATUS_OK;
1061 }
1062
1063 static void smbd_smb2_request_incoming(struct tevent_req *subreq);
1064
1065 void smbd_smb2_first_negprot(struct smbd_server_connection *conn,
1066                              const uint8_t *inbuf, size_t size)
1067 {
1068         NTSTATUS status;
1069         struct smbd_smb2_request *req;
1070         struct tevent_req *subreq;
1071
1072         DEBUG(10,("smbd_smb2_first_negprot: packet length %u\n",
1073                  (unsigned int)size));
1074
1075         status = smbd_initialize_smb2(conn);
1076         if (!NT_STATUS_IS_OK(status)) {
1077                 smbd_server_connection_terminate(conn, nt_errstr(status));
1078                 return;
1079         }
1080
1081         status = smbd_smb2_request_create(conn, inbuf, size, &req);
1082         if (!NT_STATUS_IS_OK(status)) {
1083                 smbd_server_connection_terminate(conn, nt_errstr(status));
1084                 return;
1085         }
1086
1087         status = smbd_smb2_request_setup_out(req);
1088         if (!NT_STATUS_IS_OK(status)) {
1089                 smbd_server_connection_terminate(conn, nt_errstr(status));
1090                 return;
1091         }
1092
1093         status = smbd_smb2_request_dispatch(req);
1094         if (!NT_STATUS_IS_OK(status)) {
1095                 smbd_server_connection_terminate(conn, nt_errstr(status));
1096                 return;
1097         }
1098
1099         /* ask for the next request */
1100         subreq = smbd_smb2_request_read_send(conn,conn->smb2.event_ctx, conn);
1101         if (subreq == NULL) {
1102                 smbd_server_connection_terminate(conn, "no memory for reading");
1103                 return;
1104         }
1105         tevent_req_set_callback(subreq, smbd_smb2_request_incoming, conn);
1106 }
1107
1108 static void smbd_smb2_request_incoming(struct tevent_req *subreq)
1109 {
1110         struct smbd_server_connection *conn = tevent_req_callback_data(subreq,
1111                                               struct smbd_server_connection);
1112         NTSTATUS status;
1113         struct smbd_smb2_request *req;
1114
1115         status = smbd_smb2_request_read_recv(subreq, conn, &req);
1116         TALLOC_FREE(subreq);
1117         if (!NT_STATUS_IS_OK(status)) {
1118                 smbd_server_connection_terminate(conn, nt_errstr(status));
1119                 return;
1120         }
1121
1122         /* TODO: validate the incoming request */
1123         req->current_idx = 1;
1124
1125         DEBUG(10,("smbd_smb2_request_incoming: idx[%d] of %d vectors\n",
1126                  req->current_idx, req->in.vector_count));
1127
1128         status = smbd_smb2_request_setup_out(req);
1129         if (!NT_STATUS_IS_OK(status)) {
1130                 smbd_server_connection_terminate(conn, nt_errstr(status));
1131                 return;
1132         }
1133
1134         status = smbd_smb2_request_dispatch(req);
1135         if (!NT_STATUS_IS_OK(status)) {
1136                 smbd_server_connection_terminate(conn, nt_errstr(status));
1137                 return;
1138         }
1139
1140         /* ask for the next request (this constructs the main loop) */
1141         subreq = smbd_smb2_request_read_send(conn,conn->smb2.event_ctx, conn);
1142         if (subreq == NULL) {
1143                 smbd_server_connection_terminate(conn, "no memory for reading");
1144                 return;
1145         }
1146         tevent_req_set_callback(subreq, smbd_smb2_request_incoming, conn);
1147 }