Dstar with kinodynamic constraints and visualization functionality using Java