Added third sensor:
In this commit, the third sensor(for the feet angle) was added to the soup and safeguards in the code to prevent noisy data from affecting that motor were removed. Thus, this code allows the use of all three sensors.
However, this is not advised since the addition of the third sensor causes some speed issues