// adjust heading based on current rudder angle
- if (rudder <= -0.25 or rudder >= 0.25) {
+ if (rudder <= -0.25 || rudder >= 0.25) {
/* turn_radius_ft = 0.088362 * speed * speed
/ tan( fabs(rudder) / SG_RADIANS_TO_DEGREES );
turn_circum_ft = SGD_2PI * turn_radius_ft;
//low pass filter
roll = (raw_roll * roll_constant) + (roll * (1 - roll_constant));
- cout << " rudder: " << rudder << " raw roll: "<< raw_roll<<" roll: " << roll ;
- cout << " hdg: " << hdg << endl ;
+ /*cout << " rudder: " << rudder << " raw roll: "<< raw_roll<<" roll: " << roll ;
+ cout << " hdg: " << hdg << endl ;*/
// adjust target rudder angle if heading lock engaged
if (hdg_lock) {