testing fk with robot move in real time