added TrapezoidProfile (copied from frc254-2011)

I cleaned it up extensively and added a couple of quick tests.

git-svn-id: https://robotics.mvla.net/svn/frc971/2013/trunk/src@4172 f308d9b7-e957-4cde-b6ac-9a88185e7312
7 files changed