Print starting times of maneuvers inside plans.

ManeuverTimes.java

package pt.lsts.imc.lsf.batch;

import pt.lsts.imc.IMCDefinition;
import pt.lsts.imc.PlanControlState;
import pt.lsts.imc.PlanControlState.STATE;
import pt.lsts.imc.lsf.UnserializedMessage;

public class ManeuverTimes {

	public static void main(String[] args) throws Exception {
		LsfBatch batch = LsfBatch.selectFolders();
		UnserializedMessage msg;
		PlanControlState last = null;
		PlanControlState planStart = null;
		while ((msg = batch.next()) != null) {

			switch (msg.getMgId()) {

			case PlanControlState.ID_STATIC:
				PlanControlState cur = (PlanControlState) msg.deserialize();
				if (cur.getState() == STATE.BLOCKED)
					continue;
				if (last != null && cur.getState() == STATE.INITIALIZING && !cur.getPlanId().equals(last.getPlanId())) {
					System.out.println(cur.getDate() + ", " + cur.getPlanId());
					planStart = cur;
				}

				if (last != null && (cur.getManType() != last.getManType() || cur.getState() != last.getState())) {
					String time = "0.000";
					if (planStart != null)
						time = "\t" + (cur.getTimestamp() - planStart.getTimestamp());
					if (cur.getState() == STATE.EXECUTING)
						System.out.println(time + ", " + IMCDefinition.getInstance().getMessageName(cur.getManType()));
				}
				last = cur;
			default:
				break;
			}
		}
	}
}