update FPGA code 2014 + add speed calculation for all 4 encoders