started jacobian calculation method.
completed forward kine method.