Commit 4fb71e3b authored by Yvan Bosshard's avatar Yvan Bosshard
Browse files

cleaning up repositories

parent 3cdf48e7
......@@ -195,7 +195,7 @@ class PPSRadioClient:
#publish battery voltage for GUI
#cfbattery_pub.publish(std_msgs.Float32(batteryVolt.data))
# print "batteryVolt: %s" % batteryVolt
print "batteryVolt: %s" % batteryVolt
cfbattery_pub.publish(batteryVolt)
......@@ -206,6 +206,9 @@ class PPSRadioClient:
def _vbat_logging_error(self, batLog, msg):
print "Error when logging %s" % batLog.name
def _xyzrpy_logging_error(self, xyzrpy, msg):
print "Error when logging %s" % xyzrpy.name
# def _init_logging(self):
def init_log_battery(self):
......@@ -224,7 +227,7 @@ class PPSRadioClient:
print "batLog start"
def init_log_xyzrpy(self):
self.xyzrpy = LogConfig("XYZRPYLog", xyzrpy_polling_period)
self.xyzrpy = LogConfig("XYZRPYLog", 50)
#self.xyzrpy.add_variable("xxx.x", "float");
#self.xyzrpy.add_variable("xxx.y", "float");
#self.xyzrpy.add_variable("xxx.z", "float");
......@@ -248,7 +251,7 @@ class PPSRadioClient:
self.init_log_battery()
#self.init_log_xyzrpy() #TODO: Test
self.init_log_xyzrpy() #TODO: Test
#TODO: Test, then clean up
......@@ -319,6 +322,11 @@ class PPSRadioClient:
self.batLog.delete()
rospy.loginfo("batLog deleted")
self.xyzrpy.stop()
rospy.loginfo("xyzrpy stopped")
self.xyzrpy.delete()
rospy.loginfo("xyzrpy deleted")
def _send_to_commander_motor(self, cmd1, cmd2, cmd3, cmd4):
pk = CRTPPacket()
pk.port = CRTPPort.COMMANDER_GENERIC
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment