simulate mocap output by using rostopic pub
minor revision
minor
abstract planner class to unite old planner structure with upcoming stuff
added PQP model to triangle object class, which we need for the old planning structure