Add kd-tree sources
Add ArmState constructor from Arm
Add a generic random command generator
Simplified arm can run Analitic Jacobian, and SSA with NearestNeighbor or LWR