refactor strategy

[manx52]

• [ ] Analysis
• [ ] class diagram
• [ ] flowchart
• [ ] functional analysis
• [ ] unit test
• [ ] documentation with mermaid js
• [ ] Add ROS back
• [ ] Integration test

Start from scratch and add features from old try to get a small version to walk when given target and get up if fallen