/*
 * To change this template, choose Tools | Templates
 * and open the template in the editor.
 */
package com.jme3.gde.scenecomposer.tools;

import com.jme3.asset.AssetManager;
import com.jme3.bullet.control.CharacterControl;
import com.jme3.bullet.control.RigidBodyControl;
import com.jme3.gde.core.sceneexplorer.nodes.JmeNode;
import com.jme3.gde.core.sceneexplorer.nodes.JmeSpatial;
import com.jme3.gde.core.undoredo.AbstractUndoableSceneEdit;
import com.jme3.gde.scenecomposer.SceneComposerToolController;
import com.jme3.gde.scenecomposer.SceneEditTool;
import com.jme3.material.Material;
import com.jme3.math.FastMath;
import com.jme3.math.Quaternion;
import com.jme3.math.Vector2f;
import com.jme3.math.Vector3f;
import com.jme3.scene.Geometry;
import com.jme3.scene.Node;
import com.jme3.scene.Spatial;
import com.jme3.scene.shape.Quad;
import com.jme3.util.TempVars;
import org.openide.loaders.DataObject;

/**
 * Move an object.
 * When created, it generates a quad that will lie along a plane
 * that the user selects for moving on. When the mouse is over
 * the axisMarker, it will highlight the plane that it is over: XY,XZ,YZ.
 * When clicked and then dragged, the selected object will move along that 
 * plane.
 * @author Brent Owens
 */
public class MoveTool extends SceneEditTool {

    private Vector3f pickedPlane;
    private Vector3f startLoc = new Vector3f();
    private Vector3f lastLoc = new Vector3f();
    private boolean wasDragging = false;
    private Vector3f offset;
    private Node plane;
    Material pinkMat;
    private final Quaternion XY = new Quaternion().fromAngleAxis(0,   new Vector3f(1,0,0));
    private final Quaternion YZ = new Quaternion().fromAngleAxis(-FastMath.PI/2,   new Vector3f(0,1,0));
    private final Quaternion XZ = new Quaternion().fromAngleAxis(FastMath.PI/2,   new Vector3f(1,0,0));
    
    
    public MoveTool() {
        axisPickType = AxisMarkerPickType.axisAndPlane;
        setOverrideCameraControl(true);
        
        float size = 1000;
        Geometry g = new Geometry("plane", new Quad(size, size));
        g.setLocalTranslation(-size/2, -size/2, 0);
        plane = new Node();
        plane.attachChild(g);
        
        
    }

    @Override
    public void activate(AssetManager manager, Node toolNode, Node onTopToolNode, Spatial selectedSpatial, SceneComposerToolController toolController) {
        super.activate(manager, toolNode, onTopToolNode, selectedSpatial, toolController);
        displayPlanes();
    }

    
    
    
    
    @Override
    public void actionPrimary(Vector2f screenCoord, boolean pressed, JmeNode rootNode, DataObject dataObject) {
        if (!pressed) {
            setDefaultAxisMarkerColors();
            pickedPlane = null; // mouse released, reset selection
            offset = null;
            if (wasDragging) {
                actionPerformed(new MoveUndo(toolController.getSelectedSpatial(), startLoc, lastLoc));
                wasDragging = false;
            }
        }
    }

    @Override
    public void actionSecondary(Vector2f screenCoord, boolean pressed, JmeNode rootNode, DataObject dataObject) {
        
    }

    @Override
    public void mouseMoved(Vector2f screenCoord, JmeNode rootNode, DataObject currentDataObject, JmeSpatial selectedSpatial) {
        if (pickedPlane == null) {
            highlightAxisMarker(camera, screenCoord, axisPickType);
        }
        else {
            pickedPlane = null;
            offset = null;
        }
    }

