Added some code to do input shaping with the Arduino

This is also set up to print the output of the input shaper to either
the Serial Monitor or to a real-time plot using matplotlib. The Python
matplotlib code is also included.