Beispiel #1
0
        public static AlignmentPattern findAlignmentPattern(bool[][] image, FinderPattern finderPattern)
        {
            Point[][] logicalCenter   = AlignmentPattern.getLogicalCenter(finderPattern);
            int       patternDistance = logicalCenter[1][0].X - logicalCenter[0][0].X;

            return(new AlignmentPattern(AlignmentPattern.getCenter(image, finderPattern, logicalCenter), patternDistance));
        }
        // For only version 1 which has no Alignement Patterns
        /*	SamplingGrid getSamplingGrid1(FinderPattern finderPattern) {
        int sqrtNumArea = 1;
        int sqrtNumModules = finderPattern.getSqrtNumModules(); //get nummber of modules at side
        int sqrtNumAreaModules = sqrtNumModules / sqrtNumArea;
        Point[] centers = finderPattern.getCenter();
        int logicalDistance = 14;
        SamplingGrid samplingGrid = new SamplingGrid(sqrtNumArea);
        Line baseLineX, baseLineY, gridLineX, gridLineY;

        ModulePitch modulePitch = new ModulePitch(); //store (up,left) order
        modulePitch.top = getAreaModulePitch(centers[0], centers[1], logicalDistance);
        modulePitch.left = getAreaModulePitch(centers[0], centers[2], logicalDistance);

        //X軸に垂直の基線(一般に縦)
        baseLineX = new Line(
        finderPattern.getCenter(FinderPattern.UL),
        finderPattern.getCenter(FinderPattern.DL));

        Axis axis = new Axis(finderPattern.getAngle(), modulePitch.top);
        axis.setOrigin(baseLineX.getP1());
        baseLineX.setP1(axis.translate(-3, -3));

        axis.setModulePitch(modulePitch.left);
        axis.setOrigin(baseLineX.getP2());
        baseLineX.setP2(axis.translate(-3, 3));

        //Y軸に垂直の基線(一般に横)
        baseLineY =
        new Line(finderPattern.getCenter(FinderPattern.UL),
        finderPattern.getCenter(FinderPattern.UR));

        axis.setModulePitch(modulePitch.left);
        axis.setOrigin(baseLineY.getP1());
        baseLineY.setP1(axis.translate(-3, -3));

        axis.setModulePitch(modulePitch.left);
        axis.setOrigin(baseLineY.getP2());
        baseLineY.setP2(axis.translate(3, -3));

        //baseLineX.translate(1,1);
        //baseLineY.translate(1,1);

        samplingGrid.initGrid(0, 0, sqrtNumAreaModules, sqrtNumAreaModules);

        for (int i = 0; i < sqrtNumAreaModules; i++) {

        gridLineX = new Line(baseLineX.getP1(), baseLineX.getP2());

        axis.setOrigin(gridLineX.getP1());
        axis.setModulePitch(modulePitch.top);
        gridLineX.setP1(axis.translate(i,0));

        axis.setOrigin(gridLineX.getP2());
        axis.setModulePitch(modulePitch.top);
        gridLineX.setP2(axis.translate(i,0));

        gridLineY = new Line(baseLineY.getP1(), baseLineY.getP2());
        axis.setOrigin(gridLineY.getP1());
        axis.setModulePitch(modulePitch.left);
        gridLineY.setP1(axis.translate(0,i));

        axis.setOrigin(gridLineY.getP2());
        axis.setModulePitch(modulePitch.left);
        gridLineY.setP2(axis.translate(0,i));

        samplingGrid.setXLine(0,0,i,gridLineX);
        samplingGrid.setYLine(0,0,i,gridLineY);
        }
        for (int ay = 0; ay < samplingGrid.getHeight(); ay++) {
        for (int ax = 0; ax < samplingGrid.getWidth();ax++) {
        canvas.drawLines(samplingGrid.getXLines(ax,ay), Color.BLUE);
        canvas.drawLines(samplingGrid.getYLines(ax,ay), Color.BLUE);
        }
        }
        return samplingGrid;
        }*/
        //sampllingGrid[areaX][areaY][direction(x=0,y=1)][EachLines]
        /*	SamplingGrid getSamplingGrid2_6(FinderPattern finderPattern, AlignmentPattern alignmentPattern) {

        Point centers[][] = alignmentPattern.getCenter();
        centers[0][0] = finderPattern.getCenter(FinderPattern.UL);
        centers[1][0] = finderPattern.getCenter(FinderPattern.UR);
        centers[0][1] = finderPattern.getCenter(FinderPattern.DL);
        int sqrtNumModules = finderPattern.getSqrtNumModules(); //一辺当たりのモジュール数を得る

        SamplingGrid samplingGrid = new SamplingGrid(1);
        Line baseLineX, baseLineY, gridLineX, gridLineY;

        int logicalDistance = alignmentPattern.getLogicalDistance();
        Axis axis = new Axis(finderPattern.getAngle(), finderPattern.getModuleSize());

        ModulePitch modulePitch = new ModulePitch(); //top left bottom rightの順に格納

        modulePitch.top = getAreaModulePitch(centers[0][0], centers[1][0], logicalDistance + 6);
        modulePitch.left = getAreaModulePitch(centers[0][0], centers[0][1], logicalDistance + 6);
        axis.setModulePitch(modulePitch.top);
        axis.setOrigin(centers[0][1]);
        modulePitch.bottom = getAreaModulePitch(axis.translate(0, -3), centers[1][1], logicalDistance + 3);
        axis.setModulePitch(modulePitch.left);
        axis.setOrigin(centers[1][0]);
        modulePitch.right = getAreaModulePitch(axis.translate(-3, 0), centers[1][1], logicalDistance + 3);

        //X軸に垂直の基線(一般に縦)
        baseLineX = new Line();
        baseLineY = new Line();

        axis.setOrigin(centers[0][0]);
        modulePitch.top = getAreaModulePitch(centers[0][0], centers[1][0], logicalDistance + 6);
        modulePitch.left = getAreaModulePitch(centers[0][0], centers[0][1], logicalDistance + 6);
        axis.setModulePitch(modulePitch.top);
        axis.setOrigin(centers[0][1]);
        modulePitch.bottom = getAreaModulePitch(axis.translate(0,-3), centers[1][1], logicalDistance + 3);
        axis.setModulePitch(modulePitch.left);
        axis.setOrigin(centers[1][0]);
        modulePitch.right = getAreaModulePitch(axis.translate(-3,0), centers[1][1], logicalDistance + 3);

        axis.setOrigin(centers[0][0]);
        axis.setModulePitch(modulePitch.top);
        baseLineX.setP1(axis.translate(-3,-3));

        axis.setModulePitch(modulePitch.left);
        baseLineY.setP1(axis.translate(-3,-3));

        axis.setOrigin(centers[0][1]);
        axis.setModulePitch(modulePitch.bottom);
        baseLineX.setP2(axis.translate(-3,3));

        axis.setOrigin(centers[1][0]);
        axis.setModulePitch(modulePitch.right);
        baseLineY.setP2(axis.translate(3,-3));

        baseLineX.translate(1,1);
        baseLineY.translate(1,1);

        samplingGrid.initGrid(0, 0, sqrtNumModules, sqrtNumModules);

        for (int i = 0; i < sqrtNumModules; i++) {
        gridLineX = new Line(baseLineX.getP1(), baseLineX.getP2());

        axis.setOrigin(gridLineX.getP1());
        axis.setModulePitch(modulePitch.top);
        gridLineX.setP1(axis.translate(i,0));

        axis.setOrigin(gridLineX.getP2());
        axis.setModulePitch(modulePitch.bottom);
        gridLineX.setP2(axis.translate(i,0));

        gridLineY = new Line(baseLineY.getP1(), baseLineY.getP2());

        axis.setOrigin(gridLineY.getP1());
        axis.setModulePitch(modulePitch.left);
        gridLineY.setP1(axis.translate(0,i));

        axis.setOrigin(gridLineY.getP2());
        axis.setModulePitch(modulePitch.right);
        gridLineY.setP2(axis.translate(0,i));

        samplingGrid.setXLine(0,0,i,gridLineX);
        samplingGrid.setYLine(0,0,i,gridLineY);

        }

        for (int ay = 0; ay < samplingGrid.getHeight(); ay++) {
        for (int ax = 0; ax < samplingGrid.getWidth();ax++) {
        canvas.drawLines(samplingGrid.getXLines(ax,ay), java.awt.Color.BLUE);
        canvas.drawLines(samplingGrid.getYLines(ax,ay), java.awt.Color.BLUE);
        }
        }
        return samplingGrid;
        }

        //for version 7-13
        SamplingGrid getSamplingGrid7_13(FinderPattern finderPattern, AlignmentPattern alignmentPattern) {

        Point centers[][] = alignmentPattern.getCenter();
        centers[0][0] = finderPattern.getCenter(FinderPattern.UL);
        centers[2][0] = finderPattern.getCenter(FinderPattern.UR);
        centers[0][2] = finderPattern.getCenter(FinderPattern.DL);
        int sqrtNumModules = finderPattern.getSqrtNumModules(); //一辺当たりのモジュール数を得る
        int sqrtNumArea = 2;
        int sqrtNumAreaModules = sqrtNumModules / sqrtNumArea;
        sqrtNumAreaModules++;
        SamplingGrid samplingGrid = new SamplingGrid(sqrtNumArea);
        Line baseLineX, baseLineY, gridLineX, gridLineY;

        int logicalDistance = alignmentPattern.getLogicalDistance();
        Axis axis = new Axis(finderPattern.getAngle(), finderPattern.getModuleSize());
        ModulePitch modulePitch;
        for (int ay = 0; ay < sqrtNumArea; ay++) {
        for (int ax = 0; ax < sqrtNumArea; ax++) {
        modulePitch = new ModulePitch(); //top left bottom rightの順に格納
        baseLineX = new Line();
        baseLineY = new Line();
        axis.setModulePitch(finderPattern.getModuleSize());
        if (ax == 0 && ay == 0) {
        axis.setOrigin(centers[0][0]);
        modulePitch.top = getAreaModulePitch(axis.translate(0,3), centers[1][0], logicalDistance + 3);
        modulePitch.left = getAreaModulePitch(axis.translate(3,0), centers[0][1], logicalDistance + 3);
        axis.setModulePitch(modulePitch.top);
        modulePitch.bottom = getAreaModulePitch(centers[0][1], centers[1][1], logicalDistance);
        axis.setModulePitch(modulePitch.left);
        modulePitch.right = getAreaModulePitch(centers[1][0], centers[1][1], logicalDistance);

        axis.setModulePitch(modulePitch.top);
        baseLineX.setP1(axis.translate(-3,-3));

        axis.setModulePitch(modulePitch.left);
        baseLineY.setP1(axis.translate(-3,-3));

        axis.setOrigin(centers[0][1]);
        axis.setModulePitch(modulePitch.bottom);
        baseLineX.setP2(axis.translate(-6,0));

        axis.setOrigin(centers[1][0]);
        axis.setModulePitch(modulePitch.right);
        baseLineY.setP2(axis.translate(0,-6));
        }
        else if (ax == 1 && ay == 0) {
        axis.setOrigin(centers[1][0]);
        modulePitch.top = getAreaModulePitch(axis.translate(0,-3), centers[2][0], logicalDistance + 3);
        modulePitch.left = getAreaModulePitch(centers[1][0], centers[1][1], logicalDistance);
        axis.setModulePitch(modulePitch.top);
        modulePitch.bottom = getAreaModulePitch(centers[1][1], centers[2][1], logicalDistance);
        axis.setModulePitch(modulePitch.left);
        axis.setOrigin(centers[2][0]);
        modulePitch.right = getAreaModulePitch(axis.translate(-3,0), centers[2][1], logicalDistance + 3);

        axis.setOrigin(centers[1][0]);
        axis.setModulePitch(modulePitch.left);
        baseLineX.setP1(axis.translate(0,-6));

        baseLineY.setP1(axis.translate(0,-6));

        baseLineX.setP2(centers[1][1]);

        axis.setOrigin(centers[2][0]);
        axis.setModulePitch(modulePitch.right);
        baseLineY.setP2(axis.translate(3,-3));
        }
        else if (ax == 0 && ay == 1) {
        modulePitch.top = getAreaModulePitch(centers[0][1], centers[1][1], logicalDistance);
        axis.setOrigin(centers[0][2]);
        modulePitch.left = getAreaModulePitch(centers[0][1], axis.translate(3,0), logicalDistance + 3);
        axis.setModulePitch(modulePitch.top);
        modulePitch.bottom = getAreaModulePitch(axis.translate(0,-3), centers[1][2], logicalDistance + 3);
        axis.setModulePitch(modulePitch.bottom);
        modulePitch.right = getAreaModulePitch(centers[1][1], centers[1][2], logicalDistance);

        axis.setOrigin(centers[0][1]);
        axis.setModulePitch(modulePitch.top);
        baseLineX.setP1(axis.translate(-6,0));

        baseLineY.setP1(axis.translate(-6,0));

        axis.setOrigin(centers[0][2]);
        axis.setModulePitch(modulePitch.bottom);
        baseLineX.setP2(axis.translate(-3, 3));

        baseLineY.setP2(centers[1][1]);
        }
        else if (ax == 1 && ay == 1) {
        modulePitch.top = getAreaModulePitch(centers[1][1], centers[2][1], logicalDistance);
        modulePitch.left = getAreaModulePitch(centers[1][1], centers[1][2], logicalDistance);
        modulePitch.bottom = getAreaModulePitch(centers[1][2], centers[2][2], logicalDistance);
        modulePitch.right = getAreaModulePitch(centers[2][1], centers[2][2], logicalDistance);

        baseLineX.setP1(centers[1][1]);
        baseLineY.setP1(centers[1][1]);

        axis.setOrigin(centers[1][2]);
        axis.setModulePitch(modulePitch.left);
        baseLineX.setP2(axis.translate(0,6));

        axis.setOrigin(centers[2][1]);
        axis.setModulePitch(modulePitch.top);
        baseLineY.setP2(axis.translate(6,0));
        }

        samplingGrid.initGrid(ax,ay, sqrtNumAreaModules, sqrtNumAreaModules);

        for (int i = 0; i < sqrtNumAreaModules; i++) {
        gridLineX = new Line(baseLineX.getP1(), baseLineX.getP2());

        axis.setOrigin(gridLineX.getP1());
        axis.setModulePitch(modulePitch.top);
        gridLineX.setP1(axis.translate(i,0));

        axis.setOrigin(gridLineX.getP2());
        axis.setModulePitch(modulePitch.bottom);
        gridLineX.setP2(axis.translate(i,0));

        gridLineY = new Line(baseLineY.getP1(), baseLineY.getP2());

        axis.setOrigin(gridLineY.getP1());
        axis.setModulePitch(modulePitch.left);
        gridLineY.setP1(axis.translate(0,i));

        axis.setOrigin(gridLineY.getP2());
        axis.setModulePitch(modulePitch.right);
        gridLineY.setP2(axis.translate(0,i));

        samplingGrid.setXLine(ax,ay,i,gridLineX);
        samplingGrid.setYLine(ax,ay,i,gridLineY);

        }
        }
        }

        for (int ay = 0; ay < samplingGrid.getHeight(); ay++) {
        for (int ax = 0; ax < samplingGrid.getWidth();ax++) {
        canvas.drawLines(samplingGrid.getXLines(ax,ay), java.awt.Color.BLUE);
        canvas.drawLines(samplingGrid.getYLines(ax,ay), java.awt.Color.BLUE);
        }
        }

        return samplingGrid;
        }*/
        /// <summary> Generic Sampling grid method</summary>
        internal virtual SamplingGrid getSamplingGrid(FinderPattern finderPattern, AlignmentPattern alignmentPattern)
        {
            Point[][] centers = alignmentPattern.getCenter();

            int version = finderPattern.Version;
            int sqrtCenters = (version / 7) + 2;

            centers[0][0] = finderPattern.getCenter(FinderPattern.UL);
            centers[sqrtCenters - 1][0] = finderPattern.getCenter(FinderPattern.UR);
            centers[0][sqrtCenters - 1] = finderPattern.getCenter(FinderPattern.DL);
            //int sqrtNumModules = finderPattern.getSqrtNumModules(); /// The number of modules per one side is obtained
            int sqrtNumArea = sqrtCenters - 1;

            //--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//--//
            SamplingGrid samplingGrid = new SamplingGrid(sqrtNumArea);

            Line baseLineX, baseLineY, gridLineX, gridLineY;

            ///???
            //Point[] targetCenters;

            //int logicalDistance = alignmentPattern.getLogicalDistance();
            Axis axis = new Axis(finderPattern.getAngle(), finderPattern.getModuleSize());
            ModulePitch modulePitch;

            // for each area :
            for (int ay = 0; ay < sqrtNumArea; ay++)
            {
                for (int ax = 0; ax < sqrtNumArea; ax++)
                {
                    modulePitch = new ModulePitch(this); /// Housing to order
                    baseLineX = new Line();
                    baseLineY = new Line();
                    axis.ModulePitch = finderPattern.getModuleSize();

                    Point[][] logicalCenters = AlignmentPattern.getLogicalCenter(finderPattern);

                    Point upperLeftPoint = centers[ax][ay];
                    Point upperRightPoint = centers[ax + 1][ay];
                    Point lowerLeftPoint = centers[ax][ay + 1];
                    Point lowerRightPoint = centers[ax + 1][ay + 1];

                    Point logicalUpperLeftPoint = logicalCenters[ax][ay];
                    Point logicalUpperRightPoint = logicalCenters[ax + 1][ay];
                    Point logicalLowerLeftPoint = logicalCenters[ax][ay + 1];
                    Point logicalLowerRightPoint = logicalCenters[ax + 1][ay + 1];

                    if (ax == 0 && ay == 0)
                    // left upper corner
                    {
                        if (sqrtNumArea == 1)
                        {
                            upperLeftPoint = axis.translate(upperLeftPoint, - 3, - 3);
                            upperRightPoint = axis.translate(upperRightPoint, 3, - 3);
                            lowerLeftPoint = axis.translate(lowerLeftPoint, - 3, 3);
                            lowerRightPoint = axis.translate(lowerRightPoint, 6, 6);

                            logicalUpperLeftPoint.translate(- 6, - 6);
                            logicalUpperRightPoint.translate(3, - 3);
                            logicalLowerLeftPoint.translate(- 3, 3);
                            logicalLowerRightPoint.translate(6, 6);
                        }
                        else
                        {
                            upperLeftPoint = axis.translate(upperLeftPoint, - 3, - 3);
                            upperRightPoint = axis.translate(upperRightPoint, 0, - 6);
                            lowerLeftPoint = axis.translate(lowerLeftPoint, - 6, 0);

                            logicalUpperLeftPoint.translate(- 6, - 6);
                            logicalUpperRightPoint.translate(0, - 6);
                            logicalLowerLeftPoint.translate(- 6, 0);
                        }
                    }
                    else if (ax == 0 && ay == sqrtNumArea - 1)
                    // left bottom corner
                    {
                        upperLeftPoint = axis.translate(upperLeftPoint, - 6, 0);
                        lowerLeftPoint = axis.translate(lowerLeftPoint, - 3, 3);
                        lowerRightPoint = axis.translate(lowerRightPoint, 0, 6);

                        logicalUpperLeftPoint.translate(- 6, 0);
                        logicalLowerLeftPoint.translate(- 6, 6);
                        logicalLowerRightPoint.translate(0, 6);
                    }
                    else if (ax == sqrtNumArea - 1 && ay == 0)
                    // right upper corner
                    {
                        upperLeftPoint = axis.translate(upperLeftPoint, 0, - 6);
                        upperRightPoint = axis.translate(upperRightPoint, 3, - 3);
                        lowerRightPoint = axis.translate(lowerRightPoint, 6, 0);

                        logicalUpperLeftPoint.translate(0, - 6);
                        logicalUpperRightPoint.translate(6, - 6);
                        logicalLowerRightPoint.translate(6, 0);
                    }
                    else if (ax == sqrtNumArea - 1 && ay == sqrtNumArea - 1)
                    // right bottom corner
                    {
                        lowerLeftPoint = axis.translate(lowerLeftPoint, 0, 6);
                        upperRightPoint = axis.translate(upperRightPoint, 6, 0);
                        lowerRightPoint = axis.translate(lowerRightPoint, 6, 6);

                        logicalLowerLeftPoint.translate(0, 6);
                        logicalUpperRightPoint.translate(6, 0);
                        logicalLowerRightPoint.translate(6, 6);
                    }
                    else if (ax == 0)
                    // left side
                    {
                        upperLeftPoint = axis.translate(upperLeftPoint, - 6, 0);
                        lowerLeftPoint = axis.translate(lowerLeftPoint, - 6, 0);

                        logicalUpperLeftPoint.translate(- 6, 0);
                        logicalLowerLeftPoint.translate(- 6, 0);
                    }
                    else if (ax == sqrtNumArea - 1)
                    // right
                    {
                        upperRightPoint = axis.translate(upperRightPoint, 6, 0);
                        lowerRightPoint = axis.translate(lowerRightPoint, 6, 0);

                        logicalUpperRightPoint.translate(6, 0);
                        logicalLowerRightPoint.translate(6, 0);
                    }
                    else if (ay == 0)
                    // top
                    {
                        upperLeftPoint = axis.translate(upperLeftPoint, 0, - 6);
                        upperRightPoint = axis.translate(upperRightPoint, 0, - 6);

                        logicalUpperLeftPoint.translate(0, - 6);
                        logicalUpperRightPoint.translate(0, - 6);
                    }
                    else if (ay == sqrtNumArea - 1)
                    // bottom
                    {
                        lowerLeftPoint = axis.translate(lowerLeftPoint, 0, 6);
                        lowerRightPoint = axis.translate(lowerRightPoint, 0, 6);

                        logicalLowerLeftPoint.translate(0, 6);
                        logicalLowerRightPoint.translate(0, 6);
                    }

                    if (ax == 0)
                    {
                        logicalUpperRightPoint.translate(1, 0);
                        logicalLowerRightPoint.translate(1, 0);
                    }
                    else
                    {
                        logicalUpperLeftPoint.translate(- 1, 0);
                        logicalLowerLeftPoint.translate(- 1, 0);
                    }

                    if (ay == 0)
                    {
                        logicalLowerLeftPoint.translate(0, 1);
                        logicalLowerRightPoint.translate(0, 1);
                    }
                    else
                    {
                        logicalUpperLeftPoint.translate(0, - 1);
                        logicalUpperRightPoint.translate(0, - 1);
                    }

                    int logicalWidth = logicalUpperRightPoint.X - logicalUpperLeftPoint.X;
                    int logicalHeight = logicalLowerLeftPoint.Y - logicalUpperLeftPoint.Y;

                    if (version < 7)
                    {
                        logicalWidth += 3;
                        logicalHeight += 3;
                    }
                    modulePitch.top = getAreaModulePitch(upperLeftPoint, upperRightPoint, logicalWidth - 1);
                    modulePitch.left = getAreaModulePitch(upperLeftPoint, lowerLeftPoint, logicalHeight - 1);
                    modulePitch.bottom = getAreaModulePitch(lowerLeftPoint, lowerRightPoint, logicalWidth - 1);
                    modulePitch.right = getAreaModulePitch(upperRightPoint, lowerRightPoint, logicalHeight - 1);

                    baseLineX.setP1(upperLeftPoint);
                    baseLineY.setP1(upperLeftPoint);
                    baseLineX.setP2(lowerLeftPoint);
                    baseLineY.setP2(upperRightPoint);

                    samplingGrid.initGrid(ax, ay, logicalWidth, logicalHeight);

                    for (int i = 0; i < logicalWidth; i++)
                    {
                        gridLineX = new Line(baseLineX.getP1(), baseLineX.getP2());

                        axis.Origin = gridLineX.getP1();
                        axis.ModulePitch = modulePitch.top;
                        gridLineX.setP1(axis.translate(i, 0));

                        axis.Origin = gridLineX.getP2();
                        axis.ModulePitch = modulePitch.bottom;
                        gridLineX.setP2(axis.translate(i, 0));

                        samplingGrid.setXLine(ax, ay, i, gridLineX);
                    }

                    for (int i = 0; i < logicalHeight; i++)
                    {

                        gridLineY = new Line(baseLineY.getP1(), baseLineY.getP2());

                        axis.Origin = gridLineY.getP1();
                        axis.ModulePitch = modulePitch.left;
                        gridLineY.setP1(axis.translate(0, i));

                        axis.Origin = gridLineY.getP2();
                        axis.ModulePitch = modulePitch.right;
                        gridLineY.setP2(axis.translate(0, i));

                        samplingGrid.setYLine(ax, ay, i, gridLineY);
                    }
                }
            }

            return samplingGrid;
        }
