Control principles

TODO

Field Oriented Control (FOC)

PD Impedance controller

Open loop controller

Impedance

Ima jako puno info u quads folder https://www.ias.informatik.tu-darmstadt.de/uploads/Team/TianyuRen/J1_forceContro_TianyuRen.pdf