self.goBackwardToGrabTreasure()
time.sleep(0.1)
self.ascendArm()
time.sleep(3)
self.deactivateMagnet()
time.sleep(0.1)
return True
if __name__ == "__main__":
# __init__(self, wheelManager, robotVision, maestro, spc):
# def __init__(self, wheelManager, cameraTower, videoCapture):
m = Controller()
spc = SerialPortCommunicator()
wm = WheelManager(spc)
rv = RobotVision(wm, CameraTower(m), cv2.VideoCapture(0))
pa = PositionAdjuster(wm, rv, m, spc)
while True:
print "Voltage : ", pa.readCondensatorVoltage()
time.sleep(5)
# a = raw_input("Press to mode recharge")
# pa.rechargeMagnet()
# a = raw_input("Press to mode stop magnet")
# pa.deactivateMagnet()
# a = raw_input("Press to start magnet")
# pa.activateMagnet()
# a = raw_input("Press to stop magnet")
# pa.deactivateMagnet()
def setUp(self):
self.wheelMotorMock = MagicMock()
self.serialPortCommunicator = MagicMock()
self.wheelManager = WheelManager(self.serialPortCommunicator)
import fcntl
from threading import Thread
from socketIO_client import SocketIO
import time
from Client.Robot.Movement.WheelManager import WheelManager
from Logic.BotDispatcher import BotDispatcher
import subprocess
c = os.path.dirname(__file__)
configPath = os.path.join(c, "..", "..", "Shared", "config.json")
subprocess.call(['./cameraSettings.sh'])
with open(configPath) as json_data_file:
config = json.load(json_data_file)
socketIO = SocketIO(config['url'], int(config['port']))
spc = SerialPortCommunicator()
botDispatcher = BotDispatcher(WheelManager(spc), Controller(), spc)
def goToNextPosition(data):
print("heading toward next coordinates")
botDispatcher.lastPositionGoneTo = (data['positionTOx'], data['positionTOy'])
botDispatcher.followPath(data)
def startRound(json):
print("start round")
botDispatcher.lastPositionGoneTo = (json['positionX'], json['positionY'])
socketIO.emit("needNewCoordinates")
def alignToTreasure(json):