Beispiel #3
0
        internal static Point[][] getCenter(bool[][] image, FinderPattern finderPattern, Point[][] logicalCenters)
        {
            int  moduleSize = finderPattern.GetModuleSize();
            Axis axis       = new Axis(finderPattern.GetAngle(), moduleSize);
            int  length     = logicalCenters.Length;

            Point[][] pointArray = new Point[length][];
            for (int index = 0; index < length; ++index)
            {
                pointArray[index] = new Point[length];
            }
            axis.Origin      = finderPattern.GetCenter(0);
            pointArray[0][0] = axis.translate(3, 3);
            AlignmentPattern.canvas.DrawCross(pointArray[0][0], Color_Fields.BLUE);
            axis.Origin = finderPattern.GetCenter(1);
            pointArray[length - 1][0] = axis.translate(-3, 3);
            AlignmentPattern.canvas.DrawCross(pointArray[length - 1][0], Color_Fields.BLUE);
            axis.Origin = finderPattern.GetCenter(2);
            pointArray[0][length - 1] = axis.translate(3, -3);
            AlignmentPattern.canvas.DrawCross(pointArray[0][length - 1], Color_Fields.BLUE);
            Point p1 = pointArray[0][0];

            for (int index1 = 0; index1 < length; ++index1)
            {
                for (int index2 = 0; index2 < length; ++index2)
                {
                    if ((index2 != 0 || index1 != 0) && (index2 != 0 || index1 != length - 1) && (index2 != length - 1 || index1 != 0))
                    {
                        Point point1 = (Point)null;
                        if (index1 == 0)
                        {
                            if (index2 > 0 && index2 < length - 1)
                            {
                                point1 = axis.translate(pointArray[index2 - 1][index1], logicalCenters[index2][index1].X - logicalCenters[index2 - 1][index1].X, 0);
                            }
                            pointArray[index2][index1] = new Point(point1.X, point1.Y);
                            AlignmentPattern.canvas.DrawCross(pointArray[index2][index1], Color_Fields.RED);
                        }
                        else if (index2 == 0)
                        {
                            if (index1 > 0 && index1 < length - 1)
                            {
                                point1 = axis.translate(pointArray[index2][index1 - 1], 0, logicalCenters[index2][index1].Y - logicalCenters[index2][index1 - 1].Y);
                            }
                            pointArray[index2][index1] = new Point(point1.X, point1.Y);
                            AlignmentPattern.canvas.DrawCross(pointArray[index2][index1], Color_Fields.RED);
                        }
                        else
                        {
                            Point point2 = axis.translate(pointArray[index2 - 1][index1], logicalCenters[index2][index1].X - logicalCenters[index2 - 1][index1].X, 0);
                            Point point3 = axis.translate(pointArray[index2][index1 - 1], 0, logicalCenters[index2][index1].Y - logicalCenters[index2][index1 - 1].Y);
                            pointArray[index2][index1] = new Point((point2.X + point3.X) / 2, (point2.Y + point3.Y) / 2 + 1);
                        }
                        if (finderPattern.Version > 1)
                        {
                            Point precisionCenter = AlignmentPattern.getPrecisionCenter(image, pointArray[index2][index1]);
                            if (pointArray[index2][index1].DistanceOf(precisionCenter) < 6)
                            {
                                AlignmentPattern.canvas.DrawCross(pointArray[index2][index1], Color_Fields.RED);
                                int num1 = precisionCenter.X - pointArray[index2][index1].X;
                                int num2 = precisionCenter.Y - pointArray[index2][index1].Y;
                                AlignmentPattern.canvas.Print("Adjust AP(" + (object)index2 + "," + (object)index1 + ") to d(" + (object)num1 + "," + (object)num2 + ")");
                                pointArray[index2][index1] = precisionCenter;
                            }
                        }
                        AlignmentPattern.canvas.DrawCross(pointArray[index2][index1], Color_Fields.BLUE);
                        AlignmentPattern.canvas.DrawLine(new Line(p1, pointArray[index2][index1]), Color_Fields.LIGHTBLUE);
                        p1 = pointArray[index2][index1];
                    }
                }
            }
            return(pointArray);
        }
