X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FCockpit%2Fhud_ladr.cxx;h=38def8d9d7c85b4c13b1d2d7bc59c0232f46a1e4;hb=13ec36af4218402eda39c680e8da6ca2c198733c;hp=2e9524ac380205e879d2eeea612e711ec2d9e08c;hpb=cff0022a164a2e3147ff7186d7b1dedcab900492;p=flightgear.git diff --git a/src/Cockpit/hud_ladr.cxx b/src/Cockpit/hud_ladr.cxx index 2e9524ac3..38def8d9d 100644 --- a/src/Cockpit/hud_ladr.cxx +++ b/src/Cockpit/hud_ladr.cxx @@ -1,680 +1,785 @@ +#ifdef HAVE_CONFIG_H +# include "config.h" +#endif + +#include #include "hud.hxx" #include "panel.hxx" +#include
+ +// FIXME +extern float get_roll(void); +extern float get_pitch(void); + + +HudLadder::HudLadder(const SGPropertyNode *node) : + dual_instr_item( + node->getIntValue("x"), + node->getIntValue("y"), + node->getIntValue("width"), + node->getIntValue("height"), + get_roll, + get_pitch, // FIXME getter functions from cockpit.cxx + node->getBoolValue("working", true), + HUDS_RIGHT), + width_units(int(node->getFloatValue("span_units"))), + div_units(int(fabs(node->getFloatValue("division_units")))), + minor_div(0 /* hud.cxx: static float minor_division = 0 */), + label_pos(node->getIntValue("lbl_pos")), + scr_hole(node->getIntValue("screen_hole")), + factor(node->getFloatValue("compression_factor")), + hudladder_type(node->getStringValue("name")), + frl(node->getBoolValue("enable_frl", false)), + target_spot(node->getBoolValue("enable_target_spot", false)), + velocity_vector(node->getBoolValue("enable_velocity_vector", false)), + drift_marker(node->getBoolValue("enable_drift_marker", false)), + alpha_bracket(node->getBoolValue("enable_alpha_bracket", false)), + energy_marker(node->getBoolValue("enable_energy_marker", false)), + climb_dive_marker(node->getBoolValue("enable_climb_dive_marker", false)), + glide_slope_marker(node->getBoolValue("enable_glide_slope_marker",false)), + glide_slope(node->getFloatValue("glide_slope", -4.0)), + energy_worm(node->getBoolValue("enable_energy_marker", false)), + waypoint_marker(node->getBoolValue("enable_waypoint_marker", false)), + zenith(node->getIntValue("zenith")), + nadir(node->getIntValue("nadir")), + hat(node->getIntValue("hat")) +{ + // The factor assumes a base of 55 degrees per 640 pixels. + // Invert to convert the "compression" factor to a + // pixels-per-degree number. + if (fgGetBool("/sim/hud/enable3d", true) && HUD_style == 1) + factor = 640.0 / 55.0; -#define DO_PANEL_HACK - -//====================== Top of HudLadder Class ======================= -HudLadder :: HudLadder( string name, - int x, - int y, - UINT width, - UINT height, - float factr, - FLTFNPTR ptch_source, - FLTFNPTR roll_source, - float span_units, - float major_div, - float minor_div, - UINT screen_hole, - UINT lbl_pos, - bool frl_spot, - bool target, - bool vel_vec, - bool drift, - bool alpha, - bool energy, - bool climb, - bool glide, - float glide_slope_val, - bool worm_energy, - bool waypoint, - 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 ), - factor ( factr ), - hudladder_type ( name ), - frl ( frl_spot ), - velocity_vector ( vel_vec ), - drift_marker ( drift ), - alpha_bracket ( alpha ), - energy_marker ( energy ), - climb_dive_marker ( climb ), - target_spot ( target ), - glide_slope_marker ( glide ), - glide_slope ( glide_slope_val), - energy_worm ( worm_energy), - waypoint_marker ( waypoint) + SG_LOG(SG_INPUT, SG_INFO, "Done reading HudLadder instrument" + << node->getStringValue("name", "[unnamed]")); + if (!width_units) + width_units = 45; -{ - if( !width_units ) { - width_units = 45; - } -} - -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_type ( image.hudladder_type), - frl ( image.frl), - velocity_vector ( image.velocity_vector), - drift_marker ( image.drift_marker), - alpha_bracket ( image.alpha_bracket), - energy_marker ( image.energy_marker), - climb_dive_marker ( image.climb_dive_marker), - target_spot ( image.target_spot), - glide_slope_marker ( image.glide_slope_marker), - glide_slope ( image.glide_slope), - energy_worm ( image.energy_worm), - waypoint_marker ( image.waypoint_marker) -{ -} -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; - hudladder_type = rhs.hudladder_type; - frl = rhs.frl; - velocity_vector = rhs.velocity_vector; - drift_marker = rhs.drift_marker; - alpha_bracket = rhs.alpha_bracket; - energy_marker = rhs.energy_marker; - climb_dive_marker = rhs.climb_dive_marker; - target_spot = rhs.target_spot; - glide_slope_marker = rhs.glide_slope_marker; - glide_slope = rhs.glide_slope; - energy_worm = rhs.energy_worm; - waypoint_marker = rhs.waypoint_marker; - } - return *this; + vmax = width_units / 2; + vmin = -vmax; } - + + // // Draws a climb ladder in the center of the HUD // -void HudLadder :: draw( void ) +void HudLadder::draw(void) { - float x_ini,x_ini2; - float x_end,x_end2; - float y; + float x_ini, x_ini2; + float x_end, x_end2; + float y = 0; 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] ; - bool pitch_ladder; - bool climb_dive_ladder; - bool clip_plane; - - 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(); + float cosine, sine, xvvr, yvvr, Vxx = 0.0, Vyy = 0.0, Vzz = 0.0; + float up_vel, ground_vel, actslope = 0.0; + float Axx = 0.0, Ayy = 0.0, Azz = 0.0, total_vel = 0.0, pot_slope, t1; + float t2 = 0.0, psi = 0.0, alpha, pla; + float vel_x = 0.0, vel_y = 0.0, drift; + bool pitch_ladder = false; + bool climb_dive_ladder = false; + bool clip_plane = false; + + 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,ilcanclaw,ihook; - ilcanclaw = get_iaux1(); - lgear = get_iaux2(); - wown = get_iaux3(); - wowm = get_iaux4(); - ihook = get_iaux5(); - - float pitch_value = current_ch1() * RAD_TO_DEG; - - if(hudladder_type=="Climb/Dive Ladder") { - pitch_ladder = false; - climb_dive_ladder = true; - clip_plane = true; +#ifdef ENABLE_SP_FDM + int lgear, wown, wowm, ilcanclaw, ihook; + ilcanclaw = get_iaux2(); + lgear = get_iaux3(); + wown = get_iaux4(); + wowm = get_iaux5(); + ihook = get_iaux6(); +#endif + float pitch_value = current_ch1() * SGD_RADIANS_TO_DEGREES; + + if (hudladder_type == "Climb/Dive Ladder") { + pitch_ladder = false; + climb_dive_ladder = true; + clip_plane = true; + + } else { // hudladder_type == "Pitch Ladder" + pitch_ladder = true; + climb_dive_ladder = false; + clip_plane = false; } - else - if(hudladder_type=="Pitch Ladder") { - pitch_ladder = true; - climb_dive_ladder = false; - clip_plane = false; - } - + //************************************************************** glPushMatrix(); - // define (0,0) as center of screen - glTranslatef( centroid.x, centroid.y, 0); + // define (0, 0) as center of screen + glTranslatef(centroid.x, centroid.y, 0); // OBJECT STATIC RETICLE // TYPE FRL // ATTRIB - ALWAYS // Draw the FRL spot and line - if(frl) { + if (frl) { #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(); + 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 } // TYPE WATERLINE_MARK (W shaped _ _ ) - // \/\/ + // \/\/ - //**************************************************************** + //**************************************************************** // TYPE TARGET_SPOT // Draw the target spot. - if (target_spot) { + if (target_spot) { #define CENTER_DIAMOND_SIZE 6.0 - 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(); + 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(); #undef CENTER_DIAMOND_SIZE } - //**************************************************************** + //**************************************************************** //velocity vector reticle - computations - if(velocity_vector) { - 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); - //**************************************************************** - // OBJECT MOVING RETICLE - // TYPE - DRIFT MARKER - // ATTRIB - ALWAYS - // drift marker - if(drift_marker) { - glBegin(GL_LINE_STRIP); - glVertex2f((xvvr*25/120)-6, -4); - glVertex2f(xvvr*25/120, 8); - glVertex2f((xvvr*25/120)+6, -4); - glEnd(); - } - - //**************************************************************** - // Clipping coordinates for ladder to be input from xml file - // Clip hud ladder - if (clip_plane) { - 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); - // glScissor(-100,-240,200,240); - // glEnable(GL_SCISSOR_TEST); - } - //**************************************************************** - // OBJECT MOVING RETICLE - // TYPE VELOCITY VECTOR - // ATTRIB - ALWAYS - // velocity vector - glBegin(GL_LINE_LOOP); // Use polygon to approximate a circle - for(count=0; count<50; count++) { - cosine = 6 * cos(count * 2 * FG_PI/50.0); - sine = 6 * sin(count * 2 * FG_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(); - - // OBJECT MOVING RETICLE - // TYPE LINE - // ATTRIB - ON CONDITION - if (lgear == 1) { - // undercarriage status - glBegin(GL_LINE_STRIP); - glVertex2f(vel_x+8, vel_y); - glVertex2f(vel_x+8, vel_y-4); - glEnd(); - // OBJECT MOVING RETICLE - // TYPE LINE - // ATTRIB - ON CONDITION - glBegin(GL_LINE_STRIP); - glVertex2f(vel_x-8, vel_y); - glVertex2f(vel_x-8, vel_y-4); - glEnd(); - // OBJECT MOVING RETICLE - // TYPE LINE - // ATTRIB - ON CONDITION - glBegin(GL_LINE_STRIP); - glVertex2f(vel_x, vel_y-6); - glVertex2f(vel_x, vel_y-10); - glEnd(); - } - - // OBJECT MOVING RETICLE - // TYPE V - // ATTRIB - ON CONDITION - 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(); - } - }//if velocity_vector + if (velocity_vector) { + 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) * SGD_RADIANS_TO_DEGREES; + } + + xvvr = (((atan2(Vyy, Vxx) * SGD_RADIANS_TO_DEGREES) - psi) + * (factor / globals->get_current_view()->get_aspect_ratio())); + drift = ((atan2(Vyy, Vxx) * SGD_RADIANS_TO_DEGREES) - 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)) + * (factor/globals->get_current_view()->get_aspect_ratio()); + // printf("%f %f %f %f\n",vel_x, vel_y, drift, psi); + + //**************************************************************** + // OBJECT MOVING RETICLE + // TYPE - DRIFT MARKER + // ATTRIB - ALWAYS + // drift marker + if (drift_marker) { + glBegin(GL_LINE_STRIP); + glVertex2f((xvvr * 25 / 120) - 6, -4); + glVertex2f(xvvr * 25 / 120, 8); + glVertex2f((xvvr * 25 / 120) + 6, -4); + glEnd(); + } + + //**************************************************************** + // Clipping coordinates for ladder to be input from xml file + // Clip hud ladder + if (clip_plane) { + 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); + // glScissor(-100,-240, 200, 240); + // glEnable(GL_SCISSOR_TEST); + } + + //**************************************************************** + // OBJECT MOVING RETICLE + // TYPE VELOCITY VECTOR + // ATTRIB - ALWAYS + // velocity vector + glBegin(GL_LINE_LOOP); // Use polygon to approximate a circle + for (count = 0; count < 50; count++) { + cosine = 6 * cos(count * SGD_2PI / 50.0); + sine = 6 * sin(count * SGD_2PI / 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(); + +#ifdef ENABLE_SP_FDM + // OBJECT MOVING RETICLE + // TYPE LINE + // ATTRIB - ON CONDITION + if (lgear == 1) { + // undercarriage status + glBegin(GL_LINE_STRIP); + glVertex2f(vel_x + 8, vel_y); + glVertex2f(vel_x + 8, vel_y - 4); + glEnd(); + + // OBJECT MOVING RETICLE + // TYPE LINE + // ATTRIB - ON CONDITION + glBegin(GL_LINE_STRIP); + glVertex2f(vel_x - 8, vel_y); + glVertex2f(vel_x - 8, vel_y - 4); + glEnd(); + + // OBJECT MOVING RETICLE + // TYPE LINE + // ATTRIB - ON CONDITION + glBegin(GL_LINE_STRIP); + glVertex2f(vel_x, vel_y - 6); + glVertex2f(vel_x, vel_y - 10); + glEnd(); + } + + // OBJECT MOVING RETICLE + // TYPE V + // ATTRIB - ON CONDITION + 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(); + } +#endif + } // if velocity_vector + //*************************************************************** // OBJECT MOVING RETICLE // TYPE - SQUARE_BRACKET // ATTRIB - ON CONDITION // alpha bracket - if (alpha_bracket) { - 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(); - } +#ifdef ENABLE_SP_FDM + if (alpha_bracket && 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); - //**************************************************************** +#endif + //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); + + //**************************************************************** // OBJECT MOVING RETICLE // TYPE ENERGY_MARKERS // ATTRIB - ALWAYS //energy markers - compute potential slope - if(energy_marker) { - 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; - // if (pot_slope < (vel_y - 45)) pot_slope = vel_y-45; - // if (pot_slope > (vel_y + 45)) pot_slope = vel_y+45; - - //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(); - } + if (energy_marker) { + 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) * SGD_RADIANS_TO_DEGREES) * factor + vel_y; + // if (pot_slope < (vel_y - 45)) pot_slope = vel_y - 45; + // if (pot_slope > (vel_y + 45)) pot_slope = vel_y + 45; + + //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 // OBJECT STATIC RETICLE // TYPE LINE // ATTRIB - ON CONDITION - if (energy_worm) { - if (ilcanclaw == 1) { - glBegin(GL_LINE_STRIP); - glVertex2f(-15, -134); - glVertex2f(15, -134); - glEnd(); - // OBJECT MOVING RETICLE - // TYPE BOX - // ATTRIB - ON CONDITION - 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(); - // OBJECT MOVING RETICLE - // TYPE DIAMOND - // ATTRIB - ON CONDITION - 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(); - } +#ifdef ENABLE_SP_FDM + if (energy_worm && ilcanclaw == 1) { + glBegin(GL_LINE_STRIP); + glVertex2f(-15, -134); + glVertex2f(15, -134); + glEnd(); + + // OBJECT MOVING RETICLE + // TYPE BOX + // ATTRIB - ON CONDITION + glBegin(GL_LINE_STRIP); + glVertex2f(-6, -134); + glVertex2f(-6, t2 * SGD_RADIANS_TO_DEGREES * 4.0 - 134); + glVertex2f(+6, t2 * SGD_RADIANS_TO_DEGREES * 4.0 - 134); + glVertex2f(6, -134); + glEnd(); + + // OBJECT MOVING RETICLE + // TYPE DIAMOND + // ATTRIB - ON CONDITION + 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(); } +#endif + //************************************************************* // OBJECT MOVING RETICLE // TYPE DIAMOND // ATTRIB - ALWAYS // Draw the locked velocity vector. - if(climb_dive_marker) { - 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(); + if (climb_dive_marker) { + 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(); } - //**************************************************************** - - if(climb_dive_ladder) {// CONFORMAL_HUD + //**************************************************************** - vmin = pitch_value - (float)width_units; - vmax = pitch_value + (float)width_units; - - glTranslatef( vel_x, vel_y, 0); + if (climb_dive_ladder) { // CONFORMAL_HUD + vmin = pitch_value - (float)width_units; + vmax = pitch_value + (float)width_units; + glTranslatef(vel_x, vel_y, 0); + } else { // pitch_ladder - Default Hud + vmin = pitch_value - (float)width_units * 0.5f; + vmax = pitch_value + (float)width_units * 0.5f; } - else - if (pitch_ladder) {//Default Hud - - vmin = pitch_value - (float)width_units * 0.5f; - vmax = pitch_value + (float)width_units * 0.5f; - - } - glRotatef(roll_value * RAD_TO_DEG, 0.0, 0.0, 1.0); + glRotatef(roll_value * SGD_RADIANS_TO_DEGREES, 0.0, 0.0, 1.0); // FRL marker not rotated - this line shifted below - 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; - - if(climb_dive_ladder) - zero_offset = 50.0f ; - else - if(pitch_ladder) - zero_offset = 10.0f ; - - fntFont *font = HUDtext->getFont(); - float pointsize = HUDtext->getPointSize(); - float italic = HUDtext->getSlant(); - - TextList.setFont( HUDtext ); + 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 = 0.0; + + if (climb_dive_ladder) + zero_offset = 50.0f; // horizon line is wider by this much (hard coded ??) + else + zero_offset = 10.0f; + + fntFont *font = HUDtext->getFont(); // FIXME + 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; + int last = float_to_int(vmax) + 1; + int i = float_to_int(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)/2.0f; - + label_height = (top - bot) / 2.0f; + x_ini = -half_span; - - if( i >= 0 ) { + + if (i >= 0) { // Make zero point wider on left - if( i == 0 ) + if (i == 0) x_ini -= zero_offset; + // Zero or above draw solid lines Line(x_ini, y, x_end, y); + + if (i == 90 && zenith == 1) + drawZenith(x_ini, x_end, y); } else { // Below zero draw dashed lines. StippleLine(x_ini, y, x_end, y); + + if (i == -90 && nadir ==1) + drawNadir(x_ini, 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 ); + 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); + + x_end = -half_span + hole; + x_ini2 = half_span - hole; + + for (; i < last; i++) { + if (hudladder_type == "Pitch Ladder") + y = (((float)(i - pitch_value) * factor) + .5); + else if (hudladder_type == "Climb/Dive Ladder") + y = (((float)(i - actslope) * factor) + .5); + + if (!(i % div_units)) { // At integral multiple of div + sprintf(TextLadder, "%d", i); + font->getBBox(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_end2 = half_span; + + if (i >= 0) { + // Make zero point wider on left + if (i == 0) { + x_ini -= zero_offset; + x_end2 += zero_offset; + } + //draw climb bar vertical lines + if (climb_dive_ladder) { + // Zero or above draw solid lines + Line(x_end, y - 5.0, x_end, y); + Line(x_ini2, y - 5.0, x_ini2, y); + } + // draw pitch / climb bar + Line(x_ini, y, x_end, y); + Line(x_ini2, y, x_end2, y); + + if (i == 90 && zenith == 1) + drawZenith(x_ini2, x_end, y); + + } else { // i < 0 + // draw dive bar vertical lines + if (climb_dive_ladder) { + Line(x_end, y + 5.0, x_end, y); + Line(x_ini2, y + 5.0, x_ini2, y); + } + + // draw pitch / dive bars + StippleLine(x_ini, y, x_end, y); + StippleLine(x_ini2, y, x_end2, y); + + if (i == -90 && nadir == 1) + drawNadir(x_ini2, x_end, y); + } + + // Now calculate the location of the left side label using + Text(x_ini-label_length, y - label_height, TextLadder); + Text(x_end2+text_offset, y - label_height, TextLadder); } } + + // OBJECT LADDER MARK + // TYPE LINE + // ATTRIB - ON CONDITION + // draw appraoch glide slope marker +#ifdef ENABLE_SP_FDM + if (glide_slope_marker && ihook) { + Line(-half_span + 15, (glide_slope-actslope) * factor, + -half_span + hole, (glide_slope - actslope) * factor); + Line(half_span - 15, (glide_slope-actslope) * factor, + half_span - hole, (glide_slope - actslope) * factor); + } +#endif } - else // if(scr_hole ) - { // Draw ladder with space in the middle of the lines - float hole = (float)((scr_hole)/2.0f); - - 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)/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_end2= half_span; - - if( i >= 0 ) { - // Make zero point wider on left - if( i == 0 ) { - x_ini -= zero_offset; - x_end2 +=zero_offset; - } else { - if(climb_dive_ladder){ - // Zero or above draw solid lines - Line(x_end, y-5.0, x_end, y); - Line(x_ini2, y-5.0, x_ini2, y); - } - } - - Line(x_ini, y, x_end, y); - Line(x_ini2, y, x_end2, y); - - } else { - // Below zero draw dashed lines. - if(climb_dive_ladder) { - Line(x_end, y+5.0, x_end, y); - Line(x_ini2, y+5.0, x_ini2, y); - } - StippleLine(x_ini, y, x_end, y); - StippleLine(x_ini2, y, x_end2, y); - } - - // Now calculate the location of the left side label using - Text( x_ini-label_length, y-label_height, TextLadder ); - Text (x_end2+text_offset, y-label_height, TextLadder ); - - } - } - - // OBJECT LADDER MARK - // TYPE LINE - // ATTRIB - ON CONDITION - // draw appraoch glide slope marker - if (glide_slope_marker) { - if (ihook) { - Line(-half_span+15, (glide_slope-actslope)*factor, -half_span + hole, (glide_slope-actslope)*factor); - Line(half_span-15, (glide_slope-actslope)*factor, half_span - hole, (glide_slope-actslope)*factor); - } - }// if glide_slope_marker - } TextList.draw(); glLineWidth(0.2); - + LineList.draw(); - + glEnable(GL_LINE_STIPPLE); - glLineStipple( 1, 0x00FF ); - StippleLineList.draw( ); + 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); + // glDisable(GL_SCISSOR_TEST); glPopMatrix(); //************************************************************* + //************************************************************* - if(waypoint_marker) { - //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 - // end waypoint marker computation - //********************************************************* - // OBJECT MOVING RETICLE - // TYPE ARROW - // 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(); - } - //************************************************************* - }// if waypoint_marker +#ifdef ENABLE_SP_FDM + if (waypoint_marker) { + //waypoint marker computation + float fromwp_lat, towp_lat, fromwp_lon, towp_lon, dist, delx, dely, hyp, theta, brg; + + fromwp_lon = get_longitude() * SGD_DEGREES_TO_RADIANS; + fromwp_lat = get_latitude() * SGD_DEGREES_TO_RADIANS; + towp_lon = get_aux2() * SGD_DEGREES_TO_RADIANS; + towp_lat = get_aux1() * SGD_DEGREES_TO_RADIANS; + + 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 * SGD_RADIANS_TO_DEGREES; + 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 * SGD_RADIANS_TO_DEGREES; } + + dist *= SGD_RADIANS_TO_DEGREES * 60.0 * 1852.0; //rad->deg->nm->m + // end waypoint marker computation + + //********************************************************* + // OBJECT MOVING RETICLE + // TYPE ARROW + // 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) { + if (hat == 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 { //if hat=0 + float x = (brg - psi) * 60 / 25 + 320, y = 240.0, r = 5.0; + float x1, y1; + + glEnable(GL_POINT_SMOOTH); + glBegin(GL_POINTS); + + for (int count = 0; count <= 200; count++) { + float temp = count * 3.142 * 3 / (200.0 * 2.0); + float temp1 = temp - (45.0 * SGD_DEGREES_TO_RADIANS); + x1 = x + r * cos(temp1); + y1 = y + r * sin(temp1); + glVertex2f(x1, y1); + } + + glEnd(); + glDisable(GL_POINT_SMOOTH); + } //hat=0 + + } //brg<12 + } // if waypoint_marker +#endif }//draw + + +/******************************************************************/ +// draws the zenith symbol for highest possible climb angle (i.e. 90 degree climb angle) +// +void HudLadder::drawZenith(float xfirst, float xlast, float yvalue) +{ + float xcentre = (xfirst + xlast) / 2.0; + float ycentre = yvalue; + + Line(xcentre - 9.0, ycentre, xcentre - 3.0, ycentre + 1.3); + Line(xcentre - 9.0, ycentre, xcentre - 3.0, ycentre - 1.3); + + Line(xcentre + 9.0, ycentre, xcentre + 3.0, ycentre + 1.3); + Line(xcentre + 9.0, ycentre, xcentre + 3.0, ycentre - 1.3); + + Line(xcentre, ycentre + 9.0, xcentre - 1.3, ycentre + 3.0); + Line(xcentre, ycentre + 9.0, xcentre + 1.3, ycentre + 3.0); + + Line(xcentre - 3.9, ycentre + 3.9, xcentre - 3.0, ycentre + 1.3); + Line(xcentre - 3.9, ycentre + 3.9, xcentre - 1.3, ycentre + 3.0); + + Line(xcentre + 3.9, ycentre + 3.9, xcentre + 1.3, ycentre+3.0); + Line(xcentre + 3.9, ycentre + 3.9, xcentre + 3.0, ycentre+1.3); + + Line(xcentre - 3.9, ycentre - 3.9, xcentre - 3.0, ycentre-1.3); + Line(xcentre - 3.9, ycentre - 3.9, xcentre - 1.3, ycentre-2.6); + + Line(xcentre + 3.9, ycentre - 3.9, xcentre + 3.0, ycentre-1.3); + Line(xcentre + 3.9, ycentre - 3.9, xcentre + 1.3, ycentre-2.6); + + Line(xcentre - 1.3, ycentre - 2.6, xcentre, ycentre - 27.0); + Line(xcentre + 1.3, ycentre - 2.6, xcentre, ycentre - 27.0); +} + + +// draws the nadir symbol for lowest possible dive angle (i.e. 90 degree dive angle) +// +void HudLadder::drawNadir(float xfirst, float xlast, float yvalue) +{ + float xcentre = (xfirst + xlast) / 2.0; + float ycentre = yvalue; + + float r = 7.5; + float x1, y1, x2, y2; + + // to draw a circle + float xcent1, xcent2, ycent1, ycent2; + xcent1 = xcentre + r; + ycent1 = ycentre; + + for (int count = 1; count <= 400; count++) { + float temp = count * 2 * 3.142 / 400.0; + xcent2 = xcentre + r * cos(temp); + ycent2 = ycentre + r * sin(temp); + + Line(xcent1, ycent1, xcent2, ycent2); + + xcent1 = xcent2; + ycent1 = ycent2; + } + + xcent2 = xcentre + r; + ycent2 = ycentre; + + drawOneLine(xcent1, ycent1, xcent2, ycent2); //to connect last point to first point + //end circle + + //to draw a line above the circle + Line(xcentre, ycentre + 7.5, xcentre, ycentre + 22.5); + + //line in the middle of circle + Line(xcentre - 7.5, ycentre, xcentre + 7.5, ycentre); + + float theta = asin (2.5 / 7.5); + float theta1 = asin(5.0 / 7.5); + + x1 = xcentre + r * cos(theta); + y1 = ycentre + 2.5; + x2 = xcentre + r * cos((180.0 * SGD_DEGREES_TO_RADIANS) - theta); + y2 = ycentre + 2.5; + Line(x1, y1, x2, y2); + + x1 = xcentre + r * cos(theta1); + y1 = ycentre + 5.0; + x2 = xcentre + r * cos((180.0 * SGD_DEGREES_TO_RADIANS) - theta1); + y2 = ycentre + 5.0; + Line(x1, y1, x2, y2); + + x1 = xcentre + r * cos((180.0 * SGD_DEGREES_TO_RADIANS) + theta); + y1 = ycentre - 2.5; + x2 = xcentre + r * cos((360.0 * SGD_DEGREES_TO_RADIANS) - theta); + y2 = ycentre - 2.5; + Line(x1, y1, x2, y2); + + x1 = xcentre + r * cos((180.0 * SGD_DEGREES_TO_RADIANS) + theta1); + y1 = ycentre - 5.0; + x2 = xcentre + r * cos((360.0 * SGD_DEGREES_TO_RADIANS) - theta1); + y2 = ycentre - 5.0; + Line(x1, y1, x2, y2); +} + +