Fix/sm kinematics pthread

Did not compile on Ubuntu 12.04