gps.c

GPS导航系统中

#include "gps.h"
#include "navigator.h"
#include "map.h"

EXPORT ID gps_tid;

LOCAL double convrse(double x)
{
	int zheng=x/100;
	double xiao=(x/100-zheng)/0.6;
	return (double)(zheng+xiao);
}

EXPORT void gps_task( INT stacd, VP exinf )
{
	ID id;
	INT asiz;
	ER ercd;
	UB *name="rsb";
	GPSinfor buf;
	id=tk_opn_dev(name,TD_UPDATE);

	for(;;)
	{
		ercd=tk_srea_dev(id,0,&buf,sizeof(buf),&asiz);	
    	xx1=(GPSinfor)buf;

		jingdu=convrse(xx1.positionX);
		weidu=convrse(xx1.positionY);

		ercd = tk_dly_tsk(100);
		if (MERCD(ercd) == MERCD(E_RLWAI)) break;
	}

	tk_cls_dev(id, 0 );

    /* terminate/delete key input task */
    tk_exd_tsk();
}