mirror of https://github.com/ArduPilot/ardupilot
parent
ce1b68cce8
commit
6dd28f632c
|
@ -599,7 +599,7 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
|
||||||
uint8_t result = MAV_RESULT_UNSUPPORTED;
|
uint8_t result = MAV_RESULT_UNSUPPORTED;
|
||||||
|
|
||||||
// do command
|
// do command
|
||||||
send_text(MAV_SEVERITY_INFO,"command received: ");
|
send_text(MAV_SEVERITY_INFO,"Command received: ");
|
||||||
|
|
||||||
switch(packet.command) {
|
switch(packet.command) {
|
||||||
|
|
||||||
|
@ -827,7 +827,7 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
|
||||||
// check if this is the HOME wp
|
// check if this is the HOME wp
|
||||||
if (packet.seq == 0) {
|
if (packet.seq == 0) {
|
||||||
tracker.set_home(tell_command); // New home in EEPROM
|
tracker.set_home(tell_command); // New home in EEPROM
|
||||||
send_text(MAV_SEVERITY_INFO,"new HOME received");
|
send_text(MAV_SEVERITY_INFO,"New HOME received");
|
||||||
waypoint_receiving = false;
|
waypoint_receiving = false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -916,7 +916,7 @@ void Tracker::mavlink_delay_cb()
|
||||||
}
|
}
|
||||||
if (tnow - last_5s > 5000) {
|
if (tnow - last_5s > 5000) {
|
||||||
last_5s = tnow;
|
last_5s = tnow;
|
||||||
gcs_send_text(MAV_SEVERITY_INFO, "Initialising APM...");
|
gcs_send_text(MAV_SEVERITY_INFO, "Initialising APM");
|
||||||
}
|
}
|
||||||
in_mavlink_delay = false;
|
in_mavlink_delay = false;
|
||||||
}
|
}
|
||||||
|
|
|
@ -6,7 +6,7 @@ void Tracker::init_barometer(void)
|
||||||
{
|
{
|
||||||
gcs_send_text(MAV_SEVERITY_INFO, "Calibrating barometer");
|
gcs_send_text(MAV_SEVERITY_INFO, "Calibrating barometer");
|
||||||
barometer.calibrate();
|
barometer.calibrate();
|
||||||
gcs_send_text(MAV_SEVERITY_INFO, "barometer calibration complete");
|
gcs_send_text(MAV_SEVERITY_INFO, "Barometer calibration complete");
|
||||||
}
|
}
|
||||||
|
|
||||||
// read the barometer and return the updated altitude in meters
|
// read the barometer and return the updated altitude in meters
|
||||||
|
|
|
@ -248,7 +248,7 @@ void Tracker::update_yaw_position_servo(float yaw)
|
||||||
}
|
}
|
||||||
|
|
||||||
if (new_slew_dir != slew_dir) {
|
if (new_slew_dir != slew_dir) {
|
||||||
tracker.gcs_send_text_fmt(MAV_SEVERITY_WARNING, "SLEW: %d/%d err=%ld servo=%ld ez=%.3f",
|
tracker.gcs_send_text_fmt(MAV_SEVERITY_WARNING, "Slew: %d/%d err=%ld servo=%ld ez=%.3f",
|
||||||
(int)slew_dir, (int)new_slew_dir,
|
(int)slew_dir, (int)new_slew_dir,
|
||||||
(long)angle_err,
|
(long)angle_err,
|
||||||
(long)channel_yaw.servo_out,
|
(long)channel_yaw.servo_out,
|
||||||
|
|
|
@ -94,7 +94,7 @@ void Tracker::init_tracker()
|
||||||
if (fabsf(g.start_latitude) <= 90.0f && fabsf(g.start_longitude) <= 180.0f) {
|
if (fabsf(g.start_latitude) <= 90.0f && fabsf(g.start_longitude) <= 180.0f) {
|
||||||
current_loc.lat = g.start_latitude * 1.0e7f;
|
current_loc.lat = g.start_latitude * 1.0e7f;
|
||||||
current_loc.lng = g.start_longitude * 1.0e7f;
|
current_loc.lng = g.start_longitude * 1.0e7f;
|
||||||
gcs_send_text(MAV_SEVERITY_NOTICE, "ignoring invalid START_LATITUDE or START_LONGITUDE parameter");
|
gcs_send_text(MAV_SEVERITY_NOTICE, "Ignoring invalid START_LATITUDE or START_LONGITUDE parameter");
|
||||||
}
|
}
|
||||||
|
|
||||||
// see if EEPROM has a default location as well
|
// see if EEPROM has a default location as well
|
||||||
|
@ -104,7 +104,7 @@ void Tracker::init_tracker()
|
||||||
|
|
||||||
init_capabilities();
|
init_capabilities();
|
||||||
|
|
||||||
gcs_send_text(MAV_SEVERITY_INFO,"\nReady to track.");
|
gcs_send_text(MAV_SEVERITY_INFO,"Ready to track");
|
||||||
hal.scheduler->delay(1000); // Why????
|
hal.scheduler->delay(1000); // Why????
|
||||||
|
|
||||||
set_mode(AUTO); // tracking
|
set_mode(AUTO); // tracking
|
||||||
|
|
Loading…
Reference in New Issue