+protected:
+ void _busdump(void);
+ void _updatePosition( double lat_geoc, double lon, double alt );
+ void _updateWeather( void );
+
+ inline void _set_Inertias( double m, double xx, double yy,
+ double zz, double xz)
+ {
+ mass = m;
+ i_xx = xx;
+ i_yy = yy;
+ i_zz = zz;
+ i_xz = xz;
+ }
+ inline void _set_CG_Position( double dx, double dy, double dz ) {
+ d_cg_rp_body_v[0] = dx;
+ d_cg_rp_body_v[1] = dy;
+ d_cg_rp_body_v[2] = dz;
+ }
+ inline void _set_Accels_Local( double north, double east, double down ) {
+ v_dot_local_v[0] = north;
+ v_dot_local_v[1] = east;
+ v_dot_local_v[2] = down;
+ }
+ inline void _set_Accels_Body( double u, double v, double w ) {
+ v_dot_body_v[0] = u;
+ v_dot_body_v[1] = v;
+ v_dot_body_v[2] = w;
+ }
+ inline void _set_Accels_CG_Body( double x, double y, double z ) {
+ a_cg_body_v[0] = x;
+ a_cg_body_v[1] = y;
+ a_cg_body_v[2] = z;
+ }
+ inline void _set_Accels_Pilot_Body( double x, double y, double z ) {
+ a_pilot_body_v[0] = x;
+ a_pilot_body_v[1] = y;
+ a_pilot_body_v[2] = z;
+ }
+ inline void _set_Accels_CG_Body_N( double x, double y, double z ) {
+ n_cg_body_v[0] = x;
+ n_cg_body_v[1] = y;
+ n_cg_body_v[2] = z;
+ }
+ void _set_Nlf(double n) { nlf=n; }
+ inline void _set_Velocities_Local( double north, double east, double down ){
+ v_local_v[0] = north;
+ v_local_v[1] = east;
+ v_local_v[2] = down;
+ }
+ inline void _set_Velocities_Ground(double north, double east, double down) {
+ v_local_rel_ground_v[0] = north;
+ v_local_rel_ground_v[1] = east;
+ v_local_rel_ground_v[2] = down;
+ }
+ inline void _set_Velocities_Local_Airmass( double north, double east,
+ double down)
+ {
+ v_local_airmass_v[0] = north;
+ v_local_airmass_v[1] = east;
+ v_local_airmass_v[2] = down;
+ }
+ inline void _set_Velocities_Wind_Body( double u, double v, double w) {
+ v_wind_body_v[0] = u;
+ v_wind_body_v[1] = v;
+ v_wind_body_v[2] = w;
+ }
+ inline void _set_V_rel_wind(double vt) { v_rel_wind = vt; }
+ inline void _set_V_ground_speed( double v) { v_ground_speed = v; }
+ inline void _set_V_equiv_kts( double kts ) { v_equiv_kts = kts; }
+ inline void _set_V_calibrated_kts( double kts ) { v_calibrated_kts = kts; }
+ inline void _set_Omega_Body( double p, double q, double r ) {
+ omega_body_v[0] = p;
+ omega_body_v[1] = q;
+ omega_body_v[2] = r;
+ }
+ inline void _set_Euler_Rates( double phi, double theta, double psi ) {
+ euler_rates_v[0] = phi;
+ euler_rates_v[1] = theta;
+ euler_rates_v[2] = psi;
+ }
+ inline void _set_Geocentric_Rates( double lat, double lon, double rad ) {
+ geocentric_rates_v[0] = lat;
+ geocentric_rates_v[1] = lon;
+ geocentric_rates_v[2] = rad;
+ }
+#if 0
+ inline void _set_Radius_to_vehicle(double radius) {
+ geocentric_position_v[2] = radius;
+ }
+#endif
+ inline void _set_Geocentric_Position( double lat, double lon, double rad ) {
+ geocentric_position_v[0] = lat;
+ geocentric_position_v[1] = lon;
+ geocentric_position_v[2] = rad;
+ }
+ inline void _set_Latitude(double lat) { geodetic_position_v[0] = lat; }
+ inline void _set_Longitude(double lon) { geodetic_position_v[1] = lon; }
+ inline void _set_Altitude(double altitude) {
+ geodetic_position_v[2] = altitude;
+ }
+ inline void _set_Altitude_AGL(double agl) {
+ altitude_agl = agl;
+ }
+ inline void _set_Geodetic_Position( double lat, double lon, double alt ) {
+ geodetic_position_v[0] = lat;
+ geodetic_position_v[1] = lon;
+ geodetic_position_v[2] = alt;
+ }
+ inline void _set_Euler_Angles( double phi, double theta, double psi ) {
+ euler_angles_v[0] = phi;
+ euler_angles_v[1] = theta;
+ euler_angles_v[2] = psi;
+ }
+ inline void _set_T_Local_to_Body( int i, int j, double value) {
+ t_local_to_body_m[i-1][j-1] = value;
+ }
+ inline void _set_T_Local_to_Body( double m[3][3] ) {
+ int i, j;
+ for ( i = 0; i < 3; i++ ) {
+ for ( j = 0; j < 3; j++ ) {
+ t_local_to_body_m[i][j] = m[i][j];
+ }
+ }
+ }
+ inline void _set_Alpha( double a ) { alpha = a; }
+ inline void _set_Beta( double b ) { beta = b; }
+ inline void _set_Cos_phi( double cp ) { cos_phi = cp; }
+ inline void _set_Cos_theta( double ct ) { cos_theta = ct; }
+ inline void _set_Gamma_vert_rad( double gv ) { gamma_vert_rad = gv; }
+ inline void _set_Density( double d ) { density = d; }
+ inline void _set_Mach_number( double m ) { mach_number = m; }
+ inline void _set_Static_pressure( double sp ) { static_pressure = sp; }
+ inline void _set_Static_temperature( double t ) { static_temperature = t; }
+ inline void _set_Sea_level_radius( double r ) { sea_level_radius = r; }
+ inline void _set_Earth_position_angle(double a) {
+ earth_position_angle = a;
+ }
+ inline void _set_Runway_altitude( double alt ) { runway_altitude = alt; }
+ inline void _set_Climb_Rate(double rate) { climb_rate = rate; }
+ inline void _set_sin_lat_geocentric(double parm) {
+ sin_lat_geocentric = sin(parm);
+ }
+ inline void _set_cos_lat_geocentric(double parm) {
+ cos_lat_geocentric = cos(parm);
+ }
+ inline void _set_sin_cos_longitude(double parm) {
+ sin_longitude = sin(parm);
+ cos_longitude = cos(parm);
+ }
+ inline void _set_sin_cos_latitude(double parm) {
+ sin_latitude = sin(parm);
+ cos_latitude = cos(parm);
+ }
+