initial commit of inv kinematics test code

stretch.py has functions to test the inv kinematics program. I'm
committing this for ryan. see kinematics_conventions.png for conventions
of what different variables represent. -s