You cannot select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

137 lines
4.2 KiB
Java

package com.verictas.pos.simulator;
import javax.vecmath.*;
import com.verictas.pos.simulator.dataWriter.DataWriter;
import com.verictas.pos.simulator.dataWriter.WritingException;
import com.verictas.pos.simulator.mathUtils.AU;
import com.verictas.pos.simulator.mathUtils.Vector3dMatrix;
public class Simulator {
public static void run(Object[] objects) {
/**
* Get variables from the config
*/
int rounds = SimulatorConfig.rounds;
/**
* Log a debug message to the console to signal the simulation has started
*/
System.out.println("========== Simulation Started ==========\n");
// Create a timer
long startTime = System.currentTimeMillis();
/**
* Define the forces matrix and the DataWriter
*/
Vector3dMatrix matrix = new Vector3dMatrix(objects.length,objects.length);
try {
DataWriter writer = new DataWriter();
/**
* Write begin values
*/
for(int i = 0; i < objects.length; i++) {
writer.write(objects[i].name, objects[i].position, objects[i].speed, objects[i].oldAcceleration, objects[i].acceleration, objects[i].mass);
}
/**
* Start the leap frog integration!
*/
accelerate(objects, matrix);
/**
* Start the rounds loop
*/
for(int t = 0; t != rounds; t++) {
/**
* The round has started
*/
System.out.println("\nRound " + (t + 1) + " started!");
/**
* Define the initial values
*/
double time = SimulatorConfig.time;
for(int i = 0; i < objects.length; i++) {
objects[i].updatePosition(time);
objects[i].updateAcceleration();
}
accelerate(objects, matrix);
/**
* Print the matrix for this round
*/
for(int i = 0; i < objects.length; i++) {
writer.write(objects[i].name, objects[i].position, objects[i].speed, objects[i].oldAcceleration, objects[i].acceleration, objects[i].mass);
}
}
/**
* Log that the simulation has finished and save info to file
*/
writer.save();
System.out.println("========== Simulation Finished ==========");
// Display time info
long stopTime = System.currentTimeMillis();
System.out.println("Simulation took: " + (stopTime - startTime) + "ms");
} catch(WritingException e) {
e.printStackTrace();
}
}
public static void accelerate(Object[] objects, Vector3dMatrix matrix) {
// Loop
for(int i = 0; i < objects.length; i++) {
/**
* For every object: calculate the force upon it.
*/
// Reset acceleration
objects[i].setAcceleration(new Vector3d(0, 0, 0));
for (int o = 0; o < objects.length; o++) {
/**
* Loop through all other objects
*/
if (o == i) {
break;
}
Vector3d force = objects[i].getForceOnObject(objects[o]);
matrix.setPosition(force, i, o);
System.out.println("Force " + (i + 1) + " on " + (o + 1) + " - " + force);
/**
* Also put in the opposite force
*/
force.scale(-1);
matrix.setPosition(force, o, i);
System.out.println("Force " + (o + 1) + " on " + (i + 1) + " - " + force);
}
}
System.out.println("\n");
System.out.println(matrix);
for(int i = 0; i < objects.length; i++) {
/**
* Progress forces on the object
*/
Vector3d forceOnI = matrix.getColumnTotal(i);
System.out.println("All forces on " + (i + 1) + " - " + forceOnI);
objects[i].enactForceOnObject(forceOnI);
}
}
}