adding first implementation of contact planner
changing shadow threshold
Merge branch 'hydro-devel' into sachin-hydro