PID ¶ÔËÄÐýÒíµÄ×÷ÓÃÓëµ÷ÊÔ ÏÂÔر¾ÎÄ

ÄÚÈÝ·¢²¼¸üÐÂʱ¼ä : 2025/2/22 20:41:30ÐÇÆÚÒ» ÏÂÃæÊÇÎÄÕµÄÈ«²¿ÄÚÈÝÇëÈÏÕæÔĶÁ¡£

PID ¶ÔËÄÐýÒíµÄ×÷ÓÃÓëµ÷ÊÔ£¬APMºÍº£µÁÄÜÓÃ

ת·¢PID ¶ÔÐÔÄܵÄ×÷ÓÃAcroÒÔÍâµÄËùÓÐģʽʹÓÃÎȶ¨¹¦ÄÜ¡£Ëü±¾À´ÊǶԳƵģ¬µ«ÎÒÃÇ·Ö¿ªÁ˸©ÑöºÍºá¹ö£¬ÕâÑùÄã¾Í¿ÉÒÔÔÚÒ»¸öÖáÉÏ΢µ÷Ö±Éý»úµÄ¸ººÉ¡£Õâ¿ÉÄÜÊÇÒòΪÔÚ»ú¼ÜµÄijһ²à¹ÒÁËÁ½¿éµç³Ø£¬»òÕßÒ»¸öºÜ³¤µÄµç³Ø¡£Èç¹ûij¸öÖá±ÈÆäËüÖá¸ü¿ì»ò¸ü³Ù¶Û£¬ÄãµÄÀíÏë²ÎÊý¾Í²»ÊǶԳƵġ£

? ? ? ?

? ?

Îȶ¨ P (STABILIZE_P)£ºÄãÏ£ÍûÐÞÕýÎó²îµÄÐýתËÙÂÊ¡£Õâ¸öÖµÔ½¸ß£¬·ÉÐÐÆ÷½«¸ü¿ìµØµ½´ïÔ¤ÆÚµÄ×Ë̬¡£ Îȶ¨ I (STABILIZE_I)£ºÓÃÓڼƴ¦Àí CG ±ä»¯¡¢ÈõµÄÂí´ï»òÕß³ÖÐøµÄÍâÁ¦¡£ Îȶ¨ Imax (STABILIZE_IMAX)£º·ÉÐÐÆ÷ÓÃÓÚ²¹³¥ÕâЩ·ÇƽºâÁ¦µÄ×î´óÁ¿¡£ ±È ÂÊ P (RATE_P)£º ×îÖØÒªµÄÖµ! Õâ¸öÖµ¿ØÖÆÐèÒªÊä³ö¶à´óµÄÍÆÁ¦À´µ½´ïÔ¤ÆÚµÄÐýתËÙÂÊ¡£¸ßÍÆÁ¦/ÖØÁ¿±ÈµÄ·ÉÐÐÆ÷ÐèÒª½ÏСµÄÖµ£¬¶øµÍÍÆÁ¦/ÖØÁ¿±ÈµÄÐèÒªÒ»¸ö½Ï¸ßµÄÖµ¡£Ì«¸ßµÄÖµ»áµ¼Ö 5-10hz µÄÕñµ´¡£ÄãÐèÒª½«Õâ¸öÖµÉè³É±ÈÒýÆðÕñµ´µÄÉÔ΢µÍÒ»µã¡£¼¤Áҵĵ÷Õû½á¹û¿ÉÄÜÊǸպÃÒ»¸ö¹ý³åÈ»ºó¾ÍÐÞÕýÁË£¬ÕâÊÇ¿ÉÒÔ½ÓÊܵġ£Ê¹Óà CH6 À´ÔÚ¿ÕÖе÷ÕûÕâ¸öÖµ£¬ÒÔ´ïµ½×î¼ÑÐÔÄÜ¡£

±ÈÂÊ I (RATE_I): ÓÃÓÚ°ïÖú·ÉÐÐÆ÷´ïµ½Ô¤ÆڵIJàÇãËÙÂÊ¡£Ä¬Èϲ»Ê¹Óã¬ÒòΪÕâ¸öÖµ·Ç³£Äѵ÷£¬ºÜÈÝÒ×»ìÏý¡£Èç¹ûÄã¸Õ¿ªÊ¼Ê¹Ó㬰ÑÕâ¸öÖµÉè³É 0¡£ ±ÈÂÊ IMAX (RATE_IMAX): Rate_I Äܵ½´ïµÄ×î´óÖµ¡£Õâ¸öÖµÔÚ»ù±¾ÉèÖÃÖÐÒ²²»Ê¹Ó᣽«ÆäÉèΪ 0 »áʹ Rate_I ÍêȫʧЧ£¬ÎÞÂÛ Rate_I ¶à´ó¡£

