package com.team687.frc2017.utilities;

import edu.wpi.first.wpilibj.Timer;

/**
 * Pose of robot (x, y, theta)
 * 
 * @author tedlin
 *
 */

public class Pose {

    private double m_x;
    private double m_y;
    private double m_theta;
    private double m_timestamp;

    public Pose(double x, double y, double theta) {
	m_x = x;
	m_y = y;
	m_theta = theta;
	m_timestamp = Timer.getFPGATimestamp();
    }

    public void setX(double x) {
	m_x = x;
    }

    public void setY(double y) {
	m_y = y;
    }

    public void setTheta(double theta) {
	m_theta = theta;
    }

    public double getX() {
	return m_x;
    }

    public double getY() {
	return m_y;
    }

    public double getTheta() {
	return m_theta;
    }

    /**
     * @return Pose in column matrix form
     */
    public Matrix getMatrix() {
	double[][] A = { { m_x }, { m_y }, { m_theta } };
	return new Matrix(A);
    }

    public double getTimestamp() {
	return m_timestamp;
    }

}

@@ -37,45 +37,8 @@
 s;%0A%0A
-import edu.wpi.first.wpilibj.Timer;%0A%0A
 /**%0A
@@ -322,49 +322,8 @@
 ta;%0A
-%09m_timestamp = Timer.getFPGATimestamp();%0A
     
@@ -483,32 +483,114 @@
 = theta;%0A    %7D%0A%0A
+    public void setTimestamp(double timestamp) %7B%0A%09m_timestamp = timestamp;%0A    %7D%0A%0A
     public doubl

fix problem where wpilib dependencies caused travis ci build fails