Did math, created inv kine function

Created the inverse kinematics function.  It takes the desired x and y
coordinates of the arm and calculates the new T matrices.