Check for negative values of altitude

modified: src/rosbuzz/src/roscontroller.cpp
2018-09-26 12:50:27 -04:00 · 2018-09-26 12:50:27 -04:00 · 65d7d3f5a8
parent 06c7bf4d7c
commit 65d7d3f5a8
1 changed files with 1 additions and 1 deletions
--- a/src/roscontroller.cpp
+++ b/src/roscontroller.cpp
@ -44,7 +44,7 @@ logical_clock(ros::Time()), previous_step_time(ros::Time())
  SetStreamRate(0, 10, 1);

  //  Get Home position - wait for none-zero value
-  while (cur_pos.latitude == 0.0f)
+  while ((cur_pos.latitude == 0.0f) || (cur_pos.altitude < -1000.0))
  {
    ROS_INFO("Waiting for GPS. ");
    ros::Duration(0.5).sleep();