Example usage for org.opencv.core Point set

List of usage examples for org.opencv.core Point set

Introduction

In this page you can find the example usage for org.opencv.core Point set.

Prototype

public void set(double[] vals) 

Source Link

Usage

From source file:bollettini.BullettinCompiler.java

private void writeReciever(String reciever) {
    //massimo 24 caratteri
    String temp = "";
    int offset = 26;
    if (reciever.length() > offset) {
        temp = reciever.substring(0, offset);
    } else {/*from   ww w . j a  v  a2  s  . c om*/
        temp = reciever;
    }
    Core.putText(bullettin, temp, new Point(93, 188), Core.FONT_HERSHEY_COMPLEX, 0.8, new Scalar(0, 0, 0));
    Core.putText(bullettin, temp, new Point(567, 188), Core.FONT_HERSHEY_COMPLEX, 0.8, new Scalar(0, 0, 0));

    Point R = new Point(1000, 159);
    for (int i = 0; i < 68 && i < reciever.length(); i++) {
        Core.putText(bullettin, String.valueOf(reciever.charAt(i)), R, Core.FONT_HERSHEY_COMPLEX, 0.8,
                new Scalar(0, 0, 0));
        R.x += 25.3;
        if (i == 33)
            R.set(new double[] { 1000, 190 });
    }
}

From source file:bollettini.BullettinCompiler.java

private void writePerformer(String performer) {
    String temp = "";
    int offset = 24;
    if (performer.length() > offset) {
        temp = performer.substring(0, offset);
    } else {// w w  w  .j  av a 2 s. c  o  m
        temp = performer;
    }
    Core.putText(bullettin, temp, new Point(95, 500), Core.FONT_HERSHEY_COMPLEX, 0.8, new Scalar(0, 0, 0));
    Core.putText(bullettin, temp, new Point(569, 500), Core.FONT_HERSHEY_COMPLEX, 0.8, new Scalar(0, 0, 0));

    Point A = new Point(1278, 317);
    for (int i = 0; i < 46 && i < performer.length(); i++) {
        Core.putText(bullettin, String.valueOf(performer.charAt(i)), A, Core.FONT_HERSHEY_COMPLEX, 0.8,
                new Scalar(0, 0, 0));
        A.x += 25;
        if (i == 22)
            A.set(new double[] { 1278, 348 });
    }
}

From source file:com.seleniumtests.util.imaging.ImageDetector.java

License:Apache License

/**
 * Compute the rectangle where the searched picture is and the rotation angle between both images
 * Throw {@link ImageSearchException} if picture is not found
 * @return/*w  w w.j  a  v  a 2  s.com*/
 * @Deprecated Kept here for information, but open CV 3 does not include SURF anymore for java build
 */
