I've refactored my code to be much faster (using basic manual Euler integration instead of MATLAB's integral() function) and plotted the robot's position for problem 5. The plot is attached.
Here is the code. I would have done this in C++, but MATLAB lets me plot much more easily