Quadrotor

Revision 7a6ed02d

Major changes in mikrokopter for lost connection

-In nav_lib.cpp, added main_loop, so we don't have to keep rewriting it
:). Also, this now publishes to /mk_wrapper/control, which should be
used from now on. However, old publish_on still works as it did.

-Changed turn_to_target and joystick_control (but not any others yet) to
use new nav_lib main_loop.

-Added mk_wrapper, which simply copies messages from /mk_wrapper/control
to /mikrokopter/req_set_control. After recieving the first message, if
it receives no message for a period of 200ms (rosparam max_quiet_time),
it will instead publish 0's and a thrust of 60, ignoring all future
input until restarted.

-Added launch files onboard.launch and joystick.launch, so that we
remember what should run where and can easily set some parameters.

JoystickControl::JoystickControl()

{

  pub = n.advertise<mikrokopter::Control>("/mikrokopter/req_set_control", 100); 

  sub = n.subscribe<sensor_msgs::Joy>("joy", 100,

      &JoystickControl::joyCallback, this);

}

void JoystickControl::joyLoop()

{

    ros::Rate loop_rate(25);

    while(ros::ok())

    {

        ros::spinOnce(); // if joyCallback is called, it will be in here

        control.publish_on(pub);

        loop_rate.sleep();

    }

    return;

    control.main_loop();

}

void JoystickControl::joyCallback(const sensor_msgs::Joy::ConstPtr& joy)

Also available in: Unified diff