stmcb function [b,a] = stmcb( x, u_in, q, p, niter, a_in )