Add mpc step heading response test w/ data logging