public void detectCorrespondingZone() {
    Mat objectImageMat = Imgcodecs.imread(objectImage.getAbsolutePath(), Imgcodecs.CV_LOAD_IMAGE_COLOR);
    Mat sceneImageMat = Imgcodecs.imread(sceneImage.getAbsolutePath(), Imgcodecs.CV_LOAD_IMAGE_COLOR);
    FeatureDetector surf = FeatureDetector.create(FeatureDetector.SURF);

    MatOfKeyPoint objectKeyPoints = new MatOfKeyPoint();
    MatOfKeyPoint sceneKeyPoints = new MatOfKeyPoint();

    surf.detect(objectImageMat, objectKeyPoints);
    surf.detect(sceneImageMat, sceneKeyPoints);

    DescriptorExtractor surfExtractor = DescriptorExtractor.create(DescriptorExtractor.SURF);
    Mat objectDescriptor = new Mat();
    Mat sceneDescriptor = new Mat();
    surfExtractor.compute(objectImageMat, objectKeyPoints, objectDescriptor);
    surfExtractor.compute(sceneImageMat, sceneKeyPoints, sceneDescriptor);

    try {
        Mat outImage = new Mat();
        Features2d.drawKeypoints(objectImageMat, objectKeyPoints, outImage);
        String tempFile = File.createTempFile("img", ".png").getAbsolutePath();
        writeComparisonPictureToFile(tempFile, outImage);
    } catch (IOException e) {

    }

    // http://stackoverflow.com/questions/29828849/flann-for-opencv-java
    DescriptorMatcher matcher = DescriptorMatcher.create(DescriptorMatcher.FLANNBASED);
    MatOfDMatch matches = new MatOfDMatch();

    if (objectKeyPoints.toList().isEmpty()) {
        throw new ImageSearchException("No keypoints in object to search, check it's not uniformly coloured: "
                + objectImage.getAbsolutePath());
    }
    if (sceneKeyPoints.toList().isEmpty()) {
        throw new ImageSearchException(
                "No keypoints in scene, check it's not uniformly coloured: " + sceneImage.getAbsolutePath());
    }
    if (objectDescriptor.type() != CvType.CV_32F) {
        objectDescriptor.convertTo(objectDescriptor, CvType.CV_32F);
    }
    if (sceneDescriptor.type() != CvType.CV_32F) {
        sceneDescriptor.convertTo(sceneDescriptor, CvType.CV_32F);
    }

    matcher.match(objectDescriptor, sceneDescriptor, matches);

    double maxDist = 0;
    double minDist = 10000;

    for (int i = 0; i < objectDescriptor.rows(); i++) {
        double dist = matches.toList().get(i).distance;
        if (dist < minDist) {
            minDist = dist;
        }
        if (dist > maxDist) {
            maxDist = dist;
        }
    }

    logger.debug("-- Max dist : " + maxDist);
    logger.debug("-- Min dist : " + minDist);

    LinkedList<DMatch> goodMatches = new LinkedList<>();
    MatOfDMatch gm = new MatOfDMatch();

    for (int i = 0; i < objectDescriptor.rows(); i++) {
        if (matches.toList().get(i).distance < detectionThreshold) {
            goodMatches.addLast(matches.toList().get(i));
        }
    }
    gm.fromList(goodMatches);

    Features2d.drawMatches(objectImageMat, objectKeyPoints, sceneImageMat, sceneKeyPoints, gm, imgMatch,
            Scalar.all(-1), Scalar.all(-1), new MatOfByte(), Features2d.NOT_DRAW_SINGLE_POINTS);

    if (goodMatches.isEmpty()) {
        throw new ImageSearchException("Cannot find matching zone");
    }

    LinkedList<Point> objList = new LinkedList<>();
    LinkedList<Point> sceneList = new LinkedList<>();

    List<KeyPoint> objectKeyPointsList = objectKeyPoints.toList();
    List<KeyPoint> sceneKeyPointsList = sceneKeyPoints.toList();

    for (int i = 0; i < goodMatches.size(); i++) {
        objList.addLast(objectKeyPointsList.get(goodMatches.get(i).queryIdx).pt);
        sceneList.addLast(sceneKeyPointsList.get(goodMatches.get(i).trainIdx).pt);
    }

    MatOfPoint2f obj = new MatOfPoint2f();
    obj.fromList(objList);

    MatOfPoint2f scene = new MatOfPoint2f();
    scene.fromList(sceneList);

    // Calib3d.RANSAC could be used instead of 0
    Mat hg = Calib3d.findHomography(obj, scene, 0, 5);

    Mat objectCorners = new Mat(4, 1, CvType.CV_32FC2);
    Mat sceneCorners = new Mat(4, 1, CvType.CV_32FC2);

    objectCorners.put(0, 0, new double[] { 0, 0 });
    objectCorners.put(1, 0, new double[] { objectImageMat.cols(), 0 });
    objectCorners.put(2, 0, new double[] { objectImageMat.cols(), objectImageMat.rows() });
    objectCorners.put(3, 0, new double[] { 0, objectImageMat.rows() });

    Core.perspectiveTransform(objectCorners, sceneCorners, hg);

    // points of object
    Point po1 = new Point(objectCorners.get(0, 0));
    Point po2 = new Point(objectCorners.get(1, 0));
    Point po3 = new Point(objectCorners.get(2, 0));
    Point po4 = new Point(objectCorners.get(3, 0));

    // point of object in scene
    Point p1 = new Point(sceneCorners.get(0, 0)); // top left
    Point p2 = new Point(sceneCorners.get(1, 0)); // top right
    Point p3 = new Point(sceneCorners.get(2, 0)); // bottom right
    Point p4 = new Point(sceneCorners.get(3, 0)); // bottom left

    logger.debug(po1);
    logger.debug(po2);
    logger.debug(po3);
    logger.debug(po4);
    logger.debug(p1); // top left
    logger.debug(p2); // top right
    logger.debug(p3); // bottom right
    logger.debug(p4); // bottom left

    if (debug) {
        try {
            // translate corners
            p1.set(new double[] { p1.x + objectImageMat.cols(), p1.y });
            p2.set(new double[] { p2.x + objectImageMat.cols(), p2.y });
            p3.set(new double[] { p3.x + objectImageMat.cols(), p3.y });
            p4.set(new double[] { p4.x + objectImageMat.cols(), p4.y });

            Imgproc.line(imgMatch, p1, p2, new Scalar(0, 255, 0), 1);
            Imgproc.line(imgMatch, p2, p3, new Scalar(0, 255, 0), 1);
            Imgproc.line(imgMatch, p3, p4, new Scalar(0, 255, 0), 1);
            Imgproc.line(imgMatch, p4, p1, new Scalar(0, 255, 0), 1);

            showResultingPicture(imgMatch);
        } catch (IOException e) {
        }
    }

    // check rotation angles
    checkRotationAngle(p1, p2, p3, p4, po1, po2, po3, po4);

    // rework on scene points as new, we are sure the object rotation is 0, 90, 180 or 270
    reworkOnScenePoints(p1, p2, p3, p4);

    // check that aspect ratio of the detected height and width are the same
    checkDetectionZoneAspectRatio(p1, p2, p4, po1, po2, po4);

    recordDetectedRectangle(p1, p2, p3, p4);
}

