Basic implementation of FOC by using the estimator for angle and speed feedback only Also adds vibration compensation library interface