A* search: optimized implementation in Lisp (gitlab.com)