摘要: GPS部分GPS_angle[ROLL] = (nav[LON]*cos_yaw_x - nav[LAT]*sin_yaw_y) /10;GPS_angle[PITCH]= (nav[LON]*sin_yaw_y + nav[LAT]*cos_yaw_x) /10;这是二维向量的旋转,导航点的坐标是... 阅读全文
posted @ 2015-04-23 18:52 kakain 阅读(650) 评论(0) 推荐(0) 编辑