Esempio n. 1
0
        /**
         * Update the View and modules
         */
        private void update()
        {
            Stopwatch stopwatch = new Stopwatch();

            while (true)
            {
                if (model.SenseManager.AcquireFrame(true) >= pxcmStatus.PXCM_STATUS_NO_ERROR) // Dauert manchmal voll lange ...
                {
                    debug_y = 0;
                    // <magic>
                    PXCMCapture.Sample sample = model.SenseManager.QueryFaceSample();
                    sample.color.AcquireAccess(PXCMImage.Access.ACCESS_READ, PXCMImage.PixelFormat.PIXEL_FORMAT_RGB32, out colorData);

                    model.FaceData = model.Face.CreateOutput();
                    model.FaceData.Update();
                    model.FaceAktuell = model.FaceData.QueryFaceByIndex(0);
                    if (model.FaceAktuell != null)
                    {
                        uiSlide = true;
                        PXCMFaceData.PoseData pose = model.FaceAktuell.QueryPose();
                        if (pose != null)
                        {
                            pose.QueryPoseAngles(out model.currentPose);
                        }
                        model.Lp = model.FaceAktuell.QueryLandmarks();
                        if (model.NullFace == null)
                        {
                            if (model.Lp != null)
                            {
                                PXCMFaceData.LandmarkPoint[] aPoints;
                                model.Lp.QueryPoints(out aPoints);
                                model.NullFace = aPoints;
                            }
                        }
                    }

                    colorBitmap = colorData.ToBitmap(0, sample.color.info.width, sample.color.info.height);

                    Graphics bitmapGraphics = Graphics.FromImage(colorBitmap);
                    if (resetModules)
                    {
                        model.Modules.ForEach(delegate(RSModule mod)
                        {
                            mod.Reset();
                        });
                        resetModules = false;
                    }

                    if (testMode)
                    {
                        if (outputEnabled)
                        {
                            bitmapGraphics.FillRectangle(model.DefaultBGBrush, new Rectangle(0, 0, model.Width, model.Height));
                        }
                        if (!imageEnabled)
                        {
                            bitmapGraphics.FillRectangle(model.OpaqueBGBrush, new Rectangle(0, 0, model.Width, model.Height));
                        }

                        bitmapGraphics.DrawString("pose: " + model.CurrentPoseDiff, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                        Debug_Y += 25;
                    }
                    else
                    {
                        using (Graphics gr = Graphics.FromImage(colorBitmap))
                        {
                            if (model.calibrationProgress == 100)
                            {
                                angerMonitor.targetValue    = (int)model.Emotions[Model.Emotion.ANGER];
                                fearMonitor.targetValue     = (int)model.Emotions[Model.Emotion.FEAR];
                                disgustMonitor.targetValue  = (int)model.Emotions[Model.Emotion.DISGUST];
                                surpriseMonitor.targetValue = (int)model.Emotions[Model.Emotion.SURPRISE];
                                joyMonitor.targetValue      = (int)model.Emotions[Model.Emotion.JOY];
                                sadMonitor.targetValue      = (int)model.Emotions[Model.Emotion.SADNESS];
                                contemptMonitor.targetValue = (int)model.Emotions[Model.Emotion.CONTEMPT];

                                angerMonitor.Step();
                                fearMonitor.Step();
                                disgustMonitor.Step();
                                surpriseMonitor.Step();
                                joyMonitor.Step();
                                sadMonitor.Step();
                                contemptMonitor.Step();
                            }

                            if (!testMode)
                            {
                                gr.DrawImage(windowBitmap, xP - 90, yP - 150);
                            }
                            FriggnAweseomeGraphix.DrawMEMontior(gr, angerMonitor);
                            FriggnAweseomeGraphix.DrawMEMontior(gr, sadMonitor);
                            FriggnAweseomeGraphix.DrawMEMontior(gr, fearMonitor);
                            FriggnAweseomeGraphix.DrawMEMontior(gr, surpriseMonitor);
                            FriggnAweseomeGraphix.DrawMEMontior(gr, contemptMonitor);
                            FriggnAweseomeGraphix.DrawMEMontior(gr, disgustMonitor);
                            FriggnAweseomeGraphix.DrawMEMontior(gr, joyMonitor);
                            bitmapGraphics.DrawString("Subject #" + subject, FriggnAweseomeGraphix.majorFont, new SolidBrush(FriggnAweseomeGraphix.fontColor), xP, yP - 75);
                            bitmapGraphics.DrawLine(linePen, xP + 10, yP - 20, xP + 800, yP - 20);
                            bitmapGraphics.DrawString("Pose: " + (int)model.CurrentPoseDiff, FriggnAweseomeGraphix.minorFont, new SolidBrush(FriggnAweseomeGraphix.fontColor), xP + 550, yP - 55);

                            FriggnAweseomeGraphix.MEMonitor calibMonitor = new FriggnAweseomeGraphix.MEMonitor("", "", 1150, 580 - calibRadius, calibRadius, 20);
                            calibMonitor.showPercent = false;
                            if (model.calibrationProgress != 100 && model.CurrentFace != null)
                            {
                                PXCMFaceData.LandmarkPoint mPoint = model.CurrentFace[29];

                                int rad = 2;

                                if (mPoint.image.x > 1200)
                                {
                                    calibMonitor.y = (int)mPoint.image.y - calibRadius;
                                    calibMonitor.x = (int)mPoint.image.x - calibRadius;
                                }

                                calibMonitor.showPercent  = false;
                                calibMonitor.currentValue = (int)model.calibrationProgress;
                                int sMark = (int)(model.calibrationProgress * 0.69);
                                int tMark = sMark + 1;


                                PXCMFaceData.LandmarkPoint sPoint = model.CurrentFace[sMark];
                                PXCMFaceData.LandmarkPoint tPoint = model.CurrentFace[tMark];


                                SolidBrush sb = new SolidBrush(FriggnAweseomeGraphix.fgColor);
                                for (int i = 0; i < sMark - 1; i++)
                                {
                                    PXCMFaceData.LandmarkPoint iPoint = model.CurrentFace[i];
                                    gr.FillEllipse(sb, new Rectangle((int)iPoint.image.x - rad, (int)iPoint.image.y - rad, rad * 2, rad * 2));
                                }

                                gr.FillEllipse(sb, new Rectangle((int)sPoint.image.x - rad, (int)sPoint.image.y - rad, rad * 4, rad * 4));
                                FriggnAweseomeGraphix.DrawMEMontior(gr, calibMonitor);
                            }
                            else
                            {
                                calibMonitor.currentValue = 0;
                            }
                            if (model.CurrentPoseDiff > model.PoseMax && model.calibrationProgress == 100)
                            {
                                warningPopupX += (warningPopupSlideX - warningPopupX) / 3;
                                gr.FillRectangle(new SolidBrush(Color.FromArgb(100, 255, 255, 255)), new Rectangle(warningX, warningY, warningWidth, warningHeight));
                                gr.DrawImage(smallWindowBitmap, warningPopupX, 900);
                            }
                            else
                            {
                                warningPopupX = 2500;
                            }
                        }
                    }


                    if (model.FaceData.QueryNumberOfDetectedFaces() > 0 && model.CurrentFace != null)
                    {
                        model.Modules.ForEach(delegate(RSModule mod)
                        {
                            mod.Work(bitmapGraphics);
                            if (outputEnabled && mod.output != "")
                            {
                                bitmapGraphics.DrawString(mod.output, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                                Debug_Y += 25; // new row
                            }
                        });
                    }

                    double pitchDiff = Math.Abs(model.currentPose.pitch - model.NullPose.pitch);
                    double rollDiff  = Math.Abs(model.currentPose.roll - model.NullPose.roll);
                    double yawDiff   = Math.Abs(model.currentPose.yaw - model.NullPose.yaw);

                    model.CurrentPoseDiff  = pitchDiff + rollDiff + yawDiff;
                    model.CurrentRollDiff  = rollDiff;
                    model.CurrentPitchDiff = pitchDiff;
                    model.CurrentYawDiff   = yawDiff;

                    // Update PictureBox
                    if (testMode)
                    {
                        pb.Image = colorBitmap;
                    }
                    else
                    {
                        pb.Image = colorBitmap; // uiBitmap.Clone(new Rectangle(0, 0, uiBitmap.Width, uiBitmap.Height), uiBitmap.PixelFormat);
                    }
                    if (PXCMCapture.Device.MirrorMode.MIRROR_MODE_HORIZONTAL != model.SenseManager.captureManager.device.QueryMirrorMode())
                    {
                        model.SenseManager.captureManager.device.SetMirrorMode(PXCMCapture.Device.MirrorMode.MIRROR_MODE_HORIZONTAL);                                                                                                                     //mirror
                    }
                    model.SenseManager.ReleaseFrame();
                    model.FaceData.Dispose(); // DONE!
                    sample.color.ReleaseAccess(colorData);
                    if (xP < targetX && uiSlide)
                    {
                        xP               += (targetX - xP) / 8;
                        warningX          = xP - 70;
                        warningSymbolX    = (warningX + warningWidth) / 2 - 728 / 2;
                        angerMonitor.x    = xP;
                        joyMonitor.x      = xP;
                        fearMonitor.x     = xP;
                        contemptMonitor.x = xP;

                        sadMonitor.x      = xP + xgap;
                        disgustMonitor.x  = xP + xgap;
                        surpriseMonitor.x = xP + xgap;
                    }
                }
            }
        }
Esempio n. 2
0
        /**
         * Update the View
         */
        private void update()
        {
            Stopwatch stopwatch = new Stopwatch();

            while (true)
            {
                if (model.SenseManager.AcquireFrame(true) >= pxcmStatus.PXCM_STATUS_NO_ERROR) // Dauert manchmal voll lange ...
                {
                    debug_y = 0;
                    // <magic>
                    PXCMCapture.Sample sample = model.SenseManager.QueryFaceSample();
                    sample.color.AcquireAccess(PXCMImage.Access.ACCESS_READ, PXCMImage.PixelFormat.PIXEL_FORMAT_RGB32, out colorData);

                    model.FaceData = model.Face.CreateOutput();
                    model.FaceData.Update();
                    model.FaceAktuell = model.FaceData.QueryFaceByIndex(0);
                    if (model.FaceAktuell != null)
                    {
                        uiSlide = true;
                        PXCMFaceData.PoseData pose = model.FaceAktuell.QueryPose();
                        if (pose != null)
                        {
                            pose.QueryPoseAngles(out model.currentPose);
                        }
                        model.Lp = model.FaceAktuell.QueryLandmarks();
                        if (model.NullFace == null)
                        {
                            if (model.Lp != null)
                            {
                                PXCMFaceData.LandmarkPoint[] aPoints;
                                model.Lp.QueryPoints(out aPoints);
                                model.NullFace = aPoints;
                            }
                        }
                    }

                    colorBitmap = colorData.ToBitmap(0, sample.color.info.width, sample.color.info.height);

                    Graphics bitmapGraphics = Graphics.FromImage(colorBitmap);
                    if (resetModules)
                    {
                        model.Modules.ForEach(delegate(RSModule mod)
                        {
                            mod.reset();
                        });
                        resetModules = false;
                    }

                    if (testMode)
                    {
                        if (outputEnabled)
                        {
                            bitmapGraphics.FillRectangle(model.DefaultBGBrush, new Rectangle(0, 0, model.Width, model.Height));
                        }
                        if (!imageEnabled)
                        {
                            bitmapGraphics.FillRectangle(model.OpaqueBGBrush, new Rectangle(0, 0, model.Width, model.Height));
                        }

                        bitmapGraphics.DrawString("pose: " + model.CurrentPoseDiff, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                        Debug_Y += 25;
                    }
                    else
                    {
                        // uiBitmap = new Bitmap(blurWidth, blurHeight, PixelFormat.Format32bppArgb);

                        //  using (Graphics gr = Graphics.FromImage(uiBitmap))
                        // {
                        //   gr.DrawImage(colorBitmap, 0, 0);
                        //  }

                        //   BitmapData sourceData = colorBitmap.LockBits(new Rectangle(xPos - 10, yPos - 10, blurWidth + 20, blurHeight + 20), ImageLockMode.ReadOnly, colorBitmap.PixelFormat);
                        //BitmapData uiData = uiBitmap.LockBits(new Rectangle(0, 0, blurWidth, blurHeight), ImageLockMode.WriteOnly, uiBitmap.PixelFormat);
                        //if (blur) FriggnAweseomeGraphix.sonic_blur(colorBitmap, uiBitmap, 0, 0, blurWidth, blurHeight, 1, 4, sourceData, uiData);
                        //  uiBitmap.UnlockBits(uiData);
                        //  colorBitmap.UnlockBits(sourceData);

                        using (Graphics gr = Graphics.FromImage(colorBitmap))
                        {
                            if (model.calibrationProgress == 100)
                            {
                                angerMonitor.targetValue    = (int)model.Emotions["Anger"];
                                fearMonitor.targetValue     = (int)model.Emotions["Fear"];
                                disgustMonitor.targetValue  = (int)model.Emotions["Disgust"];
                                surpriseMonitor.targetValue = (int)model.Emotions["Surprise"];
                                joyMonitor.targetValue      = (int)model.Emotions["Joy"];
                                sadMonitor.targetValue      = (int)model.Emotions["Sadness"];

                                angerMonitor.step();
                                fearMonitor.step();
                                disgustMonitor.step();
                                surpriseMonitor.step();
                                joyMonitor.step();
                                sadMonitor.step();
                            }

                            // if (false) gr.DrawImage(uiBitmap, xPos, yPos);
                            gr.DrawImage(windowBitmap, xP - 90, yP - 150);
                            FriggnAweseomeGraphix.drawMEMontior(gr, angerMonitor);
                            FriggnAweseomeGraphix.drawMEMontior(gr, sadMonitor);
                            FriggnAweseomeGraphix.drawMEMontior(gr, fearMonitor);
                            FriggnAweseomeGraphix.drawMEMontior(gr, surpriseMonitor);
                            FriggnAweseomeGraphix.drawMEMontior(gr, contemptMonitor);
                            FriggnAweseomeGraphix.drawMEMontior(gr, disgustMonitor);
                            FriggnAweseomeGraphix.drawMEMontior(gr, joyMonitor);
                            bitmapGraphics.DrawString("Subject #" + subject, FriggnAweseomeGraphix.majorFont, new SolidBrush(FriggnAweseomeGraphix.fontColor), xP, yP - 75);
                            bitmapGraphics.DrawLine(linePen, xP + 10, yP - 20, xP + 800, yP - 20);
                            bitmapGraphics.DrawString("Pose: " + (int)model.CurrentPoseDiff, FriggnAweseomeGraphix.minorFont, new SolidBrush(FriggnAweseomeGraphix.fontColor), xP + 550, yP - 55);

                            FriggnAweseomeGraphix.MEMonitor calibMonitor = new FriggnAweseomeGraphix.MEMonitor("", "", 1150, 580 - calibRadius, calibRadius, 20);
                            calibMonitor.showPercent = false;
                            if (model.calibrationProgress != 100 && model.CurrentFace != null)
                            {
                                PXCMFaceData.LandmarkPoint mPoint = model.CurrentFace[29];

                                int rad = 2;

                                if (mPoint.image.x > 1200)
                                {
                                    calibMonitor.y = (int)mPoint.image.y - calibRadius;
                                    calibMonitor.x = (int)mPoint.image.x - calibRadius;
                                }

                                calibMonitor.showPercent  = false;
                                calibMonitor.currentValue = (int)model.calibrationProgress;
                                int sMark = (int)(model.calibrationProgress * 0.69);
                                int tMark = sMark + 1;

                                Console.WriteLine(sMark + " -> " + tMark);

                                PXCMFaceData.LandmarkPoint sPoint = model.CurrentFace[sMark];
                                PXCMFaceData.LandmarkPoint tPoint = model.CurrentFace[tMark];


                                //FriggnAweseomeGraphix.drawFadingLine(gr, sPoint.image.x, sPoint.image.y, tPoint.image.x, tPoint.image.y);
                                SolidBrush sb = new SolidBrush(FriggnAweseomeGraphix.fgColor);
                                for (int i = 0; i < sMark - 1; i++)
                                {
                                    PXCMFaceData.LandmarkPoint iPoint = model.CurrentFace[i];
                                    gr.FillEllipse(sb, new Rectangle((int)iPoint.image.x - rad, (int)iPoint.image.y - rad, rad * 2, rad * 2));
                                }

                                gr.FillEllipse(sb, new Rectangle((int)sPoint.image.x - rad, (int)sPoint.image.y - rad, rad * 4, rad * 4));
                                FriggnAweseomeGraphix.drawMEMontior(gr, calibMonitor);
                            }
                            else
                            {
                                calibMonitor.currentValue = 0;
                            }
                            if (model.CurrentPoseDiff > model.PoseMax && model.calibrationProgress == 100)
                            {
                                warningPopupX += (warningPopupSlideX - warningPopupX) / 3;
                                gr.FillRectangle(new SolidBrush(Color.FromArgb(100, 255, 255, 255)), new Rectangle(warningX, warningY, warningWidth, warningHeight));
                                gr.DrawImage(smallWindowBitmap, warningPopupX, 900);
                            }
                            else
                            {
                                warningPopupX = 2500;
                            }
                        }
                    }


                    if (model.FaceData.QueryNumberOfDetectedFaces() > 0 && model.CurrentFace != null)
                    {
                        model.Modules.ForEach(delegate(RSModule mod)
                        {
                            mod.Work(bitmapGraphics);
                            if (outputEnabled && mod.output != "")
                            {
                                bitmapGraphics.DrawString(mod.output, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                                Debug_Y += 25; // new row
                            }
                        });
                    }

                    double pitchDiff = Math.Abs(model.currentPose.pitch - model.NullPose.pitch);
                    double rollDiff  = Math.Abs(model.currentPose.roll - model.NullPose.roll);
                    double yawDiff   = Math.Abs(model.currentPose.yaw - model.NullPose.yaw);

                    model.CurrentPoseDiff  = pitchDiff + rollDiff + yawDiff;
                    model.CurrentRollDiff  = rollDiff;
                    model.CurrentPitchDiff = pitchDiff;
                    model.CurrentYawDiff   = yawDiff;

                    /* bitmapGraphics.DrawString("poll: " + pitchDiff + ", roll: " + rollDiff + ", yaw: " + yawDiff, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                     * Debug_Y += 25;
                     * bitmapGraphics.DrawString("all: " + (int)(pitchDiff + rollDiff + yawDiff), model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                     * Debug_Y += 25;
                     * bitmapGraphics.DrawString("pitch: " + pitchDiff, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                     * Debug_Y += 25;
                     * bitmapGraphics.DrawString("yaw: " + yawDiff, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);
                     * Debug_Y += 25;
                     * bitmapGraphics.DrawString("roll: " + rollDiff, model.DefaultFont, model.DefaultStringBrush, 10, Debug_Y);*/

                    // update PictureBox
                    if (testMode)
                    {
                        pb.Image = colorBitmap;
                    }
                    else
                    {
                        pb.Image = colorBitmap; // uiBitmap.Clone(new Rectangle(0, 0, uiBitmap.Width, uiBitmap.Height), uiBitmap.PixelFormat);
                    }
                    model.SenseManager.ReleaseFrame();
                    model.FaceData.Dispose(); // DONE!
                    sample.color.ReleaseAccess(colorData);
                    if (xP < targetX && uiSlide)
                    {
                        xP               += (targetX - xP) / 8;
                        warningX          = xP - 70;
                        warningSymbolX    = (warningX + warningWidth) / 2 - 728 / 2;
                        angerMonitor.x    = xP;
                        joyMonitor.x      = xP;
                        fearMonitor.x     = xP;
                        contemptMonitor.x = xP;

                        sadMonitor.x      = xP + xgap;
                        disgustMonitor.x  = xP + xgap;
                        surpriseMonitor.x = xP + xgap;
                    }
                }
            }
        }