Magic Cube

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

// Copyright 2021 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.control;

import org.distorted.helpers.QuatHelper;

import org.distorted.library.effect.MatrixEffectScale;

import org.distorted.library.main.DistortedEffects;

import org.distorted.library.main.DistortedNode;

import org.distorted.library.main.DistortedScreen;

import org.distorted.library.main.DistortedTexture;

import org.distorted.library.mesh.MeshQuad;

import org.distorted.library.type.Dynamic;

import org.distorted.library.type.Dynamic3D;

import org.distorted.library.type.Static3D;

import org.distorted.library.type.Static4D;

import org.distorted.objects.TwistyObject;

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

class RubikControlRotate

  {

  private static final int NUM_SCREEN = 0;

  private static final int NUM_OBJECT = 1;

  private static Static4D INIT_QUAT;

  private final RubikControl mControl;

  private DistortedEffects[] mScreenEffects, mObjectEffects;

  private DistortedNode[] mScreenNodes, mObjectNodes;

  private long mScreenEffectID, mObjectEffectID;

  private Static4D mObjRotQuat;

  private Dynamic3D mDynamic;

  private MatrixEffectScale mScale;

  private MeshQuad mScreenQuad, mObjectQuad;

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

  private void computeInitQuat()

    {

    double alphaZ = -Math.PI* 0.1250f;

    double alphaY = -Math.PI* 0.0625f;

    alphaY /= 2;

    alphaZ /= 2;

    float sinZ = (float)Math.sin(alphaZ);

    float cosZ = (float)Math.cos(alphaZ);

    float sinY = (float)Math.sin(alphaY);

    float cosY = (float)Math.cos(alphaY);

    Static4D qZ = new Static4D(0,0,sinZ,cosZ);

    Static4D qY = new Static4D(0,sinY,0,cosY);

    INIT_QUAT = QuatHelper.quatMultiply(qY,qZ);

    }

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

// Take 3D vector 'ax', rotate it by quaternion 'objQuat' to get vector V1.

// Take 3D vector (1,0,0) and rotate it by INIT_QUAT to get vector V2.

// Return a quaternion Q such that if we rotate V1 by Q, we get V2.

  private Static4D computeQuat(Static3D ax, Static4D objQuat, float x, float y, float z)

    {

    Static4D ax4D = new Static4D( ax.get0(), ax.get1(), ax.get2(), 0);

    Static4D axRo = QuatHelper.rotateVectorByQuat(ax4D,objQuat);

    return QuatHelper.retRotationQuat(axRo.get0(),axRo.get1(),axRo.get2(),x,y,z);

    }

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

  private void computeRotQuat()

    {

    TwistyObject object = mControl.getObject();

    Static3D[] axis = object.getRotationAxis();

    int chosen=-1,numAxis = axis.length;

    float cos,maxCos = -1.0f;

    Static4D quat;

    Static4D objCurrQuat = mControl.getCurrQuat();

    Static4D axisX = new Static4D(1,0,0,0);

    Static4D rotAxisX = QuatHelper.rotateVectorByQuat(axisX,INIT_QUAT);

    float axX = rotAxisX.get0();

    float axY = rotAxisX.get1();

    float axZ = rotAxisX.get2();

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

      {

      quat = computeQuat(axis[a],objCurrQuat,axX,axY,axZ);

      cos = quat.get3();

      if (cos > maxCos)

        {

        maxCos = cos;

        chosen = a;

        mObjRotQuat = quat;

        }

      }

    android.util.Log.e("D", "axis chosen: "+chosen);

    }

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

  private void setScreenEffectsStage1()

    {

    mDynamic.resetToBeginning();

    mScale.notifyWhenFinished(mControl);

    }

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

  private void setObjectEffectsStage1()

    {

    mDynamic.resetToBeginning();

    mScale.notifyWhenFinished(mControl);

    }

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

  private void createScreenEffects()

    {

    mScreenEffects   = new DistortedEffects[NUM_SCREEN];

    mScreenEffects[0]= new DistortedEffects();

    DistortedScreen screen = mControl.getScreen();

    int wid = screen.getWidth();

    Static3D scaleStart= new Static3D(1,1,1);

    Static3D scaleEnd  = new Static3D(wid,wid,wid);

    mDynamic = new Dynamic3D(10000,0.5f);

    mDynamic.add(scaleStart);

    mDynamic.add(scaleEnd  );

    mDynamic.add(scaleStart);

    mDynamic.setMode(Dynamic.MODE_PATH);

    mScale = new MatrixEffectScale(mDynamic);

    mScreenEffectID = mScale.getID();

    mScreenEffects[0].apply(mScale);

    }

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

  private void createObjectEffects()

    {

    mObjectEffects   = new DistortedEffects[NUM_OBJECT];

    mObjectEffects[0]= new DistortedEffects();

    DistortedScreen screen = mControl.getScreen();

    int wid = screen.getWidth();

    Static3D scaleStart= new Static3D(1,1,1);

    Static3D scaleEnd  = new Static3D(wid,wid,wid);

    mDynamic = new Dynamic3D(10000,0.5f);

    mDynamic.add(scaleStart);

    mDynamic.add(scaleEnd  );

    mDynamic.add(scaleStart);

    mDynamic.setMode(Dynamic.MODE_PATH);

    mScale = new MatrixEffectScale(mDynamic);

    mObjectEffectID = mScale.getID();

    mObjectEffects[0].apply(mScale);

    }

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

  private void createScreenNodes()

    {

    if( mScreenNodes==null )

      {

      mScreenNodes= new DistortedNode[NUM_SCREEN];

      mScreenQuad = new MeshQuad();

      }

    DistortedTexture texture = new DistortedTexture();

    texture.setColorARGB(0xff00ff00);

    mScreenNodes[0] = new DistortedNode(texture, mScreenEffects[0], mScreenQuad);

    }

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

  private void createObjectNodes()

    {

    if( mObjectNodes==null )

      {

      mObjectNodes= new DistortedNode[NUM_OBJECT];

      mObjectQuad = new MeshQuad();

      }

    if( INIT_QUAT==null ) computeInitQuat();

    computeRotQuat();

    DistortedTexture texture = new DistortedTexture();

    texture.setColorARGB(0xff00ff00);

    mObjectNodes[0] = new DistortedNode(texture, mObjectEffects[0], mObjectQuad);

    }

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

// ??

  long getEffectID()

    {

    return mObjectEffectID;

    }

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

  long getScreenEffectID()

    {

    return mScreenEffectID;

    }

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

  long getObjectEffectID()

    {

    return mObjectEffectID;

    }

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

  DistortedNode[] getScreenNodes()

    {

    if( NUM_SCREEN>0 )

      {

      if( mScreenEffects==null ) createScreenEffects();

      createScreenNodes();

      setScreenEffectsStage1();

      }

    return mScreenNodes;

    }

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

  DistortedNode[] returnScreenNodes()

    {

    return mScreenNodes;

    }

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

   DistortedNode[] getObjectNodes()

    {

    if( NUM_OBJECT>0 )

      {

      if( mObjectEffects==null ) createObjectEffects();

      createObjectNodes();

      setObjectEffectsStage1();

      }

    return mObjectNodes;

    }

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

   DistortedNode[] returnObjectNodes()

    {

    return mObjectNodes;

    }

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

  RubikControlRotate(RubikControl control)

    {

    mControl = control;

    }

  }