INIT
update FPGA code 2014 + add speed calculation for all 4 encoders
Code optimisation
Small fixes