[發明專利]直立車模調試方法

在審

• 申請號: 201710308887.4
• 申請日: 2017-05-04
• 公開（公告）號: CN107024923A
• 公開（公告）日: 2017-08-08
• 發明（設計）人: 許苗;胡珺如;楊瑞琳;莫旭穎;劉澤宇
• 申請（專利權）人: 許苗
• 主分類號: G05B23/02
• 分類號: G05B23/02
• 代理公司: 上海旌勵知識產權代理事務所(普通合伙)31310
• 代理人: 牛傳凱

技術領域

本發明屬于車模調試領域，具體地說是一種直立車模調試方法。

背景技術

車模調試分為調試準備和實際調試兩個過程，精心制作的車模只有通過仔細調整，獲得最優的控制參數和最佳的機械性能才能夠獲得最后的比賽勝利。所以調試對于車模競賽至關重要，同時也非常鍛煉參賽學生的能力。

發明內容

本發明提供一種直立車模調試方法，用以解決現有技術中的缺陷。

本發明通過以下技術方案予以實現：

直立車模調試方法，包括下述步驟：S1調試環境與工具，包括下述步驟：S2 Code Warrior編程與參數設定；S3 傳感器參數調整；S4 傳感器參數-陀螺儀比例調整；S5控制參數調整S6 車模動態參數調整：通過現場的調試，對車模控制參數尋找一組配合最有的數值；S7傳感器機械調整。

如上所述的直立車模調試方法，所述的S1調試環境與工具，包括下述步驟：S1-1調試桌面：在桌面調試環境中可以對車模的傳感器參數以及靜態控制參數進行調整；S1-2測試賽道：在測試賽道上對車模的動態參數以及機械結構進行調整與測試；S1-3車模急停無線遙控開關：由于車模在調試過程中，參數不合適容易造成車模角度和速度失控，容易沖撞環境物體，造成車模的損壞；通過無線遙控開關給出車模緊急停車開關指令，可以減小沖撞的可能性，從而保護與環境；S1-4參數設定與監控軟件：顯示車模實時返回的參數；設定車模各種參數；通過BDM下載器下載車模軟件。

如上所述的直立車模調試方法，所述的S3 傳感器參數調整包括下述步驟：S3-1 零偏確定：車模保持垂直靜止；S3-2 Z軸最小極值：保持車模正面水平靜止；S3-3 Z軸最大極值：保持車模反面水平靜止；S3-4 確定陀螺儀比率：首先設定重力加速度角度補償時間常數Tz在（1-4）之間的某個常數；選擇R_GYRO從0逐步增大，重負以下步驟：保持車模正面傾倒45°，靜止10秒鐘，將車模轉到反面傾倒45°，觀察角度輸出數值或者曲線；找到角度輸出值剛剛不過沖時的R_GYRO為陀螺儀比率的正確數值。

如上所述的直立車模調試方法，所述的傳感器參數-陀螺儀比例調整包括下述步驟： S4-1首先選擇了Rgyro分別為0、0.5，1.0做實驗，判斷Rgyro應該在0～0.5之間；S4-2選擇了Rgyro分別為0. 25，0.75做實驗，判斷Rgyro應該在0. 25 -0.5之間；S4-3選擇了Rgyro分別0.3.0. 35做實驗；判斷Rgyro應該在0. 3—0. 35之間；S4-4選擇Rgyro為0.325，可以判斷該參數比較合適。

如上所述的直立車模調試方法，所述的控制參數調整包括下述步驟：S5-1角度控制：S5-1-1角度控制：參數調整路線一般先設定D=0，逐步增加P參數，直到車模開始發生震蕩；然后逐步增加D以消除震蕩，直到車模開設抖動；然后在適當增加P參數，消除抖動；反復幾次之后便可以找到合適的P，D參數；S5-2速度控制：設定車模給定速度為0；首先增加I參數，直到車模出現來回擺動，然后逐步增加P參數同時適當增加I參數，直到車模在外部干擾作用下可以迅速恢復到平衡點；S5-4輸出死區；S5-5角度測量參數：首先選取T_D參數為較大的值，逐步減少該值，同時適當增加D_ANGLE的數值使得車模在外部干擾的情況下非常穩定。

本發明的優點是：本發明車模在經過制作與初步調試之后，具有直立行走的功能。車模內的控制軟件已經可以采集各個傳感器的信息，可以控制車輪的運行。再準備一些調試工具與調試環境，便可以進行車模的的調整與測試了。

附圖說明

為了更清楚地說明本發明實施例或現有技術中的技術方案，下面將對實施例或現有技術描述中所需要使用的附圖作一簡單地介紹，顯而易見地，下面描述中的附圖是本發明的一些實施例，對于本領域普通技術人員來講，在不付出創造性勞動性的前提下，還可以根據這些附圖獲得其他的附圖。

圖1是本發明的電路框圖；圖2是5V穩壓電路圖；圖3是MC9S12XS128最小單片機系統電路圖；圖4是MOS電機驅動輸出電路圖；圖5是MOS電機驅動輸入電路圖；圖6是OLED顯示電路圖；圖7是撥碼開關按鍵電路圖；圖8是單片機外接端口電路圖；圖9是電機驅動電路圖；圖10是電源穩壓電路圖；圖11是正反向測速模塊電路圖。

具體實施方式