add *Ptr and *ConstPtr typedefs for MotionObjectives
add mapping from goals to motion objectives