#include "command_port.h" #include static void result_reset(struct command_result *result) { memset(result, 0, sizeof(*result)); result->status = COMMAND_INVALID; result->checksum = UINT32_C(2166136261); } static void accumulate(struct command_result *result, const unsigned char *data, size_t size, size_t limit) { size_t index; size_t available = limit - result->bytes_stored; size_t copied = size < available ? size : available; if (copied != 0) { memcpy(result->capture + result->bytes_stored, data, copied); result->bytes_stored += copied; } for (index = 0; index < size; index++) { result->checksum ^= data[index]; result->checksum *= UINT32_C(16777619); } result->bytes_seen += size; result->truncated = result->bytes_seen > result->bytes_stored; } static int reap(struct command_port *port, unsigned token, struct command_result *result) { int status; do { status = command_port_wait(port, token, &result->child_exit, &result->child_signal); } while (status == PORT_INTERRUPTED); return status; } int command_collect(struct command_port *port, const struct command_request *request, struct command_result *result) { unsigned token = 0; unsigned char buffer[97]; int read_failed = 0; int close_status; int wait_status; if (result == NULL) { return COMMAND_INVALID; } result_reset(result); if (port == NULL || request == NULL || request->tag != 42 || request->capture_limit > COMMAND_MAX_BYTES) { return COMMAND_INVALID; } if (command_port_open(port, request->tag, &token) != 0) { result->status = COMMAND_OPEN_ERROR; return result->status; } for (;;) { long amount = command_port_read(port, token, buffer, sizeof(buffer)); if (amount == PORT_INTERRUPTED) { continue; } if (amount < 0) { read_failed = 1; break; } if (amount == 0) { break; } accumulate(result, buffer, (size_t)amount, request->capture_limit); } close_status = command_port_close(port, token); wait_status = reap(port, token, result); if (read_failed || close_status != 0 || wait_status != 0) { result->status = COMMAND_READ_ERROR; } else if (result->child_exit != 0 || result->child_signal != 0) { result->status = COMMAND_CHILD_ERROR; } else { result->status = COMMAND_OK; } return result->status; }