3D collision avoidance for AGVs – with radar