////  OctreeQuery.cpp//  libraries/octree/src////  Created by Brad Hefta-Gaub on 10/24/13.//  Copyright 2013 High Fidelity, Inc.////  Distributed under the Apache License, Version 2.0.//  See the accompanying file LICENSE or http://www.apache.org/licenses/LICENSE-2.0.html// #include <GLMHelpers.h>#include <PacketHeaders.h> #include "OctreeConstants.h"#include "OctreeQuery.h"  OctreeQuery::OctreeQuery() {    _maxQueryPPS = DEFAULT_MAX_OCTREE_PPS;} int OctreeQuery::getBroadcastData(unsigned char* destinationBuffer) {    unsigned char* bufferStart = destinationBuffer;        // TODO: DRY this up to a shared method    // that can pack any type given the number of bytes    // and return the number of bytes to push the pointer        // camera details    memcpy(destinationBuffer, &_cameraPosition, sizeof(_cameraPosition));    destinationBuffer += sizeof(_cameraPosition);    destinationBuffer += packOrientationQuatToBytes(destinationBuffer, _cameraOrientation);    destinationBuffer += packFloatAngleToTwoByte(destinationBuffer, _cameraFov);    destinationBuffer += packFloatRatioToTwoByte(destinationBuffer, _cameraAspectRatio);    destinationBuffer += packClipValueToTwoByte(destinationBuffer, _cameraNearClip);    destinationBuffer += packClipValueToTwoByte(destinationBuffer, _cameraFarClip);    memcpy(destinationBuffer, &_cameraEyeOffsetPosition, sizeof(_cameraEyeOffsetPosition));    destinationBuffer += sizeof(_cameraEyeOffsetPosition);     // bitMask of less than byte wide items    unsigned char bitItems = 0;    if (_wantLowResMoving)     { setAtBit(bitItems, WANT_LOW_RES_MOVING_BIT); }    if (_wantColor)            { setAtBit(bitItems, WANT_COLOR_AT_BIT); }    if (_wantDelta)            { setAtBit(bitItems, WANT_DELTA_AT_BIT); }    if (_wantOcclusionCulling) { setAtBit(bitItems, WANT_OCCLUSION_CULLING_BIT); }    if (_wantCompression)      { setAtBit(bitItems, WANT_COMPRESSION); }     *destinationBuffer++ = bitItems;     // desired Max Octree PPS    memcpy(destinationBuffer, &_maxQueryPPS, sizeof(_maxQueryPPS));    destinationBuffer += sizeof(_maxQueryPPS);     // desired voxelSizeScale    memcpy(destinationBuffer, &_octreeElementSizeScale, sizeof(_octreeElementSizeScale));    destinationBuffer += sizeof(_octreeElementSizeScale);     // desired boundaryLevelAdjust    memcpy(destinationBuffer, &_boundaryLevelAdjust, sizeof(_boundaryLevelAdjust));    destinationBuffer += sizeof(_boundaryLevelAdjust);        return destinationBuffer - bufferStart;} // called on the other nodes - assigns it to my views of the othersint OctreeQuery::parseData(const QByteArray& packet) {     // increment to push past the packet header    int numBytesPacketHeader = numBytesForPacketHeader(packet);        const unsigned char* startPosition = reinterpret_cast<const unsigned char*>(packet.data());    const unsigned char* sourceBuffer = startPosition + numBytesPacketHeader;        // camera details    memcpy(&_cameraPosition, sourceBuffer, sizeof(_cameraPosition));    sourceBuffer += sizeof(_cameraPosition);    sourceBuffer += unpackOrientationQuatFromBytes(sourceBuffer, _cameraOrientation);    sourceBuffer += unpackFloatAngleFromTwoByte((uint16_t*) sourceBuffer, &_cameraFov);    sourceBuffer += unpackFloatRatioFromTwoByte(sourceBuffer,_cameraAspectRatio);    sourceBuffer += unpackClipValueFromTwoByte(sourceBuffer,_cameraNearClip);    sourceBuffer += unpackClipValueFromTwoByte(sourceBuffer,_cameraFarClip);    memcpy(&_cameraEyeOffsetPosition, sourceBuffer, sizeof(_cameraEyeOffsetPosition));    sourceBuffer += sizeof(_cameraEyeOffsetPosition);     // voxel sending features...    unsigned char bitItems = 0;    bitItems = (unsigned char)*sourceBuffer++;    _wantLowResMoving = oneAtBit(bitItems, WANT_LOW_RES_MOVING_BIT);    _wantColor = oneAtBit(bitItems, WANT_COLOR_AT_BIT);    _wantDelta = oneAtBit(bitItems, WANT_DELTA_AT_BIT);    _wantOcclusionCulling = oneAtBit(bitItems, WANT_OCCLUSION_CULLING_BIT);    _wantCompression = oneAtBit(bitItems, WANT_COMPRESSION);     // desired Max Octree PPS    memcpy(&_maxQueryPPS, sourceBuffer, sizeof(_maxQueryPPS));    sourceBuffer += sizeof(_maxQueryPPS);     // desired _octreeElementSizeScale    memcpy(&_octreeElementSizeScale, sourceBuffer, sizeof(_octreeElementSizeScale));    sourceBuffer += sizeof(_octreeElementSizeScale);     // desired boundaryLevelAdjust    memcpy(&_boundaryLevelAdjust, sourceBuffer, sizeof(_boundaryLevelAdjust));    sourceBuffer += sizeof(_boundaryLevelAdjust);     return sourceBuffer - startPosition;} glm::vec3 OctreeQuery::calculateCameraDirection() const {    glm::vec3 direction = glm::vec3(_cameraOrientation * glm::vec4(IDENTITY_FRONT, 0.0f));    return direction;}