Autonomous surgical robot - embedded FPGA code for high-speed robot control over IEEE 1394 (set points and sensor data)