Browse Source

try to correct commander_atan - not working

master
Louis-Guillaume DUBOIS 11 years ago
parent
commit
05bbe16f37
  1. 4
      src/commander_atan.cpp

4
src/commander_atan.cpp

@ -106,12 +106,12 @@ class Run
{ {
if(msg->normal.z > 0) if(msg->normal.z > 0)
{ {
in.y = msg->normal.x; in.y = - msg->normal.x;
in.x = msg->normal.y; in.x = msg->normal.y;
} else } else
{ {
in.y = - msg->normal.x; in.y = - msg->normal.x;
in.x = - msg->normal.y; in.x = msg->normal.y;
} }
in.z = msg->altitude - neutral_z; in.z = msg->altitude - neutral_z;
in.th = msg->angle; in.th = msg->angle;

Loading…
Cancel
Save