|
|
|
@ -565,7 +565,7 @@ void Aircraft::update_dynamics(const Vector3f &rot_accel)
@@ -565,7 +565,7 @@ void Aircraft::update_dynamics(const Vector3f &rot_accel)
|
|
|
|
|
// constrain height to the ground
|
|
|
|
|
if (on_ground()) { |
|
|
|
|
if (!was_on_ground && AP_HAL::millis() - last_ground_contact_ms > 1000) { |
|
|
|
|
gcs().send_text(MAV_SEVERITY_INFO, "SIM Hit ground at %f m/s", velocity_ef.z); |
|
|
|
|
GCS_SEND_TEXT(MAV_SEVERITY_INFO, "SIM Hit ground at %f m/s", velocity_ef.z); |
|
|
|
|
last_ground_contact_ms = AP_HAL::millis(); |
|
|
|
|
} |
|
|
|
|
position.z = -(ground_level + frame_height - home.alt * 0.01f + ground_height_difference()); |
|
|
|
|