1. Modified mex function to kick out contact positions & forces
2. Wrote wrappers for the mex function to return the state derivative (calcXdot), the contact force data (calcContactForcePosition)
3. Started work on the post processing script that will generate the animation0

Signed-off-by: mjhmilla <millard.matthew@gmail.com>