00001
00002
00003 import roslib
00004 roslib.load_manifest('pr2_camera_synchronizer')
00005 import rospy
00006 import time
00007
00008 from ethercat_trigger_controllers.srv import SetMultiWaveform, SetMultiWaveformResponse
00009 from ethercat_trigger_controllers.msg import MultiWaveform
00010
00011 class Main:
00012 def __init__(self):
00013 rospy.init_node('fake_multi_trigger_controller', anonymous = True)
00014 rospy.Service('~set_waveform', SetMultiWaveform, self.waveform_set)
00015 self.pub = rospy.Publisher('~waveform', MultiWaveform, latch = True)
00016
00017 def waveform_set(self, req):
00018 self.pub.publish(req.waveform)
00019 return SetMultiWaveformResponse(success = True)
00020
00021 if __name__ == "__main__":
00022 Main()
00023 while not rospy.is_shutdown():
00024 time.sleep(0.1)