added matlab files to help with algorithm development
tested test kinematics, working correctly
in progress of debuging inverse kinematics
completed the inverse kinematics matlab function
updated bug with DCM variables