Updated servo frequency to 400