TwistyPuzzleLib

///////////////////////////////////////////////////////////////////////////////////////////////////

// Copyright 2020 Leszek Koltunski                                                               //

//                                                                                               //

// This file is part of Magic Cube.                                                              //

//                                                                                               //

// Magic Cube is free software: you can redistribute it and/or modify                            //

// it under the terms of the GNU General Public License as published by                          //

// the Free Software Foundation, either version 2 of the License, or                             //

// (at your option) any later version.                                                           //

//                                                                                               //

// Magic Cube is distributed in the hope that it will be useful,                                 //

// but WITHOUT ANY WARRANTY; without even the implied warranty of                                //

// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the                                 //

// GNU General Public License for more details.                                                  //

//                                                                                               //

// You should have received a copy of the GNU General Public License                             //

// along with Magic Cube.  If not, see <http://www.gnu.org/licenses/>.                           //

///////////////////////////////////////////////////////////////////////////////////////////////////

package org.distorted.objectlib.main;

import java.io.IOException;

import java.io.InputStream;

import java.util.Random;

import android.graphics.Bitmap;

import android.graphics.Canvas;

import android.graphics.Paint;

import org.distorted.library.effect.Effect;

import org.distorted.library.effect.MatrixEffectMove;

import org.distorted.library.effect.MatrixEffectQuaternion;

import org.distorted.library.effect.MatrixEffectScale;

import org.distorted.library.effect.VertexEffectQuaternion;

import org.distorted.library.effect.VertexEffectRotate;

import org.distorted.library.main.DistortedEffects;

import org.distorted.library.main.DistortedLibrary;

import org.distorted.library.main.DistortedNode;

import org.distorted.library.main.DistortedTexture;

import org.distorted.library.mesh.MeshFile;

import org.distorted.library.mesh.MeshJoined;

import org.distorted.library.message.EffectListener;

import org.distorted.library.type.Dynamic1D;

import org.distorted.library.type.Static1D;

import org.distorted.library.type.Static3D;

import org.distorted.library.type.Static4D;

import org.distorted.objectlib.helpers.FactorySticker;

import org.distorted.objectlib.scrambling.ObjectScrambler;

  public static final int MESH_FAST = 1;

  public static final int MODE_NORM = 1;

  public static final int COLOR_WHITE    = 0xffffffff;

  public static final int COLOR_BLUE     = 0xff0000ff;

  public static final int COLOR_GREEN    = 0xff00bb00;

  public static final int COLOR_RED      = 0xff990000;

  public static final int COLOR_ORANGE   = 0xffff6200;

  public static final int COLOR_GREY     = 0xff727c7b;

  public static final int COLOR_VIOLET   = 0xff7700bb;

  public static final int COLOR_STROKE   = 0xff000000;

  public static final int TEXTURE_HEIGHT = 256;

  static final int NUM_STICKERS_IN_ROW = 4;

  public static final float SQ2 = (float)Math.sqrt(2);

  public static final float SQ3 = (float)Math.sqrt(3);

  public static final float SQ5 = (float)Math.sqrt(5);

  public static final float SQ6 = (float)Math.sqrt(6);

  private static final float MAX_SIZE_CHANGE = 1.35f;

  private static final float MIN_SIZE_CHANGE = 0.75f;

  private static final Static3D CENTER = new Static3D(0,0,0);

  private static final int POST_ROTATION_MILLISEC = 500;

  private float[] mStickerScales;

  private Cubit[] mCubits;

  private MeshBase[] mMeshes;

  private int mNumCubits, mNumQuats, mNumFaceColors, mNumTextures;

  private float[][] mCuts;

  private int[] mNumCuts;

  private float[][] mOrigPos;

  private VertexEffectRotate mRotateEffect;

  private Dynamic1D mRotationAngle;

  private Static3D mRotationAxis;

  private Static3D mObjectScale;

  private int[] mQuatDebug;

  private Static1D mRotationAngleStatic, mRotationAngleMiddle, mRotationAngleFinal;

  private DistortedTexture mTexture;

  private float mInitScreenRatio;

  private int mSolvedFunctionIndex;

  private boolean mIsBandaged;

  private int[][] mSolvedQuats;

  private int[][] mQuatMult;

  private int[] mTmpQuats;

  private int mNumTexRows, mNumTexCols;

  private int mRotRowBitmap;

  private int mNumCubitVariants;

  //////////////////// SOLVED1 ////////////////////////

  private int[] mFaceMap;

  private int[][] mScramble;

  private int[] mColors;

