player/Project_App_Calendar/App_Src/win/mywin_user_train.c

#include "mywin_inc.h"
#include "mywin_user_train.h"
#include "arm_math.h"
#include "qmc6310.h"
#include "math.h"


#define WIN_TRAIN_TYPE "WIN_TrainStruct"



WIN_TrainStruct *WIN_CreatTrain (WIN_WindowStruct *base,
			void (*msgLoop)(struct _WIN_WindowStruct *win,WIN_MsgStruct *msg),
			int x,int y,int x_size,int y_size)
{
	//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϣѭ<CFA2><D1AD>
	if (msgLoop==0)
	{
		msgLoop=(void (*)(struct _WIN_WindowStruct *win,WIN_MsgStruct *msg))TRAIN_DefaultMsgLoop;  
	} 
	
	WIN_TrainStruct *ret=mymalloc (sizeof ( WIN_TrainStruct));
	//<2F><><EFBFBD>ø<EFBFBD><C3B8><EFBFBD><EFBFBD>Ĺ<EFBFBD><C4B9>캯<EFBFBD><ECBAAF>
	if (ret)
	{
		mymemset (ret,0,sizeof ( WIN_TrainStruct));
//		if (0==WIN_CreatWindowExt((WIN_WindowStruct *)ret,base,msgLoop,x,y,x_size,y_size))
		if (0==WIN_CreatTouchEx((WIN_TouchWinStruct *)ret,base,msgLoop,x,y,x_size,y_size))
		{
			//<2F><><EFBFBD><EFBFBD>ʧ<EFBFBD><CAA7>
			myfree (ret);
			ret=0;
		}
		else
		{
			((WIN_WindowStruct *)ret)->winType=WIN_TRAIN_TYPE;
			((WIN_WindowStruct *)ret)->intercept=1;//<2F><><EFBFBD><EFBFBD><EFBFBD>Ͱ<EFBFBD><CDB0><EFBFBD><EFBFBD><EFBFBD>Ϣ<EFBFBD><CFA2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
			((WIN_WindowStruct *)ret)->color=0xffffff;
			//<2F><><EFBFBD><EFBFBD>һ<EFBFBD><D2BB>
			ret->color1=0xff6600;		//<2F><>ɫ
			ret->color2=0x887b6e;		//<2F>Ұ<EFBFBD> 
			ret->timerId= WIN_CreatTimer ((WIN_WindowStruct *)ret,100); 
			ret->timer_20ms=WIN_CreatTimer ((WIN_WindowStruct *)ret,20);
			
			qmc6310_init(); 
			ret->fitt_on=1;		 
			for(int i=0;i<WIN_GET_ARRAY_SIZE(ret->kal);i++)
			{
				kalman_init(&ret->kal[i]);
			}
		}
	}
	
	
	return ret;

}


//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
void TRAIN_DataUpdata (WIN_TrainStruct *train,TRAIN_Struct *s)
{
	//ʹ<><CAB9><EFBFBD>ڴ渴<DAB4>Ƶķ<C6B5><C4B7><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƽṹ<C6BD><E1B9B9>
//	mymemcpy (& train->data,s,sizeof (TRAIN_Struct));

}




//<2F><><EFBFBD>ñ<EFBFBD><C3B1><EFBFBD>ͼƬ
void TRAIN_SetBackPic (WIN_TrainStruct *train,WIN_PicStruct *pic)
{
	WIN_SetBackPic ((WIN_WindowStruct *)train,pic);
}


//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϣ
int TRAIN_KeyBord (WIN_TrainStruct *train,WIN_KeyStruct *k)
{
	if (k->shortPress&KEY_VALUE_HOME)
	{
		((WIN_WindowStruct *)train)->deleteWindow((WIN_WindowStruct *)train);
	}
	return 0;
}


