def getimu(m, addr):
m.setaddr(addr)
m.flush()
m.loadheli(cmd.mode(cmd.mode_get_imu))
m.sendbase(cmd.mode(cmd.mode_sendrecv))
try:
(arr, t, crc) = m.nextline()
if (arr == False):
sys.stderr.write("\n** Error ** ")
sys.stderr.write(repr(t) + "\n\n")
return -1, None
elif arr:
if crc:
sys.stderr.write("o")
sys.stderr.flush()
return 1, None
else:
return 0, arr
else:
sys.stderr.write("x")
sys.stderr.flush()
return 1, None
except:
sys.stderr.write(repr(sys.exc_info()))
sys.stderr.write("\nQuitting... \n")
return -1, None
def startup(m): m.sendbase(cmd.radio(int(chan))) m.sendheli(cmd.flags(cmd.ledmode_cnt + cmd.tick)) m.sendheli(cmd.mode(cmd.mode_imu_loop)) m.sendbase(cmd.flags(cmd.ledmode_cnt + cmd.notick)) m.sendbase(cmd.mode(cmd.mode_sniff))
def startup(m,chan): m.sendbase(cmd.radio(chan)) # time.sleep(1) m.sendbase(cmd.flags(cmd.ledmode_cnt + cmd.notick)) # time.sleep(1) m.sendheli(cmd.flags(cmd.ledmode_cnt + cmd.tick)) #time.sleep(1) m.sendheli(cmd.mode(cmd.mode_imu_loop)) #time.sleep(1) m.sendbase(cmd.mode(cmd.mode_sniff))
def startup(m): m.sendbase(cmd.radio(25)) m.sendbase(cmd.flags(cmd.ledmode_cnt + cmd.notick)) # m.sendheli(cmd.flags(cmd.ledmode_cnt + cmd.tick)) m.sendbase(cmd.mode(cmd.mode_sniff))
def end(m): m.sendbase(cmd.mode(cmd.mode_spin)) m.end()
