Add RandomVector4 function
Bugfix on RelationMatrix

Fix indexing on set
Remove unnecessary error checking, out of bounds will already throw an
error
Add an Equilibrium to to the spring calculation