private void initializeGraphs()
{
accelPane = accelGraph.GraphPane;
accelPane.Title.Text = "Accelerometers";
accelPane.XAxis.Title.Text = "Time (s)";
accelPane.YAxis.Title.Text = "Sensor Output (g)";
// accelPane.YAxis.Scale.Max = accelMax;
// accelPane.YAxis.Scale.Min = accelMin;
gyroPane = gyroGraph.GraphPane;
gyroPane.Title.Text = "Rate Gyros";
gyroPane.XAxis.Title.Text = "Time (s)";
gyroPane.YAxis.Title.Text = "Sensor Output (deg/s)";
// gyroPane.YAxis.Scale.Max = gyroMax;
// gyroPane.YAxis.Scale.Min = gyroMin;
magPane = magGraph.GraphPane;
magPane.Title.Text = "Magnetic Sensors";
magPane.XAxis.Title.Text = "Time (s)";
magPane.YAxis.Title.Text = "Sensor Output (raw)";
// magPane.YAxis.Scale.Max = magMax;
// magPane.YAxis.Scale.Min = magMin;
anglePane = angleGraph.GraphPane;
anglePane.Title.Text = "Estimated Angles";
anglePane.XAxis.Title.Text = "Time (s)";
anglePane.YAxis.Title.Text = "Angle (degrees)";
quaternionPane = quaternion.GraphPane;
quaternionPane.Title.Text = "Estimated quaternion";
quaternionPane.XAxis.Title.Text = "Time (s)";
quaternionPane.YAxis.Title.Text = "quaternion ";
positionPane = position.GraphPane;
positionPane.Title.Text = "Estimated position";
positionPane.XAxis.Title.Text = "Time (s)";
positionPane.YAxis.Title.Text = "position ";
xAccelList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
yAccelList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
zAccelList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
xGyroList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
yGyroList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
zGyroList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
xMagList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
yMagList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
zMagList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
yawList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
pitchList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
rollList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
q0List = new RollingPointPairList(SENSOR_GRAPH_POINTS);
q1List = new RollingPointPairList(SENSOR_GRAPH_POINTS);
q2List = new RollingPointPairList(SENSOR_GRAPH_POINTS);
q3List = new RollingPointPairList(SENSOR_GRAPH_POINTS);
latList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
lonList = new RollingPointPairList(SENSOR_GRAPH_POINTS);
xAccelLine = accelPane.AddCurve("X", xAccelList, Color.Blue, SymbolType.None);
yAccelLine = accelPane.AddCurve("Y", yAccelList, Color.Red, SymbolType.None);
zAccelLine = accelPane.AddCurve("Z", zAccelList, Color.Green, SymbolType.None);
xGyroLine = gyroPane.AddCurve("X", xGyroList, Color.Blue, SymbolType.None);
yGyroLine = gyroPane.AddCurve("Y", yGyroList, Color.Red, SymbolType.None);
zGyroLine = gyroPane.AddCurve("Z", zGyroList, Color.Green, SymbolType.None);
xMagLine = magPane.AddCurve("X", xMagList, Color.Blue, SymbolType.None);
yMagLine = magPane.AddCurve("Y", yMagList, Color.Red, SymbolType.None);
zMagLine = magPane.AddCurve("Z", zMagList, Color.Green, SymbolType.None);
yawLine = anglePane.AddCurve("Yaw", yawList, Color.Blue, SymbolType.None);
pitchLine = anglePane.AddCurve("Pitch", pitchList, Color.Red, SymbolType.None);
rollLine = anglePane.AddCurve("Roll", rollList, Color.Green, SymbolType.None);
q0Line = quaternionPane.AddCurve("q0", q0List, Color.Red, SymbolType.None);
q1Line = quaternionPane.AddCurve("q1", q1List, Color.Green, SymbolType.None);
q2Line = quaternionPane.AddCurve("q2", q2List, Color.Blue, SymbolType.None);
q3Line = quaternionPane.AddCurve("q3", q3List, Color.Brown, SymbolType.None);
latLine = positionPane.AddCurve("Latitude", latList, Color.Green, SymbolType.None);
lonLine = positionPane.AddCurve("Longitude", lonList, Color.Red, SymbolType.None);
}