///////////////////////////////////////////////////////////////////////////////////////////////////

    setReader(reader);

    mNumLayers = reader.getNumLayers();

    mSize      = reader.getSize();

///////////////////////////////////////////////////////////////////////////////////////////////////

    mNumLayers = numLayers;

///////////////////////////////////////////////////////////////////////////////////////////////////

    mInitScreenRatio = getScreenRatio();

    mSolvedFunctionIndex = getSolvedFunctionIndex();

    mNumQuats = mObjectQuats.length;

    mOrigPos = getCubitPositions(mNumLayers);

    for(int i=0; i<numAxis; i++)

      }

    mNumFaceColors = getNumFaceColors();

    ScrambleState[] states = getScrambleStates();

    boolean bandaged=false;

      if( mOrigPos[c].length>3 )

        {

        bandaged=true;

        break;

        }

      }

    mIsBandaged = bandaged;

    mRotationAngle= new Dynamic1D();

    mRotationAxis = new Static3D(1,0,0);

    mRotateEffect = new VertexEffectRotate(mRotationAngle, mRotationAxis, CENTER);

    mRotationAngleStatic = new Static1D(0);

    mRotationAngleMiddle = new Static1D(0);

    mRotationAngleFinal  = new Static1D(0);

    setObjectRatioNow(scale,720);

    mEffects = new DistortedEffects();

      mEffects.apply(vq);

      }

    mEffects.apply(mRotateEffect);

    mEffects.apply(quatEffect);

    mEffects.apply(scaleEffect);

///////////////////////////////////////////////////////////////////////////////////////////////////

  private Static3D getPos(float[] origPos)

    {

    int len = origPos.length/3;

    float sumX = 0.0f;

    float sumY = 0.0f;

    float sumZ = 0.0f;

    for(int i=0; i<len; i++)

      {

      sumX += origPos[3*i  ];

      sumY += origPos[3*i+1];

      sumZ += origPos[3*i+2];

      }

    sumX /= len;

    sumY /= len;

    sumZ /= len;

    return new Static3D(sumX,sumY,sumZ);

    }

  private void createOuterFaces()

    {

    for(int v=0; v<mNumCubitVariants; v++)

      {

      int[][] indices = mShapes[v].getVertIndices();

      int faces = indices.length;

      mVariantFaceIsOuter[v] = new int[faces];

      }

      int variant = getCubitVariant(cubit,mNumLayers);

      int[][] indices = mShapes[variant].getVertIndices();

      int numFaces = indices.length;

      for(int face=0; face<numFaces; face++)

          mVariantFaceIsOuter[variant][face] = 1;

          }

      }

    }

  private void getQuatsAndShapes(boolean fromDMESH, boolean fromJSON)

    {

    mNumCubitVariants = getNumCubitVariants(mNumLayers);

    if( !fromDMESH || !fromJSON )

      {

      FactoryCubit factory = FactoryCubit.getInstance();

      factory.clear();

      for(int i=0; i<mNumCubits; i++) mOrigQuat[i] = getCubitQuats(i,mNumLayers);

      mShapes = new ObjectShape[mNumCubitVariants];

      for(int i=0; i<mNumCubitVariants; i++) mShapes[i] = getObjectShape(i);

      mNumCubitFaces = ObjectShape.computeNumComponents(mShapes);

        createOuterFaces();

    }

      try

        {

      catch(IOException e)

        {

        android.util.Log.e("meshFile", "Error closing InputStream: "+e.toString());

        }

      }

    else

      {

        cubitMesh[i].apply(new MatrixEffectMove(pos),1,0);

      mMesh = new MeshJoined(cubitMesh);

      }

    }

