Inverse kinematics

After a challenge from Kris, it became apparent that we needed an IK library to solve some folding problems. Algorithm not very stable, largely because it relies on taking the inverse of a matrix, which can produce some weird results. Will have to update it later to take the psueudo-inverse instead, if anyone has that as an algorithm please post it.