1
0
Fork 0

More heave tweaks.

This commit is contained in:
curt 1999-10-01 20:33:06 +00:00
parent 26193c5b19
commit 780a3c6831

View file

@ -572,7 +572,7 @@ static void send_pve_out( fgIOCHANNEL *p ) {
pitch_deg -= 360; pitch_deg -= 360;
} }
int heave = (int)(f->get_W_body()); int heave = (int)(f->get_W_body()) + 128;
// scale roll and pitch to output format (1 - 255) // scale roll and pitch to output format (1 - 255)
// straight && level == (128, 128) // straight && level == (128, 128)
@ -580,7 +580,7 @@ static void send_pve_out( fgIOCHANNEL *p ) {
int roll = (int)( (roll_deg+180.0) * 255.0 / 360.0) + 1; int roll = (int)( (roll_deg+180.0) * 255.0 / 360.0) + 1;
int pitch = (int)( (pitch_deg+180.0) * 255.0 / 360.0) + 1; int pitch = (int)( (pitch_deg+180.0) * 255.0 / 360.0) + 1;
sprintf( pve, "p%c%c\n", roll, pitch); sprintf( pve, "p%c%c%c\n", roll, pitch, heave);
FG_LOG( FG_SERIAL, FG_INFO, "roll=" << roll << " pitch=" << pitch << FG_LOG( FG_SERIAL, FG_INFO, "roll=" << roll << " pitch=" << pitch <<
" heave=" << heave ); " heave=" << heave );