create new test and fix fwd.hh. Add function getAffordanceObjects that adds CollisionObjects to problem solver

go from iheritance of fcl::Triangle to having a shares_ptr<fcl::Triangle> in class affordance::Triangle.

create operation classes to represent Support/Lean affordance requirements and to save margin values etc.