Finalized Updated Code

Had Some errors last night retrieving the correct functions. Went ahead
an updated the code so I can call State Space.