adding sailboat_control, simulation, boats to environment,
utilsmath distance function and tests
landmark measurement