Allowed automatic waiting for transformations following direct transformation of poses
Mostly code simplification
Added protection handler cases, simplification, formatting, code maintenance
Fixed logging, made use of new ensure-functions, fixed optimal grasp strategy calculation