adding the initial state based controller
looking for the null pointer in the servostock code