tf error msgs
Fix several bugs around waypoint pruning / skipping that would lead to jumpy robot behavior
missing waitfortransform
missing exported cflags