Hi Nick, thank you for your comment.
Yes, I am glad to share the code. After some try, and following the suggestion in your next comment, I put it in a separate post here:
PS: a top-down cave exploration is beyond my abilities! I leave it to someone else!