    @Override
    public void draggedPrimary(Vector2f screenCoord, boolean pressed, JmeNode rootNode, DataObject currentDataObject) {
        if (!pressed) {
            setDefaultAxisMarkerColors();
            pickedPlane = null; // mouse released, reset selection
            offset = null;
            if (wasDragging) {
                actionPerformed(new MoveUndo(toolController.getSelectedSpatial(), startLoc, lastLoc));
                wasDragging = false;
            }
            return;
        }
        
        if (toolController.getSelectedSpatial() == null)
            return;
        TempVars vars = TempVars.get();
        if (pickedPlane == null) {
            pickedPlane = pickAxisMarker(camera, screenCoord, axisPickType);
            if (pickedPlane == null)
                return;
            startLoc = toolController.getSelectedSpatial().getLocalTranslation().clone();
            Quaternion rot = vars.quat1.set(toolController.getSelectedSpatial().getWorldRotation());            
            if (pickedPlane.equals(new Vector3f(1,1,0)))
                plane.setLocalRotation(rot.multLocal(XY));
            else if (pickedPlane.equals(new Vector3f(1,0,1)))
                plane.setLocalRotation(rot.multLocal(XZ));
            else if (pickedPlane.equals(new Vector3f(0,1,1)))
                plane.setLocalRotation(rot.multLocal(YZ));
            plane.setLocalTranslation(startLoc);
        }
        
        Vector3f planeHit = pickWorldLocation(camera, screenCoord, plane, null);        
        if (planeHit == null){
            vars.release();
            return;
        }
        
        Spatial selected = toolController.getSelectedSpatial();
        Spatial parent = selected.getParent();
        
       
        Vector3f newPos =vars.vect1;
         if( parent == null ){
           //we are moving the root node, move is computed in local translation
           if (offset == null){                   
              offset = planeHit.subtract(startLoc); // get the offset when we start so it doesn't jump
           }

            newPos.set(planeHit).subtractLocal(offset);
            lastLoc.set(newPos);
            selected.setLocalTranslation(newPos);
         }else{
            
             //offset in world space
            if (offset == null){
                offset = planeHit.subtract(selected.getWorldTranslation()); // get the offset when we start so it doesn't jump
            }
            
            newPos = planeHit.subtract(offset);
            
            //computing the inverse world transform to get the new localtranslation
            newPos.subtractLocal(selected.getParent().getWorldTranslation());        
            newPos = selected.getParent().getWorldRotation().inverse().normalizeLocal().multLocal(newPos);
            newPos.divideLocal(selected.getWorldScale());            
            selected.setLocalTranslation(newPos);
            lastLoc.set(newPos);
         }
        vars.release();
        RigidBodyControl control = toolController.getSelectedSpatial().getControl(RigidBodyControl.class);
        if (control != null) {
            control.setPhysicsLocation(toolController.getSelectedSpatial().getWorldTranslation());
        }
        CharacterControl character = toolController.getSelectedSpatial().getControl(CharacterControl.class);
        if (character != null) {
            character.setPhysicsLocation(toolController.getSelectedSpatial().getWorldTranslation());
        }
        updateToolsTransformation();
        
        wasDragging = true;
    }

    @Override
    public void draggedSecondary(Vector2f screenCoord, boolean pressed, JmeNode rootNode, DataObject currentDataObject) {
        
    }

    private class MoveUndo extends AbstractUndoableSceneEdit {

        private Spatial spatial;
        private Vector3f before,after;
        
        MoveUndo(Spatial spatial, Vector3f before, Vector3f after) {
            this.spatial = spatial;
            this.before = before;
            this.after = after;
        }
        
        @Override
        public void sceneUndo() {
            spatial.setLocalTranslation(before);
            RigidBodyControl control = toolController.getSelectedSpatial().getControl(RigidBodyControl.class);
            if (control != null) {
                control.setPhysicsLocation(toolController.getSelectedSpatial().getWorldTranslation());
            }
            CharacterControl character = toolController.getSelectedSpatial().getControl(CharacterControl.class);
            if (character != null) {
                character.setPhysicsLocation(toolController.getSelectedSpatial().getWorldTranslation());
            }
            toolController.selectedSpatialTransformed();
        }

        @Override
        public void sceneRedo() {
            spatial.setLocalTranslation(after);
            RigidBodyControl control = toolController.getSelectedSpatial().getControl(RigidBodyControl.class);
            if (control != null) {
                control.setPhysicsLocation(toolController.getSelectedSpatial().getWorldTranslation());
            }
            CharacterControl character = toolController.getSelectedSpatial().getControl(CharacterControl.class);
            if (character != null) {
                character.setPhysicsLocation(toolController.getSelectedSpatial().getWorldTranslation());
            }
            toolController.selectedSpatialTransformed();
        }
    }
}