1 ÒýÑÔ
ÏÖ´ú¸ßÐÔÄÜ×÷Õ½·É»úÆÕ±é²ÉÓÃÍÆÁ¦Ê¸Á¿¼¼Êõ£¬¸÷Öָ߿ոßËٸ߻ú¶¯ÔÙÈ˵¯Í·µÄÍþвÓúÏÔÍ»³ö£¬Õâ¶Ô´«Í³Æø¶¯¶æ¿ØÖƵĵ¼µ¯ÏµÍ³Ìá³öеÄÒªÇó¡£ÏÖ´úµ¼µ¯ÒªÇóÄܹ»Ñ¡Ôñ¹¥»÷Ä¿±ê£¬¾ßÓÐÒ»¶¨µÄ¿¹¸ÉÈÅÄÜÁ¦£¬ÊµÏÖÈ«Ììºò×÷Õ½£¬ÕâʹµÃµ¼µ¯Ïò¸ß¾«¶È¡¢¸ßÖÇÄÜ¡¢ÇáСÐÍ»¯·¢Õ¹£»Í¬Ê±£¬µ¼µ¯ÖƵ¼¿ØÖƾ«¶ÈµÄÌá¸ßÒÑ´ÓÖƵ¼×ªÏò¿ØÖÆ¡£µ¼µ¯Ä¿±ê·¶Î§²»¶ÏÀ©´ó£¬ÓÉ·´·É»úÀ©´óÖÁ·´Ñ²º½µ¼µ¯¡¢·´µ¯µÀʽµ¼µ¯µÈ·´µ¼ÈÎÎñ¡£¸ß¿Õ¡¢¸ßËÙ¡¢´ó»ú¶¯ÒѳÉΪµ±½ñµ¼µ¯Ä¿±êµÄÖØÒªÌØÕ÷£¬Ä¿±êµÄ¸ßËÙ´ó»ú¶¯ÌØÕ÷µ¼Öµ¯Ò»Ä¿Ïà¶ÔÔ˶¯¼Ó¾ç£¬¶Ôµ¼µ¯Ä©¶Ë¹ýÔØÌá³öºÜ¸ßÒªÇó£»ÁíÒ»·½Ã棬Ŀ±êµÄ¸ß¿ÕÌØÕ÷µ¼Öµ¼µ¯ÏµÍ³Ð§ÂÊ´ó´ó½µµÍ£¬¿ÉÓùýÔØËæ¸ß¶ÈµÄÉý¸ß¶ø´ó·ùϽµ¡£ÎªÁ˽â¾öÕâЩì¶Ü£¬ÕâÀï²ÉÓÃPID¿ØÖÆ·½·¨¿ØÖƵ¼µ¯µÄ¸©Ñö¡¢Æ«º½¡¢¹ö¶¯3¸öͨµÀ¡£
2 Ä£Ð͵Ľ¨Á¢
Ñо¿µ¼µ¯ÖƵ¼ÎÊÌ⣬±ØÐëÒÔÒ»¶¨µÄÊýѧģÐÍΪ»ù´¡¡£Òò´Ë£¬ÔÚÑ¡ÔñÊʵ±µÄ×ø±êϵºó£¬·ÖÎöÍƵ¼³öµ¼µ¯µÄ·ÖͨµÀµÄÀíÏë¿ØÖÆÔ˶¯Ñ§Ä£ÐÍ£¬²¢½¨Á¢¶æ»úÄ£ÐÍ¡£
2.1 ·ÖͨµÀµÄÀíÏë¿ØÖƶ¯Á¦Ñ§·½³Ì
µ¼µ¯ÓÉÓÚ´æÔÚ¹ö¶¯½Ç£¬»áÔì³ÉñîºÏÏÖÏ󣬴ӶøÔö¼Ó¿ØÖÆÀ§ÄÑ£¬½µµÍ¿ØÖƾ«¶È£¬¹ÊÓ¦¾¡Á¿¼õÉÙñîºÏ£¬·ÖͨµÀ¿ØÖÆ¡£ÓÉÓÚµ¼µ¯µÄ¶Ô³ÆÐÔ£¬µ±¹ö¶¯½ÇΪÁã»ò½ÏСʱ£¬ºöÂÔ¸©ÑöÓëÆ«º½µÄñîºÏ£¬¼´µ¥ÊäÈëµ¥Êä³öϵͳ¡£Òò´Ë¿ÉÓþµä¿ØÖÆÀíÂÛ·ÖͨµÀÀ´Ñо¿¡¢·ÖÎöºÍÉè¼Æµ¼µ¯µÄ¿ØÖÆϵͳ¡£
×ÝÏòÔ˶¯Îªµ¼µ¯×ÝÏò¶¯Á¦Ñ§·½³ÌΪ£º
ʽÖУ¬ÎªÇÐÏòÁ¦£¬Îª·¨ÏòÁ¦£¬Îª¸©ÑöÁ¦¾Ø£¬mΪµ¼µ¯ÖÊÁ¿£¬VΪµ¼µ¯µÄ·ÉÐÐËÙ¶ÈʸÁ¿£¬αΪ¹¥½Ç£¬θΪµ¯µÀµÄÇã½Ç£¬δzΪ¸©Ñö¶æÆ«½Ç£¬ωzΪµ¼µ¯ÈƵ¯Ìå×ø±êϵoz1ÖáµÄ½ÇËٶȣ¬X£¬YΪµ¯ÉϵÄ×Ü¿ÕÆø¶¯Á¦ÑØËÙ¶È×ø±êϵ·Ö½âµÄ×èÁ¦¡¢ÉýÁ¦£¬JzΪµ¼µ¯ÈƵ¯Ìå×ø±êϵoz1ÖáµÄת¶¯¹ßÁ¿£¬MzΪ¸©ÑöÁ¦¾Ø¡£
¶ø²àÏòÔ˶¯Îªº½ÏòºÍºáÏòÏ໥½»ÁªñîºÏ£¬Ôòµ¼µ¯²àÏò¶¯Á¦Ñ§·½³ÌΪ£º
ʽÖУ¬-mVcosθ(dψv/dt)Ϊµ¼µ¯ÖÊÐļÓËٶȵÄˮƽ·ÖÁ¿£¬“-”±íʾÏòÐÄÁ¦ÎªÕý£¬Ëù¶ÔÓ¦µÄψvΪ¸º£¬·´Ö®ÒàÈ»¡£ËüÊÇÓɽǶÈÕý¸ººÅ¶¨ÒåËù¾ö¶¨µÄ£¬dωx/dt¡¢dωy/dtΪµ¼µ¯×ª¶¯½Ç¼ÓËÙ¶ÈʸÁ¿ÔÚµ¯Ìå×ø±êϵÖáÉϵķÖÁ¿£¬Jx¡¢Jy¡¢Jz·Ö±ðΪµ¼µ¯ÈƵ¯Ìå×ø±êϵox1¡¢oy1¡¢oz1ÖáµÄת¶¯¹ßÁ¿£¬Mx¡¢My·Ö±ðΪ¹öתÁ¦¾ØºÍÆ«º½Á¦¾Ø£¬Y¡¢Z·Ö±ðΪµ¯ÉϵÄ×Ü¿ÕÆø¶¯Á¦ÑØËÙ¶È×ø±êϵ·Ö½âµÄÉýÁ¦¡¢²àÏòÁ¦£¬ωx¡¢ωy¡¢ωz·Ö±ðΪµ¼µ¯ÈƵ¯Ìå×ø±êϵox1¡¢oy1¡¢oz1ÖáµÄ½ÇËٶȡ£
2.2 ¶æ»úÄ£ÐÍ
2.2.1 µç¶¯»úÄ£Ðͽ¨Á¢
µç¶¯»ú¿ØÖÆÔÀíͼÈçͼ1Ëùʾ¡£
Éè¼õËÙ±Èi£¬×Üת¶¯¹ßÁ¿J£¬Á¦¾ØM£¬ÊäÈëµçѹu£¬µçÁ÷I£¬µç¸ÐL£¬µç×èR£¬¹ÄÂֵĽÇËÙ¶ÈÓëת½Ç·Ö±ðΪωºÍδk£¬¶æÆ«½Ç䣬µç¶¯¶æ»úµÄÁ¦¾ØÌØÐÔ½üËÆΪA£¬»úеÌØÐÔ½üËÆΪ-B£¬MjÊǽÂÁ´Á¦¾Ø£¬Êǵ¥Î»¶æÆ«½Ç²úÉúµÄ½ÂÁ´Á¦¾Ø£¬TM=L/RΪµç¶¯»úµÄµçÆøʱ¼ä³£Êý£¬Ôò¶æ»úÔÚÓÐÔØÇé¿öϵĴ«µÝº¯ÊýΪ£º
2.2.2 ¶æ»Ø·
¶æÃæµÄ½ÂÁ´Á¦¾Ø¶Ô¶æ»úµÄÓ°ÏìºÜ´ó£¬·ÉÐпØÖÆϵͳ²ÉÓñջ·»Ø·Éè¼Æ£¬Ïû³ýÆäÓ°Ïì¡£¶æ»Ø·һ°ã²ÉÓÃλÖúÍËÙ¶ÈÁ½ÖÖ·´À¡²¹³¥·½Ê½Ïû³ý½ÂÁ´Á¦¾Ø¶ÔÆäµÄÓ°Ïì¡£
λÖ÷´À¡µÄ´«µÝº¯ÊýΪ£º
µ±¡£Òò´Ë£¬ÒýÈë½ÏÇ¿·´À¡£¬µç»úÊä³öת½»Õý±ÈÓÚÊäÈëµçѹ£¬Óë·´À¡Á¿³ÉÕý±È£¬¶øÓë½ÂÁ´Á¦¾ØµÄ´óСÎ޹ء£
Ëٶȷ´À¡µÄ´«µÝº¯ÊýΪ£º
¸ù¾ÝÒÔÉÏ·ÖÎö£¬ÒýÈë½ÏÇ¿Ëٶȷ´À¡Ê±£¬Ôòµç»úÊä³ö½ÇËÙ¶ÈÕý±ÈÓÚÊäÈëµçѹ£¬¶øÓë·ÉÐÐ״̬¼´½ÂÁ´Á¦¾ØµÄ´óСÎ޹ء£
Òò´Ë£¬¶æ»úλÖÿØÖÆϵͳµÄϵͳ½á¹¹Èçͼ2Ëùʾ¡£
3 ·ÖͨµÀPID¿ØÖÆ
µ¼µ¯·ÉÐÐ×Ë̬ÊÇͨ¹ý¿ØÖƵ¼µ¯µÄ3¸ö¶æÃæ(¼´Éý½µ¶æ¡¢·½Ïò¶æ¡¢¹ö¶¯¶æ)µÄƫת£¬¸Ä±ä¶æÃæµÄ¿ÕÆø¶¯Á¦ÌØÐÔ£¬ÐγÉΧÈƵ¼µ¯ÖÊÐĵÄÐýת¾Ø£¬ÊµÏÖ·ÉÐÐ×Ë̬µÄ¸Ä±ä¡£½ÇλÖÿØÖÆ·ÖΪ3¸öͨµÀ£¬¸©ÑöͨµÀ(¿ØÖƸ©Ñö½Ç)¡¢Æ«º½Í¨µÀ(¿ØÖÆÆ«º½½Ç)¡¢¹ö¶¯Í¨µÀ(¿ØÖƹö¶¯½Ç)¡£
3.1 ¶æ»úµÄPID¿ØÖÆ
¸ù¾Ýͼ2ËùʾµÄ¶æ»úλÖÿØÖÆϵͳ½á¹¹¿òͼ£¬ÆäÖеçÁ÷»·½Ú²ÉÓõçÁ÷¼Æ·´À¡£¬×ªËÙ·´À¡ÓÃËٲⷢµç»ú£¬Î»Ö÷´À¡Óùâµç±àÂëÆ÷¡£¶æ»ú²ÉÓÃÈý±Õ»·¿ØÖÆÉè¼Æ£¬¼´µçÁ÷»·£¬×ªËÙ»·ºÍλÖû·¡£¿ÉÓÓÁÙ½ç±ÈÀý¶È·¨”³õ²½È·¶¨PID²ÎÊý¡£´Ë·½·¨ÊÊÓÃÓÚÒÑÖª¶ÔÏ󴫵ݺ¯ÊýµÄ³¡ºÏ£¬±ÕºÏµÄ¿ØÖÆϵͳÖн«µ÷½ÚÆ÷ÖÃÓÚ´¿±ÈÀý×÷ÓÃÏ¡£´Ó´óµ½Ð¡Ö𽥸ıäµ÷½ÚÆ÷µÄ±ÈÀý¶È£¬µÃµ½µÈ·ùÕñµ´µÄ¹ý¶É¹ý³Ì¡£´ËʱµÄ±ÈÀý¶È³ÉΪÁÙ½ç±ÈÀý¶Èδk£¬ÏàÁÚÁ½¸ö²¨·å¼äµÄʱ¼ä¼ä¸ô³ÆΪÁÙ½çÕñµ´ÖÜÆÚTk£¬Óɴ˼ÆËã³ö¸÷¸ö²ÎÊý£¬¼´Kp¡¢Ti¡¢TdµÄÖµ¡£
3.2 ×ÝÏòͨµÀ¿ØÖÆ
´«Í³µÄ¿ØÖÆ·½°¸Êǽ«¶æ»ú¼ò»¯ÎªÒ»¸ö·Å´ó»·½Ú£¬ÏµÍ³½ö´æÔÚ½ÇËٶȷ´À¡£¬Æä×ÝÏòͨµÀ´«µÝº¯ÊýΪ£º
ʽÖУ¬KMΪ´«µÝϵÊý£¬TMΪʱ¼ä³£Êý£¬ξMΪÏà¶Ô×èÄáϵÊý£¬T1ΪÆø¶¯Á¦³£Êý¡£
ÔÚÉè¼Æ¾«È·¿¼ÂǶæ»ú»·½ÚµÄ×ÝÏòͨµÀʱ£¬Ðè¼ÓÈëPIDУÕý»·½Ú£¬·ÖÎöϵͳʹÆäÂú×ãÉè¼ÆÒªÇó£¬Í¼3ΪÆä¿ØÖÆϵͳ½á¹¹¿òͼ¡£
3.3 ºáÏòͨµÀ¿ØÖÆ
µ±¹ö¶¯Í¨µÀµÄÊäÈëÖ¸ÁîΪÁãʱ£¬¼´±£³Ö¹ö¶¯½ÇºÍ½ÇËÙ¶ÈΪÁ㣬ÔòÏû³ýÁ˸©ÑöͨµÀºÍÆ«º½Í¨µÀµÄñîºÏ×÷Ó㬿ɷֱð¿ØÖÆ3¸öͨµÀ¡£´Ëʱ£¬¶Ô³Æ½á¹¹µ¼µ¯µÄ¸©ÑöͨµÀºÍÆ«º½Í¨µÀµÄ¿ØÖÆ»ù±¾Ïàͬ¡£
3.4 ¹ö¶¯Í¨µÀ¿ØÖÆ
½«¶æ»ú»·½ÚÒýÈë¹ö¶¯Í¨µÀ£¬Óë×ÝÏòͨµÀ¼°º½ÏòͨµÀÀàËÆ£¬ÒýÈëPIDУÕý»·½Ú£¬·ÖÎöϵͳ£¬Æä½ÇËٶȴ«µÝº¯ÊýΪ£º
ʽÖУ¬KMxΪ´«µÝϵÊý£¬TMxΪÇãбʱ¼ä³£Êý¡£
4 ·ÂÕæ½á¹û
ΪÑéÖ¤¿ØÖÆ·½°¸µÄÕýÈ·ÐԺͿØÖÆЧ¹û£¬Ôò¸ø¶¨ÒÔϵ¼µ¯²ÎÊý£ºKM=0.171 7(1/s)¡¢TM=0.085 0(s)¡¢ξM=0.111 2¡¢T1=6.521 7(s)¡¢KMx=170.778 9¡¢TMx=1.006 3(s)·Ö±ð¶Ô¶æ»úϵͳ¡¢×ÝÏòͨµÀϵͳ¡¢ºáÏòͨµÀϵͳ¡¢¹ö¶¯Í¨µÀϵͳ¼ÓÈ뵥λ½×Ô¾ÐźŽøÐÐÊý×Ö·ÂÕ棬²¢¶Ô´«Í³¿ØÖÆϵͳ½øÐзÂÕ棬¶Ô±È¿ØÖƽá¹û¡£Í¼4Ϊ¶æ»úϵͳʱÓò½×Ô¾ÏìÓ¦ÇúÏß¡£ÓÉͼ4·ÂÕæÇúÏß¿´³ö£¬³¬µ÷Á¿9.5%£¬ÉÏÉýʱ¼ä41.9 ms£¬µ÷½Úʱ¼ä(2%Îó²î´ø)88.8 ms£¬ÎÈ̬Îó²îΪ0¡£
ͼ5Ϊ×ÝÏòͨµÀʱÓò½×Ô¾ÏìÓ¦ÇúÏߣ¬´Óͼ5·ÂÕæÇúÏß¿É¿´³ö£¬ÔÚ¾«È·¿¼ÂǶæ»ú»·½ÚÇé¿öÏ£¬PIDУÕý»·½Ú×ÝÏòͨµÀʱÓò½×Ô¾ÏìÓ¦ÇúÏß·´Ó¦Á¼ºÃ£¬³¬µ÷Á¿11.4%£¬ÉÏÉýʱ¼ä170.6 msµ÷½Úʱ¼ä(2%Îó²î´ø)356.3 ms£¬ÎÈ̬Îó²îΪ0¡£
ͼ6ΪºáÏòͨµÀʱÓò½×Ô¾ÏìÓ¦ÇúÏß¡£´Óͼ6·ÂÕæÇúÏß¿´³ö£¬ÔÚ¾«È·¿¼ÂǶæ»ú»·½ÚÇé¿öÏ£¬PIDУÕý»·½ÚºáÏòͨµÀʱÓò½×Ô¾ÏìÓ¦ÇúÏß·´Ó¦Á¼ºÃ£¬³¬µ÷Á¿11.4%£¬ÉÏÉýʱ¼ä168.3 msµ÷½Úʱ¼ä(2%Îó²î´ø)347.1 ms£¬ÎÈ̬Îó²îΪ0¡£
ͼ7Ϊ¹öתͨµÀʱÓò½×Ô¾ÏìÓ¦ÇúÏß¡£´Óͼ7µÄ·ÂÕæÇúÏß¿É¿´³ö£¬ÔÚ¾«È·¿¼ÂǶæ»ú»·½ÚµÄÇé¿öÏ£¬PIDУÕý»·½Ú¹öתͨµÀµÄʱÓò½×Ô¾ÏìÓ¦ÇúÏß·´Ó¦Á¼ºÃ£¬³¬µ÷Á¿9.81%£¬ÉÏÉýʱ¼äΪ178.6 ms£¬µ÷½Úʱ¼ä(2%Îó²î´ø)397.1 ms£¬ÎÈ̬Îó²îΪ0¡£
5 ½áÂÛ
±¾ÎÄÀûÓÃÁÙ½ç±ÈÀý¶È·¨µÃµ½PID²ÎÊý£¬ÀûÓÃMATLAB/Simulink½øÐÐʱÓò·ÂÕ棬´Ó·ÂÕæ½á¹û¿´£¬¸ÃPID·ÖͨµÀ¿ØÖÆ·½·¨¿ÉÒÔÌá¸ß´«Í³Æø¶¯¶æµ¼µ¯¿ØÖÆϵͳµÄ׼ȷÐÔ¡¢¿ìËÙÐÔ¼°Îȶ¨ÐÔ¡£µ±È»ÕâÖ»ÊǸø³öÓ봫ͳ¿ØÖÆ·½°¸Ïà±È½ÏµÄ½á¹û£¬Êµ¼ÊµÄ²ÎÊý»¹ÒªÔÚʵÎï·ÂÕæÖв»¶Ïµ÷ÊÔ£¬²¢¶Ô¿ØÖÆϵͳÐÞÕý¸Ä½ø£¬ÒԵõ½ÁîÈËÂúÒâµÄ¿ØÖÆЧ¹û¡£·ÂÕæ½á¹û±íÃ÷£¬¸÷ͨµÀϵͳ·´Ó³Á¼ºÃ£¬Äܹ»ÊµÏÖʵʱ¿ØÖÆÒªÇó¡£