Change smbd_smb2_request_error() to add a __location__.
[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 static void smbd_server_connection_terminate(struct smbd_server_connection *conn,
281                                              const char *reason)
282 {
283         DEBUG(10,("smbd_server_connection_terminate: reason[%s]\n", reason));
284         exit_server_cleanly(reason);
285 }
286
287 static NTSTATUS smbd_smb2_request_dispatch(struct smbd_smb2_request *req)
288 {
289         const uint8_t *inhdr;
290         int i = req->current_idx;
291         uint16_t opcode;
292         uint32_t flags;
293         NTSTATUS status;
294         NTSTATUS session_status;
295
296         inhdr = (const uint8_t *)req->in.vector[i].iov_base;
297
298         /* TODO: verify more things */
299
300         flags = IVAL(inhdr, SMB2_HDR_FLAGS);
301         opcode = IVAL(inhdr, SMB2_HDR_OPCODE);
302         DEBUG(10,("smbd_smb2_request_dispatch: opcode[%u]\n", opcode));
303
304 #define TMP_SMB2_ALLOWED_FLAGS ( \
305         SMB2_HDR_FLAG_CHAINED | \
306         SMB2_HDR_FLAG_SIGNED | \
307         SMB2_HDR_FLAG_DFS)
308         if ((flags & ~TMP_SMB2_ALLOWED_FLAGS) != 0) {
309                 return smbd_smb2_request_error(req, NT_STATUS_INVALID_PARAMETER);
310         }
311 #undef TMP_SMB2_ALLOWED_FLAGS
312
313         session_status = smbd_smb2_request_check_session(req);
314
315         req->do_signing = false;
316         if (flags & SMB2_HDR_FLAG_SIGNED) {
317                 if (!NT_STATUS_IS_OK(session_status)) {
318                         return smbd_smb2_request_error(req, session_status);
319                 }
320
321                 req->do_signing = true;
322                 status = smb2_signing_check_pdu(req->session->session_key,
323                                                 &req->in.vector[i], 3);
324                 if (!NT_STATUS_IS_OK(status)) {
325                         return smbd_smb2_request_error(req, status);
326                 }
327         } else if (req->session && req->session->do_signing) {
328                 return smbd_smb2_request_error(req, NT_STATUS_ACCESS_DENIED);
329         }
330
331         switch (opcode) {
332         case SMB2_OP_NEGPROT:
333                 return smbd_smb2_request_process_negprot(req);
334
335         case SMB2_OP_SESSSETUP:
336                 return smbd_smb2_request_process_sesssetup(req);
337
338         case SMB2_OP_LOGOFF:
339                 if (!NT_STATUS_IS_OK(session_status)) {
340                         return smbd_smb2_request_error(req, session_status);
341                 }
342                 return smbd_smb2_request_process_logoff(req);
343
344         case SMB2_OP_TCON:
345                 if (!NT_STATUS_IS_OK(session_status)) {
346                         return smbd_smb2_request_error(req, session_status);
347                 }
348                 status = smbd_smb2_request_check_session(req);
349                 if (!NT_STATUS_IS_OK(status)) {
350                         return smbd_smb2_request_error(req, status);
351                 }
352                 return smbd_smb2_request_process_tcon(req);
353
354         case SMB2_OP_TDIS:
355                 if (!NT_STATUS_IS_OK(session_status)) {
356                         return smbd_smb2_request_error(req, session_status);
357                 }
358                 status = smbd_smb2_request_check_tcon(req);
359                 if (!NT_STATUS_IS_OK(status)) {
360                         return smbd_smb2_request_error(req, status);
361                 }
362                 return smbd_smb2_request_process_tdis(req);
363
364         case SMB2_OP_CREATE:
365                 if (!NT_STATUS_IS_OK(session_status)) {
366                         return smbd_smb2_request_error(req, session_status);
367                 }
368                 status = smbd_smb2_request_check_tcon(req);
369                 if (!NT_STATUS_IS_OK(status)) {
370                         return smbd_smb2_request_error(req, status);
371                 }
372                 return smbd_smb2_request_process_create(req);
373
374         case SMB2_OP_CLOSE:
375                 if (!NT_STATUS_IS_OK(session_status)) {
376                         return smbd_smb2_request_error(req, session_status);
377                 }
378                 status = smbd_smb2_request_check_tcon(req);
379                 if (!NT_STATUS_IS_OK(status)) {
380                         return smbd_smb2_request_error(req, status);
381                 }
382                 return smbd_smb2_request_process_close(req);
383
384         case SMB2_OP_FLUSH:
385                 if (!NT_STATUS_IS_OK(session_status)) {
386                         return smbd_smb2_request_error(req, session_status);
387                 }
388                 status = smbd_smb2_request_check_tcon(req);
389                 if (!NT_STATUS_IS_OK(status)) {
390                         return smbd_smb2_request_error(req, status);
391                 }
392                 return smbd_smb2_request_process_flush(req);
393
394         case SMB2_OP_READ:
395                 if (!NT_STATUS_IS_OK(session_status)) {
396                         return smbd_smb2_request_error(req, session_status);
397                 }
398                 status = smbd_smb2_request_check_tcon(req);
399                 if (!NT_STATUS_IS_OK(status)) {
400                         return smbd_smb2_request_error(req, status);
401                 }
402                 return smbd_smb2_request_process_read(req);
403
404         case SMB2_OP_WRITE:
405                 if (!NT_STATUS_IS_OK(session_status)) {
406                         return smbd_smb2_request_error(req, session_status);
407                 }
408                 status = smbd_smb2_request_check_tcon(req);
409                 if (!NT_STATUS_IS_OK(status)) {
410                         return smbd_smb2_request_error(req, status);
411                 }
412                 return smbd_smb2_request_process_write(req);
413
414         case SMB2_OP_LOCK:
415                 if (!NT_STATUS_IS_OK(session_status)) {
416                         return smbd_smb2_request_error(req, session_status);
417                 }
418                 status = smbd_smb2_request_check_tcon(req);
419                 if (!NT_STATUS_IS_OK(status)) {
420                         return smbd_smb2_request_error(req, status);
421                 }
422                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
423
424         case SMB2_OP_IOCTL:
425                 if (!NT_STATUS_IS_OK(session_status)) {
426                         return smbd_smb2_request_error(req, session_status);
427                 }
428                 status = smbd_smb2_request_check_tcon(req);
429                 if (!NT_STATUS_IS_OK(status)) {
430                         return smbd_smb2_request_error(req, status);
431                 }
432                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
433
434         case SMB2_OP_CANCEL:
435                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
436
437         case SMB2_OP_KEEPALIVE:
438                 return smbd_smb2_request_process_keepalive(req);
439
440         case SMB2_OP_FIND:
441                 if (!NT_STATUS_IS_OK(session_status)) {
442                         return smbd_smb2_request_error(req, session_status);
443                 }
444                 status = smbd_smb2_request_check_tcon(req);
445                 if (!NT_STATUS_IS_OK(status)) {
446                         return smbd_smb2_request_error(req, status);
447                 }
448                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
449
450         case SMB2_OP_NOTIFY:
451                 if (!NT_STATUS_IS_OK(session_status)) {
452                         return smbd_smb2_request_error(req, session_status);
453                 }
454                 status = smbd_smb2_request_check_tcon(req);
455                 if (!NT_STATUS_IS_OK(status)) {
456                         return smbd_smb2_request_error(req, status);
457                 }
458                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
459
460         case SMB2_OP_GETINFO:
461                 if (!NT_STATUS_IS_OK(session_status)) {
462                         return smbd_smb2_request_error(req, session_status);
463                 }
464                 status = smbd_smb2_request_check_tcon(req);
465                 if (!NT_STATUS_IS_OK(status)) {
466                         return smbd_smb2_request_error(req, status);
467                 }
468                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
469
470         case SMB2_OP_SETINFO:
471                 if (!NT_STATUS_IS_OK(session_status)) {
472                         return smbd_smb2_request_error(req, session_status);
473                 }
474                 status = smbd_smb2_request_check_tcon(req);
475                 if (!NT_STATUS_IS_OK(status)) {
476                         return smbd_smb2_request_error(req, status);
477                 }
478                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
479
480         case SMB2_OP_BREAK:
481                 if (!NT_STATUS_IS_OK(session_status)) {
482                         return smbd_smb2_request_error(req, session_status);
483                 }
484                 status = smbd_smb2_request_check_tcon(req);
485                 if (!NT_STATUS_IS_OK(status)) {
486                         return smbd_smb2_request_error(req, status);
487                 }
488                 return smbd_smb2_request_error(req, NT_STATUS_NOT_IMPLEMENTED);
489         }
490
491         return smbd_smb2_request_error(req, NT_STATUS_INVALID_PARAMETER);
492 }
493
494 static void smbd_smb2_request_dispatch_compound(struct tevent_req *subreq);
495 static void smbd_smb2_request_writev_done(struct tevent_req *subreq);
496
497 static NTSTATUS smbd_smb2_request_reply(struct smbd_smb2_request *req)
498 {
499         struct tevent_req *subreq;
500
501         smb2_setup_nbt_length(req->out.vector, req->out.vector_count);
502
503         if (req->do_signing) {
504                 int i = req->current_idx;
505                 NTSTATUS status;
506                 status = smb2_signing_sign_pdu(req->session->session_key,
507                                                &req->out.vector[i], 3);
508                 if (!NT_STATUS_IS_OK(status)) {
509                         return status;
510                 }
511         }
512
513         req->current_idx += 3;
514
515         if (req->current_idx > req->in.vector_count) {
516                 struct timeval zero = timeval_zero();
517                 subreq = tevent_wakeup_send(req,
518                                             req->conn->smb2.event_ctx,
519                                             zero);
520                 if (subreq == NULL) {
521                         return NT_STATUS_NO_MEMORY;
522                 }
523                 tevent_req_set_callback(subreq,
524                                         smbd_smb2_request_dispatch_compound,
525                                         req);
526
527                 return NT_STATUS_OK;
528         }
529
530         subreq = tstream_writev_queue_send(req,
531                                            req->conn->smb2.event_ctx,
532                                            req->conn->smb2.stream,
533                                            req->conn->smb2.send_queue,
534                                            req->out.vector,
535                                            req->out.vector_count);
536         if (subreq == NULL) {
537                 return NT_STATUS_NO_MEMORY;
538         }
539         tevent_req_set_callback(subreq, smbd_smb2_request_writev_done, req);
540
541         return NT_STATUS_OK;
542 }
543
544 static void smbd_smb2_request_dispatch_compound(struct tevent_req *subreq)
545 {
546         struct smbd_smb2_request *req = tevent_req_callback_data(subreq,
547                                         struct smbd_smb2_request);
548         struct smbd_server_connection *conn = req->conn;
549         NTSTATUS status;
550
551         tevent_wakeup_recv(subreq);
552         TALLOC_FREE(subreq);
553
554         DEBUG(10,("smbd_smb2_request_dispatch_compound: idx[%d] of %d vectors\n",
555                   req->current_idx, req->in.vector_count));
556
557         status = smbd_smb2_request_dispatch(req);
558         if (!NT_STATUS_IS_OK(status)) {
559                 smbd_server_connection_terminate(conn, nt_errstr(status));
560                 return;
561         }
562 }
563
564 static void smbd_smb2_request_writev_done(struct tevent_req *subreq)
565 {
566         struct smbd_smb2_request *req = tevent_req_callback_data(subreq,
567                                         struct smbd_smb2_request);
568         struct smbd_server_connection *conn = req->conn;
569         int ret;
570         int sys_errno;
571         TALLOC_CTX *mem_pool;
572
573         ret = tstream_writev_queue_recv(subreq, &sys_errno);
574         TALLOC_FREE(subreq);
575         if (ret == -1) {
576                 NTSTATUS status = map_nt_error_from_unix(sys_errno);
577                 smbd_server_connection_terminate(conn, nt_errstr(status));
578                 return;
579         }
580
581         mem_pool = req->mem_pool;
582         req = NULL;
583         talloc_free(mem_pool);
584 }
585
586 static NTSTATUS smbd_smb2_request_error_ex(struct smbd_smb2_request *req,
587                                     NTSTATUS status,
588                                     const char *wherestr,
589                                     DATA_BLOB *info)
590 {
591         uint8_t *outhdr;
592         uint8_t *outbody;
593         int i = req->current_idx;
594
595         DEBUG(10,("smbd_smb2_request_error_ex: idx[%d] status[%s] at %s |%s|\n",
596                   i, nt_errstr(status), wherestr, info ? " +info" : ""));
597
598         outhdr = (uint8_t *)req->out.vector[i].iov_base;
599
600         SIVAL(outhdr, SMB2_HDR_STATUS, NT_STATUS_V(status));
601
602         outbody = outhdr + SMB2_HDR_BODY;
603
604         req->out.vector[i+1].iov_base = (void *)outbody;
605         req->out.vector[i+1].iov_len = 8;
606
607         if (info) {
608                 SIVAL(outbody, 0x04, info->length);
609                 req->out.vector[i+2].iov_base   = (void *)info->data;
610                 req->out.vector[i+2].iov_len    = info->length;
611         } else {
612                 req->out.vector[i+2].iov_base = (void *)(outbody + 8);
613                 req->out.vector[i+2].iov_len = 1;
614         }
615
616         /* the error packet is the last response in the chain */
617         SIVAL(outhdr, SMB2_HDR_NEXT_COMMAND, 0);
618         req->out.vector_count = req->current_idx + 3;
619
620         return smbd_smb2_request_reply(req);
621 }
622
623 NTSTATUS smbd_smb2_request_error_(struct smbd_smb2_request *req,
624                                  NTSTATUS status, const char *wherestr)
625 {
626         return smbd_smb2_request_error_ex(req, status, wherestr, NULL);
627 }
628
629 NTSTATUS smbd_smb2_request_done_ex(struct smbd_smb2_request *req,
630                                    NTSTATUS status,
631                                    DATA_BLOB body, DATA_BLOB *dyn)
632 {
633         uint8_t *outhdr;
634         uint8_t *outdyn;
635         int i = req->current_idx;
636         uint32_t next_command_ofs;
637
638         DEBUG(10,("smbd_smb2_request_done_ex: "
639                   "idx[%d] status[%s] body[%u] dyn[%s:%u]\n",
640                   i, nt_errstr(status), (unsigned int)body.length,
641                   dyn ? "yes": "no",
642                   (unsigned int)(dyn ? dyn->length : 0)));
643
644         if (body.length < 2) {
645                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
646         }
647
648         if ((body.length % 2) != 0) {
649                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
650         }
651
652         outhdr = (uint8_t *)req->out.vector[i].iov_base;
653         /* the fallback dynamic buffer */
654         outdyn = outhdr + SMB2_HDR_BODY + 8;
655
656         next_command_ofs = IVAL(outhdr, SMB2_HDR_NEXT_COMMAND);
657         SIVAL(outhdr, SMB2_HDR_STATUS, NT_STATUS_V(status));
658
659         req->out.vector[i+1].iov_base = (void *)body.data;
660         req->out.vector[i+1].iov_len = body.length;
661
662         if (dyn) {
663                 if (dyn->length > 0) {
664                         req->out.vector[i+2].iov_base   = (void *)dyn->data;
665                         req->out.vector[i+2].iov_len    = dyn->length;
666                 } else {
667                         req->out.vector[i+2].iov_base   = (void *)outdyn;
668                         req->out.vector[i+2].iov_len    = 1;
669                 }
670         } else {
671                 req->out.vector[i+2].iov_base = NULL;
672                 req->out.vector[i+2].iov_len = 0;
673         }
674
675         /* see if we need to recalculate the offset to the next response */
676         if (next_command_ofs > 0) {
677                 next_command_ofs  = SMB2_HDR_BODY;
678                 next_command_ofs += req->out.vector[i+1].iov_len;
679                 next_command_ofs += req->out.vector[i+2].iov_len;
680         }
681
682         /* TODO: we need to add padding ... */
683         if ((next_command_ofs % 8) != 0) {
684                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
685         }
686
687         /* the error packet is the last response in the chain */
688         SIVAL(outhdr, SMB2_HDR_NEXT_COMMAND, next_command_ofs);
689
690         return smbd_smb2_request_reply(req);
691 }
692
693 NTSTATUS smbd_smb2_request_done(struct smbd_smb2_request *req,
694                                 DATA_BLOB body, DATA_BLOB *dyn)
695 {
696         return smbd_smb2_request_done_ex(req, NT_STATUS_OK, body, dyn);
697 }
698
699 struct smbd_smb2_request_read_state {
700         size_t missing;
701         bool asked_for_header;
702         struct smbd_smb2_request *smb2_req;
703 };
704
705 static int smbd_smb2_request_next_vector(struct tstream_context *stream,
706                                          void *private_data,
707                                          TALLOC_CTX *mem_ctx,
708                                          struct iovec **_vector,
709                                          size_t *_count);
710 static void smbd_smb2_request_read_done(struct tevent_req *subreq);
711
712 static struct tevent_req *smbd_smb2_request_read_send(TALLOC_CTX *mem_ctx,
713                                         struct tevent_context *ev,
714                                         struct smbd_server_connection *conn)
715 {
716         struct tevent_req *req;
717         struct smbd_smb2_request_read_state *state;
718         struct tevent_req *subreq;
719         TALLOC_CTX *mem_pool;
720
721         req = tevent_req_create(mem_ctx, &state,
722                                 struct smbd_smb2_request_read_state);
723         if (req == NULL) {
724                 return NULL;
725         }
726         state->missing = 0;
727         state->asked_for_header = false;
728
729         mem_pool = talloc_pool(state, 8192);
730         if (tevent_req_nomem(mem_pool, req)) {
731                 return tevent_req_post(req, ev);
732         }
733
734         state->smb2_req = talloc_zero(mem_pool, struct smbd_smb2_request);
735         if (tevent_req_nomem(state->smb2_req, req)) {
736                 return tevent_req_post(req, ev);
737         }
738
739         state->smb2_req->mem_pool       = mem_pool;
740         state->smb2_req->conn           = conn;
741
742         subreq = tstream_readv_pdu_queue_send(state, ev, conn->smb2.stream,
743                                               conn->smb2.recv_queue,
744                                               smbd_smb2_request_next_vector,
745                                               state);
746         if (tevent_req_nomem(subreq, req)) {
747                 return tevent_req_post(req, ev);
748         }
749         tevent_req_set_callback(subreq, smbd_smb2_request_read_done, req);
750
751         return req;
752 }
753
754 static int smbd_smb2_request_next_vector(struct tstream_context *stream,
755                                          void *private_data,
756                                          TALLOC_CTX *mem_ctx,
757                                          struct iovec **_vector,
758                                          size_t *_count)
759 {
760         struct smbd_smb2_request_read_state *state =
761                 talloc_get_type_abort(private_data,
762                 struct smbd_smb2_request_read_state);
763         struct smbd_smb2_request *req = state->smb2_req;
764         struct iovec *vector;
765         int idx = req->in.vector_count;
766         size_t len = 0;
767         uint8_t *buf = NULL;
768
769         if (req->in.vector_count == 0) {
770                 /*
771                  * first we need to get the NBT header
772                  */
773                 req->in.vector = talloc_array(req, struct iovec,
774                                               req->in.vector_count + 1);
775                 if (req->in.vector == NULL) {
776                         return -1;
777                 }
778                 req->in.vector_count += 1;
779
780                 req->in.vector[idx].iov_base    = (void *)req->in.nbt_hdr;
781                 req->in.vector[idx].iov_len     = 4;
782
783                 vector = talloc_array(mem_ctx, struct iovec, 1);
784                 if (vector == NULL) {
785                         return -1;
786                 }
787
788                 vector[0] = req->in.vector[idx];
789
790                 *_vector = vector;
791                 *_count = 1;
792                 return 0;
793         }
794
795         if (req->in.vector_count == 1) {
796                 /*
797                  * Now we analyze the NBT header
798                  */
799                 state->missing = smb2_len(req->in.vector[0].iov_base);
800
801                 if (state->missing == 0) {
802                         /* if there're no remaining bytes, we're done */
803                         *_vector = NULL;
804                         *_count = 0;
805                         return 0;
806                 }
807
808                 req->in.vector = talloc_realloc(req, req->in.vector,
809                                                 struct iovec,
810                                                 req->in.vector_count + 1);
811                 if (req->in.vector == NULL) {
812                         return -1;
813                 }
814                 req->in.vector_count += 1;
815
816                 if (CVAL(req->in.vector[0].iov_base, 0) != 0) {
817                         /*
818                          * it's a special NBT message,
819                          * so get all remaining bytes
820                          */
821                         len = state->missing;
822                 } else if (state->missing < (SMB2_HDR_BODY + 2)) {
823                         /*
824                          * it's an invalid message, just read what we can get
825                          * and let the caller handle the error
826                          */
827                         len = state->missing;
828                 } else {
829                         /*
830                          * We assume it's a SMB2 request,
831                          * and we first get the header and the
832                          * first 2 bytes (the struct size) of the body
833                          */
834                         len = SMB2_HDR_BODY + 2;
835
836                         state->asked_for_header = true;
837                 }
838
839                 state->missing -= len;
840
841                 buf = talloc_array(req->in.vector, uint8_t, len);
842                 if (buf == NULL) {
843                         return -1;
844                 }
845
846                 req->in.vector[idx].iov_base    = (void *)buf;
847                 req->in.vector[idx].iov_len     = len;
848
849                 vector = talloc_array(mem_ctx, struct iovec, 1);
850                 if (vector == NULL) {
851                         return -1;
852                 }
853
854                 vector[0] = req->in.vector[idx];
855
856                 *_vector = vector;
857                 *_count = 1;
858                 return 0;
859         }
860
861         if (state->missing == 0) {
862                 /* if there're no remaining bytes, we're done */
863                 *_vector = NULL;
864                 *_count = 0;
865                 return 0;
866         }
867
868         if (state->asked_for_header) {
869                 const uint8_t *hdr;
870                 size_t full_size;
871                 size_t next_command_ofs;
872                 size_t body_size;
873                 uint8_t *body;
874                 size_t dyn_size;
875                 uint8_t *dyn;
876                 bool invalid = false;
877
878                 state->asked_for_header = false;
879
880                 /*
881                  * We got the SMB2 header and the first 2 bytes
882                  * of the body. We fix the size to just the header
883                  * and manually copy the 2 first bytes to the body section
884                  */
885                 req->in.vector[idx-1].iov_len = SMB2_HDR_BODY;
886                 hdr = (const uint8_t *)req->in.vector[idx-1].iov_base;
887
888                 /* allocate vectors for body and dynamic areas */
889                 req->in.vector = talloc_realloc(req, req->in.vector,
890                                                 struct iovec,
891                                                 req->in.vector_count + 2);
892                 if (req->in.vector == NULL) {
893                         return -1;
894                 }
895                 req->in.vector_count += 2;
896
897                 full_size = state->missing + SMB2_HDR_BODY + 2;
898                 next_command_ofs = IVAL(hdr, SMB2_HDR_NEXT_COMMAND);
899                 body_size = SVAL(hdr, SMB2_HDR_BODY);
900
901                 if (next_command_ofs != 0) {
902                         if (next_command_ofs < (SMB2_HDR_BODY + 2)) {
903                                 /*
904                                  * this is invalid, just return a zero
905                                  * body and let the caller deal with the error
906                                  */
907                                 invalid = true;
908                         } else if (next_command_ofs > full_size) {
909                                 /*
910                                  * this is invalid, just return a zero
911                                  * body and let the caller deal with the error
912                                  */
913                                 invalid = true;
914                         } else {
915                                 full_size = next_command_ofs;
916                         }
917                 }
918
919                 if (!invalid) {
920                         if (body_size < 2) {
921                                 /*
922                                  * this is invalid, just return a zero
923                                  * body and let the caller deal with the error
924                                  */
925                                 invalid = true;
926                         } else if (body_size > (full_size - SMB2_HDR_BODY)) {
927                                 /*
928                                  * this is invalid, just return a zero
929                                  * body and let the caller deal with the error
930                                  */
931                                 invalid = true;
932                         }
933                 }
934
935                 if (invalid) {
936                         /* the caller should check this */
937                         body_size = 0;
938                 }
939
940                 if ((body_size % 2) != 0) {
941                         body_size -= 1;
942                 }
943
944                 dyn_size = full_size - (SMB2_HDR_BODY + body_size);
945
946                 state->missing -= (body_size - 2) + dyn_size;
947
948                 body = talloc_array(req->in.vector, uint8_t, body_size);
949                 if (body == NULL) {
950                         return -1;
951                 }
952
953                 dyn = talloc_array(req->in.vector, uint8_t, dyn_size);
954                 if (dyn == NULL) {
955                         return -1;
956                 }
957
958                 req->in.vector[idx].iov_base    = (void *)body;
959                 req->in.vector[idx].iov_len     = body_size;
960                 req->in.vector[idx+1].iov_base  = (void *)dyn;
961                 req->in.vector[idx+1].iov_len   = dyn_size;
962
963                 vector = talloc_array(mem_ctx, struct iovec, 2);
964                 if (vector == NULL) {
965                         return -1;
966                 }
967
968                 /*
969                  * the first 2 bytes of the body were already fetched
970                  * together with the header
971                  */
972                 memcpy(body, hdr + SMB2_HDR_BODY, 2);
973                 vector[0].iov_base = body + 2;
974                 vector[0].iov_len = req->in.vector[idx].iov_len - 2;
975
976                 vector[1] = req->in.vector[idx+1];
977
978                 *_vector = vector;
979                 *_count = 2;
980                 return 0;
981         }
982
983         /*
984          * when we endup here, we're looking for a new SMB2 request
985          * next. And we ask for its header and the first 2 bytes of
986          * the body (like we did for the first SMB2 request).
987          */
988
989         req->in.vector = talloc_realloc(req, req->in.vector,
990                                         struct iovec,
991                                         req->in.vector_count + 1);
992         if (req->in.vector == NULL) {
993                 return -1;
994         }
995         req->in.vector_count += 1;
996
997         /*
998          * We assume it's a SMB2 request,
999          * and we first get the header and the
1000          * first 2 bytes (the struct size) of the body
1001          */
1002         len = SMB2_HDR_BODY + 2;
1003
1004         if (len > state->missing) {
1005                 /* let the caller handle the error */
1006                 len = state->missing;
1007         }
1008
1009         state->missing -= len;
1010         state->asked_for_header = true;
1011
1012         buf = talloc_array(req->in.vector, uint8_t, len);
1013         if (buf == NULL) {
1014                 return -1;
1015         }
1016
1017         req->in.vector[idx].iov_base    = (void *)buf;
1018         req->in.vector[idx].iov_len     = len;
1019
1020         vector = talloc_array(mem_ctx, struct iovec, 1);
1021         if (vector == NULL) {
1022                 return -1;
1023         }
1024
1025         vector[0] = req->in.vector[idx];
1026
1027         *_vector = vector;
1028         *_count = 1;
1029         return 0;
1030 }
1031
1032 static void smbd_smb2_request_read_done(struct tevent_req *subreq)
1033 {
1034         struct tevent_req *req =
1035                 tevent_req_callback_data(subreq,
1036                 struct tevent_req);
1037         int ret;
1038         int sys_errno;
1039         NTSTATUS status;
1040
1041         ret = tstream_readv_pdu_queue_recv(subreq, &sys_errno);
1042         if (ret == -1) {
1043                 status = map_nt_error_from_unix(sys_errno);
1044                 tevent_req_nterror(req, status);
1045                 return;
1046         }
1047
1048         tevent_req_done(req);
1049 }
1050
1051 static NTSTATUS smbd_smb2_request_read_recv(struct tevent_req *req,
1052                                             TALLOC_CTX *mem_ctx,
1053                                             struct smbd_smb2_request **_smb2_req)
1054 {
1055         struct smbd_smb2_request_read_state *state =
1056                 tevent_req_data(req,
1057                 struct smbd_smb2_request_read_state);
1058         NTSTATUS status;
1059
1060         if (tevent_req_is_nterror(req, &status)) {
1061                 tevent_req_received(req);
1062                 return status;
1063         }
1064
1065         talloc_steal(mem_ctx, state->smb2_req->mem_pool);
1066         *_smb2_req = state->smb2_req;
1067         tevent_req_received(req);
1068         return NT_STATUS_OK;
1069 }
1070
1071 static void smbd_smb2_request_incoming(struct tevent_req *subreq);
1072
1073 void smbd_smb2_first_negprot(struct smbd_server_connection *conn,
1074                              const uint8_t *inbuf, size_t size)
1075 {
1076         NTSTATUS status;
1077         struct smbd_smb2_request *req;
1078         struct tevent_req *subreq;
1079
1080         DEBUG(10,("smbd_smb2_first_negprot: packet length %u\n",
1081                  (unsigned int)size));
1082
1083         status = smbd_initialize_smb2(conn);
1084         if (!NT_STATUS_IS_OK(status)) {
1085                 smbd_server_connection_terminate(conn, nt_errstr(status));
1086                 return;
1087         }
1088
1089         status = smbd_smb2_request_create(conn, inbuf, size, &req);
1090         if (!NT_STATUS_IS_OK(status)) {
1091                 smbd_server_connection_terminate(conn, nt_errstr(status));
1092                 return;
1093         }
1094
1095         status = smbd_smb2_request_setup_out(req);
1096         if (!NT_STATUS_IS_OK(status)) {
1097                 smbd_server_connection_terminate(conn, nt_errstr(status));
1098                 return;
1099         }
1100
1101         status = smbd_smb2_request_dispatch(req);
1102         if (!NT_STATUS_IS_OK(status)) {
1103                 smbd_server_connection_terminate(conn, nt_errstr(status));
1104                 return;
1105         }
1106
1107         /* ask for the next request */
1108         subreq = smbd_smb2_request_read_send(conn,conn->smb2.event_ctx, conn);
1109         if (subreq == NULL) {
1110                 smbd_server_connection_terminate(conn, "no memory for reading");
1111                 return;
1112         }
1113         tevent_req_set_callback(subreq, smbd_smb2_request_incoming, conn);
1114 }
1115
1116 static void smbd_smb2_request_incoming(struct tevent_req *subreq)
1117 {
1118         struct smbd_server_connection *conn = tevent_req_callback_data(subreq,
1119                                               struct smbd_server_connection);
1120         NTSTATUS status;
1121         struct smbd_smb2_request *req;
1122
1123         status = smbd_smb2_request_read_recv(subreq, conn, &req);
1124         TALLOC_FREE(subreq);
1125         if (!NT_STATUS_IS_OK(status)) {
1126                 smbd_server_connection_terminate(conn, nt_errstr(status));
1127                 return;
1128         }
1129
1130         /* TODO: validate the incoming request */
1131         req->current_idx = 1;
1132
1133         DEBUG(10,("smbd_smb2_request_incoming: idx[%d] of %d vectors\n",
1134                  req->current_idx, req->in.vector_count));
1135
1136         status = smbd_smb2_request_setup_out(req);
1137         if (!NT_STATUS_IS_OK(status)) {
1138                 smbd_server_connection_terminate(conn, nt_errstr(status));
1139                 return;
1140         }
1141
1142         status = smbd_smb2_request_dispatch(req);
1143         if (!NT_STATUS_IS_OK(status)) {
1144                 smbd_server_connection_terminate(conn, nt_errstr(status));
1145                 return;
1146         }
1147
1148         /* ask for the next request (this constructs the main loop) */
1149         subreq = smbd_smb2_request_read_send(conn,conn->smb2.event_ctx, conn);
1150         if (subreq == NULL) {
1151                 smbd_server_connection_terminate(conn, "no memory for reading");
1152                 return;
1153         }
1154         tevent_req_set_callback(subreq, smbd_smb2_request_incoming, conn);
1155 }