Added xml parser and cpp code that sets up all dh params to software directory; cleaned up the excess code a bit; added dh params for KUKA KR5 robot into an xml file for testing