def __init__(self):
self.current_publisher = rospy.Publisher('CurrentSensor/battery_current_draw', Float64, queue_size=10)
self._hz = rospy.get_param('~hz' , 50)
try:
"""
* Allocate a new Phidget Channel object
"""
ch = CurrentInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 2
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch.setHubPort(channelInfo.hubPort)
ch.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch.setChannel(channelInfo.channel)
ch.setOnAttachHandler(onAttachHandler)
ch.setOnDetachHandler(onDetachHandler)
ch.setOnErrorHandler(onErrorHandler)
ch.setOnCurrentChangeHandler(onCurrentChangeHandler)
"""
* Open the channel with a timeout
"""
print("\nOpening and Waiting for Attachment...")
try:
ch.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch)
raise EndProgramSignal("Program Terminated: Open Failed")
except:
pass
def __init__(self):
self.current_publisher = rospy.Publisher(
'CurrentSensor/battery_current_draw', Float64, queue_size=10)
self._hz = rospy.get_param('~hz', 50)
try:
"""
* Allocate a new Phidget Channel object
"""
ch = CurrentInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 2
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch.setHubPort(channelInfo.hubPort)
ch.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch.setChannel(channelInfo.channel)
ch.setOnAttachHandler(onAttachHandler)
ch.setOnDetachHandler(onDetachHandler)
ch.setOnErrorHandler(onErrorHandler)
ch.setOnCurrentChangeHandler(onCurrentChangeHandler)
"""
* Open the channel with a timeout
"""
print("\nOpening and Waiting for Attachment...")
try:
ch.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch)
raise EndProgramSignal("Program Terminated: Open Failed")
except:
pass
def __init__(self):
self.motor_current_publisher = rospy.Publisher('phidgetsensor/motor_current_draw', Float64, queue_size=10)
self.voltage_publisher = rospy.Publisher('phidgetsensor/battery_voltage' , Float64, queue_size=10)
self.battery_current_publisher = rospy.Publisher('phidgetsensor/battery_current_draw', Float64, queue_size=10)
self._hz = 10
#Channel 1 will be the motor_current_draw
ch1 = CurrentInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 2
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch1.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch1.setHubPort(channelInfo.hubPort)
ch1.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch1.setChannel(channelInfo.channel)
ch1.setOnAttachHandler(self.onAttachHandler)
ch1.setOnDetachHandler(self.onDetachHandler)
ch1.setOnErrorHandler(self.onErrorHandler)
ch1.setOnCurrentChangeHandler(self.onCurrentChangeHandler_m)
try:
ch1.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch1)
raise EndProgramSignal("Program Terminated: Open ch1 failed")
#channel 2 will be the battery voltage
ch2 = VoltageInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 1
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch2.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch2.setHubPort(channelInfo.hubPort)
ch2.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch2.setChannel(channelInfo.channel)
ch2.setOnAttachHandler(self.onAttachHandler)
ch2.setOnDetachHandler(self.onDetachHandler)
ch2.setOnErrorHandler(self.onErrorHandler)
ch2.setOnVoltageChangeHandler(self.onVoltageChangeHandler)
try:
ch2.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch2)
raise EndProgramSignal("Program Terminated: Open ch2 failed")
#channel 3 will be the battery current
ch3 = CurrentInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 0
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch3.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch3.setHubPort(channelInfo.hubPort)
ch3.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch3.setChannel(channelInfo.channel)
ch3.setOnAttachHandler(self.onAttachHandler)
ch3.setOnDetachHandler(self.onDetachHandler)
ch3.setOnErrorHandler(self.onErrorHandler)
ch3.setOnCurrentChangeHandler(self.onCurrentChangeHandler_b)
try:
ch3.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch3)
raise EndProgramSignal("Program Terminated: Open ch3 failed")
def __init__(self):
self.motor_current_publisher = rospy.Publisher(
'phidgetsensor/motor_current_draw', Float64, queue_size=10)
self.voltage_publisher = rospy.Publisher(
'phidgetsensor/battery_voltage', Float64, queue_size=10)
self.battery_current_publisher = rospy.Publisher(
'phidgetsensor/battery_current_draw', Float64, queue_size=10)
self._hz = 10
#Channel 1 will be the motor_current_draw
ch1 = CurrentInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 2
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch1.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch1.setHubPort(channelInfo.hubPort)
ch1.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch1.setChannel(channelInfo.channel)
ch1.setOnAttachHandler(self.onAttachHandler)
ch1.setOnDetachHandler(self.onDetachHandler)
ch1.setOnErrorHandler(self.onErrorHandler)
ch1.setOnCurrentChangeHandler(self.onCurrentChangeHandler_m)
try:
ch1.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch1)
raise EndProgramSignal("Program Terminated: Open ch1 failed")
#channel 2 will be the battery voltage
ch2 = VoltageInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 1
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch2.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch2.setHubPort(channelInfo.hubPort)
ch2.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch2.setChannel(channelInfo.channel)
ch2.setOnAttachHandler(self.onAttachHandler)
ch2.setOnDetachHandler(self.onDetachHandler)
ch2.setOnErrorHandler(self.onErrorHandler)
ch2.setOnVoltageChangeHandler(self.onVoltageChangeHandler)
try:
ch2.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch2)
raise EndProgramSignal("Program Terminated: Open ch2 failed")
#channel 3 will be the battery current
ch3 = CurrentInput()
channelInfo = ChannelInfo()
channelInfo.deviceSerialNumber = 539331
channelInfo.hubPort = 0
channelInfo.isHubPortDevice = 0
channelInfo.channel = 0
ch3.setDeviceSerialNumber(channelInfo.deviceSerialNumber)
ch3.setHubPort(channelInfo.hubPort)
ch3.setIsHubPortDevice(channelInfo.isHubPortDevice)
ch3.setChannel(channelInfo.channel)
ch3.setOnAttachHandler(self.onAttachHandler)
ch3.setOnDetachHandler(self.onDetachHandler)
ch3.setOnErrorHandler(self.onErrorHandler)
ch3.setOnCurrentChangeHandler(self.onCurrentChangeHandler_b)
try:
ch3.openWaitForAttachment(5000)
except PhidgetException as e:
PrintOpenErrorMessage(e, ch3)
raise EndProgramSignal("Program Terminated: Open ch3 failed")
