Merge pull request #4 from avalenzu/kinematic-planner

Kinematic planner (round 2)
Add drakeFunction.interpolation.Linear class