|
|
@ -2,6 +2,28 @@ import time
|
|
|
|
import threading
|
|
|
|
import threading
|
|
|
|
import DobotDllType as dType
|
|
|
|
import DobotDllType as dType
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
'''
|
|
|
|
|
|
|
|
Six actuators:
|
|
|
|
|
|
|
|
linear rail
|
|
|
|
|
|
|
|
base rotation
|
|
|
|
|
|
|
|
rear arm
|
|
|
|
|
|
|
|
forarm
|
|
|
|
|
|
|
|
gripperrotation
|
|
|
|
|
|
|
|
gripper
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
First five takes argument 1 or -1 (direction)
|
|
|
|
|
|
|
|
Example:
|
|
|
|
|
|
|
|
#initialisation
|
|
|
|
|
|
|
|
c = Candybot()
|
|
|
|
|
|
|
|
c.linear(1) # move linear in positive direction
|
|
|
|
|
|
|
|
c.gripp() # gripp candy
|
|
|
|
|
|
|
|
c.letgo() # let go of candy
|
|
|
|
|
|
|
|
c.stopcmp() # stoop compressor
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
c.panic() # stops everything
|
|
|
|
|
|
|
|
'''
|
|
|
|
class Candybot:
|
|
|
|
class Candybot:
|
|
|
|
def __init__(self):
|
|
|
|
def __init__(self):
|
|
|
|
CON_STR = {
|
|
|
|
CON_STR = {
|
|
|
|