Java Motion Planning