import sys
from NavInterfaceClient import NavInterfaceClient
x = 0
serverHost = "sim.sailsim.org"
serverPort = 20170
username = "PinkFlags"
password = "lagena"

simAPI = NavInterfaceClient()
connected = simAPI.connect(username, password, serverHost, serverPort)

if connected:
    print("Connection established.")
else:
   print("Something went wrong...", file=sys.stderr)

simAPI.send("boatHeader", "33.3")
response = simAPI.receive()

if simAPI.isConnected():
    print("Connection is operational.")

while(simAPI.isConnected()):
    simAPI.send("anchor")
    print(simAPI.receive())

    simAPI.send("atDestination")
    print(simAPI.receive())

    simAPI.send("atObstacle")
    print(simAPI.receive())

    simAPI.send("boatHeading")
    print(simAPI.receive())

    simAPI.send("boatPosition")
    print(simAPI.receive())

    simAPI.send("boatSpeed")
    print(simAPI.receive())

    simAPI.send("goalPosition")
    print(simAPI.receive())

    simAPI.send("obstacle 1")
    print(simAPI.receive())

    simAPI.send("obstacleCount")
    print(simAPI.receive())

    simAPI.send("obstacleDistance 45")
    print(simAPI.receive())

    simAPI.send("obstacles")
    print(simAPI.receive())

    simAPI.send("obstacleScan")
    print(simAPI.receive())

    simAPI.send("sailAngle")
    print(simAPI.receive())

    simAPI.send("time")
    print(simAPI.receive())

    simAPI.send("windHeading")
    print(simAPI.receive())

    simAPI.send("windStrength")
    print(simAPI.receive())

    simAPI.send("atDestination")
    if (simAPI.receive() == "true"):
        simAPI.disconnect()
    else:
        simAPI.disconnect()

simAPI.disconnect()