TwistyPuzzleLib

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

// Copyright 2021 Leszek Koltunski                                                               //

//                                                                                               //

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

//                                                                                               //

// Magic Cube is proprietary software licensed under an EULA which you should have received      //

// along with the code. If not, check https://distorted.org/magic/License-Magic-Cube.html        //

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

package org.distorted.objectlib.touchcontrol;

import org.distorted.library.helpers.QuatHelper;

import org.distorted.library.type.Static3D;

import org.distorted.library.type.Static4D;

import org.distorted.objectlib.main.TwistyObject;

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

public class TouchControlSquare extends TouchControlShapeChanging

  {

  private static final float NOT_TOUCHED = 100000.0f;

  private static final float DIST3D = 0.5f;

  private static final float DIST2D = 0.5f;

  private static final float[][] mCastedRotAxis = { {0,1,0,0}, {1,0,0,0} };

  private static final int[] mEnabled = {2,0,1};

  private final int mNumFaces;

  private final Static3D[] mFaceAxis;

  private final float[][] mTmp4;

  private final float[][] mTmp2;

  private final float[] mTmp2D, mMove2D;

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

  public TouchControlSquare(TwistyObject object)

    {

    super(object);

    mNumFaces = object.getNumPuzzleFaces();

    mFaceAxis = TouchControlHexahedron.FACE_AXIS;

    mTmp4  = new float[mNumFaces][4];

    mTmp2  = new float[mNumFaces][2];

    mTmp2D = new float[2];

    mMove2D= new float[2];

    }

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

  private boolean faceIsVisible(int index)

    {

    Static3D faceAxis = mFaceAxis[index];

    float castCameraOnAxis = mCamera[0]*faceAxis.get0() + mCamera[1]*faceAxis.get1() + mCamera[2]*faceAxis.get2();

    return castCameraOnAxis > DIST3D;

    }

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

  private boolean isInsideFace(float[] p)

    {

    return ( p[0]<=DIST2D && p[0]>=-DIST2D && p[1]<=DIST2D && p[1]>=-DIST2D );

    }

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

  private int figureOutTouchedFace()

    {

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

      {

      if( faceIsVisible(face) )

        {

        float nx = mFaceAxis[face].get0();

        float ny = mFaceAxis[face].get1();

        float nz = mFaceAxis[face].get2();

        castTouchPointOntoFace(nx,ny,nz, DIST3D, mTmp4[face]);

        convertTo2Dcoords(mTmp4[face], nx,ny,nz, mTmp2[face]);

        if( isInsideFace(mTmp2[face]) ) return face;

        }

      else mTmp4[face][0] = NOT_TOUCHED;

      }

    float maxDist = 0.0f;

    int faceTouched=-1;

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

      {

      float[] point = mTmp4[face];

      if( point[0] != NOT_TOUCHED )

        {

        float cx = point[0]-mCamera[0];

        float cy = point[1]-mCamera[1];

        float cz = point[2]-mCamera[2];

        float dist = cx*cx + cy*cy + cz*cz;

        if( dist>maxDist )

          {

          maxDist = dist;

          faceTouched = face;

          }

        }

      }

    return faceTouched;

    }

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

// PUBLIC API

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

  public void newRotation(int[] output, Static4D rotatedTouchPoint, Static4D quat)

    {

    int rotIndex,face = figureOutTouchedFace();

    mPoint[0] = rotatedTouchPoint.get0()/mObjectRatio;

    mPoint[1] = rotatedTouchPoint.get1()/mObjectRatio;

    mPoint[2] = rotatedTouchPoint.get2()/mObjectRatio;

    float nx = mFaceAxis[face].get0();

    float ny = mFaceAxis[face].get1();

    float nz = mFaceAxis[face].get2();

    castTouchPointOntoFace(nx,ny,nz, DIST3D, mTmp);

    convertTo2Dcoords(mTmp, nx,ny,nz, mTmp2D);

    switch(face)

      {

      case 0: case 1: rotIndex = 0;

                      break;

      case 2: case 3: rotIndex = 1;

                      break;

      default       : mMove2D[0] = mTmp2D[0]-mTmp2[face][0]; // mTmp2D contains an in-face-plane 2D 'new' point of touch;

                      mMove2D[1] = mTmp2D[1]-mTmp2[face][1]; // mTmp2 contains such 'old' point. Old as in - at the time

                                                             // of touchdown; 'new' as in - now, after moving the minimal

                                                             // distance.

                      rotIndex = computeRotationIndex( mCastedRotAxis, mMove2D, mEnabled);

      }

    output[0] = rotIndex;

    output[1] = rotIndex==0 ? (mTmp2D[1]<0 ? 0:2) : computeRow(mTouchedCubit,rotIndex);

    }

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

  public void getCastedRotAxis(float[] output, Static4D quat, int rotIndex)

    {

    float[] axis = mCastedRotAxis[rotIndex];

    Static4D result = QuatHelper.rotateVectorByQuat(axis[0],axis[1],axis[2],axis[3],quat);

    float cx =result.get0();

    float cy =result.get1();

    float len = (float)Math.sqrt(cx*cx+cy*cy);

    if( len!=0 )

      {

      output[0] = cx/len;

      output[1] = cy/len;

      }

    else

      {

      output[0] = 1;

      output[1] = 0;

      }

    }

  }