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

some test changes

This commit is contained in:
Mario Alexis Labrana 2016-12-23 17:48:01 -05:00
parent 12f6cfe1ae
commit 53d400da27
2 changed files with 11 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
launch/rosbuzzm100.launch
View File

@ -2,7 +2,7 @@
<launch>
<node name="rosbuzz_node" pkg="rosbuzz" type="rosbuzz_node" respawn="false" output="screen" >
<param name="bzzfile_name" value="../ROS_WS/src/ROSBuzz/src/test1.bzz" />
<param name="bzzfile_name" value="../djiros_ws/src/ROSBuzz/src/test1.bzz" />
<param name="rcclient" value="true" />
<param name="rcservice_name" value="/buzzcmd" />
<param name="fcclient_name" value="/dji_mavcmd" />

16
src/test1.bzz
View File

@ -42,7 +42,7 @@ function table_print(t) {
})
}
function barrier_wait(threshold, transf) {
table_print(barrier)
#table_print(barrier)
barrier.get(id)
extradbg = barrier.size()
if(barrier.size() >= threshold) {
@ -54,6 +54,7 @@ function barrier_wait(threshold, transf) {
# flight status
function idle() {
statef=idle
neighbors.listen("cmd",
function(vid, value, rid) {
print("Got (", vid, ",", value, ") from robot #", rid)
@ -85,6 +86,7 @@ function land() {
function transition_to_land() {
statef=transition_to_land
if(tim>=100){
statef=land
tim=0
@ -106,17 +108,19 @@ statef=idle
# Executed at each time step.
function step() {
if(flight.rc_cmd!=oldcmd) {
#if(flight.rc_cmd!=oldcmd) {
if(flight.rc_cmd==22) {
if(flight.rc_cmd==22 and flight.status==1) {
flight.rc_cmd=0
statef=takeoff
neighbors.broadcast("cmd", 22)
} else if(flight.rc_cmd==21) {
} else if(flight.rc_cmd==21 and flight.status==2) {
flight.rc_cmd=0
statef=land
neighbors.broadcast("cmd", 21)
}
oldcmd=flight.rc_cmd
}
# oldcmd=flight.rc_cmd
#}
statef()
}