[WIP] Porting adaptiveASTAR: small benchmarking work

  * random fixes
  * new environment functions for benchmarking