Найдите длину вектора через координаты и приравняйте 6.