רÀûÃû³Æ£º¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨ºÍ×°ÖõÄÖÆ×÷·½·¨
¼¼ÊõÁìÓò£º
±¾·¢Ã÷Éæ¼°ÎÀÐǵ¼º½ÏµÍ³£¬ÓÈÆäÉæ¼°Ò»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨ºÍ×°Öá£
±³¾°¼¼Êõ£º
Ŀǰ´æÔÚ5ÖÖÎÀÐǵ¼º½ÏµÍ³£¬·Ö±ðÊÇÖйúBD1(±±¶·1ºÅ)¡¢ÖйúBD2(±±´óºÅ)¡¢¶íÂÞ˹GLONASS(GLOBAL NAVIGATION SATEL LITESYSTE£¬È«ÇòÎÀÐǵ¼º½ÏµÍ³)¡¢ÃÀ¹úGPS(Global Position System£¬È«Çò¶¨Î»ÏµÍ³)¡¢Å·ÖÞGALILEO(Ù¤ÀûÂÔ)£¬´Ó°²È«ÐÔ¡¢¿É¿¿ÐÔ¡¢¿ÉÓÃÐԵȷ½Ã濼ÂÇ£¬¶àϵͳÈÚºÏÒѾ³ÉΪδÀ´µÄ¼¼Êõ·¢Õ¹Ç÷ÊÆ¡£¹úÄÚÍâµÄÎÀÐǽÓÊÕ»ú³§ÉÌÒѾ»òÕýÔÚ×¼±¸ÑÐÖÆ»ùÓÚ¶àϵͳÈںϵÄÎÀÐǵ¼º½Ð¾Æ¬£¬ÒÔ±ãʵÏÖÎÀÐǽÓÊÕ»úµÄСÐÍ»¯¡¢µÍ³É±¾ºÍµÍ¹¦ºÄ¡£
Òò´Ë£¬ÔÚÎÀÐǽÓÊÕ»úµÄ΢´¦ÀíÆ÷ÉÏ¿ìËÙ´¦Àí¶à¸öÎÀÐǵ¼º½ÏµÍ³µÄ¹Û²âÊý¾ÝÊÇÊ®·ÖÖØÒªµÄ¡£
·¢Ã÷ÄÚÈÝ
±¾·¢Ã÷ʵʩÀýÌṩÁËÒ»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨ºÍ×°Öã¬ÒÔʵÏÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐпìËÙ´¦Àí¡£
Ò»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬°üÀ¨ ÎÀÐǽÓÊÕ»ú¶ÁÈ¡¸÷¸öÎÀÐǵĹ۲âÊý¾ÝÐγÉα¾à£¬¸ù¾Ý¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬¸ù¾ÝËùÊöα¾àºÍ¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬µÃµ½¹Û²âÏòÁ¿¾ØÕó£» ¶ÔËùÊö¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬µÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖá£
Ò»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ×°Ö㬰üÀ¨ ¹Û²âÏòÁ¿¾ØÕó»ñȡģ¿é£¬ÓÃÓÚ¶ÁÈ¡¸÷¸öÎÀÐǵĹ۲âÊý¾ÝÐγÉα¾à£¬¸ù¾Ý¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬¸ù¾ÝËùÊöα¾àºÍ¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬µÃµ½¹Û²âÏòÁ¿¾ØÕó£» ¹Û²âÏòÁ¿¾ØÕó¼ÆËãÄ£¿é£¬ÓÃÓÚ¶ÔËùÊö¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬µÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖá£
ÓÉÉÏÊö±¾·¢Ã÷µÄʵʩÀýÌṩµÄ¼¼Êõ·½°¸¿ÉÒÔ¿´³ö£¬±¾·¢Ã÷ʵʩÀýͨ¹ý¶Ô¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬´Ó¶øÊµÏÖÁËÎÀÐǽÓÊÕ»úÖеĹ۲âÊý¾ÝµÄ¿ìËÙ´¦Àí£¬ÒÔ½ÚÊ¡ÎÀÐǽÓÊÕ»úµÄ΢´¦ÀíÆ÷µÄ¼ÆËãʱ¼äºÍ´æÈ¡¿Õ¼ä¡£
ΪÁ˸üÇå³þµØËµÃ÷±¾·¢Ã÷ʵʩÀýµÄ¼¼Êõ·½°¸£¬ÏÂÃæ½«¶ÔʵʩÀýÃèÊöÖÐËùÐèҪʹÓõĸ½Í¼×÷¼òµ¥µØ½éÉÜ£¬ÏÔ¶øÒ×¼ûµØ£¬ÏÂÃæÃèÊöÖеĸ½Í¼½ö½öÊDZ¾·¢Ã÷µÄʵʩÀý£¬¶ÔÓÚ±¾ÁìÓòÆÕͨ¼¼ÊõÈËÔ±À´½²£¬ÔÚ²»¸¶³ö´´ÔìÐÔÀͶ¯ÐÔµÄǰÌáÏ£¬»¹¿ÉÒÔ¸ù¾ÝÕâЩ¸½Í¼»ñµÃÆäËûµÄ¸½Í¼¡£
ͼ1Ϊ±¾·¢Ã÷ʵʩÀýÌṩµÄÒ»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨µÄÁ÷³Ìͼ£» ͼ2Ϊ±¾·¢Ã÷ʵʩÀýÌṩµÄÒ»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ×°ÖõľßÌå½á¹¹Í¼¡£
¾ßÌåʵʩÀý·½Ê½ Ϊ±ãÓÚ¶Ô±¾·¢Ã÷ʵʩÀýµÄÀí½â£¬ÏÂÃæ½«½áºÏ¸½Í¼×ö½øÒ»²½µÄ½âÊÍ˵Ã÷£¬ÇÒ¸÷¸öʵʩÀý²¢²»¹¹³É¶Ô±¾·¢Ã÷ʵʩÀýµÄÏÞ¶¨¡£
±¾·¢Ã÷ʵʩÀýÌṩµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨µÄÁ÷³ÌͼÈçͼ1Ëùʾ£¬°üÀ¨ÈçÏ´¦Àí²½Öè ²½Öè11¡¢ÎÀÐǽÓÊÕ»úͨ¹ýÅжϽÓÊÕµ½µÄÎÀÐǵĵçÎÄÐÅÏ¢ÖеÄÐÇÀúÓëÀúÊéÊý¾ÝµÄ¸üвÎÊýÊÇ·ñÂú×ãÔ¤¶¨µÄÌõ¼þ£¬À´¶ÔµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝºÍÀúÊéÊý¾Ý½øÐнâµ÷¡£
µ±ÎÀÐǽÓÊÕ»ú½ÓÊÕµ½ÎÀÐǵ¼º½¶¨Î»ÏµÍ³Öи÷¸öÎÀÐÇ·¢Ë͵ĵçÎÄÐÅÏ¢ºÍ¹Û²âÊý¾Ýʱ£¬½«¸ÃеĵçÎÄÐÅÏ¢°´ÕÕ300±ÈÌØ×é³ÉÒ»Ö¡Êý¾Ý·ÅÈëµçÎÄÐÅÏ¢»º³åÇøÖУ¬½«¹Û²âÊý¾Ý·ÅÈë¹Û²âÊý¾Ý»º³åÇøÖС£
È»ºó£¬³ä·ÖÀûÓõçÎÄÐÅÏ¢ÖеÄÐÇÀúºÍÀúÊéÊý¾Ý´æÔڹ̶¨¸üÐÂʱ¼äµÄÌØµã£¬Í¨¹ýÅжϻº´æµÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý¡¢ÀúÊéÊý¾ÝµÄ¸üвÎÊýÊÇ·ñÂú×ãÔ¤¶¨µÄÌõ¼þ£¬À´¾ö¶¨ÊÇ·ñ¶ÔÉÏÊö»º´æµÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý¡¢ÀúÊéÊý¾Ý½øÐнâµ÷¡£
µ±ËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚÓëÒѾ½âµ÷²¢±£´æµÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚÏàµÈʱ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£¬½«½âµ÷ºóµÃµ½µÄÐÇÀúÊý¾Ý½øÐб£´æ¡£±ÈÈ磬¶ÔÓÚGPSÎÀÐÇ»òBD2µÄMEO/IGSOÎÀÐǶøÑÔ£¬µ±µçÎÄÐÅÏ¢ÖÐǰÈý¸ö×ÓÖ¡½ÓÊÕµ½²¢»º´æºó£¬¾ÍÅжÏÉÏÊö»º´æµÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚÊÇ·ñÓëÒѾ½âµ÷²¢±£´æµÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚÏàµÈ£¬Èç¹û²»ÏàµÈ£¬¾Í½âµ÷ÉÏÊö»º´æµÄÈý¸ö×ÓÖ¡µÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý£¬½«½âµ÷³öÀ´µÄÐÇÀúÊý¾Ý±£´æÔÚ´æ´¢Æ÷(±ÈÈçÉÁ´æFLASH)ÖС£
ÓÖ±ÈÈ磬¶ÔÓÚBD2µÄGEOÎÀÐǶøÑÔ£¬µ±µçÎÄÐÅÏ¢ÖÐǰʮ¸ö×ÓÖ¡½ÓÊÕµ½²¢»º´æºó£¬¾ÍÅжÏÉÏÊö»º´æµÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚ£¬ÊÇ·ñÓëÒѾ½âµ÷²¢±£´æµÄÐÇÀúÊý¾ÝÁäÆÚÏàµÈ£¬Èç¹û²»ÏàµÈ£¬¾Í½âµ÷ÉÏÊö»º´æµÄÊ®¸ö×ÓÖ¡µÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý£¬½«½âµ÷³öÀ´µÄÐÇÀúÊý¾Ý±£´æÔÚ´æ´¢Æ÷ÖС£
µ±ËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÀúÊéÊý¾ÝµÄʱ¼äÓëÒѾ½âµ÷²¢±£´æµÄÀúÊéÊý¾ÝµÄʱ¼äÖ®¼äµÄ¼ä¸ô´óÓÚÉ趨µÄÊýֵʱ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£¬½«½âµ÷ºóµÃµ½µÄÐÇÀúÊý¾Ý½øÐб£´æ¡£±ÈÈ磬¶ÔÓÚGPS»òBD2µÄÎÀÐǶøÑÔ£¬µ±µçÎÄÐÅÏ¢ÖÐǰʮ¸ö×ÓÖ¡½ÓÊÕµ½²¢»º´æºó£¬¾ÍÅжÏÉÏÊö»º´æµÄµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾ÝµÄʱ¼ä£¬ÓëÒѾ½âµ÷²¢±£´æµÄÀúÊéÊý¾ÝµÄʱ¼äÖ®¼äµÄ¼ä¸ôÊÇ·ñ´óÓÚ7Ì죬Èç¹ûÊÇ£¬¾Í½âµ÷ÉÏÊö»º´æµÄÊ®¸ö×ÓÖ¡µÄµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý£¬½«½âµ÷³öÀ´µÄÀúÊéÊý¾Ý±£´æÔÚ´æ´¢Æ÷ÖС£
ÉÏÊö´¦Àí¹ý³Ì¸øÐÇÀú»òÀúÊéÊý¾ÝÉèÖÃÁ˸üÐÂÖÜÆÚ£¬´Ó¶ø¼õÉÙÁËÆµ·±½âµ÷´óÁ¿ÐÇÀúºÍÀúÊéµÈµçÎÄÐÅÏ¢ËùºÄµÄʱ¼ä¡£
²½Öè12¡¢ÎÀÐǽÓÊÕ»ú¶ÁÈ¡´æ´¢µÄ¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢£¬¸ù¾ÝµçÎÄÐÅÏ¢ºÍÎÀÐǵÄÔ˶¯Ä£ÐÍ£¬²ÉÓÃÐÇÀúÄÚ²åËã·¨¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¡£
ÎÀÐǽÓÊÕ»úµÄ΢´¦ÀíÆ÷Æô¶¯Ê±£¬ÐèÒª´Ó´æ´¢Æ÷ÖжÁÈ¡¸÷¸öÎÀÐǵÄÐÇÀúÊý¾Ý¡¢ÀúÊéÊý¾Ý¡¢µçÀë²ãÐÞÕý²ÎÊýµÈµçÎÄÐÅÏ¢£¬²¢ÇÒ¶ÁÈ¡RTC(Real-timeCommunication£¬ÊµÊ±Í¨ÐÅ)µÄµ±Ç°Ê±¼ä³õʼ»¯Ê±ÖÓÄ£ÐÍÐÅÏ¢¡£È»ºó£¬ÎÀÐǽÓÊÕ»úµÄ΢´¦ÀíÆ÷°´ÕÕÔ¤¶¨µÄʱ¼ä¼ä¸ô(Ò»°ãΪ2Ãë)£¬´Ó´æ´¢Æ÷ÖжÁÈ¡¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¡£
È»ºó£¬ÎÀÐǽÓÊÕ»úÅж϶ÁÈ¡µÄÎÀÐǵĵçÎÄÐÅÏ¢ÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÅоöÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò²ÉÓÃÐÇÀúÄÚ²åËã·¨»ùÓÚÎÀÐǵÄÔ˶¯Ä£ÐͼÆËã³öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¡£
ÉÏÊöÐÇÀúÄÚ²åËã·¨µÄÖ÷Òª¹ý³ÌÈçÏ Ê×ÏÈ£¬ÉèÖø÷¸öÎÀÐÇ(±ÈÈçGPS»òBD2ÎÀÐÇ)µÄÔ˶¯Ä£ÐÍ¡£ÒÔGPSÎÀÐÇΪÀý£¬½¨Á¢µÄÔ˶¯Ä£ÐÍÖ÷Òª°üÀ¨Èçϵļ¸ÖÖ²ÎÊý µ±Ç°Ê±¼äTcurrent£¬²Î¿¼µãʱ¼äTRef£¬Äڲ岽³¤ÎªStep_len£¬³£ÊýÕóT[4][4]£¬ÄÚ²å¾ØÕóInterp[4][4]¡£
ÉÏÊöT[4][4]±íʾ³£ÊýÕ󣬯äÖУ¬T
£½1.0£»T
[1]£½T
[2]£½T
[3]£½0.0£»T[1][1]£½3.0£»T[1][2]£½-1.5£»T[2]
£½1.0£»T[2][1]£½-2.5£»T[2][2]£½2.0£»T[2][3]£½-0.5£»T[3][1]£½0.6£»T[3][2]£½-0.6£»T[1]
£½-11.0/6.0£»T[1][3]£½1/3£»T[3]
£½1/3£»¡£
ÉÏÊöÄÚ²å¾ØÕóInterp[i][j]µÄ¼ÆËã·½·¨ÈçÏ ¹«Ê½1 ÉÏÊö¹«Ê½1ÖеÄpos(k)(j)Ϊti£½TRef+i*Step_len(i£½0£¬1£¬2£¬3)ʱ¿Ì¼ÆËã³öÀ´µÄÎÀÐÇλÖÃx£¬y£¬zÒÔ¼°Ek(ÎÀÐÇµÄÆ«½ü½Ç)¡£
¼ÆËã³öÉÏÊöÄÚ²å¾ØÕóºó£¬Ôò¼Ç¼´ËʱµÄÐÇÀúÊý¾ÝÁäÆÚ£¬¼ÆËã³ö´ËʱµÄ²Î¿¼µãʱ¼äTRef£¬ ¹«Ê½2 fmod·µ»ØTCurrent/Step_lenµÄÓàÊý£¬ÉÏÊö¹«Ê½2µÄÒâ˼ΪȡTCurrentµÄÕûÊý²¿·Ö¡£
½«ÉÏÊöÄÚ²å¾ØÕóºÍ¶ÔÓ¦µÄÐÇÀúÊý¾ÝÁäÆÚ¡¢²Î¿¼µãʱ¼äTRef½øÐйØÁª±£´æ¡£
µ±ÎÀÐǽÓÊÕ»ú¶ÁÈ¡ÁËÎÀÐǵĵçÎÄÐÅÏ¢£¬ÐèÒª¼ÆËãÎÀÐǵÄλÖúÍËÙ¶ÈÐÅϢʱ£¬ÅжÏÈçÏÂÁ½¸öÌõ¼þÊÇ·ñ³ÉÁ¢ 1¡¢µ±Ç°¶ÁÈ¡µÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚµÈÓÚ¼ÆËãÄÚ²å¾ØÕóʱµÄÊý¾ÝÁäÆÚ£¬Ò»°ãÎÀÐǵÄÐÇÀúÊý¾ÝÁäÆÚµÄÓÐЧÆÚΪ4Сʱ¡£
2¡¢µ±Ç°µÄʱ¼ä¼õÈ¥TRefµÄ¾ø¶ÔֵСÓÚ3±¶µÄStep_len¡£
Èç¹ûÉÏÊöÁ½¸öÌõ¼þ³ÉÁ¢£¬ °´ÕÕÏÂʽ¼ÆËã³öÎÀÐǵÄλÖúÍËÙ¶È¡£
tk£½Tcurrent-TRef if(tk£¼-604800.0/2.0)tk£½tk+6048000£» else if(tk£¾6048000/20)tk£½tk-6048000£» tk2£½tk*tktk3£½tk2*tk£» *x£½N.Interp
+N.Interp[1]
*tk+N.Interp[2]
*tk2+N.Interp[3]
*tk3£» *y£½N.Interp
[1]+N.Interp[1][1]*tk+N.Interp[2][1]*tk2+N.Interp[3][1]*tk3£» *z£½N.Interp
[2]+N.Interp[1][2]*tk+N.Interp[2][2]*tk2+N.Interp[3][2]*tk3£» *vx£½N.Interp[1]
+2.0*N.Interp[2]
*tk+3.0*N.Interp[3]
*tk2£» *vy£½N.Interp[1][1]+2.0*N.Interp[2][1]*tk+3.0*N.Interp[3][1]*tk2£» *vz£½N.Interp[1][2]+2.0*N.Interp[2][2]*tk+3.0*N.Interp[3][2]*tk2£» ÉÏÊö¼ÆËã³öµÄÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢ÐèÒª¸ù¾Ý²»Í¬µÄµ¼º½ÎÀÐǶø²ÉÈ¡²»Í¬µÄ×ø±êϵ²ÎÊý¡£±ÈÈ磬Èç¹ûÊÇGPSÎÀÐÇ£¬Ôò²ÉÓÃWGS-84×ø±êϵ²ÎÊý£¬Èç¹ûÊÇBD-2ϵͳ£¬Ôò²ÉÓÃCGS-2000×ø±êϵ²ÎÊý¡£
°´ÕÕÉÏÊö¼ÆËã³öµÄÎÀÐǵÄλÖÃÐÅÏ¢Öеĸ߶ȽǶÔÎÀÐǽøÐÐÅÅÐò£¬¸ß¶È½Ç¸ßµÄÎÀÐÇÅÅÔÚ×îÇ°Ãæ£¬½«Ã»ÓеçÎÄÐÅÏ¢µÄÎÀÐǵĸ߶ȽÇÖÃΪÁã¡£²éѯ½ÓÊÕ»ú¸÷ͨµÀµÄ״̬£¬Èç¹ûijͨµÀ¿ÕÏУ¬ÔòÖÃÈëûÓб»¸³ÓëͨµÀºÅµÄÎÀÐǺţ¬´Ë¹ý³Ìÿ¸ô2ÃëÑ»·Ò»´Î£¬ÉÏÒ»ÂÖÂÖ¿ÕµÄÎÀÐÇÔÚÏÂÒ»ÂÖÖб»Ñ¡ÖУ¬ÒÔ±£Ö¤ËùÓпÉÄܲ¶»ñµÄÎÀÐǶ¼ÖÃÈëµ½ÏàÓ¦µÄͨµÀÖС£
²ÉÓÃÉÏÊö´¦Àí¹ý³Ì£¬¿ÉÒÔ±ÜÃâÿ¸ôÒ»¸ö±È½Ï¶ÌµÄʱ¼ä¼ä¸ô(±ÈÈç2Ãë)£¬¾ÍƵ·±µØ¼ÆËãÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¡£ÔÚʵ¼ÊÓ¦ÓÃÖУ¬¿ÉÒÔ½«¼ÆËãÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢µÄʱ¼ä¼ä¸ôÔö´óµ½3·ÖÖÓ»ò¸ü³¤¡£
²½Öè13¡¢¸ù¾ÝÉÏÊöÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬ÒÔ¼°»º´æµÄ¹Û²âÊý¾Ý£¬²ÉÓÃÐòÁд¦Àí·¨¼ÆËã³öÎÀÐǽÓÊÕ»úµÄλÖúÍËÙ¶ÈÐÅÏ¢¡£
µ±ÎÀÐǽÓÊÕ»úµÄ¶¨Î»ÖÜÆÚµ½´ïʱ£¬ÎÀÐǽÓÊÕ»úµÄ΢´¦ÀíÆ÷´Ó¹Û²âÊý¾Ý»º³åÇøÖжÁÈ¡¸÷¸öÎÀÐǵĹ۲âÊý¾Ý£¬ÐγÉα¾à¡£¼ÙÉè´Óij¿ÅÎÀÐÇÉÏ·¢³öµÄÌØ¶¨ÂëÐźÅÔÚÎÀÐÇʱϵÄʱ¿Ìt±»½ÓÊÕ£¬ÐźŴ«²¥Ê±¼äΪ¦Ó£¬ts(t-¦Ó)ΪÏàÓ¦µÄ·¢Éäʱ¼ä£¬tu(t)ÊÇͨ¹ýÓû§½ÓÊÕ»ú²âµÃµÄÐźŵ½´ïʱ¼ä£¬Ôòα¾à¦Ñ¿ÉÓÉÉÏÊö²âµÃµÄÐźŵ½´ï±íʾΪ¦Ñ£½c[tu(t)-ts(t-¦Ó)]£¬cΪ¹âËÙ¡£
È»ºó£¬¶Ôα¾à½øÐÐÆ½»¬ºÍ¶àÆÕÀÕ¹Û²âÖµµÄÐγɣ¬ÔÙ¶Ôα¾à½øÐи÷ÏîÎó²îÐÞÕý£¬¸ù¾ÝËùÊöα¾àºÍ¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢µÃµ½¹Û²âÁ¿¾ØÕóZk¡£¶Ô²»Âú×ãÎÀÐǽÓÊÕ»úµÄ¶¨Î»ÖÜÆÚÌõ¼þµÄÎÀÐǹ۲âÊý¾Ý½øÐÐÅųý£¬Í¬Ê±¸ù¾Ýα¾àµÄÂëʱ¼ä¶ÔRTCµÄµ±Ç°Ê±¼ä½øÐо«Ï¸µÄµ÷Õû¡£
½«¸÷µ¼º½ÏµÍ³µÄÎÀÐÇλÖúͲâÁ¿Ê±¼äͳһµ½²Î¿¼µÄ×ø±êϵÓëʱ¼äϵͳÖС£¶Ô¹Û²âÁ¿¾ØÕóZkÖеĹ۲âÏòÁ¿½øÐÐÐòÁд¦ÀíºÍ´Ö²î·ÖÎö¡£
ÔÚÏÖÓеÄKalmanÂ˲¨ÖУ¬ÐèÒª¶Ô¹Û²âÁ¿¾ØÕóZk¼ÆËãm¡ÁmÎ¬ÄæÕ󣬶øÄæÕóµÄ¼ÆËãÁ¿ÓëάÊým3³É±ÈÀý£¬¼ÆËãÁ¿½Ï´ó¡£ÎªÁ˽â¾öÕâ¸öÎÊÌ⣬±¾·¢Ã÷ʵʩÀýµÄÐòÁд¦Àí·¨ÊǶÔKalmanÂ˲¨µÄÀ©Õ¹£¬Í¨¹ý¶Ô¹Û²âÁ¿¾ØÕóZkÖеĹ۲âÏòÁ¿½øÐÐÐòÁд¦Àí£¬½«¶Ô¹Û²âÁ¿¾ØÕóZkµÄ¼¯Öд¦Àí·ÖɢΪ¶ÔZkµÄ¸÷·ÖÁ¿×龨ÕóµÄ˳Ðò´¦Àí£¬Ê¹¶Ô¸ß½×¾ØÕóµÄÇóÄæ±ä³É¶ÔµÍ½×¾ØÕóµÄÇóÄæ£¬´Ó¶øÓÐЧµØ½µµÍ¼ÆËãÁ¿¡£ÌرðÊǵ±¹Û²âÊý¾ÝµÄ¹Û²âÔëÉù·½²îÕóΪ¶Ô½ÇÕóʱ£¬ÕâÖÖ·ÖÉ¢ºóµÄÇóÄæ×ª»¯Îªµ¥´¿µÄ³ý·¨£¬¼ÆËãÁ¿µÄ½µµÍ¾Í¸üÃ÷ÏÔÁË¡£
ÉÏÊöÐòÁд¦Àí·¨µÄ¾ßÌå¹ý³ÌÈçÏ ÈÎÒâʱ¿ÌµÄα¾à¹Û²â·½³ÌΪ ÆäÖЦÑj-α¾à£» xj£¬yj£¬zjΪ¸Ãʱ¿ÌÎÀÐǵÄλÖã» xu£¬yu£¬zuΪ¸Ãʱ¿ÌÎÀÐǽÓÊÕ»úµÄλÖã» ¦ÄtuΪÎÀÐǽÓÊÕ»úµÄÖӲ Áî¦Ñj£½f(xu£¬yu£¬ zu£¬¦Ätu)£¬Ôò¸ù¾ÝÓû§µÄ¸ÅÂÔλÖÃ
ºÍÓû§ÖÓ²îµÄ¹À¼ÆÖµ
¿ÉÒÔ¼ÆËã³ö½üËÆÎ±¾à Áî Ôò½«ÉÏʽ½øÐÐÌ©ÀÕÕ¹¿ª²¢È¡Ò»½×ÏßÐÔÏîµÃµ½ ÆäÖÐ ÓÉÉÏÃæ¼¸¸öʽ×ӵõ½ Áî ¶Ô4¿ÅÎÀÐǽøÐÐα¾à²âÁ¿ºó¿ÉÒԵõ½Kalman¹Û²â·½³Ì£¬Ð´³É¾ØÕóÐÎʽΪ Z£½HX+V ÆäÖÐ ¸ÃÐòÁд¦Àí·½·¨ÒªÇó¹Û²âÊý¾ÝµÄ²âÁ¿ÔëÉù·½²îÕóΪ¿é¶Ô½ÇÕó»ò¶Ô½ÇÕ󣬼´ ¹«Ê½3 rkiΪmi¡ÁmiÕ󣬱íʾijµ¥Ò»µ¼º½ÏµÍ³ÖÐËùÓÐÎÀÐǵIJâÁ¿ÔëÉù·½²îÕó£» m±íʾ½ÓÊÕ»ú¹Û²âµ½µÄµ¥Ò»µ¼º½ÏµÍ³ÖÐÎÀÐǵĸöÊý£» l±íʾµ¼º½ÏµÍ³×ÜÊý£» hkiµÚi¸öµ¼º½ÏµÍ³ÖеÄϵÊýÕó£» ÉèrkiΪmi¡ÁmiÕó£»µ±l£½mʱ£¬rki¾ùΪ±êÁ¿£¬Í¬Ñù¿É°Ñ¹Û²âÕóH·Ö¿éΪ ¹«Ê½4 Õâʱÿ×é·ÖÁ¿µÄ¹Û²â·½³ÌΪ ʽÖУ¬hkiΪmi¡Án¹Û²âÕ󡣯ÕͨKalmanÂ˲¨¶Ô¹Û²âÏòÁ¿Zkͬʱ´¦Àí£¬Ò»²½Ô¤²â¹À¼ÆÔÚ»ñµÃZkºó£¬Â˲¨¹À¼ÆÎª ÐòÁд¦Àí°ÑZk·ÖΪZki(i£½1£¬2£¬¡£¬l)£¬Ò»¸öÒ»¸ö°´Ë³Ðò´¦Àí£¬¼´µÚÒ»´Î´ÓºÍZk1¼ÆËãµÃÔÙÓÃXk1ºÍZk2¼ÆËãµÃµ½Ò»Ö±µ½£¬ ¹Û²âÁ¿¾ØÕóZkÔÚ²âÁ¿¸üÐÂÖнøÐУ¬Â˲¨¹«Ê½Îª µ±Ê±£¬¹Û²âÁ¿¾ØÕóZk´¦ÀíÖÕÖ¹¡£
¸ù¾ÝÒÀ´Î¼ÆËã³öZki(i£½1£¬2£¬¡£¬l)µÃµ½¹Û²âÁ¿¾ØÕóZkµÄÇó½âÖµ£¬¸ù¾Ý¸ÃÇó½âÖµµÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖÃxu£¬yu£¬zu¡£
´ÓÉÏʽ¿ÉÒÔÃ÷ÏԵؿ´³ö£¬²ÉÓÃÐòÁд¦Àí·¨£¬Ö»Ðè½øÐÐl´Îmi¡Ámiά¾ØÕóÇóÄæ¡£ÀýÈ磬¹Û²âÏòÁ¿µÄάÊým£½12£¬Èç·ÖËĴδ¦Àí£¬¼´l£½4£¬mi£½3ʱ£¬ÆÕͨKalmanÂ˲¨Ëã·¨µÄ¼ÆËãÁ¿Îª123£½1728£¬±¾·¢Ã÷ʵʩÀýµÄÐòÁд¦Àí·¨µÄ¼ÆËãÁ¿Îª4¡Á33£½108£¬½öΪǰÕßµÄ6.25£¥¡£ÓÉÓÚ¸÷¸öµ¼º½ÏµÍ³µÄ¹Û²âÏòÁ¿Ö®¼äµÄ²âÁ¿Îó²î·½²îÕóRΪÑϸñ¶Ô½ÇÕ󣬼´ Òò´Ë£¬Ã¿´Î´¦ÀíÒ»¸ö²âÁ¿·ÖÁ¿£¬¼ÆËãЧÂʸü¸ß¡£ÁíÒ»·½Ã棬ÔÚ¼ÆËã¹ý³ÌÖУ¬ÓÉÓÚ¾ØÕóÏà³Ë±äΪ±êÁ¿¼ÆË㣬ȥ³ýÁ˶àά¾ØÕóÁª³ËËùÐèµÄÁÙʱ¾ØÕó¡£
±¾·¢Ã÷ʵʩÀý»¹ÌṩÁËÒ»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ×°Ö㬸Ã×°ÖõľßÌå½á¹¹Èçͼ2Ëùʾ£¬°üÀ¨Èçϲ½Öè ¹Û²âÏòÁ¿¾ØÕó»ñȡģ¿é21£¬ÓÃÓÚ¶ÁÈ¡¸÷¸öÎÀÐǵĹ۲âÊý¾ÝÐγÉα¾à£¬¸ù¾Ý¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬¸ù¾ÝËùÊöα¾àºÍ¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬µÃµ½¹Û²âÏòÁ¿¾ØÕó£» ¹Û²âÏòÁ¿¾ØÕó¼ÆËãÄ£¿é22£¬ÓÃÓÚ¶ÔËùÊö¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬µÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖúÍËÙ¶È¡£
ËùÊö×°Öû¹¿ÉÒÔ°üÀ¨ µçÎĽâµ÷Ä£¿é23£¬ÓÃÓÚ½ÓÊÕµ½ÎÀÐǵĵçÎÄÐÅÏ¢ºó£¬ÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£»·ñÔò£¬²»¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£» ÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£»·ñÔò£¬²»¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£» ½«½âµ÷ºóµÄÐÇÀúÊý¾ÝºÍÀúÊéÊý¾Ý½øÐб£´æ¡£
ÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¼ÆËãÄ£¿é24£¬ÓÃÓÚ¶ÁÈ¡»º´æµÄÎÀÐǵĵçÎÄÐÅÏ¢£¬¸ù¾ÝËùÊöµçÎÄÐÅÏ¢ºÍÔ¤ÏÈÉèÖõÄÎÀÐǵÄÔ˶¯Ä£ÐÍ£¬²ÉÓÃÐÇÀúÄÚ²åËã·¨¼ÆËã³öËùÊöÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¡£
ÉÏÊö±¾·¢Ã÷ʵʩÀýËùÊö·½·¨ºÍ×°ÖÃÒѾÔÚGPS/BD2¼æÈݽÓÊÕ»úÉÏʵÏÖ£¬¿¼Âǵ½¸÷ÖÖÀàÐ͵Ä×éºÏ½ÓÊÕ»úµÄÊý¾Ý´¦ÀíÏàËÆÐÔ£¬±¾·¢Ã÷ʵʩÀýͬÑùÒ²ÊÊÓÃÓÚÆäËüÀàÐ͵Ä×éºÏ½ÓÊÕ»ú¡£
×ÛÉÏËùÊö£¬±¾·¢Ã÷ʵʩÀýʵÏÖÁËÎÀÐǽÓÊÕ»úÖеĹ۲âÊý¾ÝµÄ¿ìËÙ´¦Àí£¬ÒÔ½ÚÊ¡ÎÀÐǽÓÊÕ»úµÄ΢´¦ÀíÆ÷µÄ¼ÆËãʱ¼äºÍ´æÈ¡¿Õ¼ä£¬´Ó¶øÊµÏÖÔÚÒ»¸ö΢´¦ÀíÆ÷ÉÏʵÏÖ¶à¸öÎÀÐǵ¼º½ÏµÍ³µÄÊý¾ÝʵʱÈںϴ¦ÀíÓ붨λ²âËÙÊý¾ÝµÄ¸ßËÙÂÊÊä³ö¡£½â¾öÏÖÓеÄÎÀÐǽÓÊÕ»úÖеĹ۲âÊý¾ÝµÄ´¦Àí·½·¨ËÙ¶ÈÂý¡¢Õ¼ÓÃÄÚ´æ¶à¡¢Á÷ƬÄѶȴóµÈÎÊÌâ¡£
±¾·¢Ã÷ʵʩÀýͨ¹ý¸øÐÇÀúÊý¾ÝºÍÀúÊéÊý¾ÝÉèÖøüÐÂÖÜÆÚ£¬´Ó¶ø¼õÉÙÁËÆµ·±½âµ÷´óÁ¿ÐÇÀúÊý¾ÝºÍÀúÊéÊý¾ÝµÈµçÎÄÐÅÏ¢ËùºÄµÄʱ¼ä¡£
±¾·¢Ã÷ʵʩÀýͨ¹ýÅж϶ÁÈ¡µÄÎÀÐǵĵçÎÄÐÅÏ¢ÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÅоöÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò²ÉÓÃÐÇÀúÄÚ²åËã·¨»ùÓÚÎÀÐǵÄÔ˶¯Ä£ÐͼÆËã³öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬´Ó¶ø±ÜÃâÁËÆµ·±µØ¼ÆËãÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¡£
ÒÔÉÏËùÊö£¬½öΪ±¾·¢Ã÷½Ï¼ÑµÄ¾ßÌåʵʩ·½Ê½
£¬µ«±¾·¢Ã÷µÄ±£»¤·¶Î§²¢²»¾ÖÏÞÓÚ´Ë£¬ÈκÎÊìϤ±¾¼¼ÊõÁìÓòµÄ¼¼ÊõÈËÔ±ÔÚ±¾·¢Ã÷½Ò¶µÄ¼¼Êõ·¶Î§ÄÚ£¬¿ÉÇáÒ×Ïëµ½µÄ±ä»¯»òÌæ»»£¬¶¼Ó¦º¸ÇÔÚ±¾·¢Ã÷µÄ±£»¤·¶Î§Ö®ÄÚ¡£Òò´Ë£¬±¾·¢Ã÷µÄ±£»¤·¶Î§Ó¦¸ÃÒÔȨÀûÒªÇóµÄ±£»¤·¶Î§Îª×¼¡£
ȨÀûÒªÇó
1.Ò»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬°üÀ¨
ÎÀÐǽÓÊÕ»ú¶ÁÈ¡¸÷¸öÎÀÐǵĹ۲âÊý¾ÝÐγÉα¾à£¬¸ù¾Ý¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬¸ù¾ÝËùÊöα¾àºÍ¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬µÃµ½¹Û²âÏòÁ¿¾ØÕó£»
¶ÔËùÊö¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬µÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖá£
2.¸ù¾ÝȨÀûÒªÇó1ËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊö·½·¨»¹°üÀ¨
ÎÀÐǽÓÊÕ»ú½ÓÊÕµ½ÎÀÐǵĵçÎÄÐÅÏ¢ºó£¬ÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£»·ñÔò£¬²»¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£»
ÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£»·ñÔò£¬²»¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷¡£
3.¸ù¾ÝȨÀûÒªÇó2ËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊöÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£¬°üÀ¨
µ±ËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚÓëÒѾ½âµ÷²¢±£´æµÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚÏàµÈʱ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£¬½«½âµ÷ºóµÃµ½µÄÐÇÀúÊý¾Ý½øÐб£´æ¡£
4.¸ù¾ÝȨÀûÒªÇó2ËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊöÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£¬°üÀ¨
µ±ËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÀúÊéÊý¾ÝµÄʱ¼äÓëÒѾ½âµ÷²¢±£´æµÄÀúÊéÊý¾ÝµÄʱ¼äÖ®¼äµÄ¼ä¸ô´óÓÚÉ趨µÄÊýֵʱ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢µÄÉ趨ÊýÁ¿¸ö×ÓÖ¡ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£¬½«½âµ÷ºóµÃµ½µÄÐÇÀúÊý¾Ý½øÐб£´æ¡£
5.¸ù¾ÝȨÀûÒªÇó2ËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊö¸ù¾Ý¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬°üÀ¨
ËùÊöÎÀÐǽÓÊÕ»ú¶ÁÈ¡»º´æµÄÎÀÐǵĵçÎÄÐÅÏ¢£¬¸ù¾ÝËùÊöµçÎÄÐÅÏ¢ºÍÔ¤ÏÈÉèÖõÄÎÀÐǵÄÔ˶¯Ä£ÐÍ£¬²ÉÓÃÐÇÀúÄÚ²åËã·¨¼ÆËã³öËùÊöÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¡£
6.¸ù¾ÝȨÀûÒªÇó5ËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊö¸ù¾ÝËùÊöµçÎÄÐÅÏ¢ºÍÔ¤ÏÈÉèÖõÄÎÀÐǵÄÔ˶¯Ä£ÐÍ£¬²ÉÓÃÐÇÀúÄÚ²åËã·¨¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬°üÀ¨
Ô¤ÏÈÉèÖÃÎÀÐǵÄÔ˶¯Ä£ÐÍ£¬¸ÃÔ˶¯Ä£ÐͰüÀ¨µ±Ç°Ê±¼äTcurrent£¬²Î¿¼µãʱ¼äTRef£¬Äڲ岽³¤ÎªStep_len£¬³£ÊýÕóT[4][4]ºÍÄÚ²å¾ØÕóInterp[i][j]£¬ËùÊö³£ÊýÕóT[4][4]ÖеÄT
£½1.0£»T
[1]£½T
[2]£½T
[3]£½0.0£»T[1][1]£½3.0£»T[1][2]£½-1.5£»T[2]
£½1.0£»T[2][1]£½-2.5£»T[2][2]£½2.0£»T[2][3]£½-0.5£»T[3][1]£½0.6£»T[3][2]£½-0.6£»T[1]
£½-11.0/6.0£»T[1][3]£½1/3£»T[3]
£½1/3£»
ËùÊöÄÚ²å¾ØÕóInterp[i][j]µÄ¼ÆËã·½·¨ÈçÏÂ
ËùÊöpos(k)(j)Ϊ¸ù¾Ýti£½TRef+i*Step_len(i£½0£¬1£¬2£¬3)ʱ¿Ì¼ÆËã³öÀ´µÄÎÀÐÇλÖÃx£¬y£¬zÒÔ¼°ÎÀÐÇµÄÆ«½ü½Ç£»
ËùÊö²Î¿¼µãʱ¼äTRefµÄ¼ÆËã·½·¨ÈçÏÂ
µ±ËùÊö¶ÁÈ¡µÄµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝµÄÐÇÀúÊý¾ÝÁäÆÚµÈÓÚËùÊöÄÚ²å¾ØÕóInterp[i][j]¶ÔÓ¦µÄÊý¾ÝÁäÆÚ£¬²¢ÇÒ£¬µ±Ç°Ê±¼äTcurrent¼õÈ¥TRefµÄ¾ø¶ÔֵСÓÚ3±¶µÄStep_lenʱ£¬Ôò°´ÕÕÏÂÊö·½·¨¼ÆËãÎÀÐǵÄλÖÃÐÅÏ¢£ªX¡¢£ªYºÍ£ªZºÍËÙ¶ÈÐÅÏ¢£ªVX¡¢£ªVYºÍ£ªVZ£»
tk£½Tcurrent-TRef
if(tk£¼-6048000/2.0)tk£½tk+6048000£»
else if(tk£¾604800.0/2.0)tk£½tk-604800.0£»
tk2£½tk*tk tk3£½tk2*tk£»
*x£½N.Interp
+N.Interp[1]
*tk+N.Interp[2]
*tk2+N.Interp[3]
*tk3£»
*y£½N.Interp
[1]+N.Interp[1][1]*tk+N.Interp[2][1]*tk2+N.Interp[3][1]*tk3£»
*z£½N.Interp
[2]+N.Interp[1][2]*tk+N.Interp[2][2]*tk2+N.Interp[3][2]*tk3£»
*vx£½N.Interp[1]
+2.0*N.Interp[2]
*tk+3.0*N.Interp[3]
*tk2£»
*vy£½N.Interp[1][1]+2.0*N.Interp[2][1]*tk+3.0*N.Interp[3][1]*tk2£»
*vz£½N.Interp[1][2]+2.0*N.Interp[2][2]*tk+3.0*N.Interp[3][2]*tk2¡£
7.¸ù¾ÝȨÀûÒªÇó1ÖÁ6ÈÎÒâÏîËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊöµÄ¶ÔËùÊö¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬µÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖ㬰üÀ¨
Éè¹Û²âÊý¾ÝµÄ²âÁ¿ÔëÉù·½²îÕóE[VkVkT]Ϊ¿é¶Ô½ÇÕó»ò¶Ô½ÇÕ󣬼´
rkiΪmi¡ÁmiÕ󣬱íʾijµ¥Ò»µ¼º½ÏµÍ³ÖÐËùÓÐÎÀÐǵIJâÁ¿ÔëÉù·½²îÕó£»
m±íʾ½ÓÊÕ»ú¹Û²âµ½µÄµ¥Ò»µ¼º½ÏµÍ³ÖÐÎÀÐǵĸöÊý£¬I±íʾµ¼º½ÏµÍ³×ÜÊý£¬hkiµÚi¸öµ¼º½ÏµÍ³ÖеÄϵÊýÕó£»
½«¹Û²âÁ¿¾ØÕóZk·Ö½âΪZki(i£½1£¬2£¬¡£¬l)£¬¶ÔËùÊöZkTÒÀ´Î°´Ë³Ðò´¦Àí£¬¼´µÚÒ»´Î´Ó
ºÍZk1¼ÆËãµÃ
ÔÙÓÃXk1ºÍZk2¼ÆËãµÃµ½
Ò»Ö±¼ÆËãµ½£¬
¸ù¾ÝÒÀ´Î¼ÆËã³öZk1(i£½1£¬2£¬¡£¬l)µÃµ½¹Û²âÁ¿¾ØÕóZkµÄÇó½âÖµ£¬¸ù¾Ý¸ÃÇó½âÖµµÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖá£
8.Ò»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ×°Öã¬ÆäÌØÕ÷ÔÚÓÚ£¬°üÀ¨
¹Û²âÏòÁ¿¾ØÕó»ñȡģ¿é£¬ÓÃÓÚ¶ÁÈ¡¸÷¸öÎÀÐǵĹ۲âÊý¾ÝÐγÉα¾à£¬¸ù¾Ý¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬¸ù¾ÝËùÊöα¾àºÍ¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬µÃµ½¹Û²âÏòÁ¿¾ØÕó£»
¹Û²âÏòÁ¿¾ØÕó¼ÆËãÄ£¿é£¬ÓÃÓÚ¶ÔËùÊö¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬µÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖá£
9.¸ù¾ÝȨÀûÒªÇó8ËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ×°Öã¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊö×°Öû¹°üÀ¨
µçÎĽâµ÷Ä£¿é£¬ÓÃÓÚ½ÓÊÕµ½ÎÀÐǵĵçÎÄÐÅÏ¢ºó£¬ÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£»·ñÔò£¬²»¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÐÇÀúÊý¾Ý½øÐнâµ÷£»
ÅжÏËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾ÝÊÇ·ñÂú×ãÔ¤ÏÈÉ趨µÄÌõ¼þ£¬Èç¹ûÊÇ£¬Ôò¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£»·ñÔò£¬²»¶ÔËùÊöµçÎÄÐÅÏ¢ÖеÄÀúÊéÊý¾Ý½øÐнâµ÷£»
½«½âµ÷ºóµÄÐÇÀúÊý¾ÝºÍÀúÊéÊý¾Ý½øÐб£´æ¡£
10.¸ù¾ÝȨÀûÒªÇó8»ò9ËùÊöµÄ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ×°Öã¬ÆäÌØÕ÷ÔÚÓÚ£¬ËùÊö×°Öû¹°üÀ¨
ÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¼ÆËãÄ£¿é£¬ÓÃÓÚ¶ÁÈ¡»º´æµÄÎÀÐǵĵçÎÄÐÅÏ¢£¬¸ù¾ÝËùÊöµçÎÄÐÅÏ¢ºÍÔ¤ÏÈÉèÖõÄÎÀÐǵÄÔ˶¯Ä£ÐÍ£¬²ÉÓÃÐÇÀúÄÚ²åËã·¨¼ÆËã³öËùÊöÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢¡£
È«ÎÄÕªÒª
Ò»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨£¬¸Ã·½·¨Ö÷Òª°üÀ¨ÎÀÐǽÓÊÕ»ú¶ÁÈ¡¸÷¸öÎÀÐǵĹ۲âÊý¾ÝÐγÉα¾à£¬¸ù¾Ý¸÷¸öÎÀÐǵĵçÎÄÐÅÏ¢¼ÆËã³ö¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬¸ù¾ÝËùÊöα¾àºÍ¸÷¸öÎÀÐǵÄλÖúÍËÙ¶ÈÐÅÏ¢£¬µÃµ½¹Û²âÏòÁ¿¾ØÕó£»¶ÔËùÊö¹Û²âÏòÁ¿¾ØÕó½øÐзֽâµÃµ½¸÷¸ö¹Û²âÏòÁ¿·Ö×龨Õó£¬ÀûÓöԽÇÕóµÄ¹Û²âÔëÉù·½²îÕó¶ÔËùÊö¸÷¸ö¹Û²âÏòÁ¿·Ö×龨ÕóÒÀ´Î½øÐÐÇóÄæÔËË㣬µÃµ½ËùÊöÎÀÐǽÓÊÕ»úµÄλÖá£ÀûÓñ¾·¢Ã÷£¬¿ÉÒÔʵÏÖÎÀÐǽÓÊÕ»úÖеĹ۲âÊý¾ÝµÄ¿ìËÙ´¦Àí£¬ÒÔ½ÚÊ¡ÎÀÐǽÓÊÕ»úµÄ΢´¦ÀíÆ÷µÄ¼ÆËãʱ¼äºÍ´æÈ¡¿Õ¼ä¡£
Îĵµ±àºÅG01S19/42GK101750617SQ20101003392
¹«¿ªÈÕ2010Äê6ÔÂ23ÈÕ ÉêÇëÈÕÆÚ2010Äê1ÔÂ6ÈÕ ÓÅÏÈȨÈÕ2010Äê1ÔÂ6ÈÕ
·¢Ã÷ÕßÀî¹â³É ÉêÇëÈË:±±¾©»ªÁ¦´´Í¨¿Æ¼¼¹É·ÝÓÐÏÞ¹«Ë¾