nav parameter
This commit is contained in:
parent
a2a19d5583
commit
861305bfcd
@ -12,7 +12,7 @@ BVMSTATE = "TURNEDOFF"
|
|||||||
PICTURE_WAIT = 20 # steps
|
PICTURE_WAIT = 20 # steps
|
||||||
GOTO_MAXVEL = 0.5 # m/steps
|
GOTO_MAXVEL = 0.5 # m/steps
|
||||||
GOTO_MAXDIST = 150 # m.
|
GOTO_MAXDIST = 150 # m.
|
||||||
GOTODIST_TOL = 1.0 # m.
|
GOTODIST_TOL = 2.0 # m.
|
||||||
GOTOANG_TOL = 0.2 # rad.
|
GOTOANG_TOL = 0.2 # rad.
|
||||||
path_it = 0
|
path_it = 0
|
||||||
graphid = 0
|
graphid = 0
|
||||||
@ -98,7 +98,7 @@ function goto_gps(transf) {
|
|||||||
else {
|
else {
|
||||||
#LimitSpeed(m_navigation, 1.0)
|
#LimitSpeed(m_navigation, 1.0)
|
||||||
log("NAVIGATION !!!! distance to target: ", math.vec2.length(m_navigation)," angle", math.vec2.angle(m_navigation) )
|
log("NAVIGATION !!!! distance to target: ", math.vec2.length(m_navigation)," angle", math.vec2.angle(m_navigation) )
|
||||||
goto_abs(m_navigation.x/5, m_navigation.y/5, rc_goto.altitude - pose.position.altitude, 0.0)
|
goto_abs(m_navigation.x, m_navigation.y, rc_goto.altitude - pose.position.altitude, 0.0)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user