diff --git a/animation-server/src/main.cpp b/animation-server/src/main.cpp index 70296298ff..126216ea9b 100644 --- a/animation-server/src/main.cpp +++ b/animation-server/src/main.cpp @@ -48,11 +48,11 @@ bool wantLocalDomain = false; unsigned long packetsSent = 0; unsigned long bytesSent = 0; -static void sendVoxelEditMessage(PACKET_HEADER header, VoxelDetail& detail) { +static void sendVoxelEditMessage(PACKET_TYPE type, VoxelDetail& detail) { unsigned char* bufferOut; int sizeOut; - if (createVoxelEditMessage(header, 0, 1, &detail, bufferOut, sizeOut)){ + if (createVoxelEditMessage(type, 0, 1, &detail, bufferOut, sizeOut)){ ::packetsSent++; ::bytesSent += sizeOut; @@ -161,7 +161,7 @@ static void renderMovingBug() { } // send the "erase message" first... - PACKET_HEADER message = PACKET_HEADER_ERASE_VOXEL; + PACKET_TYPE message = PACKET_TYPE_ERASE_VOXEL; if (createVoxelEditMessage(message, 0, VOXELS_PER_BUG, (VoxelDetail*)&details, bufferOut, sizeOut)){ ::packetsSent++; @@ -231,7 +231,7 @@ static void renderMovingBug() { } // send the "create message" ... - message = PACKET_HEADER_SET_VOXEL_DESTRUCTIVE; + message = PACKET_TYPE_SET_VOXEL_DESTRUCTIVE; if (createVoxelEditMessage(message, 0, VOXELS_PER_BUG, (VoxelDetail*)&details, bufferOut, sizeOut)){ ::packetsSent++; @@ -276,7 +276,7 @@ static void sendVoxelBlinkMessage() { detail.green = 0 * ::intensity; detail.blue = 0 * ::intensity; - PACKET_HEADER message = PACKET_HEADER_SET_VOXEL_DESTRUCTIVE; + PACKET_TYPE message = PACKET_TYPE_SET_VOXEL_DESTRUCTIVE; sendVoxelEditMessage(message, detail); } @@ -293,7 +293,7 @@ unsigned char onColor[3] = { 0, 255, 255 }; const float STRING_OF_LIGHTS_SIZE = 0.125f / TREE_SCALE; // approximately 1/8th meter static void sendBlinkingStringOfLights() { - PACKET_HEADER message = PACKET_HEADER_SET_VOXEL_DESTRUCTIVE; // we're a bully! + PACKET_TYPE message = PACKET_TYPE_SET_VOXEL_DESTRUCTIVE; // we're a bully! float lightScale = STRING_OF_LIGHTS_SIZE; static VoxelDetail details[LIGHTS_PER_SEGMENT]; unsigned char* bufferOut; @@ -423,7 +423,7 @@ const int PACKETS_PER_DANCE_FLOOR = DANCE_FLOOR_VOXELS_PER_PACKET / (DANCE_FLOOR int danceFloorColors[DANCE_FLOOR_WIDTH][DANCE_FLOOR_LENGTH]; void sendDanceFloor() { - PACKET_HEADER message = PACKET_HEADER_SET_VOXEL_DESTRUCTIVE; // we're a bully! + PACKET_TYPE message = PACKET_TYPE_SET_VOXEL_DESTRUCTIVE; // we're a bully! float lightScale = DANCE_FLOOR_LIGHT_SIZE; static VoxelDetail details[DANCE_FLOOR_VOXELS_PER_PACKET]; unsigned char* bufferOut; @@ -550,7 +550,7 @@ bool billboardMessage[BILLBOARD_HEIGHT][BILLBOARD_WIDTH] = { }; static void sendBillboard() { - PACKET_HEADER message = PACKET_HEADER_SET_VOXEL_DESTRUCTIVE; // we're a bully! + PACKET_TYPE message = PACKET_TYPE_SET_VOXEL_DESTRUCTIVE; // we're a bully! float lightScale = BILLBOARD_LIGHT_SIZE; static VoxelDetail details[VOXELS_PER_PACKET]; unsigned char* bufferOut; @@ -726,7 +726,8 @@ int main(int argc, const char * argv[]) } // Nodes sending messages to us... - if (nodeList->getNodeSocket()->receive(&nodePublicAddress, packetData, &receivedBytes)) { + if (nodeList->getNodeSocket()->receive(&nodePublicAddress, packetData, &receivedBytes) && + packetVersionMatch(packetData)) { NodeList::getInstance()->processNodeData(&nodePublicAddress, packetData, receivedBytes); } } diff --git a/audio-mixer/src/AvatarAudioRingBuffer.cpp b/audio-mixer/src/AvatarAudioRingBuffer.cpp index c3e0e2cbe9..42092cff3a 100644 --- a/audio-mixer/src/AvatarAudioRingBuffer.cpp +++ b/audio-mixer/src/AvatarAudioRingBuffer.cpp @@ -24,6 +24,6 @@ AvatarAudioRingBuffer::~AvatarAudioRingBuffer() { } int AvatarAudioRingBuffer::parseData(unsigned char* sourceBuffer, int numBytes) { - _shouldLoopbackForNode = (sourceBuffer[0] == PACKET_HEADER_MICROPHONE_AUDIO_WITH_ECHO); + _shouldLoopbackForNode = (sourceBuffer[0] == PACKET_TYPE_MICROPHONE_AUDIO_WITH_ECHO); return PositionalAudioRingBuffer::parseData(sourceBuffer, numBytes); } \ No newline at end of file diff --git a/audio-mixer/src/InjectedAudioRingBuffer.cpp b/audio-mixer/src/InjectedAudioRingBuffer.cpp index 426bbf361d..7e93c7716c 100644 --- a/audio-mixer/src/InjectedAudioRingBuffer.cpp +++ b/audio-mixer/src/InjectedAudioRingBuffer.cpp @@ -21,7 +21,7 @@ InjectedAudioRingBuffer::InjectedAudioRingBuffer() : } int InjectedAudioRingBuffer::parseData(unsigned char* sourceBuffer, int numBytes) { - unsigned char* currentBuffer = sourceBuffer + sizeof(PACKET_HEADER_INJECT_AUDIO); + unsigned char* currentBuffer = sourceBuffer + numBytesForPacketHeader(sourceBuffer); // pull stream identifier from the packet memcpy(&_streamIdentifier, currentBuffer, sizeof(_streamIdentifier)); diff --git a/audio-mixer/src/PositionalAudioRingBuffer.cpp b/audio-mixer/src/PositionalAudioRingBuffer.cpp index 87c51e2cf8..60ec9a425e 100644 --- a/audio-mixer/src/PositionalAudioRingBuffer.cpp +++ b/audio-mixer/src/PositionalAudioRingBuffer.cpp @@ -22,7 +22,7 @@ PositionalAudioRingBuffer::PositionalAudioRingBuffer() : } int PositionalAudioRingBuffer::parseData(unsigned char* sourceBuffer, int numBytes) { - unsigned char* currentBuffer = sourceBuffer + sizeof(PACKET_HEADER); + unsigned char* currentBuffer = sourceBuffer + numBytesForPacketHeader(sourceBuffer); currentBuffer += parsePositionalData(currentBuffer, numBytes - (currentBuffer - sourceBuffer)); currentBuffer += parseAudioSamples(currentBuffer, numBytes - (currentBuffer - sourceBuffer)); diff --git a/audio-mixer/src/main.cpp b/audio-mixer/src/main.cpp index 67ccb47e8c..b900c48479 100644 --- a/audio-mixer/src/main.cpp +++ b/audio-mixer/src/main.cpp @@ -97,8 +97,9 @@ int main(int argc, const char* argv[]) { int nextFrame = 0; timeval startTime; - unsigned char clientPacket[BUFFER_LENGTH_BYTES_STEREO + sizeof(PACKET_HEADER_MIXED_AUDIO)]; - clientPacket[0] = PACKET_HEADER_MIXED_AUDIO; + int numBytesPacketHeader = numBytesForPacketHeader((unsigned char*) &PACKET_TYPE_MIXED_AUDIO); + unsigned char clientPacket[BUFFER_LENGTH_BYTES_STEREO + numBytesPacketHeader]; + populateTypeAndVersion(clientPacket, PACKET_TYPE_MIXED_AUDIO); int16_t clientSamples[BUFFER_LENGTH_SAMPLES_PER_CHANNEL * 2] = {}; @@ -326,7 +327,7 @@ int main(int argc, const char* argv[]) { } } - memcpy(clientPacket + sizeof(PACKET_HEADER_MIXED_AUDIO), clientSamples, sizeof(clientSamples)); + memcpy(clientPacket + numBytesPacketHeader, clientSamples, sizeof(clientSamples)); nodeList->getNodeSocket()->send(node->getPublicSocket(), clientPacket, sizeof(clientPacket)); } } @@ -346,13 +347,14 @@ int main(int argc, const char* argv[]) { } // pull any new audio data from nodes off of the network stack - while (nodeList->getNodeSocket()->receive(nodeAddress, packetData, &receivedBytes)) { - if (packetData[0] == PACKET_HEADER_MICROPHONE_AUDIO_NO_ECHO || - packetData[0] == PACKET_HEADER_MICROPHONE_AUDIO_WITH_ECHO) { + while (nodeList->getNodeSocket()->receive(nodeAddress, packetData, &receivedBytes) && + packetVersionMatch(packetData)) { + if (packetData[0] == PACKET_TYPE_MICROPHONE_AUDIO_NO_ECHO || + packetData[0] == PACKET_TYPE_MICROPHONE_AUDIO_WITH_ECHO) { Node* avatarNode = nodeList->addOrUpdateNode(nodeAddress, - nodeAddress, - NODE_TYPE_AGENT, - nodeList->getLastNodeID()); + nodeAddress, + NODE_TYPE_AGENT, + nodeList->getLastNodeID()); if (avatarNode->getNodeID() == nodeList->getLastNodeID()) { nodeList->increaseNodeID(); @@ -364,7 +366,7 @@ int main(int argc, const char* argv[]) { // kill off this node - temporary solution to mixer crash on mac sleep avatarNode->setAlive(false); } - } else if (packetData[0] == PACKET_HEADER_INJECT_AUDIO) { + } else if (packetData[0] == PACKET_TYPE_INJECT_AUDIO) { Node* matchingInjector = NULL; for (NodeList::iterator node = nodeList->begin(); node != nodeList->end(); node++) { @@ -383,16 +385,16 @@ int main(int argc, const char* argv[]) { if (!matchingInjector) { matchingInjector = nodeList->addOrUpdateNode(NULL, - NULL, - NODE_TYPE_AUDIO_INJECTOR, - nodeList->getLastNodeID()); + NULL, + NODE_TYPE_AUDIO_INJECTOR, + nodeList->getLastNodeID()); nodeList->increaseNodeID(); } // give the new audio data to the matching injector node nodeList->updateNodeWithData(matchingInjector, packetData, receivedBytes); - } else if (packetData[0] == PACKET_HEADER_PING) { + } else if (packetData[0] == PACKET_TYPE_PING) { // If the packet is a ping, let processNodeData handle it. nodeList->processNodeData(nodeAddress, packetData, receivedBytes); diff --git a/avatar-mixer/src/main.cpp b/avatar-mixer/src/main.cpp index 0b6de10029..f2fd031526 100644 --- a/avatar-mixer/src/main.cpp +++ b/avatar-mixer/src/main.cpp @@ -73,7 +73,7 @@ int main(int argc, const char* argv[]) { ssize_t receivedBytes = 0; unsigned char *broadcastPacket = new unsigned char[MAX_PACKET_SIZE]; - *broadcastPacket = PACKET_HEADER_BULK_AVATAR_DATA; + int numHeaderBytes = populateTypeAndVersion(broadcastPacket, PACKET_TYPE_BULK_AVATAR_DATA); unsigned char* currentBufferPosition = NULL; @@ -92,9 +92,10 @@ int main(int argc, const char* argv[]) { NodeList::getInstance()->sendDomainServerCheckIn(); } - if (nodeList->getNodeSocket()->receive(nodeAddress, packetData, &receivedBytes)) { + if (nodeList->getNodeSocket()->receive(nodeAddress, packetData, &receivedBytes) && + packetVersionMatch(packetData)) { switch (packetData[0]) { - case PACKET_HEADER_HEAD_DATA: + case PACKET_TYPE_HEAD_DATA: // grab the node ID from the packet unpackNodeId(packetData + 1, &nodeID); @@ -103,8 +104,8 @@ int main(int argc, const char* argv[]) { // parse positional data from an node nodeList->updateNodeWithData(avatarNode, packetData, receivedBytes); - case PACKET_HEADER_INJECT_AUDIO: - currentBufferPosition = broadcastPacket + 1; + case PACKET_TYPE_INJECT_AUDIO: + currentBufferPosition = broadcastPacket + numHeaderBytes; // send back a packet with other active node data to this node for (NodeList::iterator node = nodeList->begin(); node != nodeList->end(); node++) { @@ -116,9 +117,9 @@ int main(int argc, const char* argv[]) { nodeList->getNodeSocket()->send(nodeAddress, broadcastPacket, currentBufferPosition - broadcastPacket); break; - case PACKET_HEADER_AVATAR_VOXEL_URL: + case PACKET_TYPE_AVATAR_VOXEL_URL: // grab the node ID from the packet - unpackNodeId(packetData + 1, &nodeID); + unpackNodeId(packetData + numBytesForPacketHeader(packetData), &nodeID); // let everyone else know about the update for (NodeList::iterator node = nodeList->begin(); node != nodeList->end(); node++) { @@ -127,7 +128,7 @@ int main(int argc, const char* argv[]) { } } break; - case PACKET_HEADER_DOMAIN: + case PACKET_TYPE_DOMAIN: // ignore the DS packet, for now nodes are added only when they communicate directly with us break; default: diff --git a/domain-server/src/main.cpp b/domain-server/src/main.cpp index b4174d986f..894f602251 100644 --- a/domain-server/src/main.cpp +++ b/domain-server/src/main.cpp @@ -70,7 +70,7 @@ int main(int argc, const char * argv[]) char nodeType = '\0'; unsigned char broadcastPacket[MAX_PACKET_SIZE]; - broadcastPacket[0] = PACKET_HEADER_DOMAIN; + int numHeaderBytes = populateTypeAndVersion(broadcastPacket, PACKET_TYPE_DOMAIN); unsigned char* currentBufferPos; unsigned char* startPointer; @@ -86,11 +86,15 @@ int main(int argc, const char * argv[]) while (true) { if (nodeList->getNodeSocket()->receive((sockaddr *)&nodePublicAddress, packetData, &receivedBytes) && - (packetData[0] == PACKET_HEADER_DOMAIN_REPORT_FOR_DUTY || packetData[0] == PACKET_HEADER_DOMAIN_LIST_REQUEST)) { + (packetData[0] == PACKET_TYPE_DOMAIN_REPORT_FOR_DUTY || packetData[0] == PACKET_TYPE_DOMAIN_LIST_REQUEST) && + packetVersionMatch(packetData)) { + // this is an RFD or domain list request packet, and there is a version match std::map newestSoloNodes; + int numBytesSenderHeader = numBytesForPacketHeader(packetData); + nodeType = packetData[1]; - int numBytesSocket = unpackSocket(packetData + sizeof(PACKET_HEADER) + sizeof(NODE_TYPE), + int numBytesSocket = unpackSocket(packetData + numBytesSenderHeader + sizeof(NODE_TYPE), (sockaddr*) &nodeLocalAddress); sockaddr* destinationSocket = (sockaddr*) &nodePublicAddress; @@ -108,18 +112,18 @@ int main(int argc, const char * argv[]) } Node* newNode = nodeList->addOrUpdateNode((sockaddr*) &nodePublicAddress, - (sockaddr*) &nodeLocalAddress, - nodeType, - nodeList->getLastNodeID()); + (sockaddr*) &nodeLocalAddress, + nodeType, + nodeList->getLastNodeID()); if (newNode->getNodeID() == nodeList->getLastNodeID()) { nodeList->increaseNodeID(); } - currentBufferPos = broadcastPacket + sizeof(PACKET_HEADER); + currentBufferPos = broadcastPacket + numHeaderBytes; startPointer = currentBufferPos; - unsigned char* nodeTypesOfInterest = packetData + sizeof(PACKET_HEADER) + sizeof(NODE_TYPE) + unsigned char* nodeTypesOfInterest = packetData + numBytesSenderHeader + sizeof(NODE_TYPE) + numBytesSocket + sizeof(unsigned char); int numInterestTypes = *(nodeTypesOfInterest - 1); @@ -162,7 +166,7 @@ int main(int argc, const char * argv[]) uint64_t timeNow = usecTimestampNow(); newNode->setLastHeardMicrostamp(timeNow); - if (packetData[0] == PACKET_HEADER_DOMAIN_REPORT_FOR_DUTY + if (packetData[0] == PACKET_TYPE_DOMAIN_REPORT_FOR_DUTY && memchr(SOLO_NODE_TYPES, nodeType, sizeof(SOLO_NODE_TYPES))) { newNode->setWakeMicrostamp(timeNow); } @@ -172,8 +176,8 @@ int main(int argc, const char * argv[]) // send the constructed list back to this node nodeList->getNodeSocket()->send(destinationSocket, - broadcastPacket, - (currentBufferPos - startPointer) + 1); + broadcastPacket, + (currentBufferPos - startPointer) + 1); } if (Logstash::shouldSendStats()) { diff --git a/eve/src/main.cpp b/eve/src/main.cpp index 5e7eb5d541..5bbe5c7eac 100644 --- a/eve/src/main.cpp +++ b/eve/src/main.cpp @@ -49,9 +49,10 @@ void *receiveNodeData(void *args) { NodeList* nodeList = NodeList::getInstance(); while (!::stopReceiveNodeDataThread) { - if (nodeList->getNodeSocket()->receive(&senderAddress, incomingPacket, &bytesReceived)) { + if (nodeList->getNodeSocket()->receive(&senderAddress, incomingPacket, &bytesReceived) && + packetVersionMatch(incomingPacket)) { switch (incomingPacket[0]) { - case PACKET_HEADER_BULK_AVATAR_DATA: + case PACKET_TYPE_BULK_AVATAR_DATA: // this is the positional data for other nodes // pass that off to the nodeList processBulkNodeData method nodeList->processBulkNodeData(&senderAddress, incomingPacket, bytesReceived); @@ -85,9 +86,6 @@ int main(int argc, const char* argv[]) { // start the node list thread that will kill off nodes when they stop talking nodeList->startSilentNodeRemovalThread(); - // start the ping thread that hole punches to create an active connection to other nodes - nodeList->startPingUnknownNodesThread(); - pthread_t receiveNodeDataThread; pthread_create(&receiveNodeDataThread, NULL, receiveNodeData, NULL); @@ -125,7 +123,7 @@ int main(int argc, const char* argv[]) { nodeList->linkedDataCreateCallback = createAvatarDataForNode; unsigned char broadcastPacket[MAX_PACKET_SIZE]; - broadcastPacket[0] = PACKET_HEADER_HEAD_DATA; + int numHeaderBytes = populateTypeAndVersion(broadcastPacket, PACKET_TYPE_HEAD_DATA); timeval thisSend; int numMicrosecondsSleep = 0; @@ -153,7 +151,7 @@ int main(int argc, const char* argv[]) { // make sure we actually have an avatar mixer with an active socket if (nodeList->getOwnerID() != UNKNOWN_NODE_ID && avatarMixer && avatarMixer->getActiveSocket() != NULL) { - unsigned char* packetPosition = broadcastPacket + sizeof(PACKET_HEADER); + unsigned char* packetPosition = broadcastPacket + numHeaderBytes; packetPosition += packNodeId(packetPosition, nodeList->getOwnerID()); // use the getBroadcastData method in the AvatarData class to populate the broadcastPacket buffer @@ -210,6 +208,5 @@ int main(int argc, const char* argv[]) { pthread_join(receiveNodeDataThread, NULL); // stop the node list's threads - nodeList->stopPingUnknownNodesThread(); nodeList->stopSilentNodeRemovalThread(); } diff --git a/injector/src/main.cpp b/injector/src/main.cpp index e8cb345471..e2c1effc15 100644 --- a/injector/src/main.cpp +++ b/injector/src/main.cpp @@ -144,7 +144,8 @@ int main(int argc, char* argv[]) { nodeList->linkedDataCreateCallback = createAvatarDataForNode; timeval lastSend = {}; - unsigned char broadcastPacket = PACKET_HEADER_INJECT_AUDIO; + int numBytesPacketHeader = numBytesForPacketHeader((unsigned char*) &PACKET_TYPE_INJECT_AUDIO); + unsigned char* broadcastPacket = new unsigned char[numBytesPacketHeader]; timeval lastDomainServerCheckIn = {}; @@ -168,10 +169,10 @@ int main(int argc, char* argv[]) { NodeList::getInstance()->sendDomainServerCheckIn(); } - while (nodeList->getNodeSocket()->receive(&senderAddress, incomingPacket, &bytesReceived)) { + while (nodeList->getNodeSocket()->receive(&senderAddress, incomingPacket, &bytesReceived) && + packetVersionMatch(incomingPacket)) { switch (incomingPacket[0]) { - case PACKET_HEADER_BULK_AVATAR_DATA: - // this is the positional data for other nodes + case PACKET_TYPE_BULK_AVATAR_DATA: // this is the positional data for other nodes // pass that off to the nodeList processBulkNodeData method nodeList->processBulkNodeData(&senderAddress, incomingPacket, bytesReceived); break; @@ -211,8 +212,8 @@ int main(int argc, char* argv[]) { // use the UDPSocket instance attached to our node list to ask avatar mixer for a list of avatars nodeList->getNodeSocket()->send(avatarMixer->getActiveSocket(), - &broadcastPacket, - sizeof(broadcastPacket)); + broadcastPacket, + numBytesPacketHeader); } } else { if (!injector.isInjectingAudio() && (::shouldLoopAudio || !::hasInjectedAudioOnce)) { diff --git a/interface/src/Application.cpp b/interface/src/Application.cpp index 57109b7cad..cd74b9c6ab 100755 --- a/interface/src/Application.cpp +++ b/interface/src/Application.cpp @@ -251,7 +251,6 @@ Application::Application(int& argc, char** argv, timeval &startup_time) : // start the nodeList threads NodeList::getInstance()->startSilentNodeRemovalThread(); - NodeList::getInstance()->startPingUnknownNodesThread(); _window->setCentralWidget(_glWidget); @@ -906,12 +905,13 @@ void Application::wheelEvent(QWheelEvent* event) { void Application::sendPingPackets() { char nodeTypesOfInterest[] = {NODE_TYPE_VOXEL_SERVER, NODE_TYPE_AUDIO_MIXER, NODE_TYPE_AVATAR_MIXER}; + uint64_t currentTime = usecTimestampNow(); - unsigned char pingPacket[1 + sizeof(currentTime)]; - pingPacket[0] = PACKET_HEADER_PING; + unsigned char pingPacket[numBytesForPacketHeader((unsigned char*) &PACKET_TYPE_PING) + sizeof(currentTime)]; + int numHeaderBytes = populateTypeAndVersion(pingPacket, PACKET_TYPE_PING); memcpy(&pingPacket[1], ¤tTime, sizeof(currentTime)); - getInstance()->controlledBroadcastToNodes(pingPacket, 1 + sizeof(currentTime), + getInstance()->controlledBroadcastToNodes(pingPacket, numHeaderBytes + sizeof(currentTime), nodeTypesOfInterest, sizeof(nodeTypesOfInterest)); } @@ -1020,7 +1020,11 @@ void Application::sendAvatarVoxelURLMessage(const QUrl& url) { return; // we don't yet know who we are } QByteArray message; - message.append(PACKET_HEADER_AVATAR_VOXEL_URL); + + char packetHeader[MAX_PACKET_HEADER_BYTES]; + int numBytesPacketHeader = populateTypeAndVersion((unsigned char*) packetHeader, PACKET_TYPE_AVATAR_VOXEL_URL); + + message.append(packetHeader, numBytesPacketHeader); message.append((const char*)&ownerID, sizeof(ownerID)); message.append(url.toEncoded()); @@ -1029,8 +1033,9 @@ void Application::sendAvatarVoxelURLMessage(const QUrl& url) { void Application::processAvatarVoxelURLMessage(unsigned char *packetData, size_t dataBytes) { // skip the header - packetData++; - dataBytes--; + int numBytesPacketHeader = numBytesForPacketHeader(packetData); + packetData += numBytesPacketHeader; + dataBytes -= numBytesPacketHeader; // read the node id uint16_t nodeID = *(uint16_t*)packetData; @@ -1252,11 +1257,11 @@ void Application::updateVoxelModeActions() { } } -void Application::sendVoxelEditMessage(PACKET_HEADER header, VoxelDetail& detail) { +void Application::sendVoxelEditMessage(PACKET_TYPE type, VoxelDetail& detail) { unsigned char* bufferOut; int sizeOut; - if (createVoxelEditMessage(header, 0, 1, &detail, bufferOut, sizeOut)){ + if (createVoxelEditMessage(type, 0, 1, &detail, bufferOut, sizeOut)){ Application::controlledBroadcastToNodes(bufferOut, sizeOut, & NODE_TYPE_VOXEL_SERVER, 1); delete[] bufferOut; } @@ -1343,7 +1348,8 @@ bool Application::sendVoxelsOperation(VoxelNode* node, void* extraData) { // if we have room don't have room in the buffer, then send the previously generated message first if (args->bufferInUse + codeAndColorLength > MAXIMUM_EDIT_VOXEL_MESSAGE_SIZE) { controlledBroadcastToNodes(args->messageBuffer, args->bufferInUse, & NODE_TYPE_VOXEL_SERVER, 1); - args->bufferInUse = sizeof(PACKET_HEADER_SET_VOXEL_DESTRUCTIVE) + sizeof(unsigned short int); // reset + args->bufferInUse = numBytesForPacketHeader((unsigned char*) &PACKET_TYPE_SET_VOXEL_DESTRUCTIVE) + + sizeof(unsigned short int); // reset } // copy this node's code color details into our buffer. @@ -1410,10 +1416,12 @@ void Application::importVoxels() { // the server as an set voxel message, this will also rebase the voxels to the new location unsigned char* calculatedOctCode = NULL; SendVoxelsOperationArgs args; - args.messageBuffer[0] = PACKET_HEADER_SET_VOXEL_DESTRUCTIVE; - unsigned short int* sequenceAt = (unsigned short int*)&args.messageBuffer[sizeof(PACKET_HEADER_SET_VOXEL_DESTRUCTIVE)]; + + int numBytesPacketHeader = populateTypeAndVersion(args.messageBuffer, PACKET_TYPE_SET_VOXEL_DESTRUCTIVE); + + unsigned short int* sequenceAt = (unsigned short int*)&args.messageBuffer[numBytesPacketHeader]; *sequenceAt = 0; - args.bufferInUse = sizeof(PACKET_HEADER_SET_VOXEL_DESTRUCTIVE) + sizeof(unsigned short int); // set to command + sequence + args.bufferInUse = numBytesPacketHeader + sizeof(unsigned short int); // set to command + sequence // we only need the selected voxel to get the newBaseOctCode, which we can actually calculate from the // voxel size/position details. @@ -1426,7 +1434,7 @@ void Application::importVoxels() { importVoxels.recurseTreeWithOperation(sendVoxelsOperation, &args); // If we have voxels left in the packet, then send the packet - if (args.bufferInUse > (sizeof(PACKET_HEADER_SET_VOXEL_DESTRUCTIVE) + sizeof(unsigned short int))) { + if (args.bufferInUse > (numBytesPacketHeader + sizeof(unsigned short int))) { controlledBroadcastToNodes(args.messageBuffer, args.bufferInUse, & NODE_TYPE_VOXEL_SERVER, 1); } @@ -1461,10 +1469,12 @@ void Application::pasteVoxels() { // Recurse the clipboard tree, where everything is root relative, and send all the colored voxels to // the server as an set voxel message, this will also rebase the voxels to the new location SendVoxelsOperationArgs args; - args.messageBuffer[0] = PACKET_HEADER_SET_VOXEL_DESTRUCTIVE; - unsigned short int* sequenceAt = (unsigned short int*)&args.messageBuffer[sizeof(PACKET_HEADER_SET_VOXEL_DESTRUCTIVE)]; + + int numBytesPacketHeader = populateTypeAndVersion(args.messageBuffer, PACKET_TYPE_SET_VOXEL_DESTRUCTIVE); + + unsigned short int* sequenceAt = (unsigned short int*)&args.messageBuffer[numBytesPacketHeader]; *sequenceAt = 0; - args.bufferInUse = sizeof(PACKET_HEADER_SET_VOXEL_DESTRUCTIVE) + sizeof(unsigned short int); // set to command + sequence + args.bufferInUse = numBytesPacketHeader + sizeof(unsigned short int); // set to command + sequence // we only need the selected voxel to get the newBaseOctCode, which we can actually calculate from the // voxel size/position details. If we don't have an actual selectedNode then use the mouseVoxel to create a @@ -1478,7 +1488,7 @@ void Application::pasteVoxels() { _clipboardTree.recurseTreeWithOperation(sendVoxelsOperation, &args); // If we have voxels left in the packet, then send the packet - if (args.bufferInUse > (sizeof(PACKET_HEADER_SET_VOXEL_DESTRUCTIVE) + sizeof(unsigned short int))) { + if (args.bufferInUse > (numBytesPacketHeader + sizeof(unsigned short int))) { controlledBroadcastToNodes(args.messageBuffer, args.bufferInUse, & NODE_TYPE_VOXEL_SERVER, 1); } @@ -2069,7 +2079,8 @@ void Application::updateAvatar(float deltaTime) { unsigned char broadcastString[200]; unsigned char* endOfBroadcastStringWrite = broadcastString; - *(endOfBroadcastStringWrite++) = PACKET_HEADER_HEAD_DATA; + endOfBroadcastStringWrite += populateTypeAndVersion(endOfBroadcastStringWrite, PACKET_TYPE_HEAD_DATA); + endOfBroadcastStringWrite += packNodeId(endOfBroadcastStringWrite, nodeList->getOwnerID()); endOfBroadcastStringWrite += _myAvatar.getBroadcastData(endOfBroadcastStringWrite); @@ -2099,8 +2110,8 @@ void Application::updateAvatar(float deltaTime) { _paintingVoxel.y >= 0.0 && _paintingVoxel.y <= 1.0 && _paintingVoxel.z >= 0.0 && _paintingVoxel.z <= 1.0) { - PACKET_HEADER message = (_destructiveAddVoxel->isChecked() ? - PACKET_HEADER_SET_VOXEL_DESTRUCTIVE : PACKET_HEADER_SET_VOXEL); + PACKET_TYPE message = (_destructiveAddVoxel->isChecked() ? + PACKET_TYPE_SET_VOXEL_DESTRUCTIVE : PACKET_TYPE_SET_VOXEL); sendVoxelEditMessage(message, _paintingVoxel); } } @@ -2982,8 +2993,8 @@ void Application::shiftPaintingColor() { void Application::maybeEditVoxelUnderCursor() { if (_addVoxelMode->isChecked() || _colorVoxelMode->isChecked()) { if (_mouseVoxel.s != 0) { - PACKET_HEADER message = (_destructiveAddVoxel->isChecked() ? - PACKET_HEADER_SET_VOXEL_DESTRUCTIVE : PACKET_HEADER_SET_VOXEL); + PACKET_TYPE message = (_destructiveAddVoxel->isChecked() ? + PACKET_TYPE_SET_VOXEL_DESTRUCTIVE : PACKET_TYPE_SET_VOXEL); sendVoxelEditMessage(message, _mouseVoxel); // create the voxel locally so it appears immediately @@ -3056,7 +3067,7 @@ void Application::maybeEditVoxelUnderCursor() { void Application::deleteVoxelUnderCursor() { if (_mouseVoxel.s != 0) { // sending delete to the server is sufficient, server will send new version so we see updates soon enough - sendVoxelEditMessage(PACKET_HEADER_ERASE_VOXEL, _mouseVoxel); + sendVoxelEditMessage(PACKET_TYPE_ERASE_VOXEL, _mouseVoxel); AudioInjector* voxelInjector = AudioInjectionManager::injectorWithCapacity(5000); voxelInjector->setPosition(glm::vec3(_mouseVoxel.x, _mouseVoxel.y, _mouseVoxel.z)); // voxelInjector->setBearing(0); //straight down the z axis @@ -3166,36 +3177,39 @@ void* Application::networkReceive(void* args) { app->_packetCount++; app->_bytesCount += bytesReceived; - switch (app->_incomingPacket[0]) { - case PACKET_HEADER_TRANSMITTER_DATA_V2: - // V2 = IOS transmitter app - app->_myTransmitter.processIncomingData(app->_incomingPacket, bytesReceived); - - break; - case PACKET_HEADER_MIXED_AUDIO: - app->_audio.addReceivedAudioToBuffer(app->_incomingPacket, bytesReceived); - break; - case PACKET_HEADER_VOXEL_DATA: - case PACKET_HEADER_VOXEL_DATA_MONOCHROME: - case PACKET_HEADER_Z_COMMAND: - case PACKET_HEADER_ERASE_VOXEL: - app->_voxels.parseData(app->_incomingPacket, bytesReceived); - break; - case PACKET_HEADER_ENVIRONMENT_DATA: - app->_environment.parseData(&senderAddress, app->_incomingPacket, bytesReceived); - break; - case PACKET_HEADER_BULK_AVATAR_DATA: - NodeList::getInstance()->processBulkNodeData(&senderAddress, - app->_incomingPacket, - bytesReceived); - getInstance()->_bandwidthMeter.inputStream(BandwidthMeter::AVATARS).updateValue(bytesReceived); - break; - case PACKET_HEADER_AVATAR_VOXEL_URL: - processAvatarVoxelURLMessage(app->_incomingPacket, bytesReceived); - break; - default: - NodeList::getInstance()->processNodeData(&senderAddress, app->_incomingPacket, bytesReceived); - break; + if (packetVersionMatch(app->_incomingPacket)) { + // only process this packet if we have a match on the packet version + switch (app->_incomingPacket[0]) { + case PACKET_TYPE_TRANSMITTER_DATA_V2: + // V2 = IOS transmitter app + app->_myTransmitter.processIncomingData(app->_incomingPacket, bytesReceived); + + break; + case PACKET_TYPE_MIXED_AUDIO: + app->_audio.addReceivedAudioToBuffer(app->_incomingPacket, bytesReceived); + break; + case PACKET_TYPE_VOXEL_DATA: + case PACKET_TYPE_VOXEL_DATA_MONOCHROME: + case PACKET_TYPE_Z_COMMAND: + case PACKET_TYPE_ERASE_VOXEL: + app->_voxels.parseData(app->_incomingPacket, bytesReceived); + break; + case PACKET_TYPE_ENVIRONMENT_DATA: + app->_environment.parseData(&senderAddress, app->_incomingPacket, bytesReceived); + break; + case PACKET_TYPE_BULK_AVATAR_DATA: + NodeList::getInstance()->processBulkNodeData(&senderAddress, + app->_incomingPacket, + bytesReceived); + getInstance()->_bandwidthMeter.inputStream(BandwidthMeter::AVATARS).updateValue(bytesReceived); + break; + case PACKET_TYPE_AVATAR_VOXEL_URL: + processAvatarVoxelURLMessage(app->_incomingPacket, bytesReceived); + break; + default: + NodeList::getInstance()->processNodeData(&senderAddress, app->_incomingPacket, bytesReceived); + break; + } } } else if (!app->_enableNetworkThread) { break; diff --git a/interface/src/Application.h b/interface/src/Application.h index e6f0abecfa..0d7478619e 100644 --- a/interface/src/Application.h +++ b/interface/src/Application.h @@ -170,7 +170,7 @@ private: static void sendVoxelServerAddScene(); static bool sendVoxelsOperation(VoxelNode* node, void* extraData); - static void sendVoxelEditMessage(PACKET_HEADER header, VoxelDetail& detail); + static void sendVoxelEditMessage(PACKET_TYPE type, VoxelDetail& detail); static void sendAvatarVoxelURLMessage(const QUrl& url); static void processAvatarVoxelURLMessage(unsigned char *packetData, size_t dataBytes); static void sendPingPackets(); diff --git a/interface/src/Audio.cpp b/interface/src/Audio.cpp index dc303f8d4b..7a480cff57 100644 --- a/interface/src/Audio.cpp +++ b/interface/src/Audio.cpp @@ -99,16 +99,18 @@ inline void Audio::performIO(int16_t* inputLeft, int16_t* outputLeft, int16_t* o glm::vec3 headPosition = interfaceAvatar->getHeadJointPosition(); glm::quat headOrientation = interfaceAvatar->getHead().getOrientation(); - int leadingBytes = sizeof(PACKET_HEADER_MICROPHONE_AUDIO_NO_ECHO) + sizeof(headPosition) + sizeof(headOrientation); + int numBytesPacketHeader = numBytesForPacketHeader((unsigned char*) &PACKET_TYPE_MICROPHONE_AUDIO_NO_ECHO); + int leadingBytes = numBytesPacketHeader + sizeof(headPosition) + sizeof(headOrientation); // we need the amount of bytes in the buffer + 1 for type // + 12 for 3 floats for position + float for bearing + 1 attenuation byte unsigned char dataPacket[BUFFER_LENGTH_BYTES_PER_CHANNEL + leadingBytes]; - dataPacket[0] = (Application::getInstance()->shouldEchoAudio()) - ? PACKET_HEADER_MICROPHONE_AUDIO_WITH_ECHO - : PACKET_HEADER_MICROPHONE_AUDIO_NO_ECHO; - unsigned char *currentPacketPtr = dataPacket + 1; + PACKET_TYPE packetType = (Application::getInstance()->shouldEchoAudio()) + ? PACKET_TYPE_MICROPHONE_AUDIO_WITH_ECHO + : PACKET_TYPE_MICROPHONE_AUDIO_NO_ECHO; + + unsigned char* currentPacketPtr = dataPacket + populateTypeAndVersion(dataPacket, packetType); // memcpy the three float positions memcpy(currentPacketPtr, &headPosition, sizeof(headPosition)); @@ -446,10 +448,10 @@ void Audio::addReceivedAudioToBuffer(unsigned char* receivedData, int receivedBy //printf("Got audio packet %d\n", _packetsReceivedThisPlayback); - _ringBuffer.parseData((unsigned char*) receivedData, PACKET_LENGTH_BYTES + sizeof(PACKET_HEADER)); + _ringBuffer.parseData((unsigned char*) receivedData, PACKET_LENGTH_BYTES + sizeof(PACKET_TYPE)); Application::getInstance()->getBandwidthMeter()->inputStream(BandwidthMeter::AUDIO) - .updateValue(PACKET_LENGTH_BYTES + sizeof(PACKET_HEADER)); + .updateValue(PACKET_LENGTH_BYTES + sizeof(PACKET_TYPE)); _lastReceiveTime = currentReceiveTime; } diff --git a/interface/src/Environment.cpp b/interface/src/Environment.cpp index d087281569..35ed121e38 100644 --- a/interface/src/Environment.cpp +++ b/interface/src/Environment.cpp @@ -10,6 +10,7 @@ #include #include +#include #include #include "Camera.h" @@ -138,8 +139,10 @@ bool Environment::findCapsulePenetration(const glm::vec3& start, const glm::vec3 int Environment::parseData(sockaddr *senderAddress, unsigned char* sourceBuffer, int numBytes) { // push past the packet header unsigned char* start = sourceBuffer; - sourceBuffer++; - numBytes--; + + int numBytesPacketHeader = numBytesForPacketHeader(sourceBuffer); + sourceBuffer += numBytesPacketHeader; + numBytes -= numBytesPacketHeader; // get the lock for the duration of the call QMutexLocker locker(&_mutex); diff --git a/interface/src/Transmitter.cpp b/interface/src/Transmitter.cpp index 8cbb4a5c29..b16fb79295 100644 --- a/interface/src/Transmitter.cpp +++ b/interface/src/Transmitter.cpp @@ -3,15 +3,20 @@ // hifi // // Created by Philip Rosedale on 5/20/13. -// +// Copyright (c) 2013 HighFidelity, Inc. All rights reserved. // -#include "Transmitter.h" -#include "InterfaceConfig.h" -#include "Util.h" #include + #include + +#include + +#include "InterfaceConfig.h" #include "Log.h" +#include "Transmitter.h" +#include "Util.h" + const float DELTA_TIME = 1.f / 60.f; const float DECAY_RATE = 0.15f; @@ -45,7 +50,9 @@ void Transmitter::resetLevels() { } void Transmitter::processIncomingData(unsigned char* packetData, int numBytes) { - const int PACKET_HEADER_SIZE = 1; // Packet's first byte is 'T' + // Packet's first byte is 'T' + int numBytesPacketHeader = numBytesForPacketHeader(packetData); + const int ROTATION_MARKER_SIZE = 1; // 'R' = Rotation (clockwise about x,y,z) const int ACCELERATION_MARKER_SIZE = 1; // 'A' = Acceleration (x,y,z) if (!_lastReceivedPacket) { @@ -53,10 +60,10 @@ void Transmitter::processIncomingData(unsigned char* packetData, int numBytes) { } gettimeofday(_lastReceivedPacket, NULL); - if (numBytes == PACKET_HEADER_SIZE + ROTATION_MARKER_SIZE + ACCELERATION_MARKER_SIZE + if (numBytes == numBytesPacketHeader + ROTATION_MARKER_SIZE + ACCELERATION_MARKER_SIZE + sizeof(_lastRotationRate) + sizeof(_lastAcceleration) + sizeof(_touchState.x) + sizeof(_touchState.y) + sizeof(_touchState.state)) { - unsigned char* packetDataPosition = &packetData[PACKET_HEADER_SIZE + ROTATION_MARKER_SIZE]; + unsigned char* packetDataPosition = packetData + numBytesPacketHeader + ROTATION_MARKER_SIZE; memcpy(&_lastRotationRate, packetDataPosition, sizeof(_lastRotationRate)); packetDataPosition += sizeof(_lastRotationRate) + ACCELERATION_MARKER_SIZE; memcpy(&_lastAcceleration, packetDataPosition, sizeof(_lastAcceleration)); diff --git a/interface/src/Transmitter.h b/interface/src/Transmitter.h index 95d80249e8..27426e1d27 100644 --- a/interface/src/Transmitter.h +++ b/interface/src/Transmitter.h @@ -3,7 +3,7 @@ // hifi // // Created by Philip Rosedale on 5/20/13. -// +// Copyright (c) 2013 HighFidelity, Inc. All rights reserved. // #ifndef __hifi__Transmitter__ diff --git a/interface/src/VoxelSystem.cpp b/interface/src/VoxelSystem.cpp index 8c7cc40514..05180ebca4 100644 --- a/interface/src/VoxelSystem.cpp +++ b/interface/src/VoxelSystem.cpp @@ -113,32 +113,31 @@ float VoxelSystem::getVoxelsBytesReadPerSecondAverage() { int VoxelSystem::parseData(unsigned char* sourceBuffer, int numBytes) { unsigned char command = *sourceBuffer; - unsigned char *voxelData = sourceBuffer + 1; + int numBytesPacketHeader = numBytesForPacketHeader(sourceBuffer); + unsigned char* voxelData = sourceBuffer + numBytesPacketHeader; pthread_mutex_lock(&_treeLock); switch(command) { - case PACKET_HEADER_VOXEL_DATA: - { + case PACKET_TYPE_VOXEL_DATA: { PerformanceWarning warn(_renderWarningsOn, "readBitstreamToTree()"); // ask the VoxelTree to read the bitstream into the tree - _tree->readBitstreamToTree(voxelData, numBytes - 1, WANT_COLOR, WANT_EXISTS_BITS); + _tree->readBitstreamToTree(voxelData, numBytes - numBytesPacketHeader, WANT_COLOR, WANT_EXISTS_BITS); } - break; - case PACKET_HEADER_VOXEL_DATA_MONOCHROME: - { + break; + case PACKET_TYPE_VOXEL_DATA_MONOCHROME: { PerformanceWarning warn(_renderWarningsOn, "readBitstreamToTree()"); // ask the VoxelTree to read the MONOCHROME bitstream into the tree - _tree->readBitstreamToTree(voxelData, numBytes - 1, NO_COLOR, WANT_EXISTS_BITS); + _tree->readBitstreamToTree(voxelData, numBytes - numBytesPacketHeader, NO_COLOR, WANT_EXISTS_BITS); } - break; - case PACKET_HEADER_Z_COMMAND: + break; + case PACKET_TYPE_Z_COMMAND: // the Z command is a special command that allows the sender to send high level semantic // requests, like erase all, or add sphere scene, different receivers may handle these // messages differently char* packetData = (char *)sourceBuffer; - char* command = &packetData[1]; // start of the command + char* command = &packetData[numBytesPacketHeader]; // start of the command int commandLength = strlen(command); // commands are null terminated strings int totalLength = 1+commandLength+1; diff --git a/libraries/audio/src/AudioInjector.cpp b/libraries/audio/src/AudioInjector.cpp index d97ea8abdd..a2ba56b8ef 100644 --- a/libraries/audio/src/AudioInjector.cpp +++ b/libraries/audio/src/AudioInjector.cpp @@ -70,7 +70,7 @@ void AudioInjector::injectAudio(UDPSocket* injectorSocket, sockaddr* destination timeval startTime; // calculate the number of bytes required for additional data - int leadingBytes = sizeof(PACKET_HEADER) + int leadingBytes = numBytesForPacketHeader((unsigned char*) &PACKET_TYPE_INJECT_AUDIO) + sizeof(_streamIdentifier) + sizeof(_position) + sizeof(_orientation) @@ -79,8 +79,7 @@ void AudioInjector::injectAudio(UDPSocket* injectorSocket, sockaddr* destination unsigned char dataPacket[(BUFFER_LENGTH_SAMPLES_PER_CHANNEL * sizeof(int16_t)) + leadingBytes]; - dataPacket[0] = PACKET_HEADER_INJECT_AUDIO; - unsigned char *currentPacketPtr = dataPacket + sizeof(PACKET_HEADER_INJECT_AUDIO); + unsigned char* currentPacketPtr = dataPacket + populateTypeAndVersion(dataPacket, PACKET_TYPE_INJECT_AUDIO); // copy the identifier for this injector memcpy(currentPacketPtr, &_streamIdentifier, sizeof(_streamIdentifier)); diff --git a/libraries/audio/src/AudioRingBuffer.cpp b/libraries/audio/src/AudioRingBuffer.cpp index 79e94e625d..d5830ee72f 100644 --- a/libraries/audio/src/AudioRingBuffer.cpp +++ b/libraries/audio/src/AudioRingBuffer.cpp @@ -34,7 +34,8 @@ void AudioRingBuffer::reset() { } int AudioRingBuffer::parseData(unsigned char* sourceBuffer, int numBytes) { - return parseAudioSamples(sourceBuffer + sizeof(PACKET_HEADER_MIXED_AUDIO), numBytes - sizeof(PACKET_HEADER_MIXED_AUDIO)); + int numBytesPacketHeader = numBytesForPacketHeader(sourceBuffer); + return parseAudioSamples(sourceBuffer + numBytesPacketHeader, numBytes - numBytesPacketHeader); } int AudioRingBuffer::parseAudioSamples(unsigned char* sourceBuffer, int numBytes) { diff --git a/libraries/avatars/src/AvatarData.cpp b/libraries/avatars/src/AvatarData.cpp index 997d528a5e..09c133989e 100755 --- a/libraries/avatars/src/AvatarData.cpp +++ b/libraries/avatars/src/AvatarData.cpp @@ -174,7 +174,8 @@ int AvatarData::parseData(unsigned char* sourceBuffer, int numBytes) { } // increment to push past the packet header - sourceBuffer += sizeof(PACKET_HEADER_HEAD_DATA); + int numBytesPacketHeader = numBytesForPacketHeader(sourceBuffer); + sourceBuffer += numBytesPacketHeader; unsigned char* startPosition = sourceBuffer; diff --git a/libraries/shared/src/NodeList.cpp b/libraries/shared/src/NodeList.cpp index 75fa0ed1d9..35632d4511 100644 --- a/libraries/shared/src/NodeList.cpp +++ b/libraries/shared/src/NodeList.cpp @@ -72,7 +72,6 @@ NodeList::~NodeList() { // stop the spawned threads, if they were started stopSilentNodeRemovalThread(); - stopPingUnknownNodesThread(); pthread_mutex_destroy(&mutex); } @@ -81,27 +80,29 @@ void NodeList::timePingReply(sockaddr *nodeAddress, unsigned char *packetData) { for(NodeList::iterator node = begin(); node != end(); node++) { if (socketMatch(node->getPublicSocket(), nodeAddress) || socketMatch(node->getLocalSocket(), nodeAddress)) { - int pingTime = usecTimestampNow() - *(uint64_t *)(packetData + 1); + + int pingTime = usecTimestampNow() - *(uint64_t*)(packetData + numBytesForPacketHeader(packetData)); + node->setPingMs(pingTime / 1000); break; } } } -void NodeList::processNodeData(sockaddr *senderAddress, unsigned char *packetData, size_t dataBytes) { - switch (((char *)packetData)[0]) { - case PACKET_HEADER_DOMAIN: { +void NodeList::processNodeData(sockaddr* senderAddress, unsigned char* packetData, size_t dataBytes) { + switch (packetData[0]) { + case PACKET_TYPE_DOMAIN: { processDomainServerList(packetData, dataBytes); break; } - case PACKET_HEADER_PING: { + case PACKET_TYPE_PING: { char pingPacket[dataBytes]; memcpy(pingPacket, packetData, dataBytes); - pingPacket[0] = PACKET_HEADER_PING_REPLY; + populateTypeAndVersion((unsigned char*) pingPacket, PACKET_TYPE_PING_REPLY); _nodeSocket.send(senderAddress, pingPacket, dataBytes); break; } - case PACKET_HEADER_PING_REPLY: { + case PACKET_TYPE_PING_REPLY: { timePingReply(senderAddress, packetData); break; } @@ -118,18 +119,23 @@ void NodeList::processBulkNodeData(sockaddr *senderAddress, unsigned char *packe bulkSendNode->setLastHeardMicrostamp(usecTimestampNow()); bulkSendNode->recordBytesReceived(numTotalBytes); } - + + int numBytesPacketHeader = numBytesForPacketHeader(packetData); + unsigned char *startPosition = packetData; - unsigned char *currentPosition = startPosition + 1; + unsigned char *currentPosition = startPosition + numBytesPacketHeader; unsigned char packetHolder[numTotalBytes]; - packetHolder[0] = PACKET_HEADER_HEAD_DATA; + // we've already verified packet version for the bulk packet, so all head data in the packet is also up to date + populateTypeAndVersion(packetHolder, PACKET_TYPE_HEAD_DATA); uint16_t nodeID = -1; while ((currentPosition - startPosition) < numTotalBytes) { unpackNodeId(currentPosition, &nodeID); - memcpy(packetHolder + 1, currentPosition, numTotalBytes - (currentPosition - startPosition)); + memcpy(packetHolder + numBytesPacketHeader, + currentPosition, + numTotalBytes - (currentPosition - startPosition)); Node* matchingNode = nodeWithID(nodeID); @@ -139,8 +145,8 @@ void NodeList::processBulkNodeData(sockaddr *senderAddress, unsigned char *packe } currentPosition += updateNodeWithData(matchingNode, - packetHolder, - numTotalBytes - (currentPosition - startPosition)); + packetHolder, + numTotalBytes - (currentPosition - startPosition)); } unlock(); @@ -232,23 +238,29 @@ void NodeList::sendDomainServerCheckIn() { // construct the DS check in packet if we need to static unsigned char* checkInPacket = NULL; static int checkInPacketSize; + + const int IP_ADDRESS_BYTES = 4; if (!checkInPacket) { int numBytesNodesOfInterest = _nodeTypesOfInterest ? strlen((char*) _nodeTypesOfInterest) : 0; // check in packet has header, node type, port, IP, node types of interest, null termination - int numPacketBytes = sizeof(PACKET_HEADER) + sizeof(NODE_TYPE) + sizeof(uint16_t) + (sizeof(char) * 4) + - numBytesNodesOfInterest + sizeof(unsigned char); + int numPacketBytes = sizeof(PACKET_TYPE) + sizeof(PACKET_VERSION) + sizeof(NODE_TYPE) + sizeof(uint16_t) + + IP_ADDRESS_BYTES + numBytesNodesOfInterest + sizeof(unsigned char); checkInPacket = new unsigned char[numPacketBytes]; unsigned char* packetPosition = checkInPacket; - *(packetPosition++) = (memchr(SOLO_NODE_TYPES, _ownerType, sizeof(SOLO_NODE_TYPES))) - ? PACKET_HEADER_DOMAIN_REPORT_FOR_DUTY - : PACKET_HEADER_DOMAIN_LIST_REQUEST; + PACKET_TYPE nodePacketType = (memchr(SOLO_NODE_TYPES, _ownerType, sizeof(SOLO_NODE_TYPES))) + ? PACKET_TYPE_DOMAIN_REPORT_FOR_DUTY + : PACKET_TYPE_DOMAIN_LIST_REQUEST; + + int numHeaderBytes = populateTypeAndVersion(packetPosition, nodePacketType); + packetPosition += numHeaderBytes; + *(packetPosition++) = _ownerType; - packetPosition += packSocket(checkInPacket + sizeof(PACKET_HEADER) + sizeof(NODE_TYPE), + packetPosition += packSocket(checkInPacket + numHeaderBytes + sizeof(NODE_TYPE), getLocalAddress(), htons(_nodeSocket.getListeningPort())); @@ -269,7 +281,7 @@ void NodeList::sendDomainServerCheckIn() { _nodeSocket.send(DOMAIN_IP, DOMAINSERVER_PORT, checkInPacket, checkInPacketSize); } -int NodeList::processDomainServerList(unsigned char *packetData, size_t dataBytes) { +int NodeList::processDomainServerList(unsigned char* packetData, size_t dataBytes) { int readNodes = 0; char nodeType; @@ -281,16 +293,16 @@ int NodeList::processDomainServerList(unsigned char *packetData, size_t dataByte sockaddr_in nodeLocalSocket; nodeLocalSocket.sin_family = AF_INET; - unsigned char *readPtr = packetData + 1; - unsigned char *startPtr = packetData; + unsigned char* readPtr = packetData + numBytesForPacketHeader(packetData); + unsigned char* startPtr = packetData; while((readPtr - startPtr) < dataBytes - sizeof(uint16_t)) { nodeType = *readPtr++; - readPtr += unpackNodeId(readPtr, (uint16_t *)&nodeId); - readPtr += unpackSocket(readPtr, (sockaddr *)&nodePublicSocket); - readPtr += unpackSocket(readPtr, (sockaddr *)&nodeLocalSocket); + readPtr += unpackNodeId(readPtr, (uint16_t*) &nodeId); + readPtr += unpackSocket(readPtr, (sockaddr*) &nodePublicSocket); + readPtr += unpackSocket(readPtr, (sockaddr*) &nodeLocalSocket); - addOrUpdateNode((sockaddr *)&nodePublicSocket, (sockaddr *)&nodeLocalSocket, nodeType, nodeId); + addOrUpdateNode((sockaddr*) &nodePublicSocket, (sockaddr*) &nodeLocalSocket, nodeType, nodeId); } // read out our ID from the packet @@ -401,46 +413,6 @@ Node* NodeList::soloNodeOfType(char nodeType) { return NULL; } -void *pingUnknownNodes(void *args) { - - NodeList* nodeList = (NodeList*) args; - const int PING_INTERVAL_USECS = 1 * 1000000; - - timeval lastSend; - - while (!pingUnknownNodeThreadStopFlag) { - gettimeofday(&lastSend, NULL); - - for(NodeList::iterator node = nodeList->begin(); - node != nodeList->end(); - node++) { - if (!node->getActiveSocket() && node->getPublicSocket() && node->getLocalSocket()) { - // ping both of the sockets for the node so we can figure out - // which socket we can use - nodeList->getNodeSocket()->send(node->getPublicSocket(), &PACKET_HEADER_PING, 1); - nodeList->getNodeSocket()->send(node->getLocalSocket(), &PACKET_HEADER_PING, 1); - } - } - - int usecToSleep = PING_INTERVAL_USECS - (usecTimestampNow() - usecTimestamp(&lastSend)); - - if (usecToSleep > 0) { - usleep(usecToSleep); - } - } - - return NULL; -} - -void NodeList::startPingUnknownNodesThread() { - pthread_create(&pingUnknownNodesThread, NULL, pingUnknownNodes, (void *)this); -} - -void NodeList::stopPingUnknownNodesThread() { - pingUnknownNodeThreadStopFlag = true; - pthread_join(pingUnknownNodesThread, NULL); -} - void *removeSilentNodes(void *args) { NodeList* nodeList = (NodeList*) args; uint64_t checkTimeUSecs; diff --git a/libraries/shared/src/NodeList.h b/libraries/shared/src/NodeList.h index b1f7acdbb3..da9c4a556a 100644 --- a/libraries/shared/src/NodeList.h +++ b/libraries/shared/src/NodeList.h @@ -89,8 +89,6 @@ public: void startSilentNodeRemovalThread(); void stopSilentNodeRemovalThread(); - void startPingUnknownNodesThread(); - void stopPingUnknownNodesThread(); friend class NodeListIterator; private: @@ -113,7 +111,6 @@ private: uint16_t _lastNodeID; pthread_t removeSilentNodesThread; pthread_t checkInWithDomainServerThread; - pthread_t pingUnknownNodesThread; pthread_mutex_t mutex; void handlePingReply(sockaddr *nodeAddress); diff --git a/libraries/shared/src/PacketHeaders.cpp b/libraries/shared/src/PacketHeaders.cpp new file mode 100644 index 0000000000..9f8314e0b7 --- /dev/null +++ b/libraries/shared/src/PacketHeaders.cpp @@ -0,0 +1,62 @@ +// +// PacketHeaders.cpp +// hifi +// +// Created by Stephen Birarda on 6/28/13. +// Copyright (c) 2013 HighFidelity, Inc. All rights reserved. +// + +#include + +#include "PacketHeaders.h" + +PACKET_VERSION versionForPacketType(PACKET_TYPE type) { + switch (type) { + default: + return 0; + break; + } +} + +bool packetVersionMatch(unsigned char* packetHeader) { + // currently this just checks if the version in the packet matches our return from versionForPacketType + // may need to be expanded in the future for types and versions that take > than 1 byte + if (packetHeader[1] == versionForPacketType(packetHeader[0])) { + return true; + } else { + printf("There is a packet version mismatch for packet with header %c\n", packetHeader[0]); + return false; + } +} + +int populateTypeAndVersion(unsigned char* destinationHeader, PACKET_TYPE type) { + destinationHeader[0] = type; + destinationHeader[1] = versionForPacketType(type); + + // return the number of bytes written for pointer pushing + return 2; +} + +int numBytesForPacketType(const unsigned char* packetType) { + if (packetType[0] == 255) { + return 1 + numBytesForPacketType(packetType + 1); + } else { + return 1; + } +} + +int numBytesForPacketVersion(const unsigned char* packetVersion) { + if (packetVersion[0] == 255) { + return 1 + numBytesForPacketVersion(packetVersion + 1); + } else { + return 1; + } +} + +int numBytesForPacketHeader(unsigned char* packetHeader) { + // int numBytesType = numBytesForPacketType(packetHeader); + // return numBytesType + numBytesForPacketVersion(packetHeader + numBytesType); + + // currently this need not be dynamic - there are 2 bytes for each packet header + return 2; +} \ No newline at end of file diff --git a/libraries/shared/src/PacketHeaders.h b/libraries/shared/src/PacketHeaders.h index 89f6fbaf54..041303f2b5 100644 --- a/libraries/shared/src/PacketHeaders.h +++ b/libraries/shared/src/PacketHeaders.h @@ -12,28 +12,38 @@ #ifndef hifi_PacketHeaders_h #define hifi_PacketHeaders_h -typedef char PACKET_HEADER; -const PACKET_HEADER PACKET_HEADER_DOMAIN = 'D'; -const PACKET_HEADER PACKET_HEADER_PING = 'P'; -const PACKET_HEADER PACKET_HEADER_PING_REPLY = 'R'; -const PACKET_HEADER PACKET_HEADER_HEAD_DATA = 'H'; -const PACKET_HEADER PACKET_HEADER_Z_COMMAND = 'Z'; -const PACKET_HEADER PACKET_HEADER_INJECT_AUDIO = 'I'; -const PACKET_HEADER PACKET_HEADER_MIXED_AUDIO = 'A'; -const PACKET_HEADER PACKET_HEADER_MICROPHONE_AUDIO_NO_ECHO = 'M'; -const PACKET_HEADER PACKET_HEADER_MICROPHONE_AUDIO_WITH_ECHO = 'm'; -const PACKET_HEADER PACKET_HEADER_SET_VOXEL = 'S'; -const PACKET_HEADER PACKET_HEADER_SET_VOXEL_DESTRUCTIVE = 'O'; -const PACKET_HEADER PACKET_HEADER_ERASE_VOXEL = 'E'; -const PACKET_HEADER PACKET_HEADER_VOXEL_DATA = 'V'; -const PACKET_HEADER PACKET_HEADER_VOXEL_DATA_MONOCHROME = 'v'; -const PACKET_HEADER PACKET_HEADER_BULK_AVATAR_DATA = 'X'; -const PACKET_HEADER PACKET_HEADER_AVATAR_VOXEL_URL = 'U'; -const PACKET_HEADER PACKET_HEADER_TRANSMITTER_DATA_V2 = 'T'; -const PACKET_HEADER PACKET_HEADER_ENVIRONMENT_DATA = 'e'; -const PACKET_HEADER PACKET_HEADER_DOMAIN_LIST_REQUEST = 'L'; -const PACKET_HEADER PACKET_HEADER_DOMAIN_REPORT_FOR_DUTY = 'C'; +typedef char PACKET_TYPE; +const PACKET_TYPE PACKET_TYPE_DOMAIN = 'D'; +const PACKET_TYPE PACKET_TYPE_PING = 'P'; +const PACKET_TYPE PACKET_TYPE_PING_REPLY = 'R'; +const PACKET_TYPE PACKET_TYPE_HEAD_DATA = 'H'; +const PACKET_TYPE PACKET_TYPE_Z_COMMAND = 'Z'; +const PACKET_TYPE PACKET_TYPE_INJECT_AUDIO = 'I'; +const PACKET_TYPE PACKET_TYPE_MIXED_AUDIO = 'A'; +const PACKET_TYPE PACKET_TYPE_MICROPHONE_AUDIO_NO_ECHO = 'M'; +const PACKET_TYPE PACKET_TYPE_MICROPHONE_AUDIO_WITH_ECHO = 'm'; +const PACKET_TYPE PACKET_TYPE_SET_VOXEL = 'S'; +const PACKET_TYPE PACKET_TYPE_SET_VOXEL_DESTRUCTIVE = 'O'; +const PACKET_TYPE PACKET_TYPE_ERASE_VOXEL = 'E'; +const PACKET_TYPE PACKET_TYPE_VOXEL_DATA = 'V'; +const PACKET_TYPE PACKET_TYPE_VOXEL_DATA_MONOCHROME = 'v'; +const PACKET_TYPE PACKET_TYPE_BULK_AVATAR_DATA = 'X'; +const PACKET_TYPE PACKET_TYPE_AVATAR_VOXEL_URL = 'U'; +const PACKET_TYPE PACKET_TYPE_TRANSMITTER_DATA_V2 = 'T'; +const PACKET_TYPE PACKET_TYPE_ENVIRONMENT_DATA = 'e'; +const PACKET_TYPE PACKET_TYPE_DOMAIN_LIST_REQUEST = 'L'; +const PACKET_TYPE PACKET_TYPE_DOMAIN_REPORT_FOR_DUTY = 'C'; +typedef char PACKET_VERSION; + +PACKET_VERSION versionForPacketType(PACKET_TYPE type); + +bool packetVersionMatch(unsigned char* packetHeader); + +int populateTypeAndVersion(unsigned char* destinationHeader, PACKET_TYPE type); +int numBytesForPacketHeader(unsigned char* packetHeader); + +const int MAX_PACKET_HEADER_BYTES = sizeof(PACKET_TYPE) + sizeof(PACKET_VERSION); // These are supported Z-Command #define ERASE_ALL_COMMAND "erase all" diff --git a/libraries/shared/src/SharedUtil.cpp b/libraries/shared/src/SharedUtil.cpp index a32b567f34..3fa7295d90 100644 --- a/libraries/shared/src/SharedUtil.cpp +++ b/libraries/shared/src/SharedUtil.cpp @@ -11,17 +11,20 @@ #include #include #include + #ifdef _WIN32 #include "Syssocket.h" #endif -#include "Log.h" -#include "SharedUtil.h" -#include "OctalCode.h" #ifdef __APPLE__ #include #endif +#include "Log.h" +#include "OctalCode.h" +#include "PacketHeaders.h" +#include "SharedUtil.h" + uint64_t usecTimestamp(timeval *time) { return (time->tv_sec * 1000000 + time->tv_usec); } @@ -209,13 +212,14 @@ bool createVoxelEditMessage(unsigned char command, short int sequence, int messageSize = MAXIMUM_EDIT_VOXEL_MESSAGE_SIZE; // just a guess for now int actualMessageSize = 3; unsigned char* messageBuffer = new unsigned char[messageSize]; - unsigned short int* sequenceAt = (unsigned short int*)&messageBuffer[1]; - messageBuffer[0]=command; - *sequenceAt=sequence; - unsigned char* copyAt = &messageBuffer[3]; + int numBytesPacketHeader = populateTypeAndVersion(messageBuffer, command); + unsigned short int* sequenceAt = (unsigned short int*) &messageBuffer[numBytesPacketHeader]; + + *sequenceAt = sequence; + unsigned char* copyAt = &messageBuffer[numBytesPacketHeader + sizeof(sequence)]; - for (int i=0;i MAXIMUM_EDIT_VOXEL_MESSAGE_SIZE) { - success=false; + success = false; } else { // add it to our message - memcpy(copyAt,voxelData,lengthOfVoxelData); - copyAt+=lengthOfVoxelData; - actualMessageSize+=lengthOfVoxelData; + memcpy(copyAt, voxelData, lengthOfVoxelData); + copyAt += lengthOfVoxelData; + actualMessageSize += lengthOfVoxelData; } // cleanup delete[] voxelData; @@ -238,9 +242,10 @@ bool createVoxelEditMessage(unsigned char command, short int sequence, if (success) { // finally, copy the result to the output bufferOut = new unsigned char[actualMessageSize]; - sizeOut=actualMessageSize; - memcpy(bufferOut,messageBuffer,actualMessageSize); + sizeOut = actualMessageSize; + memcpy(bufferOut, messageBuffer, actualMessageSize); } + delete[] messageBuffer; // clean up our temporary buffer return success; } diff --git a/libraries/voxels/src/VoxelTree.cpp b/libraries/voxels/src/VoxelTree.cpp index 70bca504cb..ef1ae4b996 100644 --- a/libraries/voxels/src/VoxelTree.cpp +++ b/libraries/voxels/src/VoxelTree.cpp @@ -596,7 +596,7 @@ void VoxelTree::readCodeColorBufferToTreeRecursion(VoxelNode* node, void* extraD void VoxelTree::processRemoveVoxelBitstream(unsigned char * bitstream, int bufferSizeBytes) { //unsigned short int itemNumber = (*((unsigned short int*)&bitstream[sizeof(PACKET_HEADER)])); - int atByte = sizeof(short int) + sizeof(PACKET_HEADER); + int atByte = sizeof(short int) + numBytesForPacketHeader(bitstream); unsigned char* voxelCode = (unsigned char*)&bitstream[atByte]; while (atByte < bufferSizeBytes) { int codeLength = numberOfThreeBitSectionsInCode(voxelCode); diff --git a/voxel-server/src/VoxelNodeData.cpp b/voxel-server/src/VoxelNodeData.cpp index f2cce906cf..98af7bb847 100644 --- a/voxel-server/src/VoxelNodeData.cpp +++ b/voxel-server/src/VoxelNodeData.cpp @@ -27,9 +27,10 @@ VoxelNodeData::VoxelNodeData(Node* owningNode) : void VoxelNodeData::resetVoxelPacket() { - _voxelPacket[0] = getWantColor() ? PACKET_HEADER_VOXEL_DATA : PACKET_HEADER_VOXEL_DATA_MONOCHROME; - _voxelPacketAt = &_voxelPacket[1]; - _voxelPacketAvailableBytes = MAX_VOXEL_PACKET_SIZE - 1; + PACKET_TYPE voxelPacketType = getWantColor() ? PACKET_TYPE_VOXEL_DATA : PACKET_TYPE_VOXEL_DATA_MONOCHROME; + int numBytesPacketHeader = populateTypeAndVersion(_voxelPacket, voxelPacketType); + _voxelPacketAt = _voxelPacket + numBytesPacketHeader; + _voxelPacketAvailableBytes = MAX_VOXEL_PACKET_SIZE - numBytesPacketHeader; _voxelPacketWaiting = false; } diff --git a/voxel-server/src/main.cpp b/voxel-server/src/main.cpp index f38b82886d..a691ec3d29 100644 --- a/voxel-server/src/main.cpp +++ b/voxel-server/src/main.cpp @@ -262,10 +262,13 @@ void deepestLevelVoxelDistributor(NodeList* nodeList, // send the environment packet if (shouldSendEnvironments) { int envPacketLength = 1; - *tempOutputBuffer = PACKET_HEADER_ENVIRONMENT_DATA; - for (int i = 0; i < sizeof(environmentData) / sizeof(environmentData[0]); i++) { + + int numBytesPacketHeader = populateTypeAndVersion(tempOutputBuffer, PACKET_TYPE_ENVIRONMENT_DATA); + + for (int i = 0; i < sizeof(environmentData) / numBytesPacketHeader; i++) { envPacketLength += environmentData[i].getBroadcastData(tempOutputBuffer + envPacketLength); } + nodeList->getNodeSocket()->send(node->getActiveSocket(), tempOutputBuffer, envPacketLength); trueBytesSent += envPacketLength; truePacketsSent++; @@ -509,19 +512,24 @@ int main(int argc, const char * argv[]) { // check to see if we need to persist our voxel state persistVoxelsWhenDirty(); - if (nodeList->getNodeSocket()->receive(&nodePublicAddress, packetData, &receivedBytes)) { - if (packetData[0] == PACKET_HEADER_SET_VOXEL || packetData[0] == PACKET_HEADER_SET_VOXEL_DESTRUCTIVE) { - bool destructive = (packetData[0] == PACKET_HEADER_SET_VOXEL_DESTRUCTIVE); + if (nodeList->getNodeSocket()->receive(&nodePublicAddress, packetData, &receivedBytes) && + packetVersionMatch(packetData)) { + + int numBytesPacketHeader = numBytesForPacketHeader(packetData); + + if (packetData[0] == PACKET_TYPE_SET_VOXEL || packetData[0] == PACKET_TYPE_SET_VOXEL_DESTRUCTIVE) { + bool destructive = (packetData[0] == PACKET_TYPE_SET_VOXEL_DESTRUCTIVE); PerformanceWarning warn(::shouldShowAnimationDebug, - destructive ? "PACKET_HEADER_SET_VOXEL_DESTRUCTIVE" : "PACKET_HEADER_SET_VOXEL", + destructive ? "PACKET_TYPE_SET_VOXEL_DESTRUCTIVE" : "PACKET_TYPE_SET_VOXEL", ::shouldShowAnimationDebug); - unsigned short int itemNumber = (*((unsigned short int*)&packetData[1])); + + unsigned short int itemNumber = (*((unsigned short int*)(packetData + numBytesPacketHeader))); if (::shouldShowAnimationDebug) { printf("got %s - command from client receivedBytes=%ld itemNumber=%d\n", - destructive ? "PACKET_HEADER_SET_VOXEL_DESTRUCTIVE" : "PACKET_HEADER_SET_VOXEL", + destructive ? "PACKET_TYPE_SET_VOXEL_DESTRUCTIVE" : "PACKET_TYPE_SET_VOXEL", receivedBytes,itemNumber); } - int atByte = sizeof(PACKET_HEADER) + sizeof(itemNumber); + int atByte = numBytesPacketHeader + sizeof(itemNumber); unsigned char* voxelData = (unsigned char*)&packetData[atByte]; while (atByte < receivedBytes) { unsigned char octets = (unsigned char)*voxelData; @@ -564,20 +572,21 @@ int main(int argc, const char * argv[]) { atByte += voxelDataSize; } } - if (packetData[0] == PACKET_HEADER_ERASE_VOXEL) { + if (packetData[0] == PACKET_TYPE_ERASE_VOXEL) { // Send these bits off to the VoxelTree class to process them pthread_mutex_lock(&::treeLock); serverTree.processRemoveVoxelBitstream((unsigned char*)packetData, receivedBytes); pthread_mutex_unlock(&::treeLock); } - if (packetData[0] == PACKET_HEADER_Z_COMMAND) { + if (packetData[0] == PACKET_TYPE_Z_COMMAND) { // the Z command is a special command that allows the sender to send the voxel server high level semantic // requests, like erase all, or add sphere scene - char* command = (char*) &packetData[1]; // start of the command + + char* command = (char*) &packetData[numBytesPacketHeader]; // start of the command int commandLength = strlen(command); // commands are null terminated strings - int totalLength = sizeof(PACKET_HEADER_Z_COMMAND) + commandLength + 1; // 1 for null termination + int totalLength = numBytesPacketHeader + commandLength + 1; // 1 for null termination printf("got Z message len(%ld)= %s\n", receivedBytes, command); bool rebroadcast = true; // by default rebroadcast @@ -604,20 +613,20 @@ int main(int argc, const char * argv[]) { nodeList->broadcastToNodes(packetData, receivedBytes, &NODE_TYPE_AGENT, 1); } } - // If we got a PACKET_HEADER_HEAD_DATA, then we're talking to an NODE_TYPE_AVATAR, and we + // If we got a PACKET_TYPE_HEAD_DATA, then we're talking to an NODE_TYPE_AVATAR, and we // need to make sure we have it in our nodeList. - if (packetData[0] == PACKET_HEADER_HEAD_DATA) { + if (packetData[0] == PACKET_TYPE_HEAD_DATA) { uint16_t nodeID = 0; - unpackNodeId(packetData + sizeof(PACKET_HEADER_HEAD_DATA), &nodeID); + unpackNodeId(packetData + numBytesPacketHeader, &nodeID); Node* node = nodeList->addOrUpdateNode(&nodePublicAddress, - &nodePublicAddress, - NODE_TYPE_AGENT, - nodeID); + &nodePublicAddress, + NODE_TYPE_AGENT, + nodeID); nodeList->updateNodeWithData(node, packetData, receivedBytes); } // If the packet is a ping, let processNodeData handle it. - if (packetData[0] == PACKET_HEADER_PING) { + if (packetData[0] == PACKET_TYPE_PING) { nodeList->processNodeData(&nodePublicAddress, packetData, receivedBytes); } }