Added comments in the end
Modified Robot.java no functional changes, now has DhChains but does not use
some errors removed