Excerpts from the controls package, as taken from the larger private McGill Robotics Repository