Arm simulation/testing

[ottopasuuna]

As part of the arm control software, we need to have a way to simulate the movement of the arm. Last year we had code that basically did this, but I would like to expand upon it to support any arm geometry without hard coding the degrees of freedom or how joints are attached to each other.