diff --git a/movearm/moveCmdTester.py b/movearm/moveCmdTester.py index 2dbe9be..9fa5a01 100644 --- a/movearm/moveCmdTester.py +++ b/movearm/moveCmdTester.py @@ -30,6 +30,7 @@ class Candybot: self.linearspeed = 100 self.lastleinearspeed = 100 + return CON_STR = { dType.DobotConnect.DobotConnect_NoError: "DobotConnect_NoError", @@ -136,7 +137,7 @@ class Candybot: def letgo(self): print("drops\n") - dType.SetEndEffectorGripper(self.api, 1, 0, isQueued=0) + #dType.SetEndEffectorGripper(self.api, 1, 0, isQueued=0) def stop(self): print("stops\n") @@ -168,17 +169,18 @@ class Candybot: def setparams(self, name, speed): lookup = {'base' : 0, 'reararm' : 1, 'forearm' : 2, 'gripperroation' :3} if name == 'rail': - print("Change speed rail %d\n", speed) + print("Change speed rail " + str(speed) +"\n" ) #dType.SetJOGLParams(self.api, speed, 200, isQueued=0) else: speeds = [0,0,0,0] speeds[lookup[name]] = speed - print("change speed" + name + "%d\n",speed) + print("change speed " + name + str(speed)) #dType.SetJOGJointParams(self.api, speeds[0], 200, speeds[1], 200, speeds[2], 200, speeds[3], 200, isQueued = 1) def setJOGcmd(self, cmd): - dType.SetJOGCmd(self.api,1,cmd) + print("Joint "+ str(cmd) + "is moving \n") + #dType.SetJOGCmd(self.api,1,cmd) candy = Candybot() @@ -269,55 +271,18 @@ def ll(): updateLoop() -# -#c = Candybot() -# -# -#def slide_left(): -# c.linear(-1) -# -#def slide_right(): -# c.linear(1) -# -#def rotate_left(): -# c.base(-1) -# -#def rotate_right(): -# c.base(1) -# -#def forward(): -# c.forearm(1) -# -#def back(): -# c.forearm(-1) -# -#def up(): -# c.rearArm(1) -# -#def down(): -# c.rearArm(-1) -# + def stopCmp(): candy.stopcmp() def grab(): candy.gripp() -# c.stopcmp() -# + def drop(): candy.letgo() -# c.stopcmp() -# def stop(): candy.panic() -# -#def getCurrentCmd(): -# return c.getCurrentCmd() -# -#def updateLinearSpeed(): -# pass -#