#include "pch.h"
#include "NavChart.h"

/********************************************************************/
/*		串口开关回调函数											*/
/*	输入：	title	图像标题										*/
/*			len		数据长度，每个数据点代表0.1s						*/
/********************************************************************/
NavChart::NavChart()
{
}


NavChart::~NavChart()
{
}

void NavChart::init(TChartString title, INT len)
{
	pAxis_g = CreateStandardAxis(CChartCtrl::BottomAxis);		// 坐标系初始化
	pAxis_g->SetAutomatic(true);
	pAxis_g = CreateStandardAxis(CChartCtrl::LeftAxis);
	pAxis_g->SetAutomatic(true);

	chartTitle = title;

	RemoveAllSeries();	//先清空
	pLS_x = CreateLineSerie();
	pLS_y = CreateLineSerie();
	pLS_z = CreateLineSerie();

	datalen = len;
	t = new DOUBLE[len];
	x = new DOUBLE[len];
	y = new DOUBLE[len];
	z = new DOUBLE[len];
	GetTitle()->AddString(chartTitle);
	for (int i = 0; i < datalen; i++)
	{
		t[i] = -datalen * 0.2 + i * 0.2;
		x[i] = 0;
		y[i] = 0;
		z[i] = 0;
	}
	pLS_x->SetPoints(t, x, datalen);
	pLS_y->SetPoints(t, y, datalen);
	pLS_z->SetPoints(t, z, datalen);
	pLS_x->SetColor(rgb_RED);			// Red is x-axis
	pLS_y->SetColor(rgb_GREEN);			// Blue is y-axis
	pLS_z->SetColor(rgb_BLUE);			// Green is z-axis
}

void NavChart::clear()
{
	for (int i = 0; i < datalen; i++)
	{
		t[i] = -datalen * 0.2 + i * 0.2;
		x[i] = 0;
		y[i] = 0;
		z[i] = 0;
	}
	pLS_x->SetPoints(t, x, datalen);
	pLS_y->SetPoints(t, y, datalen);
	pLS_z->SetPoints(t, z, datalen);
}

void NavChart::addSample(double* txyz)
{
	memcpy(t, t+1, (datalen-1)*sizeof(double));
	memcpy(x, x+1, (datalen-1)*sizeof(double));
	memcpy(y, y+1, (datalen-1)*sizeof(double));
	memcpy(z, z+1, (datalen-1)*sizeof(double));
	t[datalen - 1] = txyz[0];
	x[datalen - 1] = txyz[1];
	y[datalen - 1] = txyz[2];
	z[datalen - 1] = txyz[3];
	pLS_x->SetPoints(t, x, datalen);
	pLS_y->SetPoints(t, y, datalen);
	pLS_z->SetPoints(t, z, datalen);
}