After detection parameters of the objects (robot, obstacle, destination point) i can used the graph of the visibility method to the planning the optimal path.
I used Web Camera.
Programming language: Visual Basic 6.0 (VB) and Lego Assembler (LASM) (without NQC).