I finished the coding.
I finished the coding and working on the debugging right now. Hopefully get some results tomorrow.
do as much as thorugh thinking and convert all in state space matrix format besting. keep me closely posted for your learning about optimal control journal papers