From source file:org.lasarobotics.vision.ftc.resq.BeaconAnalyzer.java

License:Open Source License

static Beacon.BeaconAnalysis analyze_FAST(ColorBlobDetector detectorRed, ColorBlobDetector detectorBlue,
        Mat img, Mat gray, ScreenOrientation orientation, Rectangle bounds, boolean debug) {
    //Figure out which way to read the image
    double orientationAngle = orientation.getAngle();
    boolean swapLeftRight = orientationAngle >= 180; //swap if LANDSCAPE_WEST or PORTRAIT_REVERSE
    boolean readOppositeAxis = orientation == ScreenOrientation.PORTRAIT
            || orientation == ScreenOrientation.PORTRAIT_REVERSE; //read other axis if any kind of portrait

    //Bound the image
    if (readOppositeAxis)
        //Force the analysis box to transpose inself in place
        //noinspection SuspiciousNameCombination
        bounds = new Rectangle(new Point(bounds.center().y / img.height() * img.width(),
                bounds.center().x / img.width() * img.height()), bounds.height(), bounds.width())
                        .clip(new Rectangle(img.size()));
    if (!swapLeftRight && readOppositeAxis)
        //Force the analysis box to flip across its primary axis
        bounds = new Rectangle(
                new Point((img.size().width / 2) + Math.abs(bounds.center().x - (img.size().width / 2)),
                        bounds.center().y),
                bounds.width(), bounds.height());
    else if (swapLeftRight && !readOppositeAxis)
        //Force the analysis box to flip across its primary axis
        bounds = new Rectangle(new Point(bounds.center().x, img.size().height - bounds.center().y),
                bounds.width(), bounds.height());
    bounds = bounds.clip(new Rectangle(img.size()));

    //Get contours within the bounds
    detectorRed.process(img);//from  w  ww  .  j a  v  a  2s. c  om
    detectorBlue.process(img);
    List<Contour> contoursRed = detectorRed.getContours();
    List<Contour> contoursBlue = detectorBlue.getContours();

    //DEBUG Draw contours before filtering
    if (debug)
        Drawing.drawContours(img, contoursRed, new ColorRGBA("#FF0000"), 2);
    if (debug)
        Drawing.drawContours(img, contoursBlue, new ColorRGBA("#0000FF"), 2);

    if (debug)
        Drawing.drawRectangle(img, bounds, new ColorRGBA("#aaaaaa"), 4);

    //Get the largest contour in each - we're calling this one the main light
    int largestIndexRed = findLargestIndexInBounds(contoursRed, bounds);
    int largestIndexBlue = findLargestIndexInBounds(contoursBlue, bounds);
    Contour largestRed = (largestIndexRed != -1) ? contoursRed.get(largestIndexRed) : null;
    Contour largestBlue = (largestIndexBlue != -1) ? contoursBlue.get(largestIndexBlue) : null;

    //If we don't have a main light for one of the colors, we know both colors are the same
    //TODO we should re-filter the contours by size to ensure that we get at least a decent size
    if (largestRed == null && largestBlue == null)
        return new Beacon.BeaconAnalysis();

    //INFO The best contour from each color (if available) is selected as red and blue
    //INFO The two best contours are then used to calculate the location of the beacon

    //If we don't have a main light for one of the colors, we know both colors are the same
    //TODO we should re-filter the contours by size to ensure that we get at least a decent size

    //If the largest part of the non-null color is wider than a certain distance, then both are bright
    //Otherwise, only one may be lit
    //If only one is lit, and is wider than a certain distance, it is bright
    //TODO We are currently assuming that the beacon cannot be in a "bright" state
    if (largestRed == null)
        return new Beacon.BeaconAnalysis();
    else if (largestBlue == null)
        return new Beacon.BeaconAnalysis();

    //The height of the beacon on screen is the height of the best contour
    Contour largestHeight = ((largestRed.size().height) > (largestBlue.size().height)) ? largestRed
            : largestBlue;
    double beaconHeight = largestHeight.size().height;

    //Get beacon width on screen by extrapolating from height
    final double beaconActualHeight = Constants.BEACON_HEIGHT; //cm, only the lit up portion - 14.0 for entire
    final double beaconActualWidth = Constants.BEACON_WIDTH; //cm
    final double beaconWidthHeightRatio = Constants.BEACON_WH_RATIO;
    double beaconWidth = beaconHeight * beaconWidthHeightRatio;
    Size beaconSize = new Size(beaconWidth, beaconHeight);

    //Look at the locations of the largest contours
    //Check to see if the largest red contour is more left-most than the largest right contour
    //If it is, then we know that the left beacon is red and the other blue, and vice versa

    Point bestRedCenter = largestRed.centroid();
    Point bestBlueCenter = largestBlue.centroid();

    //DEBUG R/B text
    if (debug)
        Drawing.drawText(img, "R", bestRedCenter, 1.0f, new ColorRGBA(255, 0, 0));
    if (debug)
        Drawing.drawText(img, "B", bestBlueCenter, 1.0f, new ColorRGBA(0, 0, 255));

    //Test which side is red and blue
    //If the distance between the sides is smaller than a value, then return unknown
    final int minDistance = (int) (Constants.DETECTION_MIN_DISTANCE * beaconSize.width); //percent of beacon width

    boolean leftIsRed;
    Contour leftMostContour, rightMostContour;
    if (readOppositeAxis) {
        if (bestRedCenter.y + minDistance < bestBlueCenter.y) {
            leftIsRed = true;
        } else if (bestBlueCenter.y + minDistance < bestRedCenter.y) {
            leftIsRed = false;
        } else {
            return new Beacon.BeaconAnalysis();
        }
    } else {
        if (bestRedCenter.x + minDistance < bestBlueCenter.x) {
            leftIsRed = true;
        } else if (bestBlueCenter.x + minDistance < bestRedCenter.x) {
            leftIsRed = false;
        } else {
            return new Beacon.BeaconAnalysis();
        }
    }

    //Swap left and right if necessary
    leftIsRed = swapLeftRight != leftIsRed;

    //Get the left-most best contour (or top-most if axis swapped) (or right-most if L/R swapped)
    if (readOppositeAxis) {
        //Get top-most best contour
        leftMostContour = ((largestRed.topLeft().y) < (largestBlue.topLeft().y)) ? largestRed : largestBlue;
        //Get bottom-most best contour
        rightMostContour = ((largestRed.topLeft().y) < (largestBlue.topLeft().y)) ? largestBlue : largestRed;
    } else {
        //Get left-most best contour
        leftMostContour = ((largestRed.topLeft().x) < (largestBlue.topLeft().x)) ? largestRed : largestBlue;
        //Get the right-most best contour
        rightMostContour = ((largestRed.topLeft().x) < (largestBlue.topLeft().x)) ? largestBlue : largestRed;
    }

    //DEBUG Logging
    if (debug)
        Log.d("Beacon", "Orientation: " + orientation + "Angle: " + orientationAngle + " Swap Axis: "
                + readOppositeAxis + " Swap Direction: " + swapLeftRight);

    //Swap left and right if necessary
    //BUGFIX: invert when we swap
    if (!swapLeftRight) {
        Contour temp = leftMostContour;
        leftMostContour = rightMostContour;
        rightMostContour = temp;
    }

    //Now that we have the two contours, let's find ellipses that match

    //Draw the box surrounding both contours
    //Get the width of the contours
    double widthBeacon = rightMostContour.right() - leftMostContour.left();

    //Center of contours is the average of centroids of the contours
    Point center = new Point((leftMostContour.centroid().x + rightMostContour.centroid().x) / 2,
            (leftMostContour.centroid().y + rightMostContour.centroid().y) / 2);

    //Get the combined height of the contours
    double heightContours = Math.max(leftMostContour.bottom(), rightMostContour.bottom())
            - Math.min(leftMostContour.top(), rightMostContour.top());

    //The largest size ratio of tested over actual is the scale ratio
    double scale = Math.max(widthBeacon / beaconActualWidth, heightContours / beaconActualHeight);

    //Define size of bounding box by scaling the actual beacon size
    Size beaconSizeFinal = new Size(beaconActualWidth * scale, beaconActualHeight * scale);

    //Swap x and y if we rotated the view
    if (readOppositeAxis) {
        //noinspection SuspiciousNameCombination
        beaconSizeFinal = new Size(beaconSizeFinal.height, beaconSizeFinal.width);
    }

    //Get points of the bounding box
    Point beaconTopLeft = new Point(center.x - (beaconSizeFinal.width / 2),
            center.y - (beaconSizeFinal.height / 2));
    Point beaconBottomRight = new Point(center.x + (beaconSizeFinal.width / 2),
            center.y + (beaconSizeFinal.height / 2));
    Rectangle boundingBox = new Rectangle(new Rect(beaconTopLeft, beaconBottomRight));

    //Get ellipses in region of interest
    //Make sure the rectangles don't leave the image size
    Rectangle leftRect = leftMostContour.getBoundingRectangle().clip(new Rectangle(img.size()));
    Rectangle rightRect = rightMostContour.getBoundingRectangle().clip(new Rectangle(img.size()));
    Mat leftContourImg = gray.submat((int) leftRect.top(), (int) leftRect.bottom(), (int) leftRect.left(),
            (int) leftRect.right());
    Mat rightContourImg = gray.submat((int) rightRect.top(), (int) rightRect.bottom(), (int) rightRect.left(),
            (int) rightRect.right());

    //Locate ellipses in the image to process contours against
    List<Ellipse> ellipsesLeft = PrimitiveDetection.locateEllipses(leftContourImg).getEllipses();
    Detectable.offset(ellipsesLeft, new Point(leftRect.left(), leftRect.top()));
    List<Ellipse> ellipsesRight = PrimitiveDetection.locateEllipses(rightContourImg).getEllipses();
    Detectable.offset(ellipsesRight, new Point(rightRect.left(), rightRect.top()));

    //Score ellipses
    BeaconScoringCOMPLEX scorer = new BeaconScoringCOMPLEX(img.size());
    List<BeaconScoringCOMPLEX.ScoredEllipse> scoredEllipsesLeft = scorer.scoreEllipses(ellipsesLeft, null, null,
            gray);
    scoredEllipsesLeft = filterEllipses(scoredEllipsesLeft);
    ellipsesLeft = BeaconScoringCOMPLEX.ScoredEllipse.getList(scoredEllipsesLeft);
    if (debug)
        Drawing.drawEllipses(img, ellipsesLeft, new ColorRGBA("#00ff00"), 3);
    List<BeaconScoringCOMPLEX.ScoredEllipse> scoredEllipsesRight = scorer.scoreEllipses(ellipsesRight, null,
            null, gray);
    scoredEllipsesRight = filterEllipses(scoredEllipsesRight);
    ellipsesRight = BeaconScoringCOMPLEX.ScoredEllipse.getList(scoredEllipsesRight);
    if (debug)
        Drawing.drawEllipses(img, ellipsesRight, new ColorRGBA("#00ff00"), 3);

    //Calculate ellipse center if present
    Point centerLeft;
    Point centerRight;
    boolean done = false;
    do {
        centerLeft = null;
        centerRight = null;
        if (scoredEllipsesLeft.size() > 0)
            centerLeft = scoredEllipsesLeft.get(0).ellipse.center();
        if (scoredEllipsesRight.size() > 0)
            centerRight = scoredEllipsesRight.get(0).ellipse.center();

        //Flip axis if necesary
        if (centerLeft != null && readOppositeAxis) {
            centerLeft.set(new double[] { centerLeft.y, centerLeft.x });
        }
        if (centerRight != null && readOppositeAxis) {
            centerRight.set(new double[] { centerRight.y, centerRight.x });
        }

        //Make very, very sure that we didn't just find the same ellipse
        if (centerLeft != null && centerRight != null) {
            if (Math.abs(centerLeft.x - centerRight.x) < Constants.ELLIPSE_MIN_DISTANCE * beaconSize.width) {
                //Are both ellipses on the left or right side of the beacon? - remove the opposite side's ellipse
                if (Math.abs(centerLeft.x - leftRect.center().x) < Constants.ELLIPSE_MIN_DISTANCE
                        * beaconSize.width)
                    scoredEllipsesRight.remove(0);
                else
                    scoredEllipsesLeft.remove(0);
            } else
                done = true;
        } else
            done = true;

    } while (!done);

    //Improve the beacon center if both ellipses present
    byte ellipseExtrapolated = 0;
    if (centerLeft != null && centerRight != null) {
        if (readOppositeAxis)
            center.y = (centerLeft.x + centerRight.x) / 2;
        else
            center.x = (centerLeft.x + centerRight.x) / 2;
    }
    //Extrapolate other ellipse location if one present
    //FIXME: This method of extrapolation may not work when readOppositeAxis is true
    else if (centerLeft != null) {
        ellipseExtrapolated = 2;
        if (readOppositeAxis)
            centerRight = new Point(centerLeft.x - 2 * Math.abs(center.x - centerLeft.x),
                    (centerLeft.y + center.y) / 2);
        else
            centerRight = new Point(centerLeft.x + 2 * Math.abs(center.x - centerLeft.x),
                    (centerLeft.y + center.y) / 2);
        if (readOppositeAxis)
            centerRight.set(new double[] { centerRight.y, centerRight.x });
    } else if (centerRight != null) {
        ellipseExtrapolated = 1;
        if (readOppositeAxis)
            centerLeft = new Point(centerRight.x + 2 * Math.abs(center.x - centerRight.x),
                    (centerRight.y + center.y) / 2);
        else
            centerLeft = new Point(centerRight.x - 2 * Math.abs(center.x - centerRight.x),
                    (centerRight.y + center.y) / 2);
        if (readOppositeAxis)
            centerLeft.set(new double[] { centerLeft.y, centerLeft.x });
    }

    //Draw center locations
    if (debug)
        Drawing.drawCross(img, center, new ColorRGBA("#ffffff"), 10, 4);
    if (debug && centerLeft != null) {
        ColorRGBA c = ellipseExtrapolated != 1 ? new ColorRGBA("#ffff00") : new ColorRGBA("#ff00ff");
        //noinspection SuspiciousNameCombination
        Drawing.drawCross(img, !readOppositeAxis ? centerLeft : new Point(centerLeft.y, centerLeft.x), c, 8, 3);
    }
    if (debug && centerRight != null) {
        ColorRGBA c = ellipseExtrapolated != 2 ? new ColorRGBA("#ffff00") : new ColorRGBA("#ff00ff");
        //noinspection SuspiciousNameCombination
        Drawing.drawCross(img, !readOppositeAxis ? centerRight : new Point(centerRight.y, centerRight.x), c, 8,
                3);
    }

    //Draw the rectangle containing the beacon
    if (debug)
        Drawing.drawRectangle(img, boundingBox, new ColorRGBA(0, 255, 0), 4);

    //Tell us the height of the beacon
    //TODO later we can get the distance away from the beacon based on its height and position

    //Remove the largest index and look for the next largest
    //If the next largest is (mostly) within the area of the box, then merge it in with the largest
    //Check if the size of the largest contour(s) is about twice the size of the other
    //This would indicate one is brightly lit and the other is not
    //If this is not true, then neither part of the beacon is highly lit

    //Get confidence approximation
    double WH_ratio = widthBeacon / beaconHeight;
    double ratioError = Math.abs((Constants.BEACON_WH_RATIO - WH_ratio)) / Constants.BEACON_WH_RATIO; // perfect value = 0;
    double averageHeight = (leftMostContour.height() + rightMostContour.height()) / 2.0;
    double dy = Math.abs((leftMostContour.centroid().y - rightMostContour.centroid().y) / averageHeight
            * Constants.FAST_HEIGHT_DELTA_FACTOR);
    double dArea = Math.sqrt(leftMostContour.area() / rightMostContour.area());
    double buttonsdy = (centerLeft != null && centerRight != null)
            ? (Math.abs(centerLeft.y - centerRight.y) / averageHeight * Constants.FAST_HEIGHT_DELTA_FACTOR)
            : Constants.ELLIPSE_PRESENCE_BIAS;
    double confidence = MathUtil.normalPDFNormalized(
            MathUtil.distance(MathUtil.distance(MathUtil.distance(ratioError, dy), dArea), buttonsdy)
                    / Constants.FAST_CONFIDENCE_ROUNDNESS,
            Constants.FAST_CONFIDENCE_NORM, 0.0);

    //Get button ellipses
    Ellipse leftEllipse = scoredEllipsesLeft.size() > 0 ? scoredEllipsesLeft.get(0).ellipse : null;
    Ellipse rightEllipse = scoredEllipsesRight.size() > 0 ? scoredEllipsesRight.get(0).ellipse : null;

    //Test for color switching
    if (leftEllipse != null && rightEllipse != null && leftEllipse.center().x > rightEllipse.center().x) {
        Ellipse tE = leftEllipse;
        leftEllipse = rightEllipse;
        rightEllipse = tE;
    } else if ((leftEllipse != null && leftEllipse.center().x > center.x)
            || (rightEllipse != null && rightEllipse.center().x < center.x)) {
        Ellipse tE = leftEllipse;
        leftEllipse = rightEllipse;
        rightEllipse = tE;
    }

    //Axis correction for ellipses
    if (swapLeftRight) {
        if (leftEllipse != null)
            leftEllipse = new Ellipse(
                    new RotatedRect(new Point(img.width() - leftEllipse.center().x, leftEllipse.center().y),
                            leftEllipse.size(), leftEllipse.angle()));
        if (rightEllipse != null)
            rightEllipse = new Ellipse(
                    new RotatedRect(new Point(img.width() - rightEllipse.center().x, rightEllipse.center().y),
                            rightEllipse.size(), rightEllipse.angle()));
        //Swap again after correcting axis to ensure left is left and right is right
        Ellipse tE = leftEllipse;
        leftEllipse = rightEllipse;
        rightEllipse = tE;
    }

    //Switch axis if necessary
    if (readOppositeAxis)
        boundingBox = boundingBox.transpose();

    if (leftIsRed)
        return new Beacon.BeaconAnalysis(Beacon.BeaconColor.RED, Beacon.BeaconColor.BLUE, boundingBox,
                confidence, leftEllipse, rightEllipse);
    else
        return new Beacon.BeaconAnalysis(Beacon.BeaconColor.BLUE, Beacon.BeaconColor.RED, boundingBox,
                confidence, leftEllipse, rightEllipse);
}

