Magic Cube

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

// 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.object;

import org.distorted.library.type.Static4D;

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

class RubikCubeMovement extends RubikObjectMovement

{

    private final static int NONE   =-1;

    private final static int FRONT  = 0;  //

    private final static int BACK   = 1;  //

    private final static int LEFT   = 2;  // has to be 6 consecutive ints

    private final static int RIGHT  = 3;  // FRONT ... BOTTOM

    private final static int TOP    = 4;  //

    private final static int BOTTOM = 5;  //

    private static final int VECTX  = 0;  //

    private static final int VECTY  = 1;  // don't change this

    private static final int VECTZ  = 2;  //

    private static final int[] VECT = {VECTX,VECTY,VECTZ};

    private float[] mPoint, mCamera, mDiff, mTouch;

    private int mRotationVect, mLastTouchedFace;

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

    private boolean isVertical(float x, float y)

      {

      return (y>x) ? (y>=-x) : (y< -x);

      }

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

    private int retFaceSign(int face)

      {

      return (face==FRONT || face==RIGHT || face==TOP) ? 1:-1;

      }

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

    private int retFaceRotationSign(int face)

      {

      return (face==BACK || face==RIGHT || face==TOP) ? 1:-1;

      }

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

// retFace{X,Y,Z}axis: 3 functions which return which real AXIS gets mapped to which when we look

// directly at a given face. For example, when we look at the RIGHT face of the cube (with TOP still

// in the top) then the 'real' X axis becomes the 'Z' axis, thus retFaceXaxis(RIGHT) = VECTZ.

    private int retFaceXaxis(int face)

      {

      switch(face)

        {

        case FRONT :

        case BACK  : return VECTX;

        case LEFT  :

        case RIGHT : return VECTZ;

        case TOP   :

        case BOTTOM: return VECTX;

        }

      return -1;

      }

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

    private int retFaceYaxis(int face)

      {

      switch(face)

        {

        case FRONT :

        case BACK  : return VECTY;

        case LEFT  :

        case RIGHT : return VECTY;

        case TOP   :

        case BOTTOM: return VECTZ;

        }

      return -1;

      }

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

    private int retFaceZaxis(int face)

      {

      switch(face)

        {

        case FRONT :

        case BACK  : return VECTZ;

        case LEFT  :

        case RIGHT : return VECTX;

        case TOP   :

        case BOTTOM: return VECTY;

        }

      return -1;

      }

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

    private boolean faceIsVisible(int face, float cubeHalfSize)

      {

      int sign = retFaceSign(face);

      int zAxis= retFaceZaxis(face);

      return sign*mCamera[zAxis] > cubeHalfSize;

      }

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

// given precomputed mCamera and mPoint, respectively camera and touch point positions in ScreenSpace,

// cast this touch point onto the surface defined by the 'face' and write the cast coords to 'output'.

// Center of the 'face' = (0,0), third coord always +- cubeHalfSize.

    private void castTouchPointOntoFace(int face, float cubeHalfSize, float[] output)

      {

      int sign = retFaceSign(face);

      int zAxis= retFaceZaxis(face);

      float diff = mPoint[zAxis]-mCamera[zAxis];

      float ratio =  diff!=0.0f ? (sign*cubeHalfSize-mCamera[zAxis])/diff : 0.0f;

      output[0] = (mPoint[0]-mCamera[0])*ratio + mCamera[0];

      output[1] = (mPoint[1]-mCamera[1])*ratio + mCamera[1];

      output[2] = (mPoint[2]-mCamera[2])*ratio + mCamera[2];

      }

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

    RubikCubeMovement()

      {

      mPoint = new float[3];

      mCamera= new float[3];

      mDiff  = new float[3];

      mTouch = new float[3];

      }

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

// PUBLIC API

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

    public boolean faceTouched(Static4D rotatedTouchPoint, Static4D rotatedCamera)

      {

      float cubeHalfSize= RubikObject.OBJECT_SCREEN_RATIO*0.5f;

      mPoint[0]  = rotatedTouchPoint.get0();

      mPoint[1]  = rotatedTouchPoint.get1();

      mPoint[2]  = rotatedTouchPoint.get2();

      mCamera[0] = rotatedCamera.get0();

      mCamera[1] = rotatedCamera.get1();

      mCamera[2] = rotatedCamera.get2();

      for( mLastTouchedFace=FRONT; mLastTouchedFace<=BOTTOM; mLastTouchedFace++)

        {

        if( faceIsVisible(mLastTouchedFace,cubeHalfSize) )

          {

          castTouchPointOntoFace(mLastTouchedFace,cubeHalfSize, mTouch);

          float qX= (mTouch[0]+cubeHalfSize) / (2*cubeHalfSize);

          float qY= (mTouch[1]+cubeHalfSize) / (2*cubeHalfSize);

          float qZ= (mTouch[2]+cubeHalfSize) / (2*cubeHalfSize);

          if( qX<=1 && qX>=0 && qY<=1 && qY>=0 && qZ<=1 && qZ>=0 ) return true;

          }

        }

      mLastTouchedFace = NONE;

      return false;

      }

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

    public Static4D newRotation(Static4D rotatedTouchPoint)

      {

      float cubeHalfSize= RubikObject.OBJECT_SCREEN_RATIO*0.5f;

      mPoint[0] = rotatedTouchPoint.get0();

      mPoint[1] = rotatedTouchPoint.get1();

      mPoint[2] = rotatedTouchPoint.get2();

      castTouchPointOntoFace(mLastTouchedFace,cubeHalfSize,mDiff);

      mDiff[0] -= mTouch[0];

      mDiff[1] -= mTouch[1];

      mDiff[2] -= mTouch[2];

      int xAxis = retFaceXaxis(mLastTouchedFace);

      int yAxis = retFaceYaxis(mLastTouchedFace);

      mRotationVect = (isVertical( mDiff[xAxis], mDiff[yAxis]) ? VECT[xAxis]:VECT[yAxis]);

      float offset= (mTouch[mRotationVect]+cubeHalfSize)/(2*cubeHalfSize);

      mTouch[0] = mPoint[0];

      mTouch[1] = mPoint[1];

      mTouch[2] = mPoint[2];

      Static4D result=null;

      switch(mRotationVect)

        {

        case VECTX: result = new Static4D(1,0,0,offset); break;

        case VECTY: result = new Static4D(0,1,0,offset); break;

        case VECTZ: result = new Static4D(0,0,1,offset); break;

        }

      return result;

      }

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

    public float continueRotation(Static4D rotatedTouchPoint)

      {

      mDiff[0] = rotatedTouchPoint.get0()-mTouch[0];

      mDiff[1] = rotatedTouchPoint.get1()-mTouch[1];

      mDiff[2] = rotatedTouchPoint.get2()-mTouch[2];

      int xAxis= retFaceXaxis(mLastTouchedFace);

      int yAxis= retFaceYaxis(mLastTouchedFace);

      int sign = retFaceRotationSign(mLastTouchedFace);

      float angle = (mRotationVect==xAxis ? mDiff[yAxis] : -mDiff[xAxis]);

      return sign*angle;

      }

}