/* Copyright (C) 2014 A.Vontobel  
 *
 * This program 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.
 *
 * This program 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 this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 *
 * The license is in LICENCE-GPL.txt.
 * If not, see http://www.gnu.org/licenses/old-licenses/gpl-2.0.html.
 */

package net.sf.drawj2d.cmd.statics;

import java.util.ArrayList;
import java.util.Arrays;
import org.hecl.*;
import net.sf.drawj2d.cmd.API;

/**
 * StatMequilibriumCmd implements the "stat.mequi" command, which
 * scales an input force until moment equilibrium is fulfilled.
 */

public class StatMequilibriumCmd implements Command {
    API api;
    boolean debug = false;
    
    public StatMequilibriumCmd (API api) {
        this.api = api;
    }
    
    @Override
    public Thing cmdCode(Interp interp, Thing[] argv) throws HeclException {
        assert argv.length > 0;
        if (debug) System.out.println(argv[0].toString());
        
        ArrayList singleargv = splitArgv(argv);
        // Convert the arguments from thing to double.
        int nbsingleargs = singleargv.size(); // without command from argv[0]
        double[] argd = new double[nbsingleargs];
        for (int i = 0; i < nbsingleargs; i++) {
            argd[i] = NumberThing.asNumber(singleargv.get(i)).doubleValue();
        }
        
        if (argd.length < 5) throw new HeclException ("Illegal nb of arguments.");
        
        assert (argd.length >= 5);
        double[] here = api.here();
        double xB = argd[0];
        double yB = argd[1];
        double FxB = argd[2];
        double FyB = argd[3];
        clKraft FB = new clKraft(FxB, FyB, xB, yB);
        double MB = FB.getM(here);
         
        double M;
        switch (argd.length) {
            case 8: // xB yB FxB FyB, x0 y0 Fx Fy
                double x0 = argd[4];
                double y0 = argd[5];
                double Fx = argd[6];
                double Fy = argd[7];
                clKraft F = new clKraft(Fx, Fy, x0, y0);
                M = F.getM(here);
                break;
            case 5: // xB yB FxB FyB, M
                M = argd[4];
                break;
            default:
                throw new HeclException ("Illegal nb of arguments.");
        }
        
        double f = -M / MB;
        FxB *= f;
        FyB *= f;
        
        String xstr = StringThing.get(DoubleThing.create(xB));
        String ystr = StringThing.get(DoubleThing.create(yB));
        String Fxstr = StringThing.get(DoubleThing.create(FxB));
        String Fystr = StringThing.get(DoubleThing.create(FyB));
        String answer = xstr + " " + ystr + " " + Fxstr + " " + Fystr;
        return new Thing(answer);
    }
    
    /** Make a list of arguments (without command in argv[0]). 
     * Split List arguments to single arguments. */
    private ArrayList splitArgv(Thing[] argv) throws HeclException {
        ArrayList singleargv = new ArrayList(argv.length);
        for (int i = 1; i < argv.length; i++) {
            Thing[] currentargv = ListThing.getArray(argv[i]);
            singleargv.addAll(Arrays.asList(currentargv));
        }
        return singleargv;
    }
}