Restructured the SBA* algorithms completely. Created motion-graph connector and lazy-connector. Everything compiles (not tested).