Exemplo n.º 1
0
    def setTimePoint(self, tp, value):
        Supervisor.setTimePoint(self, tp, value)
        
        l = self.plan.getMastnMsg()
        #rospy.logdebug("Updated constraints: %s" % str(l))

        #only send a MaSTN update if the stn is consistent
        if self.plan.stn.isConsistent():
            
            arcs = []
            for a in l:
                arcs.append(StnArc(a[0], a[1], a[2], a[3]))
                
            self.sendMastnUpdate(arcs)