Fix stateMatrix parameter