Added small MHE example

This is a small MHE example of a mass-spring-damper system with position measurements, including an arrival cost.