Updated state space matrix

Added code to automatically pull out coefficients of the differential
equations for the state space matrix.