############# R1_AT_PICTURE_POS = 0 R1_AT_PLACE_POS = 1 R1_MOVING = 2 R2_AT_PICK_POS = 3 R2_MOVING = 4 PIC_DISTANCE = 0 PIC_COLOR = 1 ########### # OBJECTS # ########### CAM = Camera() BTS = BTServer() UR1 = URSocket(23) UR2 = URSocket(24) ############# # VARIABLES # ############# AGV1_state = BTS.AGV1_MOVING AGV2_state = BTS.AGV2_MOVING R1_state = R1_AT_PICTURE_POS R2_state = R2_AT_PICK_POS R1_picture_ok = False R1_pick_ok = False