Spiri
/
ROSBuzz_MISTLab
12
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

minor fix on gohome

This commit is contained in:
dave 2018-11-12 18:17:09 -05:00
parent 7d74c9291a
commit fa0e872928
1 changed files with 3 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
buzz_scripts/include/act/states.bzz
View File

@ -19,6 +19,7 @@ WP_STIG = 8
path_it = 0 path_it = 0
pic_time = 0 pic_time = 0
g_it = 0 g_it = 0
homegps = {}
# Core state function when on the ground # Core state function when on the ground
function turnedoff() { function turnedoff() {
@ -35,7 +36,8 @@ function launch() {
BVMSTATE = "LAUNCH" BVMSTATE = "LAUNCH"
log("AUTO_LAUNCH_STATE: ", AUTO_LAUNCH_STATE) log("AUTO_LAUNCH_STATE: ", AUTO_LAUNCH_STATE)
if(V_TYPE == 0 or V_TYPE == 1) { # flying vehicle so TAKE_OFF if(V_TYPE == 0 or V_TYPE == 1) { # flying vehicle so TAKE_OFF
homegps = {.lat=pose.position.latitude, .long=pose.position.longitude} homegps = {.lat=pose.position.latitude, .lng=pose.position.longitude}
log("Recorded home point: ",homegps.lat, homegps.lng)
if(pose.position.altitude >= TARGET_ALTITUDE-TARGET_ALTITUDE/20.0) { if(pose.position.altitude >= TARGET_ALTITUDE-TARGET_ALTITUDE/20.0) {
barrier_set(ROBOTS, AUTO_LAUNCH_STATE, "STOP", 22) barrier_set(ROBOTS, AUTO_LAUNCH_STATE, "STOP", 22)
barrier_ready(22) barrier_ready(22)