Rewrite of pathing code#308

Draft

CSTBook wants to merge 3 commits intomainfrom

feat/rewrite-pathing-code

Commits on Nov 1, 2025

Initial nuking
CSTBook
committed

Commits on Nov 2, 2025

Replaced RRTNode* with a smart pointer and removed all references to parent within RRTNode
CSTBook
committed

Commits on Nov 5, 2025

small changes
CSTBook
committed