コード例 #1
0
ファイル: MotorArm.py プロジェクト: isk2/Flylab
 def SignalInput_callback (self, srvSignalReq):
     rv = SrvSignalResponse()
     
     (self.stateRef, isInArena) = self.TransformStateToFrame('Stage', srvSignalReq.state)
     rv.success = True #isInArena
     
     return rv
コード例 #2
0
ファイル: MotorArm.py プロジェクト: ssafarik/Flylab
    def SignalInput_callback (self, srvSignalReq):
        rv = SrvSignalResponse()

        if (self.angposMech is not None):
            Jinv = self.JacobianInv(self.angposMech)
            
            (self.stateRef, isInArena) = self.TransformStateToFrame('Stage', srvSignalReq.state)
            self.angposRef = self.Get1FromPt(self.stateRef.pose.position)
            self.angvelRef = Jinv.dot(np.array([[self.stateRef.velocity.linear.x],[self.stateRef.velocity.linear.y]]))

        rv.success = True #isInArena
        
        return rv
コード例 #3
0
ファイル: nullmotor.py プロジェクト: sagrawal/Flylab
 def SignalInput_callback (self, srvSignal):
     rv = SrvSignalResponse()
     rv.success = True
     return rv