Exemplo n.º 1
0
    def run(self):
        rospy.init_node('patlite_node')
        patlite_host = rospy.get_param('~host', "10.68.0.10")
        patlite_port = rospy.get_param('~port', 10000)
        timeout = rospy.get_param('~timeout', 0.5)
        self.p = Patlite(patlite_host, port=patlite_port, timeout=timeout)
        self.pstate = PatliteState()
        self.send_flag = False

        rospy.Subscriber("~set/red", Int8, self.callback_r)
        rospy.Subscriber("~set/yellow", Int8, self.callback_y)
        rospy.Subscriber("~set/green", Int8, self.callback_g)
        rospy.Subscriber("~set/blue", Int8, self.callback_b)
        rospy.Subscriber("~set/white", Int8, self.callback_w)
        rospy.Subscriber("~set/buzzer", Int8, self.callback_buzz)
        rospy.loginfo("[patlite_node] started")

        while not rospy.is_shutdown():
            if self.send_flag:
                self.send_flag = False
                try:
                    with self.p:
                        self.p.write(self.pstate)
                        self.pstate.clear()
                except socket.timeout:
                    rospy.logerr(
                        "[patlite_node] Error: socket timeout (%s:%d)",
                        patlite_host, patlite_port)
                except socket.error as e:
                    rospy.logerr("[patlite_node] Error: %s (%s:%d)", e,
                                 patlite_host, patlite_port)
            rospy.sleep(0.1)
        rospy.loginfo("[patlite_node] shutdown")
        return
Exemplo n.º 2
0
class PatliteNode(object):
    def set_state(self, target, state):
        self.pstate.set_from_int(target, state)
        self.send_flag = True

    def callback_r(self, msg):
        self.set_state(self.pstate.Target.LIGHT_RED, msg.data)

    def callback_y(self, msg):
        self.set_state(self.pstate.Target.LIGHT_YELLOW, msg.data)

    def callback_g(self, msg):
        self.set_state(self.pstate.Target.LIGHT_GREEN, msg.data)

    def callback_b(self, msg):
        self.set_state(self.pstate.Target.LIGHT_BLUE, msg.data)

    def callback_w(self, msg):
        self.set_state(self.pstate.Target.LIGHT_WHITE, msg.data)

    def callback_buzz(self, msg):
        self.set_state(self.pstate.Target.BUZZER, msg.data)

    def run(self):
        rospy.init_node('patlite_node')
        patlite_host = rospy.get_param('~host', "10.68.0.10")
        patlite_port = rospy.get_param('~port', 10000)
        timeout = rospy.get_param('~timeout', 0.5)
        self.p = Patlite(patlite_host, port=patlite_port, timeout=timeout)
        self.pstate = PatliteState()
        self.send_flag = False

        rospy.Subscriber("~set/red", Int8, self.callback_r)
        rospy.Subscriber("~set/yellow", Int8, self.callback_y)
        rospy.Subscriber("~set/green", Int8, self.callback_g)
        rospy.Subscriber("~set/blue", Int8, self.callback_b)
        rospy.Subscriber("~set/white", Int8, self.callback_w)
        rospy.Subscriber("~set/buzzer", Int8, self.callback_buzz)
        rospy.loginfo("[patlite_node] started")

        while not rospy.is_shutdown():
            if self.send_flag:
                self.send_flag = False
                try:
                    with self.p:
                        self.p.write(self.pstate)
                        self.pstate.clear()
                except socket.timeout:
                    rospy.logerr(
                        "[patlite_node] Error: socket timeout (%s:%d)",
                        patlite_host, patlite_port)
                except socket.error as e:
                    rospy.logerr("[patlite_node] Error: %s (%s:%d)", e,
                                 patlite_host, patlite_port)
            rospy.sleep(0.1)
        rospy.loginfo("[patlite_node] shutdown")
        return
Exemplo n.º 3
0
class PatliteNode(object):
    def set_state(self, target, state):
        self.pstate.set_from_int(target, state)
        self.send_flag = True

    def callback_r(self, msg):
        self.set_state(self.pstate.Target.LIGHT_RED, msg.data)

    def callback_y(self, msg):
        self.set_state(self.pstate.Target.LIGHT_YELLOW, msg.data)

    def callback_g(self, msg):
        self.set_state(self.pstate.Target.LIGHT_GREEN, msg.data)

    def callback_b(self, msg):
        self.set_state(self.pstate.Target.LIGHT_BLUE, msg.data)

    def callback_w(self, msg):
        self.set_state(self.pstate.Target.LIGHT_WHITE, msg.data)

    def callback_buzz(self, msg):
        self.set_state(self.pstate.Target.BUZZER, msg.data)

    def run(self):
        rospy.init_node('patlite_node')
        patlite_host = rospy.get_param('~host', "10.68.0.10")
        patlite_port = rospy.get_param('~port', 10000)
        timeout = rospy.get_param('~timeout', 0.5)
        self.p = Patlite(patlite_host, port=patlite_port, timeout=timeout)
        self.pstate = PatliteState()
        self.send_flag = False

        rospy.Subscriber("~set/red", Int8, self.callback_r)
        rospy.Subscriber("~set/yellow", Int8, self.callback_y)
        rospy.Subscriber("~set/green", Int8, self.callback_g)
        rospy.Subscriber("~set/blue", Int8, self.callback_b)
        rospy.Subscriber("~set/white", Int8, self.callback_w)
        rospy.Subscriber("~set/buzzer", Int8, self.callback_buzz)
        rospy.loginfo("[patlite_node] started")

        while not rospy.is_shutdown():
            if self.send_flag:
                self.send_flag = False
                try:
                    with self.p:
                        self.p.write(self.pstate)
                        self.pstate.clear()
                except socket.timeout:
                    rospy.logerr("[patlite_node] Error: socket timeout (%s:%d)",
                            patlite_host, patlite_port)
                except socket.error as e:
                    rospy.logerr("[patlite_node] Error: %s (%s:%d)",
                            e, patlite_host, patlite_port)
            rospy.sleep(0.1)
        rospy.loginfo("[patlite_node] shutdown")
        return
Exemplo n.º 4
0
    def run(self):
        rospy.init_node('patlite_node')
        patlite_host = rospy.get_param('~host', "10.68.0.10")
        patlite_port = rospy.get_param('~port', 10000)
        timeout = rospy.get_param('~timeout', 0.5)
        self.p = Patlite(patlite_host, port=patlite_port, timeout=timeout)
        self.pstate = PatliteState()
        self.send_flag = False

        rospy.Subscriber("~set/red", Int8, self.callback_r)
        rospy.Subscriber("~set/yellow", Int8, self.callback_y)
        rospy.Subscriber("~set/green", Int8, self.callback_g)
        rospy.Subscriber("~set/blue", Int8, self.callback_b)
        rospy.Subscriber("~set/white", Int8, self.callback_w)
        rospy.Subscriber("~set/buzzer", Int8, self.callback_buzz)
        rospy.loginfo("[patlite_node] started")

        while not rospy.is_shutdown():
            if self.send_flag:
                self.send_flag = False
                try:
                    with self.p:
                        self.p.write(self.pstate)
                        self.pstate.clear()
                except socket.timeout:
                    rospy.logerr("[patlite_node] Error: socket timeout (%s:%d)",
                            patlite_host, patlite_port)
                except socket.error as e:
                    rospy.logerr("[patlite_node] Error: %s (%s:%d)",
                            e, patlite_host, patlite_port)
            rospy.sleep(0.1)
        rospy.loginfo("[patlite_node] shutdown")
        return