optimization still not functioning as desired... logic in place for discrete online trajectory optimization as alternative method, but matrix operations seem to be impossible in current design of system due to dimensionality issue, so alternative method is ineffective... final report completed and added to repo in '_FinalSubmissionDocuments' directory along with video demo of PD controller