Added some basic input shaping

The shaping will not work unless you have the input shaping module,
which is still private and under development. Sorry.