Add vhdl files for robot control