Beispiel #4
0
        internal static Point getPrecisionCenter(bool[][] image, Point targetPoint)
        {
            int x1 = targetPoint.X;
            int y1 = targetPoint.Y;

            if (x1 < 0 || y1 < 0 || (x1 > image.Length - 1 || y1 > image[0].Length - 1))
            {
                throw new AlignmentPatternNotFoundException("Alignment Pattern finder exceeded out of image");
            }
            if (!image[targetPoint.X][targetPoint.Y])
            {
                int  num  = 0;
                bool flag = false;
                while (!flag)
                {
                    ++num;
                    for (int index1 = num; index1 > -num; --index1)
                    {
                        for (int index2 = num; index2 > -num; --index2)
                        {
                            int index3 = targetPoint.X + index2;
                            int index4 = targetPoint.Y + index1;
                            if (index3 < 0 || index4 < 0 || (index3 > image.Length - 1 || index4 > image[0].Length - 1))
                            {
                                throw new AlignmentPatternNotFoundException("Alignment Pattern finder exceeded out of image");
                            }
                            if (image[index3][index4])
                            {
                                targetPoint = new Point(targetPoint.X + index2, targetPoint.Y + index1);
                                flag        = true;
                            }
                        }
                    }
                }
            }
            int x2;
            int x3   = x2 = targetPoint.X;
            int x4   = x2;
            int num1 = x2;
            int y2;
            int y3   = y2 = targetPoint.Y;
            int y4   = y2;
            int num2 = y2;

            while (x4 >= 1 && !AlignmentPattern.targetPointOnTheCorner(image, x4, num2, x4 - 1, num2))
            {
                --x4;
            }
            while (x3 < image.Length - 1 && !AlignmentPattern.targetPointOnTheCorner(image, x3, num2, x3 + 1, num2))
            {
                ++x3;
            }
            while (y4 >= 1 && !AlignmentPattern.targetPointOnTheCorner(image, num1, y4, num1, y4 - 1))
            {
                --y4;
            }
            while (y3 < image[0].Length - 1 && !AlignmentPattern.targetPointOnTheCorner(image, num1, y3, num1, y3 + 1))
            {
                ++y3;
            }
            return(new Point((x4 + x3 + 1) / 2, (y4 + y3 + 1) / 2));
        }