Added FailSafe
Collect motor/servo parameter in struct
...
Completed parameter collection into struct