///////////////////////////////////////////////////////////////////////////////////////////////////

    int variant = getCubitVariant(cubit,numLayers);

    if( mMeshes[variant]==null )

      {

    MeshBase mesh = mMeshes[variant].copy(true);

    return mesh;

    }

  private void setUpTextures(boolean fromDMESH, boolean fromJSON)

    {

    mTexture = new DistortedTexture();

    if( fromJSON )

      {

      mNumStickerTypes = getNumStickerTypes();

      mNumCubitFaces = getNumCubitFaces();

      }

    else

      {

      FactoryCubit factory = FactoryCubit.getInstance();

    if( mNumTexCols*mNumTexRows < mNumTextures+1 ) mNumTexRows++;

    if( !fromDMESH || shouldResetTextureMaps() ) resetAllTextureMaps();

    setTexture();

    }

  private int getMultQuat(int index1, int index2)

    {

    if( mQuatMult==null )

      {

        for(int j=0; j<mNumQuats; j++) mQuatMult[i][j] = -1;

    if( mQuatMult[index1][index2]==-1 )

      {

      mQuatMult[index1][index2] = mulQuat(index1,index2);

      }

    return mQuatMult[index1][index2];

    }

  public boolean isInIconMode()

    {

    return mIconMode==MODE_ICON;

    }

  public int getVariantFaceColor(int variant, int face)

    {

    return face>=mStickerVariants[variant].length ? -1 : mStickerVariants[variant][face];

    }

  public boolean shouldResetTextureMaps()

    {

    return false;

    }

///////////////////////////////////////////////////////////////////////////////////////////////////

  private void createDataStructuresForSolved()

    {

    mTmpQuats = new int[mNumQuats];

    mSolvedQuats = getSolvedQuats();

    }

// This is used to build internal data structures for the generic 'isSolved()'

//

// if this is an internal cubit (all faces black): return -1

// if this is a face cubit (one non-black face): return the color index of the only non-black face.

// Color index, i.e. the index into the 'FACE_COLORS' table.

// else (edge or corner cubit, more than one non-black face): return -2.

    for(int face=0; face<mNumCubitFaces; face++)

      {

      cubColor = face<numFaces ? mCubitFaceColors[cubit][face] : -1;

        numNonBlack++;

      }

    if( numNonBlack==0 ) return -1;

    if( numNonBlack>=2 ) return -2;

    return nonBlackIndex;

    }

  private boolean sticksOut(Static3D[] faceAxis, float[] dist, float x, float y, float z )

    {

    final float MAXERR = 0.05f;

    int numAxis = dist.length;

    for(int i=0; i<numAxis; i++)

      {

      Static3D ax = faceAxis[i];

      float len = ax.get0()*x + ax.get1()*y + ax.get2()*z;

    return false;

    }

///////////////////////////////////////////////////////////////////////////////////////////////////

    ObjectShape shape = getObjectShape(variant);

    float[][] vertices = shape.getVertices();

    Static3D[] axis = getFaceAxis();

    float[] dist3D = getDist3D(mNumLayers);

    for( float[] vertex : vertices)

      {

      float x = vertex[0];

      float y = vertex[1];

      float z = vertex[2];

      QuatHelper.rotateVectorByQuat(tmp, x, y, z, 1, quat);

      float my = tmp[1] + py;

      float mz = tmp[2] + pz;

      if( sticksOut(axis, dist3D, mx,my,mz) ) return false;

      }

    return true;

    }

  private float computeAvg(float[] pos, int offset)

    {

    int len = pos.length/3;

    float ret=0.0f;

    for(int i=0; i<len; i++) ret += pos[3*i+offset];

    ret /= len;

    return ret;

    }

  protected void displayCubitQuats()

    {

    StringBuilder builder = new StringBuilder();

    float[] tmp = new float[4];

    for(int cubit=0; cubit<mNumCubits; cubit++)

      {

      builder.append(" : ");

      for(refCubit=0; refCubit<mNumCubits; refCubit++)

        {

        if( getCubitVariant(refCubit,mNumLayers)==variant ) break;

        }

      float[] curpos = mOrigPos[cubit];

      float[] refpos = mOrigPos[refCubit];

      float refY = computeAvg(refpos,1);

      float refZ = computeAvg(refpos,2);

      float curX = computeAvg(curpos,0);

      float curY = computeAvg(curpos,1);

      float curZ = computeAvg(curpos,2);

      for(int quat=0; quat<mNumQuats; quat++)

        {

        QuatHelper.rotateVectorByQuat(tmp,refX,refY,refZ,0,mObjectQuats[quat]);

        float dx = tmp[0]-curX;

        float dy = tmp[1]-curY;

        float dz = tmp[2]-curZ;

            builder.append(quat);

            builder.append(',');

            }

          else

            {

            android.util.Log.e("D", "cubit: "+cubit+" quat: "+quat+" : center correct, but shape sticks out");

            }

        }

      builder.append('\n');

      }

    android.util.Log.e("D", "cubitQuats: \n"+builder.toString() );

    }

    final float MAXD = 0.0001f;

    float x = faceAx.get0();

    float y = faceAx.get1();

    float z = faceAx.get2();

    float a,dx,dy,dz,qx,qy,qz;

    Static4D quat;

    int place = 0;

      qy = quat.get1();

      qz = quat.get2();

           if( x!=0.0f ) { a = qx/x; }