Starting code for creating a DH arm simulator