mirror of
https://github.com/m5stack/libsmb2.git
synced 2026-05-20 11:41:57 -07:00
308 lines
9.8 KiB
C
308 lines
9.8 KiB
C
/* -*- mode:c; tab-width:8; c-basic-offset:8; indent-tabs-mode:nil; -*- */
|
|
/*
|
|
Copyright (C) 2016 by Ronnie Sahlberg <ronniesahlberg@gmail.com>
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU Lesser General Public License as published by
|
|
the Free Software Foundation; either version 2.1 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU Lesser General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Lesser General Public License
|
|
along with this program; if not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#ifndef _GNU_SOURCE
|
|
#define _GNU_SOURCE
|
|
#endif
|
|
|
|
#ifdef HAVE_STDINT_H
|
|
#include <stdint.h>
|
|
#endif
|
|
|
|
#ifdef HAVE_STDLIB_H
|
|
#include <stdlib.h>
|
|
#endif
|
|
|
|
#ifdef HAVE_STRING_H
|
|
#include <string.h>
|
|
#endif
|
|
|
|
#ifdef STDC_HEADERS
|
|
#include <stddef.h>
|
|
#endif
|
|
|
|
#ifdef HAVE_TIME_H
|
|
#include <time.h>
|
|
#endif
|
|
|
|
#ifdef HAVE_SYS_TIME_H
|
|
#include <sys/time.h>
|
|
#endif
|
|
|
|
#include <errno.h>
|
|
|
|
#include "compat.h"
|
|
|
|
#include "smb2.h"
|
|
#include "libsmb2.h"
|
|
#include "libsmb2-private.h"
|
|
|
|
static int
|
|
smb2_encode_write_request(struct smb2_context *smb2,
|
|
struct smb2_pdu *pdu,
|
|
struct smb2_write_request *req)
|
|
{
|
|
int len;
|
|
uint8_t *buf;
|
|
struct smb2_iovec *iov;
|
|
|
|
len = SMB2_WRITE_REQUEST_SIZE & 0xfffffffe;
|
|
buf = calloc(len, sizeof(uint8_t));
|
|
if (buf == NULL) {
|
|
smb2_set_error(smb2, "Failed to allocate write buffer");
|
|
return -1;
|
|
}
|
|
|
|
iov = smb2_add_iovector(smb2, &pdu->out, buf, len, free);
|
|
|
|
if (!smb2->supports_multi_credit && req->length > 64 * 1024) {
|
|
req->length = 64 * 1024;
|
|
}
|
|
smb2_set_uint16(iov, 0, SMB2_WRITE_REQUEST_SIZE);
|
|
smb2_set_uint16(iov, 2, SMB2_HEADER_SIZE + 48);
|
|
smb2_set_uint32(iov, 4, req->length);
|
|
smb2_set_uint64(iov, 8, req->offset);
|
|
memcpy(iov->buf + 16, req->file_id, SMB2_FD_SIZE);
|
|
smb2_set_uint32(iov, 32, req->channel);
|
|
smb2_set_uint32(iov, 36, req->remaining_bytes);
|
|
smb2_set_uint16(iov, 42, req->write_channel_info_length);
|
|
smb2_set_uint32(iov, 44, req->flags);
|
|
|
|
if (req->write_channel_info_length > 0 &&
|
|
req->write_channel_info != NULL) {
|
|
if (smb2->passthrough) {
|
|
req->write_channel_info_offset =
|
|
(SMB2_READ_REQUEST_SIZE & 0xfffffffe) + SMB2_HEADER_SIZE;
|
|
smb2_set_uint16(iov, 40, req->write_channel_info_offset);
|
|
|
|
len = PAD_TO_64BIT(req->write_channel_info_length);
|
|
buf = malloc(len);
|
|
if (buf == NULL) {
|
|
smb2_set_error(smb2, "Failed to allocate write channel context");
|
|
return -1;
|
|
}
|
|
memcpy(buf, req->write_channel_info, req->write_channel_info_length);
|
|
memset(buf + req->write_channel_info_length, 0,
|
|
len - req->write_channel_info_length);
|
|
iov = smb2_add_iovector(smb2, &pdu->out,
|
|
buf,
|
|
len,
|
|
free);
|
|
}
|
|
else {
|
|
smb2_set_error(smb2, "ChannelInfo not yet implemented");
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct smb2_pdu *
|
|
smb2_cmd_write_async(struct smb2_context *smb2,
|
|
struct smb2_write_request *req,
|
|
int pass_buf_ownership,
|
|
smb2_command_cb cb, void *cb_data)
|
|
{
|
|
struct smb2_pdu *pdu;
|
|
|
|
pdu = smb2_allocate_pdu(smb2, SMB2_WRITE, cb, cb_data);
|
|
if (pdu == NULL) {
|
|
return NULL;
|
|
}
|
|
|
|
if (smb2_encode_write_request(smb2, pdu, req)) {
|
|
smb2_free_pdu(smb2, pdu);
|
|
return NULL;
|
|
}
|
|
|
|
if (smb2_pad_to_64bit(smb2, &pdu->out) != 0) {
|
|
smb2_free_pdu(smb2, pdu);
|
|
return NULL;
|
|
}
|
|
|
|
smb2_add_iovector(smb2, &pdu->out, (uint8_t*)req->buf,
|
|
req->length, pass_buf_ownership ? free : NULL);
|
|
|
|
/* Adjust credit charge for large payloads */
|
|
if (smb2->supports_multi_credit) {
|
|
pdu->header.credit_charge = (req->length - 1) / 65536 + 1; /* 3.1.5.2 of [MS-SMB2] */
|
|
}
|
|
|
|
return pdu;
|
|
}
|
|
|
|
static int
|
|
smb2_encode_write_reply(struct smb2_context *smb2,
|
|
struct smb2_pdu *pdu,
|
|
struct smb2_write_reply *rep)
|
|
{
|
|
int len;
|
|
uint8_t *buf;
|
|
struct smb2_iovec *iov;
|
|
|
|
len = SMB2_WRITE_REPLY_SIZE;
|
|
buf = calloc(len, sizeof(uint8_t));
|
|
if (buf == NULL) {
|
|
smb2_set_error(smb2, "Failed to allocate write reply buffer");
|
|
return -1;
|
|
}
|
|
|
|
iov = smb2_add_iovector(smb2, &pdu->out, buf, len, free);
|
|
|
|
smb2_set_uint16(iov, 0, SMB2_WRITE_REPLY_SIZE);
|
|
smb2_set_uint32(iov, 4, rep->count);
|
|
smb2_set_uint32(iov, 8, rep->remaining);
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct smb2_pdu *
|
|
smb2_cmd_write_reply_async(struct smb2_context *smb2,
|
|
struct smb2_write_reply *rep,
|
|
smb2_command_cb cb, void *cb_data)
|
|
{
|
|
struct smb2_pdu *pdu;
|
|
|
|
pdu = smb2_allocate_pdu(smb2, SMB2_WRITE, cb, cb_data);
|
|
if (pdu == NULL) {
|
|
return NULL;
|
|
}
|
|
|
|
if (smb2_encode_write_reply(smb2, pdu, rep)) {
|
|
smb2_free_pdu(smb2, pdu);
|
|
return NULL;
|
|
}
|
|
|
|
if (smb2_pad_to_64bit(smb2, &pdu->out) != 0) {
|
|
smb2_free_pdu(smb2, pdu);
|
|
return NULL;
|
|
}
|
|
|
|
return pdu;
|
|
}
|
|
|
|
int
|
|
smb2_process_write_fixed(struct smb2_context *smb2,
|
|
struct smb2_pdu *pdu)
|
|
{
|
|
struct smb2_write_reply *rep;
|
|
struct smb2_iovec *iov = &smb2->in.iov[smb2->in.niov - 1];
|
|
uint16_t struct_size;
|
|
|
|
smb2_get_uint16(iov, 0, &struct_size);
|
|
if (struct_size != SMB2_WRITE_REPLY_SIZE ||
|
|
(struct_size & 0xfffe) != iov->len) {
|
|
smb2_set_error(smb2, "Unexpected size of Write "
|
|
"reply. Expected %d, got %d",
|
|
SMB2_WRITE_REPLY_SIZE,
|
|
(int)iov->len);
|
|
return -1;
|
|
}
|
|
|
|
rep = malloc(sizeof(*rep));
|
|
if (rep == NULL) {
|
|
smb2_set_error(smb2, "Failed to allocate write reply");
|
|
return -1;
|
|
}
|
|
pdu->payload = rep;
|
|
|
|
smb2_get_uint32(iov, 4, &rep->count);
|
|
smb2_get_uint32(iov, 8, &rep->remaining);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#define IOVREQ_OFFSET (req->write_channel_info_length ? (req->write_channel_info_offset - SMB2_HEADER_SIZE - \
|
|
(SMB2_WRITE_REQUEST_SIZE & 0xfffe)):0)
|
|
|
|
int
|
|
smb2_process_write_request_fixed(struct smb2_context *smb2,
|
|
struct smb2_pdu *pdu)
|
|
{
|
|
struct smb2_write_request *req;
|
|
struct smb2_iovec *iov = &smb2->in.iov[smb2->in.niov - 1];
|
|
uint16_t struct_size;
|
|
|
|
smb2_get_uint16(iov, 0, &struct_size);
|
|
if (struct_size > SMB2_WRITE_REQUEST_SIZE) {
|
|
smb2_set_error(smb2, "Unexpected size of Write "
|
|
"request. Expected %d, got %d",
|
|
SMB2_WRITE_REQUEST_SIZE,
|
|
(int)iov->len);
|
|
return -1;
|
|
}
|
|
|
|
req = malloc(sizeof(*req));
|
|
if (req == NULL) {
|
|
smb2_set_error(smb2, "Failed to allocate write request");
|
|
return -1;
|
|
}
|
|
pdu->payload = req;
|
|
|
|
smb2_get_uint16(iov, 2, &req->data_offset);
|
|
smb2_get_uint32(iov, 4, &req->length);
|
|
smb2_get_uint64(iov, 8, &req->offset);
|
|
memcpy(req->file_id, iov->buf + 16, SMB2_FD_SIZE);
|
|
smb2_get_uint32(iov, 32, &req->channel);
|
|
smb2_get_uint32(iov, 36, &req->remaining_bytes);
|
|
smb2_get_uint16(iov, 40, &req->write_channel_info_offset);
|
|
smb2_get_uint16(iov, 42, &req->write_channel_info_length);
|
|
smb2_get_uint32(iov, 44, &req->flags);
|
|
req->buf = NULL;
|
|
|
|
if (req->write_channel_info_length) {
|
|
if (req->write_channel_info_offset < (SMB2_HEADER_SIZE + (SMB2_WRITE_REQUEST_SIZE & 0xfffe))) {
|
|
smb2_set_error(smb2, "channel info overlaps request");
|
|
pdu->payload = NULL;
|
|
free(req);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
if (req->length) {
|
|
return IOVREQ_OFFSET + PAD_TO_64BIT(req->write_channel_info_length) + req->length;
|
|
}
|
|
else if (req->write_channel_info_length) {
|
|
return IOVREQ_OFFSET + req->write_channel_info_length;
|
|
}
|
|
else {
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
int
|
|
smb2_process_write_request_variable(struct smb2_context *smb2,
|
|
struct smb2_pdu *pdu)
|
|
{
|
|
struct smb2_write_request *req = (struct smb2_write_request*)pdu->payload;
|
|
struct smb2_iovec *iov = &smb2->in.iov[smb2->in.niov - 1];
|
|
struct smb2_iovec vec = { &iov->buf[IOVREQ_OFFSET],
|
|
iov->len,
|
|
NULL };
|
|
|
|
req->write_channel_info = (uint8_t *)vec.buf;
|
|
/* 0-copy but app must know this buffer is gone when pdu is freed */
|
|
req->buf = &vec.buf[PAD_TO_64BIT(req->write_channel_info_length)];
|
|
return 0;
|
|
}
|
|
|