Java implementation of ORCA collision avoidance algorithm