On interesting notes, I got in contact with Simmechanics after a long time of ignoring it (honestly I don't like MatLAB very much) but its okay, we need it.
http://www.itu.dk/stud/speciale/segmentering/Matlab6p5/help/toolbox/physmod/mech/mech_getting10.html#64568