self.lastcable=self.robot.startCableIn
else:
break
return time, self.robot.localisation.pose(), self.received
def __iter__(self):
return self
def next(self):
return self.update()
if __name__ == "__main__":
robot=EduroMaxi(can=DummyCan())
robot.localisation = KalmanFilter()
for run, start, msgdict in MetaLogReader(sys.argv[1]):
time, can_msgs=msgdict["CANlog"]
for id,data in can_msgs:
robot.updateEnc(id,data)
robot.updateEmergencyStop( id, data )
robot.updateCompass(id,data)
robot.updateButtons(id,data)
robot.updateSharps( id,data )
robot.updateBattery( id, data )
#print(robot.localisation.pose())
if 'RFU620LOG' in msgdict and msgdict['RFU620LOG']:
id, scans=msgdict['RFU620LOG']
#print(robot.localisation.pose())
for s in scans:
#print(s.id, s.RSSI)
pass
