[SOFT] Updating documentation + standardization
[SOFT] control system now gets the reference as param

A new function is used to get the measure.
Controllers now take error as params rather than reference.