//<2F>ɶ<EFBFBD><C9B6>صõ<D8B5><C3B5><EFBFBD><EFBFBD><EFBFBD>
static char *GetTxtByAngle (int angle)
{
	while (angle<0) angle+=360;
	while (angle>360) angle-=360;
	if ((angle>=360-45/2)||(angle<=45/2))
	{
		return "<EFBFBD><EFBFBD>";
	}
	else if ((angle>45/2)&&(angle<=45+45/2))
	{
		return "<EFBFBD><EFBFBD><EFBFBD><EFBFBD>";
	}
	else if ((angle>45+45/2)&&(angle<=90+45/2))
	{
		return "<EFBFBD><EFBFBD>";
	}
	else if ((angle>90+45/2)&&(angle<=135+45/2))
	{
		return "<EFBFBD><EFBFBD><EFBFBD><EFBFBD>";
	}
	else if ((angle>135+45/2)&&(angle<=180+45/2))
	{
		return "<EFBFBD><EFBFBD>";
	}
	else if ((angle>180+45/2)&&(angle<=225+45/2))
	{
		return "<EFBFBD><EFBFBD><EFBFBD><EFBFBD>";
	}
	else if ((angle>225+45/2)&&(angle<=270+45/2))
	{
		return "<EFBFBD><EFBFBD>";
	}
	else if ((angle>270+45/2)&&(angle<=315+45/2))
	{
		return "<EFBFBD><EFBFBD><EFBFBD><EFBFBD>";
	}
	return 0;
}








//<2F><>Ϊָ<CEAA><D6B8><EFBFBD><EFBFBD><EFBFBD>Ļ<EFBFBD><C4BB>ƺ<EFBFBD><C6BA><EFBFBD>
void TRAIN_CompassPaint (WIN_TrainStruct *train)
{
	int x=0;
	int y=0;
	int x_size=((WIN_WindowStruct *)train)->x_size;
	int y_size=((WIN_WindowStruct *)train)->y_size;
	
	//<2F><><EFBFBD>Ʊ<EFBFBD><C6B1><EFBFBD>
	WIN_PaintBackGround ((WIN_WindowStruct *)train);
	//<2F><>ʾ<EFBFBD><CABE><EFBFBD><EFBFBD>
	int img_x=x+25;
	int img_y=y;
	int img_xsize=0;
	int img_ysize=0;
	int head_ysize=45;
	WIN_SetLcdColor (((WIN_WindowStruct *)train)->color);
	if (train->icon)
	{
		WIN_GetImageSize (train->icon,&img_xsize,&img_ysize);
		if (img_ysize>head_ysize) img_ysize=head_ysize;
		WIN_DrawImagByAlpha (img_x,img_y+head_ysize/2-img_ysize/2, img_xsize,img_ysize,train->icon,WIN_GetLcdColor16());
		img_xsize+=10;
	}
	WIN_DrawTxtAt (train->title,img_x+img_xsize,y+head_ysize/2-WIN_GetFontHight()/2);
	
	int r_ex=250/2;
	int r_in=r_ex-10;
	//<2F><><EFBFBD><EFBFBD>Ȧ
	WIN_SetLcdColor (((WIN_WindowStruct *)train)->color);
	WIN_DrawCircle (x_size/2,y_size/2,r_ex);
	//<2F><><EFBFBD>̶<EFBFBD>
	float angle=train->angle;
	for (int i=0;i<8;i++)
	{
		float sinx=0;
		float cosx=0;
		arm_sin_cos_f32 (angle,&sinx,&cosx);
		angle+=45.0f;
		int x1=x_size/2-sinx*r_ex;
		int y1=y_size/2-cosx*r_ex;
		int x2=x_size/2-sinx*r_in;
		int y2=y_size/2-cosx*r_in;
		WIN_DrawLineAA (x1,y1,x2,y2,4);
		
		int x_txt=(x_size/2-sinx*(r_in-WIN_GetFontHight()/2));//-WIN_GetFontHight()/2;
		int y_txt=(y_size/2-cosx*(r_in-WIN_GetFontHight()/2))-WIN_GetFontHight()/2;
		WIN_SetLcdColor (((WIN_WindowStruct *)train)->color);
		if (i==0)//<2F><><EFBFBD><EFBFBD>
		{
			WIN_SetLcdColor (train->color1);
			WIN_DrawTxtHCenterAt ("N",x_txt,y_txt);
			WIN_SetLcdColor (((WIN_WindowStruct *)train)->color);
		}
		else if (i==2)//<2F><><EFBFBD><EFBFBD>
		{
			WIN_DrawTxtHCenterAt ("W",x_txt,y_txt);
		}
		else if (i==4)//<2F>Ϸ<EFBFBD>
		{
			WIN_DrawTxtHCenterAt ("S",x_txt,y_txt);
		}
		else if (i==6)//<2F><><EFBFBD><EFBFBD>
		{
			WIN_DrawTxtHCenterAt ("E",x_txt,y_txt);
		}
	}
	//<2F><><EFBFBD><EFBFBD>ͷ
	POINT_Struct point[3]={0};
	point[0].x=x_size/2;
	point[0].y=y_size/2-r_in+18;
	point[1].x=x_size/2-5;
	point[1].y=y_size/2-r_in+23;
	point[2].x=x_size/2+5;
	point[2].y=y_size/2-r_in+23;
	WIN_SetLcdColor (train->color1);
	WIN_FillPolygon (point,3);
	//<2F><><EFBFBD><EFBFBD>Ȧ
	r_in-=25;
	WIN_DrawCircle (x_size/2,y_size/2,r_in);
	//<2F><>ʾ<EFBFBD><CABE>λ
	char txt[20]={0};
	WIN_SetLcdColor (((WIN_WindowStruct *)train)->color);
	WIN_DrawTxtHCenterAt (GetTxtByAngle(train->angle),x_size/2,y_size/2-WIN_GetFontHight());
	sprintf (txt," %.0f<EFBFBD><EFBFBD>",train->angle);
	WIN_DrawTxtHCenterAt (txt,x_size/2,y_size/2);
	
}





