Pushing the arm controller (arm_controller.m), and its dependencies. The header in the file describes how to use it, and simulate.m gives an example.