https://123dok.org/document/lzgodp7q-an-fpga-based-controller-for-collaborative-robotics.html