// 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;
}
