dist(User, Display) = Sqr(2 * (dist(RSensor, User)^2 + dist(LSensor, User)^2) - dist(LSensor, RSensor)^2) / 2

float HeadTracking(int k, float kDist)
{
   //Left cam
   int pointX_L, pointY_L;
   Camera *leftCam = getCam(0);
   findPoint(pointX_L, pointY_L, leftCam);
   
   //Right cam
   int pointX_R, pointY_R;
   Camera *rightCam = getCam(1);
   findPoint(pointX_R, pointY_R, rightCam);
   
   int camMidX = getCamResX() / 2;
   int camMidY = getCamResY() / 2;

   int distMidPointX_L = pointX_L - camMidX;
   int distMidPointY_L = pointY_L - camMidY;

   int distMidPointX_R = pointX_R - camMidX;
   int distMidPointY_R = pointY_R - camMidY;
   
   //k = kalibrierter Wert: Abstand zum Mittelpunkt
   //kDist = kalibrierter Wert: Abstand zum Display
   
   //optional: distMidPointX_R und distMidPointX_L auch übergeben
   return (distMidPointX_R + distMidPointX_L) * (kDist / k);
}

if(r > 160 && g < 64 && b < 64) { ... FindeZentrumImRotenBereich(); ... }