//// // Interface// // Show a field of objects rendered in 3D, with yaw and pitch of scene driven // by accelerometer data// serial port connected to Maple board/arduino. //// Keyboard Commands: //// / = toggle stats display// spacebar = reset gyros/head// h = render Head// l = show incoming gyro levels// #include "InterfaceConfig.h"#include <iostream>#include <fstream>#include <math.h>#include <string.h>#include <sstream>#include <stdio.h>#include <stdlib.h> #ifdef _WIN32#include "Syssocket.h"#include "Systime.h"#else#include <sys/time.h>#include <arpa/inet.h>#include <ifaddrs.h>#endif #include <pthread.h> #include <glm/glm.hpp>#include <glm/gtc/matrix_transform.hpp>#include <glm/gtc/type_ptr.hpp> #include "Field.h"#include "world.h"#include "Util.h"#ifndef _WIN32#include "Audio.h"#endif #include "FieldOfView.h"#include "Stars.h" #include "Head.h"#include "Hand.h"#include "Camera.h"#include "Particle.h"#include "Texture.h"#include "Cloud.h"#include <AgentList.h>#include "VoxelSystem.h"#include "Lattice.h"#include "Finger.h"#include "Oscilloscope.h"#include "UDPSocket.h"#include "SerialInterface.h"#include <PerfStat.h>#include <SharedUtil.h> using namespace std; double testThingy = 0.0; int audio_on = 1; // Whether to turn on the audio supportint simulate_on = 1; AgentList agentList('I');pthread_t networkReceiveThread;bool stopNetworkReceiveThread = false; // For testing, add milliseconds of delay for received UDP packetsint packetcount = 0;int packets_per_second = 0; int bytes_per_second = 0;int bytescount = 0; // Getting a target location from other machine (or loopback) to displayint target_x, target_y; int target_display = 0; int head_mirror = 1; // Whether to mirror own head when viewing itint sendToSelf = 1; int WIDTH = 1200; int HEIGHT = 800; int fullscreen = 0; bool wantColorRandomizer = true; // for addSphere and load file Oscilloscope audioScope(256,200,true); #define HAND_RADIUS 0.25 // Radius of in-world 'hand' of youHead myHead; // The rendered head of oneselfCamera myCamera; // My view onto the world (sometimes on myself :) char starFile[] = "https://s3-us-west-1.amazonaws.com/highfidelity/stars.txt";FieldOfView fov;Stars stars;#ifdef STARFIELD_KEYSint starsTiles = 20;double starsLod = 1.0;#endif glm::vec3 box(WORLD_SIZE,WORLD_SIZE,WORLD_SIZE);ParticleSystem balls(0, box, false, // Wrap? 0.02f, // Noise 0.3f, // Size scale 0.0 // Gravity ); Cloud cloud(20000, // Particles box, // Bounding Box false // Wrap ); VoxelSystem voxels; Lattice lattice(160,100);Finger myFinger(WIDTH, HEIGHT);Field field; #ifndef _WIN32Audio audio(&audioScope, &myHead);#endif #define RENDER_FRAME_MSECS 8int steps_per_frame = 0; float yaw = 0.f; // The yaw, pitch for the avatar headfloat pitch = 0.f; float start_yaw = 122;float renderPitch = 0.f;float renderYawRate = 0.f;float renderPitchRate = 0.f; // Where one's own agent begins in the world (needs to become a dynamic thing passed to the program)glm::vec3 start_location(6.1f, 0, 1.4f); int stats_on = 0; // Whether to show onscreen text overlay with statsbool starsOn = true; // Whether to display the starsbool paintOn = false; // Whether to paint voxels as you fly around int noise_on = 0; // Whether to add random noise float noise = 1.0; // Overall magnitude scaling for random noise levels int step_on = 0; int display_levels = 0;int display_head = 0;int display_field = 0; int display_head_mouse = 1; // Display sample mouse pointer controlled by head movementint head_mouse_x, head_mouse_y; int head_lean_x, head_lean_y; int mouse_x, mouse_y; // Where is the mouseint mouse_start_x, mouse_start_y; // Mouse location at start of last down clickint mouse_pressed = 0; // true if mouse has been pressed (clear when finished) int nearbyAgents = 0; // How many other people near you is the domain server reporting? int speed; //// Serial USB Variables// SerialInterface serialPort;int latency_display = 1; glm::vec3 gravity;int first_measurement = 1;//int samplecount = 0; // Frame rate Measurement int framecount = 0; float FPS = 120.f;timeval timer_start, timer_end;timeval last_frame;double elapsedTime; // Particles char texture_filename[] = "images/int-texture256-v4.png";unsigned int texture_width = 256;unsigned int texture_height = 256; float particle_attenuation_quadratic[] = { 0.0f, 0.0f, 2.0f }; // larger Z = smaller particlesfloat pointer_attenuation_quadratic[] = { 1.0f, 0.0f, 0.0f }; // for 2D view #ifdef MARKER_CAPTURE /*** Marker Capture ***/ #define MARKER_CAPTURE_INTERVAL 1 MarkerCapture marker_capturer(CV_CAP_ANY); // Create a new marker capturer, attached to any valid camera. MarkerAcquisitionView marker_acq_view(&marker_capturer); bool marker_capture_enabled = true; bool marker_capture_display = true; IplImage* marker_capture_frame; IplImage* marker_capture_blob_frame; pthread_mutex_t frame_lock; #endif // Every second, check the frame rates and other stuffvoid Timer(int extra){ gettimeofday(&timer_end, NULL); FPS = (float)framecount / ((float)diffclock(&timer_start, &timer_end) / 1000.f); packets_per_second = (float)packetcount / ((float)diffclock(&timer_start, &timer_end) / 1000.f); bytes_per_second = (float)bytescount / ((float)diffclock(&timer_start, &timer_end) / 1000.f); framecount = 0; packetcount = 0; bytescount = 0; glutTimerFunc(1000,Timer,0); gettimeofday(&timer_start, NULL); // Ping the agents we can see agentList.pingAgents(); if (0) { // Massive send packet speed test timeval starttest, endtest; gettimeofday(&starttest, NULL); char junk[1000]; junk[0] = 'J'; for (int i = 0; i < 10000; i++) {// agentSocket.send((char *)"192.168.1.38", AGENT_UDP_PORT, junk, 1000); } gettimeofday(&endtest, NULL); float sendTime = static_cast<float>( diffclock(&starttest, &endtest) ); printf("packet test = %4.1f\n", sendTime); } // if we haven't detected gyros, check for them now if (!serialPort.active) { serialPort.pair(); }} void display_stats(void){ // bitmap chars are about 10 pels high char legend[] = "/ - toggle this display, Q - exit, H - show head, M - show hand, T - test audio"; drawtext(10, 15, 0.10f, 0, 1.0, 0, legend); char legend2[] = "* - toggle stars, & - toggle paint mode"; drawtext(10, 32, 0.10f, 0, 1.0, 0, legend2); char stats[200]; sprintf(stats, "FPS = %3.0f Pkts/s = %d Bytes/s = %d ", FPS, packets_per_second, bytes_per_second); drawtext(10, 49, 0.10f, 0, 1.0, 0, stats); if (serialPort.active) { sprintf(stats, "ADC samples = %d, LED = %d", serialPort.getNumSamples(), serialPort.getLED()); drawtext(300, 30, 0.10f, 0, 1.0, 0, stats); } // Output the ping times to the various agents // std::stringstream pingTimes;// pingTimes << "Agent Pings, msecs:";// for (int i = 0; i < getAgentCount(); i++) {// pingTimes << " " << getAgentAddress(i) << ": " << getAgentPing(i);// }// drawtext(10,50,0.10, 0, 1.0, 0, (char *)pingTimes.str().c_str()); std::stringstream voxelStats; voxelStats << "Voxels Rendered: " << voxels.getVoxelsRendered(); drawtext(10,70,0.10f, 0, 1.0, 0, (char *)voxelStats.str().c_str()); // Get the PerfStats group details. We need to allocate and array of char* long enough to hold 1+groups char** perfStatLinesArray = new char*[PerfStat::getGroupCount()+1]; int lines = PerfStat::DumpStats(perfStatLinesArray); int atZ = 150; // arbitrary place on screen that looks good for (int line=0; line < lines; line++) { drawtext(10,atZ,0.10f, 0, 1.0, 0, perfStatLinesArray[line]); delete perfStatLinesArray[line]; // we're responsible for cleanup perfStatLinesArray[line]=NULL; atZ+=20; // height of a line } delete []perfStatLinesArray; // we're responsible for cleanup /* std::stringstream angles; angles << "render_yaw: " << myHead.getRenderYaw() << ", Yaw: " << myHead.getYaw(); drawtext(10,50,0.10, 0, 1.0, 0, (char *)angles.str().c_str()); */ /* char adc[200]; sprintf(adc, "location = %3.1f,%3.1f,%3.1f, angle_to(origin) = %3.1f, head yaw = %3.1f, render_yaw = %3.1f", -location[0], -location[1], -location[2], angle_to(myHead.getPos()*-1.f, glm::vec3(0,0,0), myHead.getRenderYaw(), myHead.getYaw()), myHead.getYaw(), myHead.getRenderYaw()); drawtext(10, 50, 0.10, 0, 1.0, 0, adc); */} void initDisplay(void){ // Set up blending function so that we can NOT clear the display glClear(GL_COLOR_BUFFER_BIT | GL_DEPTH_BUFFER_BIT); glEnable(GL_BLEND); glBlendFunc(GL_SRC_ALPHA, GL_ONE_MINUS_SRC_ALPHA); glShadeModel (GL_SMOOTH); glEnable(GL_LIGHTING); glEnable(GL_LIGHT0); glEnable(GL_DEPTH_TEST); // load_png_as_texture(texture_filename); if (fullscreen) glutFullScreen();} void init(void){ voxels.init(); voxels.setViewerHead(&myHead); myHead.setRenderYaw(start_yaw); head_mouse_x = WIDTH/2; head_mouse_y = HEIGHT/2; head_lean_x = WIDTH/2; head_lean_y = HEIGHT/2; stars.readInput(starFile, 0); // Initialize Field values field = Field(); printf( "Field Initialized.\n" ); if (noise_on) { myHead.setNoise(noise); } myHead.setPos(start_location ); myCamera.setPosition( glm::dvec3( start_location ) ); #ifdef MARKER_CAPTURE if(marker_capture_enabled){ marker_capturer.position_updated(&position_updated); marker_capturer.frame_updated(&marker_frame_available); if(!marker_capturer.init_capture()){ printf("Camera-based marker capture initialized.\n"); }else{ printf("Error initializing camera-based marker capture.\n"); } }#endif gettimeofday(&timer_start, NULL); gettimeofday(&last_frame, NULL);} void terminate () { // Close serial port //close(serial_fd); #ifndef _WIN32 audio.terminate(); #endif stopNetworkReceiveThread = true; pthread_join(networkReceiveThread, NULL); exit(EXIT_SUCCESS);} void reset_sensors(){ // // Reset serial I/O sensors // myHead.setRenderYaw(start_yaw); yaw = renderYawRate = 0; pitch = renderPitch = renderPitchRate = 0; myHead.setPos(start_location); head_mouse_x = WIDTH/2; head_mouse_y = HEIGHT/2; head_lean_x = WIDTH/2; head_lean_y = HEIGHT/2; myHead.reset(); if (serialPort.active) { serialPort.resetTrailingAverages(); }} void simulateHand(float deltaTime) { // If mouse is being dragged, send current force to the hand controller if (mouse_pressed == 1) { // Add a velocity to the hand corresponding to the detected size of the drag vector const float MOUSE_HAND_FORCE = 1.5; float dx = mouse_x - mouse_start_x; float dy = mouse_y - mouse_start_y; glm::vec3 vel(dx*MOUSE_HAND_FORCE, -dy*MOUSE_HAND_FORCE*(WIDTH/HEIGHT), 0); myHead.hand->addVelocity(vel*deltaTime); double leftRight = dx * 0.001; double downUp = dy * 0.001; double backFront = 0.0; glm::dvec3 handMovement( leftRight, downUp, backFront ); myHead.setHandMovement( handMovement ); }} void simulateHead(float frametime)// Using serial data, update avatar/render position and angles{// float measured_pitch_rate = serialPort.getRelativeValue(PITCH_RATE);// float measured_yaw_rate = serialPort.getRelativeValue(YAW_RATE); float measured_pitch_rate = 0; float measured_yaw_rate = 0; //float measured_lateral_accel = serialPort.getRelativeValue(ACCEL_X); //float measured_fwd_accel = serialPort.getRelativeValue(ACCEL_Z); myHead.UpdatePos(frametime, &serialPort, head_mirror, &gravity); //------------------------------------------------------------------------------------- // set the position of the avatar //------------------------------------------------------------------------------------- myHead.setAvatarPosition( -myHead.getPos().x, -myHead.getPos().y, -myHead.getPos().z ); // Update head_mouse model const float MIN_MOUSE_RATE = 30.0; const float MOUSE_SENSITIVITY = 0.1f; if (powf(measured_yaw_rate*measured_yaw_rate + measured_pitch_rate*measured_pitch_rate, 0.5) > MIN_MOUSE_RATE) { head_mouse_x += measured_yaw_rate*MOUSE_SENSITIVITY; head_mouse_y += measured_pitch_rate*MOUSE_SENSITIVITY*(float)HEIGHT/(float)WIDTH; } head_mouse_x = max(head_mouse_x, 0); head_mouse_x = min(head_mouse_x, WIDTH); head_mouse_y = max(head_mouse_y, 0); head_mouse_y = min(head_mouse_y, HEIGHT); // Update render direction (pitch/yaw) based on measured gyro rates const int MIN_YAW_RATE = 100; const int MIN_PITCH_RATE = 100; const float YAW_SENSITIVITY = 0.02; const float PITCH_SENSITIVITY = 0.05; // Update render pitch and yaw rates based on keyPositions const float KEY_YAW_SENSITIVITY = 2.0; if (myHead.getDriveKeys(ROT_LEFT)) renderYawRate -= KEY_YAW_SENSITIVITY*frametime; if (myHead.getDriveKeys(ROT_RIGHT)) renderYawRate += KEY_YAW_SENSITIVITY*frametime; if (fabs(measured_yaw_rate) > MIN_YAW_RATE) { if (measured_yaw_rate > 0) renderYawRate += (measured_yaw_rate - MIN_YAW_RATE) * YAW_SENSITIVITY * frametime; else renderYawRate += (measured_yaw_rate + MIN_YAW_RATE) * YAW_SENSITIVITY * frametime; } if (fabs(measured_pitch_rate) > MIN_PITCH_RATE) { if (measured_pitch_rate > 0) renderPitchRate += (measured_pitch_rate - MIN_PITCH_RATE) * PITCH_SENSITIVITY * frametime; else renderPitchRate += (measured_pitch_rate + MIN_PITCH_RATE) * PITCH_SENSITIVITY * frametime; } renderPitch += renderPitchRate; // Decay renderPitch toward zero because we never look constantly up/down renderPitch *= (1.f - 2.0*frametime); // Decay angular rates toward zero renderPitchRate *= (1.f - 5.0*frametime); renderYawRate *= (1.f - 7.0*frametime); // Update own head data myHead.setRenderYaw(myHead.getRenderYaw() + renderYawRate); myHead.setRenderPitch(renderPitch); // Get audio loudness data from audio input device float loudness, averageLoudness; #ifndef _WIN32Lines 1–500 of 1104. Load more
// // // Interface // // Show a field of objects rendered in 3D, with yaw and pitch of scene driven // by accelerometer data // serial port connected to Maple board/arduino. // // Keyboard Commands: // // / = toggle stats display // spacebar = reset gyros/head // h = render Head // l = show incoming gyro levels // #include "InterfaceConfig.h" #include <iostream> #include <fstream> #include <math.h> #include <string.h> #include <sstream> #include <stdio.h> #include <stdlib.h> #ifdef _WIN32 #include "Syssocket.h" #include "Systime.h" #else #include <sys/time.h> #include <arpa/inet.h> #include <ifaddrs.h> #endif #include <pthread.h> #include <glm/glm.hpp> #include <glm/gtc/matrix_transform.hpp> #include <glm/gtc/type_ptr.hpp> #include "Field.h" #include "world.h" #include "Util.h" #ifndef _WIN32 #include "Audio.h" #endif #include "FieldOfView.h" #include "Stars.h" #include "Head.h" #include "Hand.h" #include "Camera.h" #include "Particle.h" #include "Texture.h" #include "Cloud.h" #include <AgentList.h> #include "VoxelSystem.h" #include "Lattice.h" #include "Finger.h" #include "Oscilloscope.h" #include "UDPSocket.h" #include "SerialInterface.h" #include <PerfStat.h> #include <SharedUtil.h> using namespace std; double testThingy = 0.0; int audio_on = 1; // Whether to turn on the audio support int simulate_on = 1; AgentList agentList('I'); pthread_t networkReceiveThread; bool stopNetworkReceiveThread = false; // For testing, add milliseconds of delay for received UDP packets int packetcount = 0; int packets_per_second = 0; int bytes_per_second = 0; int bytescount = 0; // Getting a target location from other machine (or loopback) to display int target_x, target_y; int target_display = 0; int head_mirror = 1; // Whether to mirror own head when viewing it int sendToSelf = 1; int WIDTH = 1200; int HEIGHT = 800; int fullscreen = 0; bool wantColorRandomizer = true; // for addSphere and load file Oscilloscope audioScope(256,200,true); #define HAND_RADIUS 0.25 // Radius of in-world 'hand' of you Head myHead; // The rendered head of oneself Camera myCamera; // My view onto the world (sometimes on myself :) char starFile[] = "https://s3-us-west-1.amazonaws.com/highfidelity/stars.txt"; FieldOfView fov; Stars stars; #ifdef STARFIELD_KEYS int starsTiles = 20; double starsLod = 1.0; #endif glm::vec3 box(WORLD_SIZE,WORLD_SIZE,WORLD_SIZE); ParticleSystem balls(0, box, false, // Wrap? 0.02f, // Noise 0.3f, // Size scale 0.0 // Gravity ); Cloud cloud(20000, // Particles box, // Bounding Box false // Wrap ); VoxelSystem voxels; Lattice lattice(160,100); Finger myFinger(WIDTH, HEIGHT); Field field; #ifndef _WIN32 Audio audio(&audioScope, &myHead); #endif #define RENDER_FRAME_MSECS 8 int steps_per_frame = 0; float yaw = 0.f; // The yaw, pitch for the avatar head float pitch = 0.f; float start_yaw = 122; float renderPitch = 0.f; float renderYawRate = 0.f; float renderPitchRate = 0.f; // Where one's own agent begins in the world (needs to become a dynamic thing passed to the program) glm::vec3 start_location(6.1f, 0, 1.4f); int stats_on = 0; // Whether to show onscreen text overlay with stats bool starsOn = true; // Whether to display the stars bool paintOn = false; // Whether to paint voxels as you fly around int noise_on = 0; // Whether to add random noise float noise = 1.0; // Overall magnitude scaling for random noise levels int step_on = 0; int display_levels = 0; int display_head = 0; int display_field = 0; int display_head_mouse = 1; // Display sample mouse pointer controlled by head movement int head_mouse_x, head_mouse_y; int head_lean_x, head_lean_y; int mouse_x, mouse_y; // Where is the mouse int mouse_start_x, mouse_start_y; // Mouse location at start of last down click int mouse_pressed = 0; // true if mouse has been pressed (clear when finished) int nearbyAgents = 0; // How many other people near you is the domain server reporting? int speed; // // Serial USB Variables // SerialInterface serialPort; int latency_display = 1; glm::vec3 gravity; int first_measurement = 1; //int samplecount = 0; // Frame rate Measurement int framecount = 0; float FPS = 120.f; timeval timer_start, timer_end; timeval last_frame; double elapsedTime; // Particles char texture_filename[] = "images/int-texture256-v4.png"; unsigned int texture_width = 256; unsigned int texture_height = 256; float particle_attenuation_quadratic[] = { 0.0f, 0.0f, 2.0f }; // larger Z = smaller particles float pointer_attenuation_quadratic[] = { 1.0f, 0.0f, 0.0f }; // for 2D view #ifdef MARKER_CAPTURE /*** Marker Capture ***/ #define MARKER_CAPTURE_INTERVAL 1 MarkerCapture marker_capturer(CV_CAP_ANY); // Create a new marker capturer, attached to any valid camera. MarkerAcquisitionView marker_acq_view(&marker_capturer); bool marker_capture_enabled = true; bool marker_capture_display = true; IplImage* marker_capture_frame; IplImage* marker_capture_blob_frame; pthread_mutex_t frame_lock; #endif // Every second, check the frame rates and other stuff void Timer(int extra) { gettimeofday(&timer_end, NULL); FPS = (float)framecount / ((float)diffclock(&timer_start, &timer_end) / 1000.f); packets_per_second = (float)packetcount / ((float)diffclock(&timer_start, &timer_end) / 1000.f); bytes_per_second = (float)bytescount / ((float)diffclock(&timer_start, &timer_end) / 1000.f); framecount = 0; packetcount = 0; bytescount = 0; glutTimerFunc(1000,Timer,0); gettimeofday(&timer_start, NULL); // Ping the agents we can see agentList.pingAgents(); if (0) { // Massive send packet speed test timeval starttest, endtest; gettimeofday(&starttest, NULL); char junk[1000]; junk[0] = 'J'; for (int i = 0; i < 10000; i++) { // agentSocket.send((char *)"192.168.1.38", AGENT_UDP_PORT, junk, 1000); } gettimeofday(&endtest, NULL); float sendTime = static_cast<float>( diffclock(&starttest, &endtest) ); printf("packet test = %4.1f\n", sendTime); } // if we haven't detected gyros, check for them now if (!serialPort.active) { serialPort.pair(); } } void display_stats(void) { // bitmap chars are about 10 pels high char legend[] = "/ - toggle this display, Q - exit, H - show head, M - show hand, T - test audio"; drawtext(10, 15, 0.10f, 0, 1.0, 0, legend); char legend2[] = "* - toggle stars, & - toggle paint mode"; drawtext(10, 32, 0.10f, 0, 1.0, 0, legend2); char stats[200]; sprintf(stats, "FPS = %3.0f Pkts/s = %d Bytes/s = %d ", FPS, packets_per_second, bytes_per_second); drawtext(10, 49, 0.10f, 0, 1.0, 0, stats); if (serialPort.active) { sprintf(stats, "ADC samples = %d, LED = %d", serialPort.getNumSamples(), serialPort.getLED()); drawtext(300, 30, 0.10f, 0, 1.0, 0, stats); } // Output the ping times to the various agents // std::stringstream pingTimes; // pingTimes << "Agent Pings, msecs:"; // for (int i = 0; i < getAgentCount(); i++) { // pingTimes << " " << getAgentAddress(i) << ": " << getAgentPing(i); // } // drawtext(10,50,0.10, 0, 1.0, 0, (char *)pingTimes.str().c_str()); std::stringstream voxelStats; voxelStats << "Voxels Rendered: " << voxels.getVoxelsRendered(); drawtext(10,70,0.10f, 0, 1.0, 0, (char *)voxelStats.str().c_str()); // Get the PerfStats group details. We need to allocate and array of char* long enough to hold 1+groups char** perfStatLinesArray = new char*[PerfStat::getGroupCount()+1]; int lines = PerfStat::DumpStats(perfStatLinesArray); int atZ = 150; // arbitrary place on screen that looks good for (int line=0; line < lines; line++) { drawtext(10,atZ,0.10f, 0, 1.0, 0, perfStatLinesArray[line]); delete perfStatLinesArray[line]; // we're responsible for cleanup perfStatLinesArray[line]=NULL; atZ+=20; // height of a line } delete []perfStatLinesArray; // we're responsible for cleanup /* std::stringstream angles; angles << "render_yaw: " << myHead.getRenderYaw() << ", Yaw: " << myHead.getYaw(); drawtext(10,50,0.10, 0, 1.0, 0, (char *)angles.str().c_str()); */ /* char adc[200]; sprintf(adc, "location = %3.1f,%3.1f,%3.1f, angle_to(origin) = %3.1f, head yaw = %3.1f, render_yaw = %3.1f", -location[0], -location[1], -location[2], angle_to(myHead.getPos()*-1.f, glm::vec3(0,0,0), myHead.getRenderYaw(), myHead.getYaw()), myHead.getYaw(), myHead.getRenderYaw()); drawtext(10, 50, 0.10, 0, 1.0, 0, adc); */ } void initDisplay(void) { // Set up blending function so that we can NOT clear the display glClear(GL_COLOR_BUFFER_BIT | GL_DEPTH_BUFFER_BIT); glEnable(GL_BLEND); glBlendFunc(GL_SRC_ALPHA, GL_ONE_MINUS_SRC_ALPHA); glShadeModel (GL_SMOOTH); glEnable(GL_LIGHTING); glEnable(GL_LIGHT0); glEnable(GL_DEPTH_TEST); // load_png_as_texture(texture_filename); if (fullscreen) glutFullScreen(); } void init(void) { voxels.init(); voxels.setViewerHead(&myHead); myHead.setRenderYaw(start_yaw); head_mouse_x = WIDTH/2; head_mouse_y = HEIGHT/2; head_lean_x = WIDTH/2; head_lean_y = HEIGHT/2; stars.readInput(starFile, 0); // Initialize Field values field = Field(); printf( "Field Initialized.\n" ); if (noise_on) { myHead.setNoise(noise); } myHead.setPos(start_location ); myCamera.setPosition( glm::dvec3( start_location ) ); #ifdef MARKER_CAPTURE if(marker_capture_enabled){ marker_capturer.position_updated(&position_updated); marker_capturer.frame_updated(&marker_frame_available); if(!marker_capturer.init_capture()){ printf("Camera-based marker capture initialized.\n"); }else{ printf("Error initializing camera-based marker capture.\n"); } } #endif gettimeofday(&timer_start, NULL); gettimeofday(&last_frame, NULL); } void terminate () { // Close serial port //close(serial_fd); #ifndef _WIN32 audio.terminate(); #endif stopNetworkReceiveThread = true; pthread_join(networkReceiveThread, NULL); exit(EXIT_SUCCESS); } void reset_sensors() { // // Reset serial I/O sensors // myHead.setRenderYaw(start_yaw); yaw = renderYawRate = 0; pitch = renderPitch = renderPitchRate = 0; myHead.setPos(start_location); head_mouse_x = WIDTH/2; head_mouse_y = HEIGHT/2; head_lean_x = WIDTH/2; head_lean_y = HEIGHT/2; myHead.reset(); if (serialPort.active) { serialPort.resetTrailingAverages(); } } void simulateHand(float deltaTime) { // If mouse is being dragged, send current force to the hand controller if (mouse_pressed == 1) { // Add a velocity to the hand corresponding to the detected size of the drag vector const float MOUSE_HAND_FORCE = 1.5; float dx = mouse_x - mouse_start_x; float dy = mouse_y - mouse_start_y; glm::vec3 vel(dx*MOUSE_HAND_FORCE, -dy*MOUSE_HAND_FORCE*(WIDTH/HEIGHT), 0); myHead.hand->addVelocity(vel*deltaTime); double leftRight = dx * 0.001; double downUp = dy * 0.001; double backFront = 0.0; glm::dvec3 handMovement( leftRight, downUp, backFront ); myHead.setHandMovement( handMovement ); } } void simulateHead(float frametime) // Using serial data, update avatar/render position and angles { // float measured_pitch_rate = serialPort.getRelativeValue(PITCH_RATE); // float measured_yaw_rate = serialPort.getRelativeValue(YAW_RATE); float measured_pitch_rate = 0; float measured_yaw_rate = 0; //float measured_lateral_accel = serialPort.getRelativeValue(ACCEL_X); //float measured_fwd_accel = serialPort.getRelativeValue(ACCEL_Z); myHead.UpdatePos(frametime, &serialPort, head_mirror, &gravity); //------------------------------------------------------------------------------------- // set the position of the avatar //------------------------------------------------------------------------------------- myHead.setAvatarPosition( -myHead.getPos().x, -myHead.getPos().y, -myHead.getPos().z ); // Update head_mouse model const float MIN_MOUSE_RATE = 30.0; const float MOUSE_SENSITIVITY = 0.1f; if (powf(measured_yaw_rate*measured_yaw_rate + measured_pitch_rate*measured_pitch_rate, 0.5) > MIN_MOUSE_RATE) { head_mouse_x += measured_yaw_rate*MOUSE_SENSITIVITY; head_mouse_y += measured_pitch_rate*MOUSE_SENSITIVITY*(float)HEIGHT/(float)WIDTH; } head_mouse_x = max(head_mouse_x, 0); head_mouse_x = min(head_mouse_x, WIDTH); head_mouse_y = max(head_mouse_y, 0); head_mouse_y = min(head_mouse_y, HEIGHT); // Update render direction (pitch/yaw) based on measured gyro rates const int MIN_YAW_RATE = 100; const int MIN_PITCH_RATE = 100; const float YAW_SENSITIVITY = 0.02; const float PITCH_SENSITIVITY = 0.05; // Update render pitch and yaw rates based on keyPositions const float KEY_YAW_SENSITIVITY = 2.0; if (myHead.getDriveKeys(ROT_LEFT)) renderYawRate -= KEY_YAW_SENSITIVITY*frametime; if (myHead.getDriveKeys(ROT_RIGHT)) renderYawRate += KEY_YAW_SENSITIVITY*frametime; if (fabs(measured_yaw_rate) > MIN_YAW_RATE) { if (measured_yaw_rate > 0) renderYawRate += (measured_yaw_rate - MIN_YAW_RATE) * YAW_SENSITIVITY * frametime; else renderYawRate += (measured_yaw_rate + MIN_YAW_RATE) * YAW_SENSITIVITY * frametime; } if (fabs(measured_pitch_rate) > MIN_PITCH_RATE) { if (measured_pitch_rate > 0) renderPitchRate += (measured_pitch_rate - MIN_PITCH_RATE) * PITCH_SENSITIVITY * frametime; else renderPitchRate += (measured_pitch_rate + MIN_PITCH_RATE) * PITCH_SENSITIVITY * frametime; } renderPitch += renderPitchRate; // Decay renderPitch toward zero because we never look constantly up/down renderPitch *= (1.f - 2.0*frametime); // Decay angular rates toward zero renderPitchRate *= (1.f - 5.0*frametime); renderYawRate *= (1.f - 7.0*frametime); // Update own head data myHead.setRenderYaw(myHead.getRenderYaw() + renderYawRate); myHead.setRenderPitch(renderPitch); // Get audio loudness data from audio input device float loudness, averageLoudness; #ifndef _WIN32