1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278
|
/*
Unix SMB/CIFS implementation.
Packet handling
Copyright (C) Volker Lendecke 2007
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 3 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 General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include "includes.h"
struct packet_context {
int fd;
DATA_BLOB in, out;
};
/*
* Close the underlying fd
*/
static int packet_context_destructor(struct packet_context *ctx)
{
return close(ctx->fd);
}
/*
* Initialize a packet context. The fd is given to the packet context, meaning
* that it is automatically closed when the packet context is freed.
*/
struct packet_context *packet_init(TALLOC_CTX *mem_ctx, int fd)
{
struct packet_context *result;
if (!(result = TALLOC_ZERO_P(mem_ctx, struct packet_context))) {
return NULL;
}
result->fd = fd;
talloc_set_destructor(result, packet_context_destructor);
return result;
}
/*
* Pull data from the fd
*/
NTSTATUS packet_fd_read(struct packet_context *ctx)
{
int res, available;
size_t new_size;
uint8 *in;
res = ioctl(ctx->fd, FIONREAD, &available);
if (res == -1) {
DEBUG(10, ("ioctl(FIONREAD) failed: %s\n", strerror(errno)));
return map_nt_error_from_unix(errno);
}
SMB_ASSERT(available >= 0);
if (available == 0) {
return NT_STATUS_END_OF_FILE;
}
new_size = ctx->in.length + available;
if (new_size < ctx->in.length) {
DEBUG(0, ("integer wrap\n"));
return NT_STATUS_NO_MEMORY;
}
if (!(in = TALLOC_REALLOC_ARRAY(ctx, ctx->in.data, uint8, new_size))) {
DEBUG(10, ("talloc failed\n"));
return NT_STATUS_NO_MEMORY;
}
ctx->in.data = in;
res = recv(ctx->fd, in + ctx->in.length, available, 0);
if (res < 0) {
DEBUG(10, ("recv failed: %s\n", strerror(errno)));
return map_nt_error_from_unix(errno);
}
if (res == 0) {
return NT_STATUS_END_OF_FILE;
}
ctx->in.length += res;
return NT_STATUS_OK;
}
NTSTATUS packet_fd_read_sync(struct packet_context *ctx,
struct timeval *timeout)
{
int res;
fd_set r_fds;
if (ctx->fd < 0 || ctx->fd >= FD_SETSIZE) {
errno = EBADF;
return map_nt_error_from_unix(errno);
}
FD_ZERO(&r_fds);
FD_SET(ctx->fd, &r_fds);
res = sys_select(ctx->fd+1, &r_fds, NULL, NULL, timeout);
if (res == 0) {
DEBUG(10, ("select timed out\n"));
return NT_STATUS_IO_TIMEOUT;
}
if (res == -1) {
DEBUG(10, ("select returned %s\n", strerror(errno)));
return map_nt_error_from_unix(errno);
}
return packet_fd_read(ctx);
}
bool packet_handler(struct packet_context *ctx,
bool (*full_req)(const uint8_t *buf,
size_t available,
size_t *length,
void *priv),
NTSTATUS (*callback)(uint8_t *buf, size_t length,
void *priv),
void *priv, NTSTATUS *status)
{
size_t length;
uint8_t *buf;
if (!full_req(ctx->in.data, ctx->in.length, &length, priv)) {
return False;
}
if (length > ctx->in.length) {
*status = NT_STATUS_INTERNAL_ERROR;
return true;
}
if (length == ctx->in.length) {
buf = ctx->in.data;
ctx->in.data = NULL;
ctx->in.length = 0;
} else {
buf = (uint8_t *)TALLOC_MEMDUP(ctx, ctx->in.data, length);
if (buf == NULL) {
*status = NT_STATUS_NO_MEMORY;
return true;
}
memmove(ctx->in.data, ctx->in.data + length,
ctx->in.length - length);
ctx->in.length -= length;
}
*status = callback(buf, length, priv);
return True;
}
/*
* How many bytes of outgoing data do we have pending?
*/
size_t packet_outgoing_bytes(struct packet_context *ctx)
{
return ctx->out.length;
}
/*
* Push data to the fd
*/
NTSTATUS packet_fd_write(struct packet_context *ctx)
{
ssize_t sent;
sent = send(ctx->fd, ctx->out.data, ctx->out.length, 0);
if (sent == -1) {
DEBUG(0, ("send failed: %s\n", strerror(errno)));
return map_nt_error_from_unix(errno);
}
memmove(ctx->out.data, ctx->out.data + sent,
ctx->out.length - sent);
ctx->out.length -= sent;
return NT_STATUS_OK;
}
/*
* Sync flush all outgoing bytes
*/
NTSTATUS packet_flush(struct packet_context *ctx)
{
while (ctx->out.length != 0) {
NTSTATUS status = packet_fd_write(ctx);
if (!NT_STATUS_IS_OK(status)) {
return status;
}
}
return NT_STATUS_OK;
}
/*
* Send a list of DATA_BLOBs
*
* Example: packet_send(ctx, 2, data_blob_const(&size, sizeof(size)),
* data_blob_const(buf, size));
*/
NTSTATUS packet_send(struct packet_context *ctx, int num_blobs, ...)
{
va_list ap;
int i;
size_t len;
uint8 *out;
len = ctx->out.length;
va_start(ap, num_blobs);
for (i=0; i<num_blobs; i++) {
size_t tmp;
DATA_BLOB blob = va_arg(ap, DATA_BLOB);
tmp = len + blob.length;
if (tmp < len) {
DEBUG(0, ("integer overflow\n"));
va_end(ap);
return NT_STATUS_NO_MEMORY;
}
len = tmp;
}
va_end(ap);
if (len == 0) {
return NT_STATUS_OK;
}
if (!(out = TALLOC_REALLOC_ARRAY(ctx, ctx->out.data, uint8, len))) {
DEBUG(0, ("talloc failed\n"));
return NT_STATUS_NO_MEMORY;
}
ctx->out.data = out;
va_start(ap, num_blobs);
for (i=0; i<num_blobs; i++) {
DATA_BLOB blob = va_arg(ap, DATA_BLOB);
memcpy(ctx->out.data+ctx->out.length, blob.data, blob.length);
ctx->out.length += blob.length;
}
va_end(ap);
SMB_ASSERT(ctx->out.length == len);
return NT_STATUS_OK;
}
/*
* Get the packet context's file descriptor
*/
int packet_get_fd(struct packet_context *ctx)
{
return ctx->fd;
}
|