Calibration in Y work. Some problem in y still
added functions that can be used by a PID filter
filters don't like unsigned values as input :/
NOT TESTED : regulate on angle for straigt line
added functions to lift and lower the aspirator. TODO: set the real values and adress.
pushed some garbage and fixed it ...
changed some bullshit. ffuuuu antoine
lolwut
had take some lines from older states for basic movements to be working. wtf...
resolved the trembling
Added a Kalman filter lib in pseudo code.
We still need to find/code a matrix lib.