Control system for 3D crane tip compensation