Changed state estimate rate from 25 to 20 so matlab can keep up.