First implementation with AD*, still some issues with D* Lite and NAA* has some memory issues, probably.