remove drawing class, rework calculated orientations, linear interpolate position waypoints and slerp corresponding orientations
remove drawing class, rework calculated orientations, linear interpolate position waypoints and slerp corresponding orientations

niklele/pr2_draw,niklele/pr2_draw