rubidium@5720: /* $Id$ */ rubidium@5720: rubidium@5720: #ifdef ENABLE_NETWORK rubidium@5720: rubidium@5720: #include "../../stdafx.h" rubidium@5720: #include "../../macros.h" rubidium@5720: #include "../../string.h" rubidium@5720: rubidium@5720: #include "os_abstraction.h" rubidium@5720: #include "config.h" rubidium@5720: #include "packet.h" rubidium@5720: rubidium@5720: /** rubidium@5720: * @file packet.h Basic functions to create, fill and read packets. rubidium@5720: */ rubidium@5720: rubidium@5720: rubidium@5720: /* Do not want to include functions.h and all required headers */ rubidium@5720: extern void NORETURN CDECL error(const char *str, ...); rubidium@5720: rubidium@5720: rubidium@5720: /** rubidium@5720: * Create a packet for sending rubidium@5720: * @param type the of packet rubidium@5720: * @return the newly created packet rubidium@5720: */ rubidium@5720: Packet *NetworkSend_Init(PacketType type) rubidium@5720: { rubidium@5720: Packet *packet = malloc(sizeof(Packet)); rubidium@5720: /* An error is inplace here, because it simply means we ran out of memory. */ rubidium@5720: if (packet == NULL) error("Failed to allocate Packet"); rubidium@5720: rubidium@5720: /* Skip the size so we can write that in before sending the packet */ rubidium@5720: packet->size = sizeof(packet->size); rubidium@5720: packet->buffer[packet->size++] = type; rubidium@5720: packet->pos = 0; rubidium@5720: rubidium@5720: return packet; rubidium@5720: } rubidium@5720: rubidium@5720: /** rubidium@5720: * Writes the packet size from the raw packet from packet->size rubidium@5720: * @param packet the packet to write the size of rubidium@5720: */ rubidium@5720: void NetworkSend_FillPacketSize(Packet *packet) rubidium@5720: { rubidium@5720: packet->buffer[0] = GB(packet->size, 0, 8); rubidium@5720: packet->buffer[1] = GB(packet->size, 8, 8); rubidium@5720: } rubidium@5720: rubidium@5720: /** rubidium@5720: * The next couple of functions make sure we can send rubidium@5720: * uint8, uint16, uint32 and uint64 endian-safe rubidium@5720: * over the network. The least significant bytes are rubidium@5720: * sent first. rubidium@5720: * rubidium@5720: * So 0x01234567 would be sent as 67 45 23 01. rubidium@5720: */ rubidium@5720: rubidium@5720: void NetworkSend_uint8(Packet *packet, uint8 data) rubidium@5720: { rubidium@5720: assert(packet->size < sizeof(packet->buffer) - sizeof(data)); rubidium@5720: packet->buffer[packet->size++] = data; rubidium@5720: } rubidium@5720: rubidium@5720: void NetworkSend_uint16(Packet *packet, uint16 data) rubidium@5720: { rubidium@5720: assert(packet->size < sizeof(packet->buffer) - sizeof(data)); rubidium@5720: packet->buffer[packet->size++] = GB(data, 0, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 8, 8); rubidium@5720: } rubidium@5720: rubidium@5720: void NetworkSend_uint32(Packet *packet, uint32 data) rubidium@5720: { rubidium@5720: assert(packet->size < sizeof(packet->buffer) - sizeof(data)); rubidium@5720: packet->buffer[packet->size++] = GB(data, 0, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 8, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 16, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 24, 8); rubidium@5720: } rubidium@5720: rubidium@5720: void NetworkSend_uint64(Packet *packet, uint64 data) rubidium@5720: { rubidium@5720: assert(packet->size < sizeof(packet->buffer) - sizeof(data)); rubidium@5720: packet->buffer[packet->size++] = GB(data, 0, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 8, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 16, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 24, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 32, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 40, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 48, 8); rubidium@5720: packet->buffer[packet->size++] = GB(data, 56, 8); rubidium@5720: } rubidium@5720: rubidium@5720: /** rubidium@5720: * Sends a string over the network. It sends out rubidium@5720: * the string + '\0'. No size-byte or something. rubidium@5720: */ rubidium@5720: void NetworkSend_string(Packet *packet, const char* data) rubidium@5720: { rubidium@5720: assert(data != NULL); rubidium@5720: assert(packet->size < sizeof(packet->buffer) - strlen(data) - 1); rubidium@5720: while ((packet->buffer[packet->size++] = *data++) != '\0') {} rubidium@5720: } rubidium@5720: rubidium@5720: rubidium@5720: /** rubidium@5720: * Receiving commands rubidium@5720: * Again, the next couple of functions are endian-safe rubidium@5720: * see the comment before NetworkSend_uint8 for more info. rubidium@5720: */ rubidium@5720: rubidium@5720: rubidium@5720: extern uint CloseConnection(NetworkClientState *cs); rubidium@5720: rubidium@5720: /** Is it safe to read from the packet, i.e. didn't we run over the buffer ? */ rubidium@5720: static inline bool CanReadFromPacket(NetworkClientState *cs, Packet *packet, uint bytes_to_read) rubidium@5720: { rubidium@5720: /* Don't allow reading from a closed socket */ rubidium@5720: if (HasClientQuit(cs)) return false; rubidium@5720: rubidium@5720: /* Check if variable is within packet-size */ rubidium@5720: if (packet->pos + bytes_to_read > packet->size) { rubidium@5720: CloseConnection(cs); rubidium@5720: return false; rubidium@5720: } rubidium@5720: rubidium@5720: return true; rubidium@5720: } rubidium@5720: rubidium@5720: /** rubidium@5720: * Reads the packet size from the raw packet and stores it in the packet->size rubidium@5720: * @param packet the packet to read the size of rubidium@5720: */ rubidium@5720: void NetworkRecv_ReadPacketSize(Packet *packet) rubidium@5720: { rubidium@5720: packet->size = (uint16)packet->buffer[0]; rubidium@5720: packet->size += (uint16)packet->buffer[1] << 8; rubidium@5720: } rubidium@5720: rubidium@5720: uint8 NetworkRecv_uint8(NetworkClientState *cs, Packet *packet) rubidium@5720: { rubidium@5720: uint8 n; rubidium@5720: rubidium@5720: if (!CanReadFromPacket(cs, packet, sizeof(n))) return 0; rubidium@5720: rubidium@5720: n = packet->buffer[packet->pos++]; rubidium@5720: return n; rubidium@5720: } rubidium@5720: rubidium@5720: uint16 NetworkRecv_uint16(NetworkClientState *cs, Packet *packet) rubidium@5720: { rubidium@5720: uint16 n; rubidium@5720: rubidium@5720: if (!CanReadFromPacket(cs, packet, sizeof(n))) return 0; rubidium@5720: rubidium@5720: n = (uint16)packet->buffer[packet->pos++]; rubidium@5720: n += (uint16)packet->buffer[packet->pos++] << 8; rubidium@5720: return n; rubidium@5720: } rubidium@5720: rubidium@5720: uint32 NetworkRecv_uint32(NetworkClientState *cs, Packet *packet) rubidium@5720: { rubidium@5720: uint32 n; rubidium@5720: rubidium@5720: if (!CanReadFromPacket(cs, packet, sizeof(n))) return 0; rubidium@5720: rubidium@5720: n = (uint32)packet->buffer[packet->pos++]; rubidium@5720: n += (uint32)packet->buffer[packet->pos++] << 8; rubidium@5720: n += (uint32)packet->buffer[packet->pos++] << 16; rubidium@5720: n += (uint32)packet->buffer[packet->pos++] << 24; rubidium@5720: return n; rubidium@5720: } rubidium@5720: rubidium@5720: uint64 NetworkRecv_uint64(NetworkClientState *cs, Packet *packet) rubidium@5720: { rubidium@5720: uint64 n; rubidium@5720: rubidium@5720: if (!CanReadFromPacket(cs, packet, sizeof(n))) return 0; rubidium@5720: rubidium@5720: n = (uint64)packet->buffer[packet->pos++]; rubidium@5720: n += (uint64)packet->buffer[packet->pos++] << 8; rubidium@5720: n += (uint64)packet->buffer[packet->pos++] << 16; rubidium@5720: n += (uint64)packet->buffer[packet->pos++] << 24; rubidium@5720: n += (uint64)packet->buffer[packet->pos++] << 32; rubidium@5720: n += (uint64)packet->buffer[packet->pos++] << 40; rubidium@5720: n += (uint64)packet->buffer[packet->pos++] << 48; rubidium@5720: n += (uint64)packet->buffer[packet->pos++] << 56; rubidium@5720: return n; rubidium@5720: } rubidium@5720: rubidium@5720: /** Reads a string till it finds a '\0' in the stream */ rubidium@5720: void NetworkRecv_string(NetworkClientState *cs, Packet *p, char *buffer, size_t size) rubidium@5720: { rubidium@5720: PacketSize pos; rubidium@5720: char *bufp = buffer; rubidium@5720: rubidium@5720: /* Don't allow reading from a closed socket */ rubidium@5720: if (HasClientQuit(cs)) return; rubidium@5720: rubidium@5720: pos = p->pos; rubidium@5720: while (--size > 0 && pos < p->size && (*buffer++ = p->buffer[pos++]) != '\0') {} rubidium@5720: rubidium@5720: if (size == 0 || pos == p->size) { rubidium@5720: *buffer = '\0'; rubidium@5720: /* If size was sooner to zero then the string in the stream rubidium@5720: * skip till the \0, so than packet can be read out correctly for the rest */ rubidium@5720: while (pos < p->size && p->buffer[pos] != '\0') pos++; rubidium@5720: pos++; rubidium@5720: } rubidium@5720: p->pos = pos; rubidium@5720: rubidium@5720: str_validate(bufp); rubidium@5720: } rubidium@5720: rubidium@5720: #endif /* ENABLE_NETWORK */