From source file:org.vinesrobotics.bot.utils.opencv.ColorBlobDetector.java

License:Open Source License

public void process(Mat rgbaImage) {
    Imgproc.pyrDown(rgbaImage, mPyrDownMat);
    Imgproc.pyrDown(mPyrDownMat, mPyrDownMat);

    Imgproc.cvtColor(mPyrDownMat, mHsvMat, Imgproc.COLOR_RGB2HSV_FULL);

    Core.inRange(mHsvMat, mLowerBound, mUpperBound, mMask);
    Imgproc.dilate(mMask, mDilatedMask, new Mat());

    List<MatOfPoint> contours = new ArrayList<MatOfPoint>();

    Imgproc.findContours(mDilatedMask, contours, mHierarchy, Imgproc.RETR_EXTERNAL,
            Imgproc.CHAIN_APPROX_SIMPLE);

    // Filter contours by area and resize to fit the original image size
    double maxArea = 0;
    Iterator<MatOfPoint> each = contours.iterator();

    while (each.hasNext()) {
        MatOfPoint wrapper = each.next();
        double area = Imgproc.contourArea(wrapper);
        if (area > maxArea)
            maxArea = area;/*from w  w w .  ja v a 2 s . co m*/
    }

    mContours.clear();
    each = contours.iterator();
    while (each.hasNext()) {
        MatOfPoint contour = each.next();
        if (Imgproc.contourArea(contour) > mMinContourArea * maxArea) {
            Core.multiply(contour, new Scalar(4, 4), contour);
            mContours.add(contour);
        }
    }

    Imgproc.drawContours(rgbaImage, mContours, -1, mBaseColor);

    each = mContours.iterator();
    ArrayList<Point> centers = new ArrayList<>();
    while (each.hasNext()) {
        MatOfPoint wrapper = each.next();
        Moments moments = Imgproc.moments(wrapper);
        centers.add(new Point(moments.m10 / moments.m00, moments.m01 / moments.m00));
    }
    colorCenterPoints = centers;

    Point avg = new Point(0, 0);
    for (Point p : centers)
        avg.set(new double[] { avg.x + p.x, avg.y + p.y });
    avg.set(new double[] { avg.x / centers.size(), avg.y / centers.size() });
    centerOfAll = avg;

}