timeout in bzz
This commit is contained in:
parent
e1def9d976
commit
abdef63da6
|
@ -302,6 +302,7 @@ namespace rosbzz_node{
|
|||
pt.position.y = goto_pos[1];
|
||||
pt.position.z = goto_pos[2];
|
||||
pt.yaw = 0;//goto_pos[3];
|
||||
ROS_INFO("Sending local setpoint: %.2f, %.2f, %.2f",pt.position.x,pt.position.y,pt.position.z);
|
||||
localsetpoint_pub.publish(pt);
|
||||
}
|
||||
/*obtain Pay load to be sent*/
|
||||
|
|
|
@ -78,7 +78,7 @@ function barrier_ready() {
|
|||
#
|
||||
# Executes the barrier
|
||||
#
|
||||
WAIT_TIMEOUT = 100
|
||||
WAIT_TIMEOUT = 500
|
||||
timeW=0
|
||||
function barrier_wait(threshold, transf) {
|
||||
barrier.get(id)
|
||||
|
@ -88,7 +88,7 @@ function barrier_wait(threshold, transf) {
|
|||
transf()
|
||||
} else if(timeW>=WAIT_TIMEOUT) {
|
||||
barrier = nil
|
||||
statef=hexagon #idle
|
||||
statef=land
|
||||
timeW=0
|
||||
}
|
||||
timeW = timeW+1
|
||||
|
@ -166,6 +166,7 @@ function step() {
|
|||
neighbors.broadcast("cmd", 21)
|
||||
} else if(flight.rc_cmd==16) {
|
||||
flight.rc_cmd=0
|
||||
statef = idle
|
||||
uav_goto()
|
||||
} else if(flight.rc_cmd==400) {
|
||||
flight.rc_cmd=0
|
||||
|
|
Loading…
Reference in New Issue