Rapidly-exploring Random Tree implementation in Java