TuxMonkey/bf_original_balance_chassis
1
1
Fork 0
mirror of https://gitee.com/dlmu-cone/bf_original_balance_chassis synced 2026-07-25 03:47:47 +08:00
Code Issues Packages Projects Releases Wiki Activity

修改部分参数

Browse Source
This commit is contained in:
kai
2024-03-25 18:02:13 +08:00
parent d5b5c254c4
commit 4542b0bfc3
3 changed files with 15 additions and 15 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
application/chassis/lqr_calc.h
View File

@@ -9,18 +9,18 @@
*/
static void CalcLQR(LinkNPodParam *p, ChassisParam *chassis)
{
float k[12][3] = {85.842511,-168.176021,-4.383994,
-8.011354,-27.544550,0.946791,
40.658824,-34.245857,-13.443024,
33.057883,-37.645803,-8.872245,
186.414265,-182.258244,59.110130,
12.371459,-12.979501,4.575691,
-2.044517,-13.973090,28.443243,
-8.073717,8.553946,2.899594,
109.977348,-109.218563,37.018016,
67.432105,-68.632617,25.883284,
-210.173934,175.310058,96.350481,
-15.827060,13.395116,3.049615};
float k[12][3] = {85.365277,-164.978797,-4.643325,
-7.817260,-26.353895,0.955791,
43.461413,-37.225135,-12.040913,
34.470271,-39.045724,-7.813613,
171.639863,-172.946723,59.632812,
11.281864,-11.926075,4.239721,
-19.517972,1.032904,27.896023,
-10.715152,11.663766,2.651705,
96.039929,-99.227575,36.121143,
56.371947,-60.347262,25.166639,
-213.707672,181.799382,93.194337,
-14.287060,12.217074,3.285836};
float T[2] = {0}; // 0 T_wheel 1 T_hip
float l = p->leg_len;
float lsqr = l * l;