Online motion planning for humanoid robot based on embedded vision system