ÑÇÐÇÓÎÏ·¹ÙÍø-www.yaxin868.com

  • ɽ¶«ÑÇÐÇÓÎÏ·¹ÙÍø»ú´²ÓÐÏÞ¹«Ë¾Ï³´²¹Ù·½ÍøÕ¾½ñÌìÊÇ£º2025-06-06Çл»³ÇÊÐ[È«¹ú]-ÍøÕ¾µØÍ¼
    ÍÆ¼ö²úÆ· :
    ÍÆ¼öÐÂÎÅ
    ¼¼ÊõÎÄÕµ±Ç°Î»ÖÃ:¼¼ÊõÎÄÕÂ>

    ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨ºÍ×°ÖõÄÖÆ×÷·½·¨

    ʱ¼ä:2025-06-04    ×÷Õß: ¹ÜÀíÔ±

    רÀûÃû³Æ£º¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨ºÍ×°ÖõÄÖÆ×÷·½·¨
    ¼¼ÊõÁìÓò£º
    ±¾·¢Ã÷Éæ¼°ÎÀÐǵ¼º½ÏµÍ³£¬ÓÈÆäÉæ¼°Ò»ÖÖ¶ÔÎÀÐǽÓÊÕ»úµÄ¹Û²âÊý¾Ý½øÐд¦ÀíµÄ·½·¨ºÍ×°Öá£

    ±³¾°¼¼Êõ£º
    Ŀǰ´æÔÚ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ÈÕ
    ·¢Ã÷ÕßÀî¹â³É ÉêÇëÈË:±±¾©»ªÁ¦´´Í¨¿Æ¼¼¹É·ÝÓÐÏÞ¹«Ë¾

    • רÀûÃû³Æ£ºÓпÇÌå¶à´Å¿éλÖúʹÅͨÁ¿¶¼²»¾ùÔÈ·Ö²¼´«¸ÐÆ÷µÄÖúÁ¦³µµÄÖÆ×÷·½·¨¼¼ÊõÁìÓò£º±¾·¢Ã÷ÊôÓÚÖúÁ¦×ÔÐгµµÄ¼¼ÊõÁìÓò£¬ÌرðÊÇÉæ¼°ÔÚÒ»¸öת¶¯²¿¼þÉϽøÐжàµãλ´Å¸ÐÓ¦ÌṩÖúÁ¦Ðźŵĵ綯ÖúÁ¦×ÔÐгµ¡£±³¾°¼¼Êõ£ºÒ°±¦³µÁÏ¥¨Òµ(À¥É½)ÓÐÏÞ¹«Ë¾ÉêÇëµÄÖйúרÀû20
    • רÀûÃû³Æ£ºÒ»ÖÖÌìÆ½¶¥Ãű£»¤×°ÖõÄÖÆ×÷·½·¨¼¼ÊõÁìÓò£º±¾ÊµÓÃÐÂÐÍÉæ¼°ÒÇÆ÷ÒDZí½á¹¹£¬¸ü¾ßÌåµØËµ£¬ËüÉæ¼°Ò»ÖÖÌìÆ½µÄ±£»¤×°Öᣠ±³¾°¼¼Êõ£ºÎª±£Ö¤ÌìÆ½Çå½àÒÔ¼°·ÀÖ¹ÆøÁ÷µÈ¶Ô³ÓÁ¿µÄÓ°Ï죬ÌìÆ½µÄËÄÖܼ°¶¥²¿ÍùÍù¶¼±»×°ÓÐ ¿òÌ壬¿òÌåÖÐÉèÓпɿª¹ØµÄÃÅ¡£ÔÚÆä¶¥²¿£¬Îª
    • רÀûÃû³Æ£ºÒ»ÖÖÖ±Ïßµ¼¹ì¸±¾«¶ÈÔ¤²â·½·¨¼¼ÊõÁìÓò£º±¾·¢Ã÷Éæ¼°»úеϵͳ״̬¼à²âÓë¹ÊÕÏÕï¶ÏÁìÓò£¬¾ßÌ嵨½²£¬ÊÇÒ»ÖÖÖ±Ïßµ¼¹ì¸±¾«¶ÈÔ¤²â·½·¨¡£±³¾°¼¼Êõ£ºÖ±Ïßµ¼¹ì¸±Ö÷ÒªÓÉ»¬¹ì¡¢»¬¿éÓë¼°¶þÕß¼äµÄ¹ö¶¯Ìå×é³É£¬ÊÇÒ»ÖÖ¹ö¶¯µ¼Òý£¬¹ö¶¯ÌåÔÚ»¬¿éÓ뻬¹ìÖ®¼ä×÷ÎÞÏÞ¹ö¶¯Ñ­»·
    • רÀûÃû³Æ£ºÒ»ÖÖ½ðÊô±¡Ä¤ÈÈ×èʽ¸ß¾«¶Èζȴ«¸ÐÆ÷µÄÖÆ×÷·½·¨¼¼ÊõÁìÓò£º±¾ÊµÓÃÐÂÐÍרÀû¹«¿ªÁËÒ»ÖÖ½ðÊô±¡Ä¤ÈÈ×èʽ¸ß¾«¶Èζȴ«¸ÐÆ÷£¬ÊôÓÚµç×ÓÔªÆ÷¼þÖÆÔìµÄ¼¼ÊõÁìÓò¡£±³¾°¼¼Êõ£ºÎ¶ȼƹ㷺ÓÃÓÚ¹¤Å©Òµ¡¢¹ú·À¿Æ¼¼ºÍÈËÃǵÄÈÕ³£Éú»îÖУ¬ÊÇÏÖ´úÉú»î²»¿É»òȱµÄÒ»ÖÖ²âÁ¿Æ÷
    • רÀûÃû³Æ£ºÒ»ÖÖÑ̲ݰü×°¼ì²âµÄ·½·¨¼°Æä×°ÖõÄÖÆ×÷·½·¨¼¼ÊõÁìÓò£º±¾·¢Ã÷Éæ¼°Ò»ÖÖÔÚ¾íÑ̰ü×°Éú²úÏßÉÏÓÃÓÚ¼ì²éÑ̲ݰü×°ÖÐÕûÏäȱÌõȱ°ü¡¢ÕûÌõȱ°üȱ֧¡¢Õû°üȱ֧¡¢µô×ì¡¢¶Ï²ÐÑÌÖ§¡¢¿ÕÍ·ÑÌÖ§µÈ°ü×°¡¢¾íÖÆÖÊÁ¿È±ÏݵÄÑ̲ݰü×°¼ì²â·½·¨¼°Æä×°Öᣱ³¾°¼¼Êõ£º°´ÕÕ¹ú±êG
    • רÀûÃû³Æ£ºÎüÊÕ¹âÆ×¼ì²âϵͳµÄÖÆ×÷·½·¨¼¼ÊõÁìÓò£º±¾ÊµÓÃÐÂÐÍÉæ¼°Ò»ÖÖÎüÊÕ¹âÆ×¼ì²âϵͳ£¬¾ßÌåÉæ¼°Ò»ÖÖÓÃÓÚ΢Á¿ÆøÌå³É·Ö²âÁ¿µÄÎüÊÕ¹âÆ×¼ì²âϵͳ¡£±³¾°¼¼Êõ£º¹âÆ×¼¼Êõ×÷ΪÑо¿ÎïÖÊ»ù±¾ÌØÐÔµÄÒ»ÖÖ·½·¨£¬±»¹ã·ºÓÃÓÚÓлú»¯ºÏÎï¡¢¸ß·Ö×Ó¾ÛºÏÎïºÍÎÞ»ú»¯ºÏÎïµÈ¸÷ÖÖÌìÈ»
    ɽ¶«ÑÇÐÇÓÎÏ·¹ÙÍø»ú´²ÓÐÏÞ¹«Ë¾
    È«¹ú·þÎñÈÈÏߣº13062023238
    µç»°£º13062023238
    µØÖ·£ºëøÖÝÊÐÁúȪ¹¤ÒµÔ°68ºÅ
    ¹Ø¼ü´Ê£ºÏ³´²£¬Êý¿ØÏ³´²£¬ÁúÃÅϳ´²
    ¹«Ë¾¶þάÂë
    Copyright 2010-2024 °æÈ¨ËùÓÐ All rights reserved ³ICP±¸19044495ºÅ-12
    ¡¾ÍøÕ¾µØÍ¼¡¿¡¾sitemap¡¿