Move madgwickahrs.cpp and other files common to sot-talos-balance and sot-torque-control
After discussing it with @ostasse, we think it is better to move these files in sot-core.
After discussing it with @ostasse, we think it is better to move these files in sot-core.