You should check out www.Synthiam.com. Their ARC software would allow you to figure that out and control the robot with ease. They have plenty of tutorials available to assist too.
any one help me how i can control waiter robot using Lider and 3 D camera