Æ«º½ÓÃÀ´±£³ÖÒ»¸öÌرðµÄÆ«º½½Ç¡£Èç¹ûÄãµÄ·É»ú»á×ÔÈ»Ðýת£¬Äã¾ÍÎÞ·¨±£³ÖÒ»¸ö׼ȷµÄ³¯Ïò¡£Ïà·´£¬Äã»áƯÒƼ¸¶È£¬Ö±µ½ P ±äµÃ×ã¹»¸ßÒÔ×èÖ¹Ðýת¡£ STABILIZE_YAW_P£º·ÉÐÐÆ÷תÏòÄ¿±êº½ÏßµÄÔ¤ÆÚËÙÂÊ¡£Èç¹ûÕâ¸öֵ̫¸ß£¬¿ÉÄÜÒýÆðÕñµ´¡£

? STABILIZE_YAW_I£ºÏñ΢µ÷Ò»Ñù¿Ë·þÖ±Éý»ú²»Æ½ºâµÄÎÊÌâ¡£¶¨ÒåΪ´ïµ½×î´óÖµµÄʱ¼ä¡£Ô½¸ß = Ô½¿ì¡£ ? RATE_YAW_P£ºÓÃÓÚ¿ØÖÆ AC2 Äܵ½´ï 0 Æ«º½ËÙÂʵĿØÖÆÁ¿¡£Èç¹ûÕâ¸öֵ̫µÍ£¬ÄãÓÀÔ¶²»ÄÜÍ£Ö¹Ðýת¡£Èç¹ûÌ«¸ß£¬½«»áÆ«º½Õñµ´¡£ ? RATE_YWA_I: ûÓÃ

?

LOITER ÓÃÓÚ¿ØÖÆ·É»úÊÔͼ±£³ÖλÖÃʱÓöà´óµÄ¸©Ñö½Ç·ÉÏòÅÌÐýÄ¿±ê¡£ LOITER_P£º·ÉÐÐÆ÷³¯Ä¿±êµã·ÉÐеÄËÙÂÊ¡£Èç¹ûÕâ¸öÖµ²»¹»¸ß£¬·ÉÐÐÆ÷½«²»ÄÜÔÚÇ¿·çÖзÉÐУ¬¶ø»áƯÒÆ¡£Èç¹ûÌ«¸ß£¬½«»áÔÚÄ¿±êµã¸½½üÕñµ´¡£

? LOITER_I£ºÕ⽫°ïÖú·ÉÐÐÆ÷ÔÚÁãÎó²îÊǶԿ¹·ç¡£µ«ÊÇÓõÄʱºòСÐÄÒ»µã£¬ÒòΪ̫¸ßµÄʱºòÒ²»áÒýÆðÕñµ´¡£ ? LOITER_IMAX£ºLoiter_I µÄ×î´óÖµ¡£

?

NAV_WP ÊÇÓÃÀ´·É»ú·ÉÏòÄ¿±êµÄËٶȡ£

NAV_WP_P£ºÎÒÃÇÓÃËٶȣ¨4m/s£©Æ«ÒÆ×÷ΪÎó²î¡£Ô½¸ß = Ô½´óµÄ¸©Ñö½Ç ? NAV_WP_I£ºÈÃÎÒÃÇÔÚ¶¥·çʱ¼Ó¿ì¡£Ô½¸ßµÄÖµ¼ÓËÙÔ½¿ì¡£ ? NAV_WP_D£º¼õ»º·É»ú¼ÓËÙµÄËÙÂÊ¡£

? NAV_WP_IMAX£ºÎÒÃÇÓÃÀ´¶Ô¿¹·ç¶øÔö¼ÓµÄ×î´ó¸©Ñö½Ç¡£

?

Alt Hold ÓÃÀ´Í¨¹ýÏà¶ÔàÐÔÓµÄÆøѹ´«¸ÐÆ÷±£³ÖλÖá£

Altitude hold_P£º¸ß¶È = Îó²î¡£½Ï¸ßµÄ P ´ú±í¸ü¾ß»ý¼«µÄµç»ú·´Ó¦¡£ ? Altitude hold_I£ºµ±µç³ØµçÁ¿Ï½µÊ±Î¢µ÷ÓÍÃÅÊä³ö¡£ ? Altitude hold IMAX£ºÎÒÃÇ¿ÉÒÔͨ¹ýµ÷ÕûPWMµÄÊýÖµ¡£

?

Throttle Rate ÓÃÓÚÒÖÖÆ·ÉÐÐÆ÷£¬¿ØÖÆÅÀÉýµÄËÙÂÊ¡£

Throttle Rate P: ÓÃÓڸıäÅÀÉýËÙÂʵÄÓÍÃÅÁ¿¡£

? THROTTLE_I: ¶Ô¿¹Îó²î£¬´ïµ½Ô¤ÆÚµÄÅÀÉýÂÊ£¨Ä¬ÈÏΪ 0¡£Altitude hold I ×öÁ˴󲿷ֹ¤×÷.)

? THROTTLE_IMAX: ÄÜÔö¼Ó»ò¼õÉÙµÄµÄ Throttle_I µÄÁ¿¡£

?