Added some basic code; still trying to figure out the best way to build the pid mechanisms. I have a running example, though.