New FpgaServomotor implementation. Does not work on SASIAE