Made all threads of stomp use the same KinematicState (no multi-threading for now)