/// <summary>
/// gets an instance of the wrapper,
/// runs initialization method,
/// enables movement control for the AXIS_Robot and homes the robot
/// </summary>
public Robot()
{
// Initialize and set settings
_serialStk = new SerialSTK();
_wrapper = Wrapper.getInstance();
initialization();
_wrapper.controlWrapped(Wrapper.enumAxisSettings.AXIS_ROBOT, true);
movementlock = new Semaphore(1,1);
cubeAtConveyorBelt = true;
_wrapper.watchMotionWrapped(dgateMovementStopped, dgateMovementStarted);
_wrapper.watchDigitalInputWrapped(dgateWatchDigitalInput);
}