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 NTSTATUS smbd_smb2_request_error_ex(struct smbd_smb2_request *req,
 587                                     NTSTATUS status,
 588                                     DATA_BLOB *info,
 589                                     const char *location)
 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] |%s| at %s\n",
 596                   i, nt_errstr(status), info ? " +info" : "",
 597                   location));
 598
 599         outhdr = (uint8_t *)req->out.vector[i].iov_base;
 600
 601         SIVAL(outhdr, SMB2_HDR_STATUS, NT_STATUS_V(status));
 602
 603         outbody = outhdr + SMB2_HDR_BODY;
 604
 605         req->out.vector[i+1].iov_base = (void *)outbody;
 606         req->out.vector[i+1].iov_len = 8;
 607
 608         if (info) {
 609                 SIVAL(outbody, 0x04, info->length);
 610                 req->out.vector[i+2].iov_base   = (void *)info->data;
 611                 req->out.vector[i+2].iov_len    = info->length;
 612         } else {
 613                 req->out.vector[i+2].iov_base = (void *)(outbody + 8);
 614                 req->out.vector[i+2].iov_len = 1;
 615         }
 616
 617         /* the error packet is the last response in the chain */
 618         SIVAL(outhdr, SMB2_HDR_NEXT_COMMAND, 0);
 619         req->out.vector_count = req->current_idx + 3;
 620
 621         return smbd_smb2_request_reply(req);
 622 }
 623
 624 NTSTATUS smbd_smb2_request_done_ex(struct smbd_smb2_request *req,
 625                                    NTSTATUS status,
 626                                    DATA_BLOB body, DATA_BLOB *dyn,
 627                                    const char *location)
 628 {
 629         uint8_t *outhdr;
 630         uint8_t *outdyn;
 631         int i = req->current_idx;
 632         uint32_t next_command_ofs;
 633
 634         DEBUG(10,("smbd_smb2_request_done_ex: "
 635                   "idx[%d] status[%s] body[%u] dyn[%s:%u] at %s\n",
 636                   i, nt_errstr(status), (unsigned int)body.length,
 637                   dyn ? "yes": "no",
 638                   (unsigned int)(dyn ? dyn->length : 0),
 639                   location));
 640
 641         if (body.length < 2) {
 642                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
 643         }
 644
 645         if ((body.length % 2) != 0) {
 646                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
 647         }
 648
 649         outhdr = (uint8_t *)req->out.vector[i].iov_base;
 650         /* the fallback dynamic buffer */
 651         outdyn = outhdr + SMB2_HDR_BODY + 8;
 652
 653         next_command_ofs = IVAL(outhdr, SMB2_HDR_NEXT_COMMAND);
 654         SIVAL(outhdr, SMB2_HDR_STATUS, NT_STATUS_V(status));
 655
 656         req->out.vector[i+1].iov_base = (void *)body.data;
 657         req->out.vector[i+1].iov_len = body.length;
 658
 659         if (dyn) {
 660                 if (dyn->length > 0) {
 661                         req->out.vector[i+2].iov_base   = (void *)dyn->data;
 662                         req->out.vector[i+2].iov_len    = dyn->length;
 663                 } else {
 664                         req->out.vector[i+2].iov_base   = (void *)outdyn;
 665                         req->out.vector[i+2].iov_len    = 1;
 666                 }
 667         } else {
 668                 req->out.vector[i+2].iov_base = NULL;
 669                 req->out.vector[i+2].iov_len = 0;
 670         }
 671
 672         /* see if we need to recalculate the offset to the next response */
 673         if (next_command_ofs > 0) {
 674                 next_command_ofs  = SMB2_HDR_BODY;
 675                 next_command_ofs += req->out.vector[i+1].iov_len;
 676                 next_command_ofs += req->out.vector[i+2].iov_len;
 677         }
 678
 679         /* TODO: we need to add padding ... */
 680         if ((next_command_ofs % 8) != 0) {
 681                 return smbd_smb2_request_error(req, NT_STATUS_INTERNAL_ERROR);
 682         }
 683
 684         /* the error packet is the last response in the chain */
 685         SIVAL(outhdr, SMB2_HDR_NEXT_COMMAND, next_command_ofs);
 686
 687         return smbd_smb2_request_reply(req);
 688 }
 689
 690 struct smbd_smb2_request_read_state {
 691         size_t missing;
 692         bool asked_for_header;
 693         struct smbd_smb2_request *smb2_req;
 694 };
 695
 696 static int smbd_smb2_request_next_vector(struct tstream_context *stream,
 697                                          void *private_data,
 698                                          TALLOC_CTX *mem_ctx,
 699                                          struct iovec **_vector,
 700                                          size_t *_count);
 701 static void smbd_smb2_request_read_done(struct tevent_req *subreq);
 702
 703 static struct tevent_req *smbd_smb2_request_read_send(TALLOC_CTX *mem_ctx,
 704                                         struct tevent_context *ev,
 705                                         struct smbd_server_connection *conn)
 706 {
 707         struct tevent_req *req;
 708         struct smbd_smb2_request_read_state *state;
 709         struct tevent_req *subreq;
 710         TALLOC_CTX *mem_pool;
 711
 712         req = tevent_req_create(mem_ctx, &state,
 713                                 struct smbd_smb2_request_read_state);
 714         if (req == NULL) {
 715                 return NULL;
 716         }
 717         state->missing = 0;
 718         state->asked_for_header = false;
 719
 720         mem_pool = talloc_pool(state, 8192);
 721         if (tevent_req_nomem(mem_pool, req)) {
 722                 return tevent_req_post(req, ev);
 723         }
 724
 725         state->smb2_req = talloc_zero(mem_pool, struct smbd_smb2_request);
 726         if (tevent_req_nomem(state->smb2_req, req)) {
 727                 return tevent_req_post(req, ev);
 728         }
 729
 730         state->smb2_req->mem_pool       = mem_pool;
 731         state->smb2_req->conn           = conn;
 732
 733         subreq = tstream_readv_pdu_queue_send(state, ev, conn->smb2.stream,
 734                                               conn->smb2.recv_queue,
 735                                               smbd_smb2_request_next_vector,
 736                                               state);
 737         if (tevent_req_nomem(subreq, req)) {
 738                 return tevent_req_post(req, ev);
 739         }
 740         tevent_req_set_callback(subreq, smbd_smb2_request_read_done, req);
 741
 742         return req;
 743 }
 744
 745 static int smbd_smb2_request_next_vector(struct tstream_context *stream,
 746                                          void *private_data,
 747                                          TALLOC_CTX *mem_ctx,
 748                                          struct iovec **_vector,
 749                                          size_t *_count)
 750 {
 751         struct smbd_smb2_request_read_state *state =
 752                 talloc_get_type_abort(private_data,
 753                 struct smbd_smb2_request_read_state);
 754         struct smbd_smb2_request *req = state->smb2_req;
 755         struct iovec *vector;
 756         int idx = req->in.vector_count;
 757         size_t len = 0;
 758         uint8_t *buf = NULL;
 759
 760         if (req->in.vector_count == 0) {
 761                 /*
 762                  * first we need to get the NBT header
 763                  */
 764                 req->in.vector = talloc_array(req, struct iovec,
 765                                               req->in.vector_count + 1);
 766                 if (req->in.vector == NULL) {
 767                         return -1;
 768                 }
 769                 req->in.vector_count += 1;
 770
 771                 req->in.vector[idx].iov_base    = (void *)req->in.nbt_hdr;
 772                 req->in.vector[idx].iov_len     = 4;
 773
 774                 vector = talloc_array(mem_ctx, struct iovec, 1);
 775                 if (vector == NULL) {
 776                         return -1;
 777                 }
 778
 779                 vector[0] = req->in.vector[idx];
 780
 781                 *_vector = vector;
 782                 *_count = 1;
 783                 return 0;
 784         }
 785
 786         if (req->in.vector_count == 1) {
 787                 /*
 788                  * Now we analyze the NBT header
 789                  */
 790                 state->missing = smb2_len(req->in.vector[0].iov_base);
 791
 792                 if (state->missing == 0) {
 793                         /* if there're no remaining bytes, we're done */
 794                         *_vector = NULL;
 795                         *_count = 0;
 796                         return 0;
 797                 }
 798
 799                 req->in.vector = talloc_realloc(req, req->in.vector,
 800                                                 struct iovec,
 801                                                 req->in.vector_count + 1);
 802                 if (req->in.vector == NULL) {
 803                         return -1;
 804                 }
 805                 req->in.vector_count += 1;
 806
 807                 if (CVAL(req->in.vector[0].iov_base, 0) != 0) {
 808                         /*
 809                          * it's a special NBT message,
 810                          * so get all remaining bytes
 811                          */
 812                         len = state->missing;
 813                 } else if (state->missing < (SMB2_HDR_BODY + 2)) {
 814                         /*
 815                          * it's an invalid message, just read what we can get
 816                          * and let the caller handle the error
 817                          */
 818                         len = state->missing;
 819                 } else {
 820                         /*
 821                          * We assume it's a SMB2 request,
 822                          * and we first get the header and the
 823                          * first 2 bytes (the struct size) of the body
 824                          */
 825                         len = SMB2_HDR_BODY + 2;
 826
 827                         state->asked_for_header = true;
 828                 }
 829
 830                 state->missing -= len;
 831
 832                 buf = talloc_array(req->in.vector, uint8_t, len);
 833                 if (buf == NULL) {
 834                         return -1;
 835                 }
 836
 837                 req->in.vector[idx].iov_base    = (void *)buf;
 838                 req->in.vector[idx].iov_len     = len;
 839
 840                 vector = talloc_array(mem_ctx, struct iovec, 1);
 841                 if (vector == NULL) {
 842                         return -1;
 843                 }
 844
 845                 vector[0] = req->in.vector[idx];
 846
 847                 *_vector = vector;
 848                 *_count = 1;
 849                 return 0;
 850         }
 851
 852         if (state->missing == 0) {
 853                 /* if there're no remaining bytes, we're done */
 854                 *_vector = NULL;
 855                 *_count = 0;
 856                 return 0;
 857         }
 858
 859         if (state->asked_for_header) {
 860                 const uint8_t *hdr;
 861                 size_t full_size;
 862                 size_t next_command_ofs;
 863                 size_t body_size;
 864                 uint8_t *body;
 865                 size_t dyn_size;
 866                 uint8_t *dyn;
 867                 bool invalid = false;
 868
 869                 state->asked_for_header = false;
 870
 871                 /*
 872                  * We got the SMB2 header and the first 2 bytes
 873                  * of the body. We fix the size to just the header
 874                  * and manually copy the 2 first bytes to the body section
 875                  */
 876                 req->in.vector[idx-1].iov_len = SMB2_HDR_BODY;
 877                 hdr = (const uint8_t *)req->in.vector[idx-1].iov_base;
 878
 879                 /* allocate vectors for body and dynamic areas */
 880                 req->in.vector = talloc_realloc(req, req->in.vector,
 881                                                 struct iovec,
 882                                                 req->in.vector_count + 2);
 883                 if (req->in.vector == NULL) {
 884                         return -1;
 885                 }
 886                 req->in.vector_count += 2;
 887
 888                 full_size = state->missing + SMB2_HDR_BODY + 2;
 889                 next_command_ofs = IVAL(hdr, SMB2_HDR_NEXT_COMMAND);
 890                 body_size = SVAL(hdr, SMB2_HDR_BODY);
 891
 892                 if (next_command_ofs != 0) {
 893                         if (next_command_ofs < (SMB2_HDR_BODY + 2)) {
 894                                 /*
 895                                  * this is invalid, just return a zero
 896                                  * body and let the caller deal with the error
 897                                  */
 898                                 invalid = true;
 899                         } else if (next_command_ofs > full_size) {
 900                                 /*
 901                                  * this is invalid, just return a zero
 902                                  * body and let the caller deal with the error
 903                                  */
 904                                 invalid = true;
 905                         } else {
 906                                 full_size = next_command_ofs;
 907                         }
 908                 }
 909
 910                 if (!invalid) {
 911                         if (body_size < 2) {
 912                                 /*
 913                                  * this is invalid, just return a zero
 914                                  * body and let the caller deal with the error
 915                                  */
 916                                 invalid = true;
 917                         } else if (body_size > (full_size - SMB2_HDR_BODY)) {
 918                                 /*
 919                                  * this is invalid, just return a zero
 920                                  * body and let the caller deal with the error
 921                                  */
 922                                 invalid = true;
 923                         }
 924                 }
 925
 926                 if (invalid) {
 927                         /* the caller should check this */
 928                         body_size = 0;
 929                 }
 930
 931                 if ((body_size % 2) != 0) {
 932                         body_size -= 1;
 933                 }
 934
 935                 dyn_size = full_size - (SMB2_HDR_BODY + body_size);
 936
 937                 state->missing -= (body_size - 2) + dyn_size;
 938
 939                 body = talloc_array(req->in.vector, uint8_t, body_size);
 940                 if (body == NULL) {
 941                         return -1;
 942                 }
 943
 944                 dyn = talloc_array(req->in.vector, uint8_t, dyn_size);
 945                 if (dyn == NULL) {
 946                         return -1;
 947                 }
 948
 949                 req->in.vector[idx].iov_base    = (void *)body;
 950                 req->in.vector[idx].iov_len     = body_size;
 951                 req->in.vector[idx+1].iov_base  = (void *)dyn;
 952                 req->in.vector[idx+1].iov_len   = dyn_size;
 953
 954                 vector = talloc_array(mem_ctx, struct iovec, 2);
 955                 if (vector == NULL) {
 956                         return -1;
 957                 }
 958
 959                 /*
 960                  * the first 2 bytes of the body were already fetched
 961                  * together with the header
 962                  */
 963                 memcpy(body, hdr + SMB2_HDR_BODY, 2);
 964                 vector[0].iov_base = body + 2;
 965                 vector[0].iov_len = req->in.vector[idx].iov_len - 2;
 966
 967                 vector[1] = req->in.vector[idx+1];
 968
 969                 *_vector = vector;
 970                 *_count = 2;
 971                 return 0;
 972         }
 973
 974         /*
 975          * when we endup here, we're looking for a new SMB2 request
 976          * next. And we ask for its header and the first 2 bytes of
 977          * the body (like we did for the first SMB2 request).
 978          */
 979
 980         req->in.vector = talloc_realloc(req, req->in.vector,
 981                                         struct iovec,
 982                                         req->in.vector_count + 1);
 983         if (req->in.vector == NULL) {
 984                 return -1;
 985         }
 986         req->in.vector_count += 1;
 987
 988         /*
 989          * We assume it's a SMB2 request,
 990          * and we first get the header and the
 991          * first 2 bytes (the struct size) of the body
 992          */
 993         len = SMB2_HDR_BODY + 2;
 994
 995         if (len > state->missing) {
 996                 /* let the caller handle the error */
 997                 len = state->missing;
 998         }
 999
1000         state->missing -= len;
1001         state->asked_for_header = true;
1002
1003         buf = talloc_array(req->in.vector, uint8_t, len);
1004         if (buf == NULL) {
1005                 return -1;
1006         }
1007
1008         req->in.vector[idx].iov_base    = (void *)buf;
1009         req->in.vector[idx].iov_len     = len;
1010
1011         vector = talloc_array(mem_ctx, struct iovec, 1);
1012         if (vector == NULL) {
1013                 return -1;
1014         }
1015
1016         vector[0] = req->in.vector[idx];
1017
1018         *_vector = vector;
1019         *_count = 1;
1020         return 0;
1021 }
1022
1023 static void smbd_smb2_request_read_done(struct tevent_req *subreq)
1024 {
1025         struct tevent_req *req =
1026                 tevent_req_callback_data(subreq,
1027                 struct tevent_req);
1028         int ret;
1029         int sys_errno;
1030         NTSTATUS status;
1031
1032         ret = tstream_readv_pdu_queue_recv(subreq, &sys_errno);
1033         if (ret == -1) {
1034                 status = map_nt_error_from_unix(sys_errno);
1035                 tevent_req_nterror(req, status);
1036                 return;
1037         }
1038
1039         tevent_req_done(req);
1040 }
1041
1042 static NTSTATUS smbd_smb2_request_read_recv(struct tevent_req *req,
1043                                             TALLOC_CTX *mem_ctx,
1044                                             struct smbd_smb2_request **_smb2_req)
1045 {
1046         struct smbd_smb2_request_read_state *state =
1047                 tevent_req_data(req,
1048                 struct smbd_smb2_request_read_state);
1049         NTSTATUS status;
1050
1051         if (tevent_req_is_nterror(req, &status)) {
1052                 tevent_req_received(req);
1053                 return status;
1054         }
1055
1056         talloc_steal(mem_ctx, state->smb2_req->mem_pool);
1057         *_smb2_req = state->smb2_req;
1058         tevent_req_received(req);
1059         return NT_STATUS_OK;
1060 }
1061
1062 static void smbd_smb2_request_incoming(struct tevent_req *subreq);
1063
1064 void smbd_smb2_first_negprot(struct smbd_server_connection *conn,
1065                              const uint8_t *inbuf, size_t size)
1066 {
1067         NTSTATUS status;
1068         struct smbd_smb2_request *req;
1069         struct tevent_req *subreq;
1070
1071         DEBUG(10,("smbd_smb2_first_negprot: packet length %u\n",
1072                  (unsigned int)size));
1073
1074         status = smbd_initialize_smb2(conn);
1075         if (!NT_STATUS_IS_OK(status)) {
1076                 smbd_server_connection_terminate(conn, nt_errstr(status));
1077                 return;
1078         }
1079
1080         status = smbd_smb2_request_create(conn, inbuf, size, &req);
1081         if (!NT_STATUS_IS_OK(status)) {
1082                 smbd_server_connection_terminate(conn, nt_errstr(status));
1083                 return;
1084         }
1085
1086         status = smbd_smb2_request_setup_out(req);
1087         if (!NT_STATUS_IS_OK(status)) {
1088                 smbd_server_connection_terminate(conn, nt_errstr(status));
1089                 return;
1090         }
1091
1092         status = smbd_smb2_request_dispatch(req);
1093         if (!NT_STATUS_IS_OK(status)) {
1094                 smbd_server_connection_terminate(conn, nt_errstr(status));
1095                 return;
1096         }
1097
1098         /* ask for the next request */
1099         subreq = smbd_smb2_request_read_send(conn,conn->smb2.event_ctx, conn);
1100         if (subreq == NULL) {
1101                 smbd_server_connection_terminate(conn, "no memory for reading");
1102                 return;
1103         }
1104         tevent_req_set_callback(subreq, smbd_smb2_request_incoming, conn);
1105 }
1106
1107 static void smbd_smb2_request_incoming(struct tevent_req *subreq)
1108 {
1109         struct smbd_server_connection *conn = tevent_req_callback_data(subreq,
1110                                               struct smbd_server_connection);
1111         NTSTATUS status;
1112         struct smbd_smb2_request *req;
1113
1114         status = smbd_smb2_request_read_recv(subreq, conn, &req);
1115         TALLOC_FREE(subreq);
1116         if (!NT_STATUS_IS_OK(status)) {
1117                 smbd_server_connection_terminate(conn, nt_errstr(status));
1118                 return;
1119         }
1120
1121         /* TODO: validate the incoming request */
1122         req->current_idx = 1;
1123
1124         DEBUG(10,("smbd_smb2_request_incoming: idx[%d] of %d vectors\n",
1125                  req->current_idx, req->in.vector_count));
1126
1127         status = smbd_smb2_request_setup_out(req);
1128         if (!NT_STATUS_IS_OK(status)) {
1129                 smbd_server_connection_terminate(conn, nt_errstr(status));
1130                 return;
1131         }
1132
1133         status = smbd_smb2_request_dispatch(req);
1134         if (!NT_STATUS_IS_OK(status)) {
1135                 smbd_server_connection_terminate(conn, nt_errstr(status));
1136                 return;
1137         }
1138
1139         /* ask for the next request (this constructs the main loop) */
1140         subreq = smbd_smb2_request_read_send(conn,conn->smb2.event_ctx, conn);
1141         if (subreq == NULL) {
1142                 smbd_server_connection_terminate(conn, "no memory for reading");
1143                 return;
1144         }
1145         tevent_req_set_callback(subreq, smbd_smb2_request_incoming, conn);
1146 }