#include "hud.hxx" #include "panel.hxx" #define DO_PANEL_HACK //====================== Top of HudLadder Class ======================= HudLadder :: HudLadder( int x, int y, UINT width, UINT height, UINT mini, FLTFNPTR ptch_source, FLTFNPTR roll_source, float span_units, float major_div, float minor_div, UINT screen_hole, UINT lbl_pos, bool working) : dual_instr_item( x, y, width, height, ptch_source, roll_source, working, HUDS_RIGHT), width_units ( (int)(span_units) ), div_units ( (int)(major_div < 0? -major_div: major_div) ), minor_div ( (int)(minor_div) ), label_pos ( lbl_pos ), scr_hole ( screen_hole ), vmax ( span_units/2 ), vmin ( -vmax ) { if( !width_units ) { width_units = 45; } // $$$ begin -added VS Renganthan 16 Oct 2k #ifdef FIGHTER_HUD factor = 480.0 / 33.75; #else // $$$ begin -added VS Renganthan 16 Oct 2k factor = (float)get_span() / (float) width_units; #endif minimal = mini; } HudLadder :: ~HudLadder() { } HudLadder :: HudLadder( const HudLadder & image ) : dual_instr_item( (dual_instr_item &) image), width_units ( image.width_units ), div_units ( image.div_units ), label_pos ( image.label_pos ), scr_hole ( image.scr_hole ), vmax ( image.vmax ), vmin ( image.vmin ), factor ( image.factor ) { } HudLadder & HudLadder :: operator = ( const HudLadder & rhs ) { if( !(this == &rhs)) { (dual_instr_item &)(*this) = (dual_instr_item &)rhs; width_units = rhs.width_units; div_units = rhs.div_units; label_pos = rhs.label_pos; scr_hole = rhs.scr_hole; vmax = rhs.vmax; vmin = rhs.vmin; factor = rhs.factor; } return *this; } // // Draws a climb ladder in the center of the HUD // // $$$ begin - added VS Renganathan, 13 Oct 2K #ifdef FIGHTER_HUD void HudLadder :: draw( void ) { float x_ini; float x_end; float y; int count; float cosine, sine,xvvr,yvvr,Vxx,Vyy,Vzz,up_vel,ground_vel,actslope; float Axx,Ayy,Azz,total_vel,pot_slope,t1,t2,psi,alpha,pla; float vel_x,vel_y,drift; char Textaux[8] ; GLdouble eqn_top[4] = {0.0,-1.0,0.0,0.0}; GLdouble eqn_left[4] = {-1.0,0.0,0.0,100.0}; GLdouble eqn_right[4] = {1.0,0.0,0.0,100.0}; POINT centroid = get_centroid(); RECT box = get_location(); float half_span = box.right / 2.0; float roll_value = current_ch2(); alpha = get_aoa(); pla = get_throttleval(); int lgear,wown,wowm,iclaw,ihook; iclaw = get_iaux1(); lgear = get_iaux2(); wown = get_iaux3(); wowm = get_iaux4(); ihook = get_iaux5(); float pitch_value = current_ch1() * RAD_TO_DEG; vmin = pitch_value - (float)width_units; vmax = pitch_value + (float)width_units; //$$$ glPushMatrix(); glTranslatef( centroid.x, centroid.y, 0); //********************************************************* //waypoint marker computation float fromwp_lat,towp_lat,fromwp_lon,towp_lon,dist,delx,dely,hyp,theta,brg; fromwp_lon = get_longitude()*DEG_TO_RAD; fromwp_lat = get_latitude()*DEG_TO_RAD; towp_lon = get_aux5()*DEG_TO_RAD; towp_lat = get_aux6()*DEG_TO_RAD; dist = acos(sin(fromwp_lat)*sin(towp_lat)+cos(fromwp_lat)*cos(towp_lat)*cos(fabs(fromwp_lon-towp_lon))); delx= towp_lat - fromwp_lat; dely = towp_lon - fromwp_lon; hyp = sqrt(pow(delx,2)+pow(dely,2)); if (hyp != 0) { theta = asin(dely/hyp); } else { theta = 0.0; } brg = theta*RAD_TO_DEG; if (brg > 360.0) brg = 0.0; if (delx < 0) brg = 180 - brg; // {Brg = asin(cos(towp_lat)*sin(fabs(fromwp_lon-towp_lon))/ sin(dist)); // Brg = Brg * RAD_TO_DEG; } dist = dist*RAD_TO_DEG * 60.0*1852.0; //rad->deg->nm->m //********************************************************* // Draw the FRL spot and line #define FRL_DIAMOND_SIZE 2.0 glBegin(GL_LINE_LOOP); glVertex2f( -FRL_DIAMOND_SIZE, 0.0); glVertex2f(0.0, FRL_DIAMOND_SIZE); glVertex2f( FRL_DIAMOND_SIZE, 0.0); glVertex2f(0.0, -FRL_DIAMOND_SIZE); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(0, FRL_DIAMOND_SIZE); glVertex2f(0, 8.0 ); glEnd(); #undef FRL_DIAMOND_SIZE //velocity vector reticle - computations Vxx = get_Vx(); Vyy = get_Vy(); Vzz = get_Vz(); Axx = get_Ax(); Ayy = get_Ay(); Azz = get_Az(); psi = get_heading(); if (psi > 180.0) psi = psi - 360; total_vel = sqrt(Vxx*Vxx + Vyy*Vyy + Vzz*Vzz); ground_vel = sqrt(Vxx*Vxx + Vyy*Vyy); up_vel = Vzz; if (ground_vel < 2.0) { if (fabs(up_vel) < 2.0) { actslope = 0.0; } else { actslope = (up_vel/fabs(up_vel))*90.0; } } else { actslope = atan(up_vel/ground_vel)*RAD_TO_DEG; } xvvr = (((atan2(Vyy,Vxx)*RAD_TO_DEG)-psi)*(640.0/45.0)); drift = ((atan2(Vyy,Vxx)*RAD_TO_DEG)-psi); yvvr = ((actslope - pitch_value)*factor); vel_y = ((actslope -pitch_value) * cos(roll_value) + drift*sin(roll_value))*factor; vel_x = (-(actslope -pitch_value)*sin(roll_value) + drift*cos(roll_value))*(640/45.0); // printf("%f %f %f %f\n",vel_x,vel_y,drift,psi); // drift marker glBegin(GL_LINE_STRIP); glVertex2f((xvvr*25/120)-6, -4); glVertex2f(xvvr*25/120, 8); glVertex2f((xvvr*25/120)+6, -4); glEnd(); // clip hud ladder glClipPlane(GL_CLIP_PLANE0,eqn_top); glEnable(GL_CLIP_PLANE0); glClipPlane(GL_CLIP_PLANE1,eqn_left); glEnable(GL_CLIP_PLANE1); glClipPlane(GL_CLIP_PLANE2,eqn_right); glEnable(GL_CLIP_PLANE2); // alpha bracket - reqd only for landing (tied to hook) if (ihook == 1) { glBegin(GL_LINE_STRIP); glVertex2f(vel_x-20 , vel_y-(16-alpha)*factor); glVertex2f(vel_x-17, vel_y-(16-alpha)*factor); glVertex2f(vel_x-17, vel_y-(14-alpha)*factor); glVertex2f(vel_x-20, vel_y-(14-alpha)*factor); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(vel_x+20 , vel_y-(16-alpha)*factor); glVertex2f(vel_x+17, vel_y-(16-alpha)*factor); glVertex2f(vel_x+17, vel_y-(14-alpha)*factor); glVertex2f(vel_x+20, vel_y-(14-alpha)*factor); glEnd(); } //printf("xvr=%f,yvr=%f,Vx=%f,Vy=%f,Vz=%f\n",xvvr,yvvr,Vx,Vy,Vz); //printf("Ax=%f,Ay=%f,Az=%f\n",Ax,Ay,Az); //energy markers - compute potential slope if (total_vel < 5.0) { t1 = 0; t2 = 0; } else { t1 = up_vel/total_vel; t2 = asin((Vxx*Axx + Vyy*Ayy + Vzz*Azz)/(9.81*total_vel)); } pot_slope = ((t2/3)*RAD_TO_DEG)*factor + vel_y; //energy markers glBegin(GL_LINE_STRIP); glVertex2f(vel_x-20, pot_slope-5); glVertex2f(vel_x-15, pot_slope); glVertex2f(vel_x-20, pot_slope+5); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(vel_x+20, pot_slope-5); glVertex2f(vel_x+15, pot_slope); glVertex2f(vel_x+20, pot_slope+5); glEnd(); if (pla > (105.0/131.0)) { glBegin(GL_LINE_STRIP); glVertex2f(vel_x-24, pot_slope-5); glVertex2f(vel_x-19, pot_slope); glVertex2f(vel_x-24, pot_slope+5); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(vel_x+24, pot_slope-5); glVertex2f(vel_x+19, pot_slope); glVertex2f(vel_x+24, pot_slope+5); glEnd(); } // ramp reticle - for ski jump takeoff only if (iclaw == 1) { glBegin(GL_LINE_STRIP); glVertex2f(-15, -134); glVertex2f(15, -134); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(-6, -134); glVertex2f(-6, t2*RAD_TO_DEG*4.0 - 134); glVertex2f(+6, t2*RAD_TO_DEG*4.0 - 134); glVertex2f(6, -134); glEnd(); glBegin(GL_LINE_LOOP); glVertex2f(-6, actslope*4.0 - 134); glVertex2f(0, actslope*4.0 -134 +3); glVertex2f(6, actslope*4.0 - 134); glVertex2f(0, actslope*4.0 -134 -3); glEnd(); } // Draw the locked velocity vector. glBegin(GL_LINE_LOOP); glVertex2f( -3.0, 0.0+vel_y); glVertex2f(0.0, 6.0+vel_y); glVertex2f( 3.0, 0.0+vel_y); glVertex2f(0.0, -6.0+vel_y); glEnd(); // draw velocity vector glBegin(GL_LINE_LOOP); // Use polygon to approximate a circle for(count=0; count<50; count++) { cosine = 6 * cos(count * 2 * M_PI/50.0); sine = 6 * sin(count * 2 * M_PI/50.0); glVertex2f(cosine+vel_x, sine+vel_y); } glEnd(); //velocity vector reticle orientation lines glBegin(GL_LINE_STRIP); glVertex2f(vel_x-12, vel_y); glVertex2f(vel_x-6, vel_y); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(vel_x+12, vel_y); glVertex2f(vel_x+6, vel_y); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(vel_x, vel_y+12); glVertex2f(vel_x, vel_y+6); glEnd(); if (lgear == 1) { // undercarriage status glBegin(GL_LINE_STRIP); glVertex2f(vel_x+8, vel_y); glVertex2f(vel_x+8, vel_y-4); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(vel_x-8, vel_y); glVertex2f(vel_x-8, vel_y-4); glEnd(); glBegin(GL_LINE_STRIP); glVertex2f(vel_x, vel_y-6); glVertex2f(vel_x, vel_y-10); glEnd(); } if (ihook == 1) { // arrestor hook status glBegin(GL_LINE_STRIP); glVertex2f(vel_x-4, vel_y-8); glVertex2f(vel_x, vel_y-10); glVertex2f(vel_x+4, vel_y-8); glEnd(); } // FRL marker not rotated - this line shifted below glTranslatef( vel_x, vel_y, 0); glRotatef(roll_value * RAD_TO_DEG, 0.0, 0.0, 1.0); if( div_units ) { char TextLadder[8] ; float label_length ; float label_height ; float left ; float right ; float bot ; float top ; float text_offset = 4.0f ; float zero_offset = 50.0f ; fntFont *font = HUDtext->getFont(); float pointsize = HUDtext->getPointSize(); float italic = HUDtext->getSlant(); TextList.setFont( HUDtext ); TextList.erase(); LineList.erase(); StippleLineList.erase(); int last = FloatToInt(vmax)+1; int i = FloatToInt(vmin); if( !scr_hole ) { for( ; igetBBox ( TextLadder, pointsize, italic, &left, &right, &bot, &top ) ; label_length = right - left; label_length += text_offset; label_height = (top - bot)/2.0f; x_ini = -half_span; x_end = half_span; if( i >= 0 ) { // Make zero point wider on left if( i == 0 ) x_ini -= zero_offset; // Zero or above draw solid lines Line(x_ini, y, x_end, y); } else { // Below zero draw dashed lines. StippleLine(x_ini, y, x_end, y); } // Calculate the position of the left text and write it. Text( x_ini-label_length, y-label_height, TextLadder ); Text( x_end+text_offset, y-label_height, TextLadder ); } } } else // if(scr_hole ) { // Draw ladder with space in the middle of the lines float hole = (float)((scr_hole)/2.0f); for( ; igetBBox ( TextLadder, pointsize, italic, &left, &right, &bot, &top ) ; label_length = right - left; label_length += text_offset; label_height = (top - bot)/2.0f; // printf("l %f r %f b %f t %f\n",left, right, bot, top ); // Start by calculating the points and drawing the // left side lines. x_ini = -half_span; x_end = -half_span + hole; if( i >= 0 ) { // Make zero point wider on left if( i == 0 ) { x_ini -= zero_offset; } else { // Zero or above draw solid lines Line(x_end, y-5.0, x_end, y); } Line(x_ini, y, x_end, y); } else { // Below zero draw dashed lines. Line(x_end, y+5.0, x_end, y); StippleLine(x_ini, y, x_end, y); } // Now calculate the location of the left side label using Text( x_ini-label_length, y-label_height, TextLadder ); // Now calculate and draw the right side line location x_ini = half_span - hole; x_end = half_span; if( i >= 0 ) { if( i == 0 ) { x_end += zero_offset; } else { Line(x_ini, y-5.0, x_ini, y); } // Zero or above draw solid lines Line(x_ini, y, x_end, y); } else { // Below zero draw dashed lines. Line(x_ini, y+5.0, x_ini, y); StippleLine(x_ini, y, x_end, y); } // Calculate the location and draw the right side label Text( x_end+text_offset, y-label_height, TextLadder ); } } // draw appraoch glide slope marker - for landing only (tied to hook) if (ihook) { Line(-half_span+15, (-4-actslope)*factor, -half_span + hole, (-4-actslope)*factor); Line(half_span-15, (-4-actslope)*factor, half_span - hole, (-4-actslope)*factor); } } TextList.draw(); glLineWidth(0.2); LineList.draw(); glEnable(GL_LINE_STIPPLE); glLineStipple( 1, 0x00FF ); StippleLineList.draw( ); glDisable(GL_LINE_STIPPLE); } glDisable(GL_CLIP_PLANE0); glDisable(GL_CLIP_PLANE1); glDisable(GL_CLIP_PLANE2); // glDisable(GL_SCISSOR_TEST); glPopMatrix(); //************************************************************* // waypoint marker if (fabs(brg-psi) > 10.0) { glPushMatrix(); glTranslatef( centroid.x, centroid.y, 0); glTranslatef( vel_x, vel_y, 0); glRotatef(brg - psi,0.0,0.0,-1.0); glBegin(GL_LINE_LOOP); glVertex2f(-2.5,20.0); glVertex2f(-2.5,30.0); glVertex2f(-5.0,30.0); glVertex2f(0.0,35.0); glVertex2f(5.0,30.0); glVertex2f(2.5,30.0); glVertex2f(2.5,20.0); glEnd(); glPopMatrix(); } // waypoint marker on heading scale if (fabs(brg-psi) < 12.0) { glBegin(GL_LINE_LOOP); glVertex2f(((brg-psi)*60/25)+320,240.0); glVertex2f(((brg-psi)*60/25)+326,240.0-4); glVertex2f(((brg-psi)*60/25)+323,240.0-4); glVertex2f(((brg-psi)*60/25)+323,240.0-8); glVertex2f(((brg-psi)*60/25)+317,240.0-8); glVertex2f(((brg-psi)*60/25)+317,240.0-4); glVertex2f(((brg-psi)*60/25)+314,240.0-4); glEnd(); } //************************************************************* } #else // $$$ end - added VS Renganathan, 13 Oct 2K // draw DEFAULT_HUD void HudLadder :: draw( void ) { POINT centroid = get_centroid(); float roll_value = current_ch2(); glPushMatrix(); glTranslatef( centroid.x, centroid.y, 0); // Alex's panel patch // glScalef( current_options.get_fov()/55.0, 1.0, 1.0 ); glRotatef(roll_value * RAD_TO_DEG, 0.0, 0.0, 1.0); // Draw the target spot. #define CENTER_DIAMOND_SIZE 6.0f glBegin(GL_LINE_LOOP); glVertex2f( CENTER_DIAMOND_SIZE, 0.0); glVertex2f( 0.0, CENTER_DIAMOND_SIZE); glVertex2f( -CENTER_DIAMOND_SIZE, 0.0); glVertex2f( 0.0, -CENTER_DIAMOND_SIZE); glEnd(); if( minimal || ! div_units ) { glPopMatrix(); return; } float x_ini; float x_end; float y; float pitch_value = current_ch1() * RAD_TO_DEG; vmin = pitch_value - (float)width_units * 0.5f; vmax = pitch_value + (float)width_units * 0.5f; RECT box = get_location(); float half_span = box.right * 0.5f ; char TextLadder[8] ; float label_length ; float label_height ; float left ; float right ; float bot ; float top ; float text_offset = 4.0f ; float zero_offset = 10.0f ; fntFont *font = HUDtext->getFont(); float pointsize = HUDtext->getPointSize(); float italic = HUDtext->getSlant(); TextList.setFont( HUDtext ); TextList.erase(); LineList.erase(); StippleLineList.erase(); int last = FloatToInt(vmax)+1; int i = FloatToInt(vmin); if( !scr_hole ) { x_end = half_span; for( ; igetBBox ( TextLadder, pointsize, italic, &left, &right, &bot, &top ) ; label_length = right - left; label_length += text_offset; label_height = (top - bot) * 0.5f; x_ini = -half_span; if( i >= 0 ) { // Make zero point wider on left if( i == 0 ) x_ini -= zero_offset; // Zero or above draw solid lines Line(x_ini, y, x_end, y); } else { // Below zero draw dashed lines. StippleLine(x_ini, y, x_end, y); } // Calculate the position of the left text and write it. Text( x_ini-label_length, y-label_height, TextLadder ); Text( x_end+text_offset, y-label_height, TextLadder ); } } } else { // scr_hole != 0 // Draw ladder with space in the middle of the lines float x_ini2; float x_end2; float hole = (float)((scr_hole)*0.5f); x_end = -half_span + hole; x_ini2 = half_span - hole; for( ; igetBBox ( TextLadder, pointsize, italic, &left, &right, &bot, &top ) ; label_length = right - left; label_length += text_offset; label_height = (top - bot) * 0.5f; // Start by calculating the points and drawing the // left side lines. x_ini = -half_span; x_end2 = half_span; if( i >= 0 ) { // Make zero point wider on left if( i == 0 ) { x_ini -= zero_offset; x_end2 += zero_offset; } // Zero or above draw solid lines Line(x_ini, y, x_end, y); Line(x_ini2, y, x_end2, y); } else { // Below zero draw dashed lines. StippleLine(x_ini, y, x_end, y); StippleLine(x_ini2, y, x_end2, y); } // Calculate the location of the left side label using Text( x_ini-label_length, y-label_height, TextLadder ); // Calculate the location and draw the right side label Text( x_end2+text_offset, y-label_height, TextLadder ); } } } TextList.draw(); LineList.draw(); glEnable(GL_LINE_STIPPLE); #ifdef DO_PANEL_HACK glLineStipple( 1, fgPanelVisible() ? 0x0F0F : 0x00FF ); #else glLineStipple( 1, 0x00FF ); #endif StippleLineList.draw( ); glDisable(GL_LINE_STIPPLE); // } // if(div_units) glPopMatrix(); } #endif // DEFAULT_HUD