//Ĭ<>ϻ<EFBFBD><CFBB>ƺ<EFBFBD><C6BA><EFBFBD>
void TRAIN_DefaultPaint (WIN_TrainStruct *train)
{
	
	int x=0;
	int y=0;
	int x_size=((WIN_WindowStruct *)train)->x_size;
	int y_size=((WIN_WindowStruct *)train)->y_size;
	char txt_buff[20]={0};
	int old_font_type=0;
	
	//<2F><><EFBFBD>Ʊ<EFBFBD><C6B1><EFBFBD>
	WIN_PaintBackGround ((WIN_WindowStruct *)train);
	WIN_SetLcdColor (((WIN_WindowStruct *)train)->color);
	
	
}
		



void TRAIN_Refresh(WIN_TrainStruct *axis)
{
	//<2F><>Բ<EFBFBD><D4B2><EFBFBD><EFBFBD>
	if(axis->ell.num>10&&axis->ell.num%10==0)
	{
		if(axis->fitt_on)
			ellipsoid_fitting(&axis->ell);
	}
	
	//<2F><><EFBFBD><EFBFBD>У׼<D0A3><D7BC><EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD>ֵ
	if(axis->ell.a!=0.0f)
		axis->fitt_raw[0]=(axis->mag_raw[0]-axis->ell.x)/axis->ell.a;
	if(axis->ell.b!=0.0f)
		axis->fitt_raw[1]=(axis->mag_raw[1]-axis->ell.y)/axis->ell.b;
	if(axis->ell.c!=0.0f)
		axis->fitt_raw[2]=(axis->mag_raw[2]-axis->ell.z)/axis->ell.c;
	
	//<2F><><EFBFBD><EFBFBD>ģ
	axis->mod=sqrtf(axis->fitt_raw[0]*axis->fitt_raw[0]+axis->fitt_raw[1]*axis->fitt_raw[1]+axis->fitt_raw[2]*axis->fitt_raw[2]);
	
	//<2F>ж<EFBFBD><D0B6>Ƿ<EFBFBD><C7B7><EFBFBD>Ҫ<EFBFBD><D2AA><EFBFBD><EFBFBD>У׼
	if(axis->mod-1>=-0.1f&&axis->mod-1<=0.1f)
	{
		axis->suss_num++;
		if(axis->suss_num>50) axis->fitt_on=0;
	}
	else 
	{
		axis->suss_num=0;
		axis->fitt_on=1;
	}
	
	//<2F><><EFBFBD>㷽<EFBFBD><E3B7BD>
	axis->angle=atan2(axis->fitt_raw[1],axis->fitt_raw[0])*180.0f/3.14159f;
	
	//<2F><><EFBFBD><EFBFBD>90<39><30>
	axis->angle+=90.0f;
	if(axis->angle>180.0f) axis->angle-=360.0f;
}







			
//Ĭ<><C4AC><EFBFBD><EFBFBD>Ϣ<EFBFBD><CFA2><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
void TRAIN_DefaultMsgLoop (WIN_TrainStruct *train,WIN_MsgStruct *msg)
{
	WIN_MoveStruct *m=0;
	WIN_TouchStruct *t=0;
	TRAIN_Struct *s=0;
	switch (msg->msg)
	{	
		case WIN_MSG_PAINT:
			if(train->paint)
				train->paint(train);
		break;
		case WIN_MSG_TIMER:
		if (msg->data.v==train->timerId)
		{
			TRAIN_Refresh(train);
			WIN_SetInvalidWhenTop ((WIN_WindowStruct *)train);
		}
		else if(msg->data.v==train->timer_20ms)
		{
			qmc6310_read_mag_xyz(train->mag_raw);
			for(int i=0;i<WIN_GET_ARRAY_SIZE(train->kal);i++)
			{
				train->mag_raw[i]=kalman_filter(&train->kal[i],train->mag_raw[i]);
			}
			if(train->fitt_on)
				ellipsoid_add_point(&train->ell,train->mag_raw[0],train->mag_raw[1],train->mag_raw[2]);
		}
		break;
		case WIN_MSG_KEY:
			TRAIN_KeyBord (train,msg->data.p);
		break;
		//״̬<D7B4><CCAC><EFBFBD><EFBFBD><EFBFBD>յ<EFBFBD><D5B5>ⲿ<EFBFBD><E2B2BF>Ϣ<EFBFBD><CFA2>Ϊ TRAIN_Struct <20><><EFBFBD>͵Ľṹ<C4BD><E1B9B9>
		case WIN_MSG_EXTMSG:
			s=msg->data.p;
			TRAIN_DataUpdata (train,s);
			WIN_SetInvalidWhenTop ((WIN_WindowStruct *)train);
		break;
		default:
			WIN_DefaultMsgLoop((WIN_WindowStruct *)train,msg);
		break;
	}
}


//#include "res/train.c"
//#include "res/heart.c"







//<2F><><EFBFBD><EFBFBD>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
WIN_TrainStruct *TRAIN_EnterCompass (WIN_WindowStruct *base)
{
	WIN_WindowStruct *temp=0;
	temp=(WIN_WindowStruct *)WIN_CreatTrain ((WIN_WindowStruct *)base,0,0,0,((WIN_WindowStruct *)base)->x_size,((WIN_WindowStruct *)base)->y_size);
	WIN_SetBkColor (temp,((WIN_WindowStruct *)base)->bkcolor);
	WIN_SetBackPic (temp,&((WIN_WindowStruct *)base)->pic);
	((WIN_TrainStruct *)temp)->paint=TRAIN_CompassPaint;
	((WIN_TrainStruct *)temp)->title="ָ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>";
	WIN_ShowWindow (temp);
	return (WIN_TrainStruct *)temp;
}