import sys
from NavInterfaceClient import NavInterfaceClient
x = 1
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("hello PinkFlags lagena")
print(simAPI.receive())

simAPI.send("anchor false")
simAPI.receive()

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

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

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


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

simAPI.send("anchor false")
simAPI.receive()

#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.send("finish")
    #simAPI.receive()
    #simAPI.disconnect()
#else:
    #simAPI.send("finish")
    #simAPI.receive()
    #simAPI.disconnect()
simAPI.send("finish")
simAPI.receive()
simAPI.disconnect()