3D tracking using wiimote

This project is a part of a mini project required by the Mechatronics-2 course for the 4th year Mechatronics class in faculty of engineering Ainshams university. The mini project involves the control of an articulated robotic arm which resembles a human arm. The control is done via tele-manipulation which is done by the tracking of 4 IR LEDs fixed at the joints of the controller arm. This code is the part of the project responsible for the interfacing with the wiimote, stereo-triangulation of the wiimote data and determining the 3D coordinates of the IR LEDs.