{"id":504004,"date":"2026-11-19T20:40:59","date_gmt":"2026-11-19T17:40:59","guid":{"rendered":"https:\/\/savepearlharbor.com\/?p=504004"},"modified":"2026-11-19T20:40:59","modified_gmt":"2026-11-19T17:40:59","slug":"","status":"publish","type":"post","link":"https:\/\/savepearlharbor.com\/?p=504004","title":{"rendered":"\u041f\u043e\u0447\u0435\u043c\u0443 \u043d\u0435\u043b\u044c\u0437\u044f \u043f\u0440\u043e\u0441\u0442\u043e \u0441\u043e\u0435\u0434\u0438\u043d\u0438\u0442\u044c \u0442\u043e\u0447\u043a\u0438: \u043a\u0430\u043a \u0441\u0433\u0435\u043d\u0435\u0440\u0438\u0440\u043e\u0432\u0430\u0442\u044c \u0441\u0438\u043d\u0442\u0435\u0442\u0438\u0447\u0435\u0441\u043a\u0438\u0439 IMU, \u043a\u043e\u0442\u043e\u0440\u043e\u043c\u0443 \u043f\u043e\u0432\u0435\u0440\u0438\u0442 VIO"},"content":{"rendered":"<div xmlns=\"http:\/\/www.w3.org\/1999\/xhtml\">\n<h3>\u0417\u0430\u0447\u0435\u043c \u0432\u0441\u0451 \u044d\u0442\u043e<\/h3>\n<p>\u042f \u0441\u0433\u0435\u043d\u0435\u0440\u0438\u0440\u043e\u0432\u0430\u043b\u0430 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0438\u0434\u0435\u0430\u043b\u044c\u043d\u043e\u0433\u043e IMU \u2014 \u0431\u0435\u0437 \u0448\u0443\u043c\u0430 \u0438 \u0434\u0440\u0435\u0439\u0444\u0430 \u2014 \u043f\u043e \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438, \u0437\u0430\u0434\u0430\u043d\u043d\u043e\u0439 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u043c\u0438 \u043f\u043e\u0437\u0430\u043c\u0438 \u0438 \u0441\u0444\u0435\u0440\u0438\u0447\u0435\u0441\u043a\u043e\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u0435\u0439, \u0438 \u043f\u0440\u043e\u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043b\u0430 \u0438\u0445 \u043e\u0431\u0440\u0430\u0442\u043d\u043e. \u0421\u0440\u0435\u0434\u043d\u0435\u043a\u0432\u0430\u0434\u0440\u0430\u0442\u0438\u0447\u043d\u0430\u044f \u043e\u0448\u0438\u0431\u043a\u0430 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u0437\u0430 10 \u0441\u0435\u043a\u0443\u043d\u0434 \u043f\u043e\u043b\u0443\u0447\u0438\u043b\u0430\u0441\u044c \u043e\u043a\u043e\u043b\u043e 8 \u043c\u0435\u0442\u0440\u043e\u0432. \u041f\u043e\u0432\u044b\u0448\u0435\u043d\u0438\u0435 \u0447\u0430\u0441\u0442\u043e\u0442\u044b \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u0441 50 \u0434\u043e 1600 \u0413\u0446 \u0435\u0451 \u043d\u0435 \u0443\u043c\u0435\u043d\u044c\u0448\u0438\u043b\u043e.<\/p>\n<p>\u0421 \u0434\u0440\u0443\u0433\u043e\u0439 \u043c\u043e\u0434\u0435\u043b\u044c\u044e \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0442\u0430 \u0436\u0435 \u043f\u0440\u043e\u0432\u0435\u0440\u043a\u0430 \u043f\u0440\u0438 200 \u0413\u0446 \u0434\u0430\u0451\u0442 \u043e\u0442 10 \u0441\u043c \u0434\u043e 10\u207b\u00b9\u00b9 \u043c \u2014 \u0432 \u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e\u0441\u0442\u0438 \u043e\u0442 \u0441\u0445\u0435\u043c\u044b \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f. \u0413\u043b\u0430\u0432\u043d\u043e\u0435 \u0434\u0430\u0436\u0435 \u043d\u0435 \u0441\u0430\u043c\u0438 \u0447\u0438\u0441\u043b\u0430, \u0430 \u0442\u043e, \u0447\u0442\u043e \u043e\u0448\u0438\u0431\u043a\u0430 \u0443\u043c\u0435\u043d\u044c\u0448\u0430\u0435\u0442\u0441\u044f \u0441 \u0448\u0430\u0433\u043e\u043c \u0442\u0430\u043a, \u043a\u0430\u043a \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u043e \u0434\u0430\u043d\u043d\u043e\u0439 \u0441\u0445\u0435\u043c\u0435. \u042d\u0442\u0430 \u0441\u0442\u0430\u0442\u044c\u044f \u043e \u0442\u043e\u043c, \u043e\u0442\u043a\u0443\u0434\u0430 \u0442\u0430\u043a\u0430\u044f \u0440\u0430\u0437\u043d\u0438\u0446\u0430.<\/p>\n<p>\u0410\u043b\u0433\u043e\u0440\u0438\u0442\u043c\u044b \u0432\u0438\u0437\u0443\u0430\u043b\u044c\u043d\u043e-\u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u043e\u0439 \u043e\u0434\u043e\u043c\u0435\u0442\u0440\u0438\u0438 (VIO) \u0438 SLAM \u2014 VINS-Mono [1], ORB-SLAM3 [2], OpenVINS [3] \u2014 \u043e\u0446\u0435\u043d\u0438\u0432\u0430\u044e\u0442 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e \u0438\u0437\u043e\u0431\u0440\u0430\u0436\u0435\u043d\u0438\u044f\u043c \u0438 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f\u043c \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u043e\u0433\u043e \u0431\u043b\u043e\u043a\u0430: \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0438 \u0433\u0438\u0440\u043e\u0441\u043a\u043e\u043f\u0430. \u0427\u0442\u043e\u0431\u044b \u0438\u0445 \u0441\u0440\u0430\u0432\u043d\u0438\u0432\u0430\u0442\u044c \u0438 \u043e\u0442\u043b\u0430\u0436\u0438\u0432\u0430\u0442\u044c, \u043d\u0443\u0436\u043d\u044b \u0434\u0430\u043d\u043d\u044b\u0435 \u0441 \u0442\u043e\u0447\u043d\u043e \u0438\u0437\u0432\u0435\u0441\u0442\u043d\u043e\u0439 \u0438\u0441\u0442\u0438\u043d\u043d\u043e\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0435\u0439.<\/p>\n<p>\u0412 \u0440\u0435\u0430\u043b\u044c\u043d\u044b\u0445 \u043d\u0430\u0431\u043e\u0440\u0430\u0445 \u0432\u0440\u043e\u0434\u0435 EuRoC [4] \u0438 TUM VI [5] \u044d\u0442\u0430\u043b\u043e\u043d \u0441\u043d\u044f\u0442 \u0432\u043d\u0435\u0448\u043d\u0435\u0439 \u0441\u0438\u0441\u0442\u0435\u043c\u043e\u0439: \u0437\u0430\u0445\u0432\u0430\u0442\u0430 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f \u0438\u043b\u0438, \u0432 \u0447\u0430\u0441\u0442\u0438 \u0441\u0435\u0440\u0438\u0439 EuRoC, \u043b\u0430\u0437\u0435\u0440\u043d\u044b\u043c \u0442\u0440\u0435\u043a\u0435\u0440\u043e\u043c, \u043a\u043e\u0442\u043e\u0440\u044b\u0439 \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 \u0442\u043e\u043b\u044c\u043a\u043e \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435. \u042d\u0442\u0430\u043b\u043e\u043d \u0434\u043e\u0441\u0442\u0443\u043f\u0435\u043d \u0442\u043e\u043b\u044c\u043a\u043e \u0432 \u0437\u043e\u043d\u0435 \u0434\u0435\u0439\u0441\u0442\u0432\u0438\u044f \u044d\u0442\u043e\u0439 \u0441\u0438\u0441\u0442\u0435\u043c\u044b \u0438 \u0441\u0430\u043c \u0441\u043e\u0434\u0435\u0440\u0436\u0438\u0442 \u043f\u043e\u0433\u0440\u0435\u0448\u043d\u043e\u0441\u0442\u044c. \u041a \u0442\u043e\u043c\u0443 \u0436\u0435 \u0443\u0441\u043b\u043e\u0432\u0438\u044f \u0437\u0430\u043f\u0438\u0441\u0438 \u0437\u0430\u0444\u0438\u043a\u0441\u0438\u0440\u043e\u0432\u0430\u043d\u044b: \u043d\u0435\u043b\u044c\u0437\u044f \u0432\u0437\u044f\u0442\u044c \u0442\u0443 \u0436\u0435 \u0437\u0430\u043f\u0438\u0441\u044c \u0438 \u043e\u0442\u0434\u0435\u043b\u044c\u043d\u043e \u043f\u043e\u043c\u0435\u043d\u044f\u0442\u044c \u0448\u0443\u043c \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u0438\u043b\u0438 \u0440\u0430\u0441\u0441\u0442\u043e\u044f\u043d\u0438\u0435 \u043c\u0435\u0436\u0434\u0443 \u043a\u0430\u043c\u0435\u0440\u043e\u0439 \u0438 IMU. \u0412 \u0441\u0438\u043d\u0442\u0435\u0442\u0438\u0447\u0435\u0441\u043a\u0438\u0445 \u0434\u0430\u043d\u043d\u044b\u0445 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u0437\u0430\u0434\u0430\u0451\u0442\u0441\u044f \u043f\u0440\u043e\u0433\u0440\u0430\u043c\u043c\u043d\u043e, \u0438 \u0432\u0441\u0435 \u043f\u0430\u0440\u0430\u043c\u0435\u0442\u0440\u044b \u043c\u0435\u043d\u044f\u044e\u0442\u0441\u044f \u043d\u0435\u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e.<\/p>\n<p>\u0421\u0438\u043d\u0442\u0435\u0442\u0438\u043a\u0430 \u043f\u043e\u043b\u0435\u0437\u043d\u0430, \u0442\u043e\u043b\u044c\u043a\u043e \u0435\u0441\u043b\u0438 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0434\u0430\u0442\u0447\u0438\u043a\u043e\u0432 \u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u044b \u0441 \u0437\u0430\u0434\u0430\u043d\u043d\u044b\u043c \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435\u043c, \u0430 \u044d\u0442\u043e \u0437\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0442\u043e\u0433\u043e, \u043a\u0430\u043a \u0438\u043c\u0435\u043d\u043d\u043e \u0437\u0430\u0434\u0430\u043d\u0430 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f. \u042d\u0442\u043e \u0447\u0430\u0441\u0442\u044c \u043c\u043e\u0435\u0439 \u0434\u0438\u043f\u043b\u043e\u043c\u043d\u043e\u0439 \u0440\u0430\u0431\u043e\u0442\u044b \u0432 \u041d\u0418\u0422\u0423 \u00ab\u041c\u0418\u0421\u0418\u0421\u00bb: \u0442\u0430\u043c \u043f\u043e \u0442\u043e\u0439 \u0436\u0435 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0440\u0435\u043d\u0434\u0435\u0440\u044f\u0442\u0441\u044f \u043a\u0430\u0434\u0440\u044b \u0441\u0446\u0435\u043d\u044b, \u0432\u043e\u0441\u0441\u0442\u0430\u043d\u043e\u0432\u043b\u0435\u043d\u043d\u043e\u0439 \u0433\u0430\u0443\u0441\u0441\u043e\u0432\u044b\u043c \u0441\u043f\u043b\u0430\u0442\u0442\u0438\u043d\u0433\u043e\u043c. \u0417\u0434\u0435\u0441\u044c \u0442\u043e\u043b\u044c\u043a\u043e \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u0430\u044f \u0447\u0430\u0441\u0442\u044c.<\/p>\n<h3>\u0427\u0442\u043e \u043d\u0430 \u0441\u0430\u043c\u043e\u043c \u0434\u0435\u043b\u0435 \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 IMU<\/h3>\n<p>\u041f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0437\u0430\u0432\u0438\u0441\u044f\u0442 \u043e\u0442 \u0432\u0442\u043e\u0440\u043e\u0439 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u043e\u0439 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f, \u0430 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0433\u0438\u0440\u043e\u0441\u043a\u043e\u043f\u0430 \u2014 \u043e\u0442 \u043f\u0435\u0440\u0432\u043e\u0439 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u043e\u0439 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438. \u0418\u0437 \u044d\u0442\u043e\u0433\u043e \u0441\u043b\u0435\u0434\u0443\u044e\u0442 \u0432\u0441\u0435 \u0442\u0440\u0435\u0431\u043e\u0432\u0430\u043d\u0438\u044f \u043a \u043c\u043e\u0434\u0435\u043b\u0438 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f.<\/p>\n<p>\u0412\u0432\u0435\u0434\u0443 \u0442\u0440\u0438 \u0441\u0438\u0441\u0442\u0435\u043c\u044b \u043a\u043e\u043e\u0440\u0434\u0438\u043d\u0430\u0442: \u043c\u0438\u0440 W (\u043e\u0441\u044c z \u0432\u0432\u0435\u0440\u0445), IMU B \u0438 \u043a\u0430\u043c\u0435\u0440\u0430 C. \u041c\u0430\u0442\u0440\u0438\u0446\u0430 R_XY \u043f\u0435\u0440\u0435\u0432\u043e\u0434\u0438\u0442 \u043a\u043e\u043e\u0440\u0434\u0438\u043d\u0430\u0442\u044b \u0438\u0437 \u0441\u0438\u0441\u0442\u0435\u043c\u044b Y \u0432 X, \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0441\u0432\u043e\u0431\u043e\u0434\u043d\u043e\u0433\u043e \u043f\u0430\u0434\u0435\u043d\u0438\u044f g = (0, 0, \u22129,81) \u043c\/\u0441\u00b2. \u0421\u0442\u0430\u043d\u0434\u0430\u0440\u0442\u043d\u0430\u044f \u043c\u043e\u0434\u0435\u043b\u044c \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u0439:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"\\tilde{\\boldsymbol\\omega} = \\boldsymbol\\omega_B + \\mathbf b_g + \\boldsymbol\\eta_g, \\qquad \\tilde{\\mathbf a} = R_{WB}^{\\mathsf T}\\,(\\ddot{\\mathbf p}_{WB} - \\mathbf g) + \\mathbf b_a + \\boldsymbol\\eta_a\" alt=\"\\tilde{\\boldsymbol\\omega} = \\boldsymbol\\omega_B + \\mathbf b_g + \\boldsymbol\\eta_g, \\qquad \\tilde{\\mathbf a} = R_{WB}^{\\mathsf T}\\,(\\ddot{\\mathbf p}_{WB} - \\mathbf g) + \\mathbf b_a + \\boldsymbol\\eta_a\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/9\/9a\/9af\/9afc276a28cdec61e1b26244f2af3ea8.svg\" width=\"429\" height=\"22\" data-width=\"53.645\" data-height=\"2.702\" data-vertical-align=\"-0.786\" style=\"width: 53.645ex; height: 2.702ex; vertical-align: -0.786ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/9\/9a\/9af\/9afc276a28cdec61e1b26244f2af3ea8.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/9\/9a\/9af\/9afc276a28cdec61e1b26244f2af3ea8.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u0417\u0434\u0435\u0441\u044c b \u2014 \u043c\u0435\u0434\u043b\u0435\u043d\u043d\u043e \u0443\u043f\u043b\u044b\u0432\u0430\u044e\u0449\u0438\u0435 \u0441\u043c\u0435\u0449\u0435\u043d\u0438\u044f \u043d\u0443\u043b\u044f, \u03b7 \u2014 \u0431\u0435\u043b\u044b\u0439 \u0448\u0443\u043c. \u0414\u043b\u044f \u0440\u0430\u0437\u0433\u043e\u0432\u043e\u0440\u0430 \u043e \u043c\u043e\u0434\u0435\u043b\u0438 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f \u0438\u0445 \u043c\u043e\u0436\u043d\u043e \u0441\u0447\u0438\u0442\u0430\u0442\u044c \u043d\u0443\u043b\u0435\u0432\u044b\u043c\u0438: \u0432\u0441\u0435 \u043f\u0440\u043e\u0431\u043b\u0435\u043c\u044b \u043d\u0438\u0436\u0435 \u0432\u043e\u0437\u043d\u0438\u043a\u0430\u044e\u0442 \u0438 \u0431\u0435\u0437 \u043d\u0438\u0445.<\/p>\n<p>\u0410\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 \u043d\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435, \u0430 \u0443\u0434\u0435\u043b\u044c\u043d\u0443\u044e \u0441\u0438\u043b\u0443: \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043c\u0438\u043d\u0443\u0441 g, \u043f\u043e\u0432\u0451\u0440\u043d\u0443\u0442\u043e\u0435 \u0432 \u0441\u0438\u0441\u0442\u0435\u043c\u0443 \u0434\u0430\u0442\u0447\u0438\u043a\u0430. \u041d\u0435\u043f\u043e\u0434\u0432\u0438\u0436\u043d\u044b\u0439 \u0434\u0430\u0442\u0447\u0438\u043a \u043d\u0430 \u0441\u0442\u043e\u043b\u0435 \u043f\u043e\u043a\u0430\u0437\u044b\u0432\u0430\u0435\u0442 +9,81 \u043c\/\u0441\u00b2 \u0432\u0432\u0435\u0440\u0445, \u0430 \u043f\u0430\u0434\u0430\u044e\u0449\u0438\u0439 \u2014 \u043d\u043e\u043b\u044c.<\/p>\n<p>\u0413\u0438\u0440\u043e\u0441\u043a\u043e\u043f \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 \u0443\u0433\u043b\u043e\u0432\u0443\u044e \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u03c9. \u041e\u043d\u0430 \u0441\u0432\u044f\u0437\u0430\u043d\u0430 \u0441 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u043e\u0439 \u043c\u0430\u0442\u0440\u0438\u0446\u044b \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430 \u0441\u043e\u043e\u0442\u043d\u043e\u0448\u0435\u043d\u0438\u0435\u043c<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"[\\boldsymbol\\omega]_\\times = R^{\\mathsf T}\\dot R\" alt=\"[\\boldsymbol\\omega]_\\times = R^{\\mathsf T}\\dot R\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/7\/75\/75f\/75f35fa104546759a127d7d76b598339.svg\" width=\"96\" height=\"23\" data-width=\"12.043\" data-height=\"2.846\" data-vertical-align=\"-0.857\" style=\"width: 12.043ex; height: 2.846ex; vertical-align: -0.857ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/7\/75\/75f\/75f35fa104546759a127d7d76b598339.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/7\/75\/75f\/75f35fa104546759a127d7d76b598339.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u0433\u0434\u0435 [\u03c9]\u00d7 \u2014 \u043a\u043e\u0441\u043e\u0441\u0438\u043c\u043c\u0435\u0442\u0440\u0438\u0447\u043d\u0430\u044f \u043c\u0430\u0442\u0440\u0438\u0446\u0430 \u0432\u0435\u043a\u0442\u043e\u0440\u043d\u043e\u0433\u043e \u043f\u0440\u043e\u0438\u0437\u0432\u0435\u0434\u0435\u043d\u0438\u044f. \u041f\u043e\u044d\u0442\u043e\u043c\u0443, \u0447\u0442\u043e\u0431\u044b \u0441\u0433\u0435\u043d\u0435\u0440\u0438\u0440\u043e\u0432\u0430\u0442\u044c \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f, \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044e \u043d\u0443\u0436\u043d\u043e \u0443\u043c\u0435\u0442\u044c \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u043e\u0432\u0430\u0442\u044c: \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0434\u0432\u0430\u0436\u0434\u044b, \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044e \u0445\u043e\u0442\u044f \u0431\u044b \u043e\u0434\u0438\u043d \u0440\u0430\u0437. \u041f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u043f\u0440\u0438 \u044d\u0442\u043e\u043c \u0434\u043e\u043b\u0436\u043d\u044b \u0432\u0435\u0441\u0442\u0438 \u0441\u0435\u0431\u044f \u043a\u0430\u043a \u0443 \u0444\u0438\u0437\u0438\u0447\u0435\u0441\u043a\u043e\u0433\u043e \u0442\u0435\u043b\u0430, \u0431\u0435\u0437 \u0441\u043a\u0430\u0447\u043a\u043e\u0432, \u043a\u043e\u0442\u043e\u0440\u044b\u0445 \u0432 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0438 \u043d\u0435 \u0431\u044b\u043b\u043e.<\/p>\n<p>\u0418 \u043f\u0440\u0430\u043a\u0442\u0438\u0447\u0435\u0441\u043a\u0430\u044f \u0434\u0435\u0442\u0430\u043b\u044c: \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u043b\u0443\u0447\u0448\u0435 \u0441\u0447\u0438\u0442\u0430\u0442\u044c \u0430\u043d\u0430\u043b\u0438\u0442\u0438\u0447\u0435\u0441\u043a\u0438, \u0430 \u043d\u0435 \u043a\u043e\u043d\u0435\u0447\u043d\u044b\u043c\u0438 \u0440\u0430\u0437\u043d\u043e\u0441\u0442\u044f\u043c\u0438. \u0418\u043d\u0430\u0447\u0435 \u043f\u043e\u0433\u0440\u0435\u0448\u043d\u043e\u0441\u0442\u044c \u0447\u0438\u0441\u043b\u0435\u043d\u043d\u043e\u0433\u043e \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f \u0441\u043c\u0435\u0448\u0430\u0435\u0442\u0441\u044f \u0441 \u0448\u0443\u043c\u043e\u043c, \u043a\u043e\u0442\u043e\u0440\u044b\u0439 \u043c\u044b \u0441\u0430\u043c\u0438 \u0434\u043e\u0431\u0430\u0432\u043b\u044f\u0435\u043c, \u0438 \u0440\u0430\u0437\u0434\u0435\u043b\u0438\u0442\u044c \u0438\u0445 \u0443\u0436\u0435 \u043d\u0435 \u043f\u043e\u043b\u0443\u0447\u0438\u0442\u0441\u044f.<\/p>\n<h3>\u041f\u0440\u043e\u0441\u0442\u043e \u0441\u043e\u0435\u0434\u0438\u043d\u0438\u0442\u044c \u0442\u043e\u0447\u043a\u0438: \u0447\u0442\u043e \u0438\u0434\u0451\u0442 \u043d\u0435 \u0442\u0430\u043a<\/h3>\n<p>\u0421\u0430\u043c\u044b\u0439 \u043e\u0447\u0435\u0432\u0438\u0434\u043d\u044b\u0439 \u0441\u043f\u043e\u0441\u043e\u0431 \u0437\u0430\u0434\u0430\u0442\u044c \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435 \u2014 \u0432\u0437\u044f\u0442\u044c \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u0437\u044b \u0438 \u0441\u043e\u0435\u0434\u0438\u043d\u0438\u0442\u044c \u0438\u0445: \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u043e\u0442\u0440\u0435\u0437\u043a\u0430\u043c\u0438 \u043f\u0440\u044f\u043c\u044b\u0445, \u043f\u043e\u0432\u043e\u0440\u043e\u0442 \u0441\u0444\u0435\u0440\u0438\u0447\u0435\u0441\u043a\u043e\u0439 \u043b\u0438\u043d\u0435\u0439\u043d\u043e\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u0435\u0439 \u043a\u0432\u0430\u0442\u0435\u0440\u043d\u0438\u043e\u043d\u043e\u0432 (SLERP [6]). \u041d\u0430 \u0430\u043d\u0438\u043c\u0430\u0446\u0438\u0438 \u044d\u0442\u043e \u0432\u044b\u0433\u043b\u044f\u0434\u0438\u0442 \u043d\u043e\u0440\u043c\u0430\u043b\u044c\u043d\u043e, \u043d\u043e \u0434\u0430\u0442\u0447\u0438\u043a\u0438 \u0432\u0438\u0434\u044f\u0442 \u0434\u0440\u0443\u0433\u0443\u044e \u043a\u0430\u0440\u0442\u0438\u043d\u0443.<\/p>\n<ul>\n<li>\n<p>\u0412\u043d\u0443\u0442\u0440\u0438 \u043e\u0442\u0440\u0435\u0437\u043a\u0430 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043f\u043e\u0441\u0442\u043e\u044f\u043d\u043d\u0430 \u0438 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0440\u0430\u0432\u043d\u043e \u043d\u0443\u043b\u044e. \u0410\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u0432\u0438\u0434\u0438\u0442 \u0442\u043e\u043b\u044c\u043a\u043e \u0433\u0440\u0430\u0432\u0438\u0442\u0430\u0446\u0438\u044e (\u0438 \u0446\u0435\u043d\u0442\u0440\u043e\u0441\u0442\u0440\u0435\u043c\u0438\u0442\u0435\u043b\u044c\u043d\u044b\u0439 \u0447\u043b\u0435\u043d, \u0435\u0441\u043b\u0438 \u043a\u0430\u043c\u0435\u0440\u0430 \u0441\u043c\u0435\u0449\u0435\u043d\u0430 \u043e\u0442\u043d\u043e\u0441\u0438\u0442\u0435\u043b\u044c\u043d\u043e IMU).<\/p>\n<\/li>\n<li>\n<p>\u0412 \u0443\u0437\u043b\u0435 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043c\u0435\u043d\u044f\u0435\u0442\u0441\u044f \u043c\u0433\u043d\u043e\u0432\u0435\u043d\u043d\u043e. \u0423\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0432 \u044d\u0442\u043e\u0442 \u043c\u043e\u043c\u0435\u043d\u0442 \u2014 \u0434\u0435\u043b\u044c\u0442\u0430-\u0444\u0443\u043d\u043a\u0446\u0438\u044f, \u0438 \u0434\u0438\u0441\u043a\u0440\u0435\u0442\u043d\u044b\u0439 \u0434\u0430\u0442\u0447\u0438\u043a \u0435\u0451 \u043d\u0435 \u0437\u0430\u043c\u0435\u0447\u0430\u0435\u0442.<\/p>\n<\/li>\n<li>\n<p>\u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043f\u043e\u0441\u0442\u043e\u044f\u043d\u043d\u0430 \u043d\u0430 \u043e\u0442\u0440\u0435\u0437\u043a\u0435 \u0438 \u0441\u043a\u0430\u0447\u0435\u0442 \u0432 \u0443\u0437\u043b\u0430\u0445 \u2014 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u043d\u0430 \u0432\u0435\u0440\u0445\u043d\u0435\u043c \u0433\u0440\u0430\u0444\u0438\u043a\u0435 \u0440\u0438\u0441. 1.<\/p>\n<\/li>\n<\/ul>\n<p>\u0418\u043d\u0442\u0435\u0433\u0440\u0430\u0442\u043e\u0440 \u0442\u0430\u043a\u0438\u0445 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u0439 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u043e\u0432 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0432 \u0443\u0437\u043b\u0430\u0445 \u043d\u0435 \u0432\u0438\u0434\u0438\u0442 \u0438 \u043d\u0430\u0432\u0441\u0435\u0433\u0434\u0430 \u0441\u043e\u0445\u0440\u0430\u043d\u044f\u0435\u0442 \u043d\u0430\u0447\u0430\u043b\u044c\u043d\u0443\u044e \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c. \u041c\u043e\u044f \u0442\u0435\u0441\u0442\u043e\u0432\u0430\u044f \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u2014 \u0432\u043e\u0441\u044c\u043c\u0451\u0440\u043a\u0430 4 \u00d7 3 \u043c \u0441 \u043a\u043e\u043b\u0435\u0431\u0430\u043d\u0438\u044f\u043c\u0438 \u043f\u043e \u0432\u044b\u0441\u043e\u0442\u0435, \u043a\u0440\u0435\u043d\u0443, \u0442\u0430\u043d\u0433\u0430\u0436\u0443 \u0438 \u0440\u044b\u0441\u043a\u0430\u043d\u0438\u044e, 21 \u043a\u043b\u044e\u0447\u0435\u0432\u0430\u044f \u043f\u043e\u0437\u0430 \u0447\u0435\u0440\u0435\u0437 0,5 \u0441, \u0432\u0441\u0435\u0433\u043e 10 \u0441. \u041d\u0430 \u043d\u0435\u0439 \u0441\u0440\u0435\u0434\u043d\u0435\u043a\u0432\u0430\u0434\u0440\u0430\u0442\u0438\u0447\u043d\u0430\u044f \u043e\u0448\u0438\u0431\u043a\u0430 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043e\u043a\u043e\u043b\u043e 8 \u043c \u043f\u0440\u0438 \u043b\u044e\u0431\u043e\u0439 \u0447\u0430\u0441\u0442\u043e\u0442\u0435 IMU. \u042d\u0442\u043e \u043d\u0435 \u043f\u043e\u0433\u0440\u0435\u0448\u043d\u043e\u0441\u0442\u044c, \u043a\u043e\u0442\u043e\u0440\u0430\u044f \u0443\u043c\u0435\u043d\u044c\u0448\u0430\u0435\u0442\u0441\u044f \u0441 \u0448\u0430\u0433\u043e\u043c, \u0430 \u0440\u0430\u0441\u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u0438\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u0439 \u0441 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435\u043c.<\/p>\n<p>\u041e\u0447\u0435\u0432\u0438\u0434\u043d\u0430\u044f \u043f\u043e\u043f\u0440\u0430\u0432\u043a\u0430 \u2014 \u043f\u043b\u0430\u0432\u043d\u0430\u044f \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u044f. \u0414\u043b\u044f \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u0431\u0435\u0440\u0451\u043c \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u043e\u043d\u043d\u044b\u0439 \u0441\u043f\u043b\u0430\u0439\u043d \u0441 \u0437\u0430\u0434\u0430\u043d\u043d\u044b\u043c\u0438 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044f\u043c\u0438 \u043d\u0430 \u043a\u043e\u043d\u0446\u0430\u0445, \u0432 scipy \u044d\u0442\u043e\u00a0<code>CubicSpline(t, p, bc_type=((1, v0), (1, vK)))<\/code>. \u0414\u043b\u044f \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438 \u0431\u0435\u0440\u0451\u043c SQUAD [7] \u2014 \u0441\u0444\u0435\u0440\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0430\u043d\u0430\u043b\u043e\u0433 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u043e\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u0438 \u0438\u0437 \u043a\u043e\u043c\u043f\u044c\u044e\u0442\u0435\u0440\u043d\u043e\u0439 \u0430\u043d\u0438\u043c\u0430\u0446\u0438\u0438 (\u043f\u043e\u043d\u044f\u0442\u043d\u044b\u0439 \u0440\u0430\u0437\u0431\u043e\u0440 \u0435\u0441\u0442\u044c \u0432\u00a0<a href=\"https:\/\/splines.readthedocs.io\/en\/latest\/rotation\/squad.html\" rel=\"noopener nofollow\">\u0434\u043e\u043a\u0443\u043c\u0435\u043d\u0442\u0430\u0446\u0438\u0438 \u0431\u0438\u0431\u043b\u0438\u043e\u0442\u0435\u043a\u0438 splines<\/a>\u00a0[8]). \u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u0441\u0442\u0430\u043d\u043e\u0432\u0438\u0442\u0441\u044f \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0439, \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0438\u0441\u0447\u0435\u0437\u0430\u044e\u0442.<\/p>\n<p>\u041d\u043e \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u03b1 = d\u03c9\/dt \u0443 SQUAD \u0432 \u043a\u0430\u0436\u0434\u043e\u043c \u0443\u0437\u043b\u0435 \u0441\u043a\u0430\u0447\u0435\u0442 (\u043d\u0438\u0436\u043d\u0438\u0439 \u0433\u0440\u0430\u0444\u0438\u043a, \u043e\u0440\u0430\u043d\u0436\u0435\u0432\u0430\u044f \u043f\u0438\u043b\u0430). \u041f\u043e \u043e\u0441\u0438 x \u0441\u0430\u043c\u044b\u0439 \u0431\u043e\u043b\u044c\u0448\u043e\u0439 \u0441\u043a\u0430\u0447\u043e\u043a \u2014 0,11 \u0440\u0430\u0434\/\u0441\u00b2 \u0432 \u0443\u0437\u043b\u0435 t = 9,5 \u0441, \u043f\u0440\u0438 \u0442\u043e\u043c \u0447\u0442\u043e \u0441\u0430\u043c\u043e \u03b1 \u0437\u0434\u0435\u0441\u044c \u043d\u0435 \u043f\u0440\u0435\u0432\u044b\u0448\u0430\u0435\u0442 0,19 \u0440\u0430\u0434\/\u0441\u00b2. \u041f\u043e \u043c\u043e\u0434\u0443\u043b\u044e \u0432\u0435\u043a\u0442\u043e\u0440\u0430 \u0441\u043a\u0430\u0447\u043a\u0438 \u0434\u043e\u0445\u043e\u0434\u044f\u0442 \u0434\u043e 0,12 \u0440\u0430\u0434\/\u0441\u00b2.<\/p>\n<figure class=\"full-width \"><img decoding=\"async\" src=\"https:\/\/habrastorage.org\/r\/w1560\/extt\/ec\/44\/f6\/ec44f6d011ecdf275697c2d9a94d95a9.png\" alt=\"\u0420\u0438\u0441. 1. \u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c (\u0441\u0432\u0435\u0440\u0445\u0443) \u0438 \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 (\u0441\u043d\u0438\u0437\u0443) \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e \u043e\u0441\u0438 x \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438, \u0442\u0440\u0438 \u043c\u043e\u0434\u0435\u043b\u0438 \u043f\u043e \u043e\u0434\u043d\u0438\u043c \u0438 \u0442\u0435\u043c \u0436\u0435 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u043c \u043f\u043e\u0437\u0430\u043c. \u0423 SLERP \u2014 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0432 \u03c9, \u0443 SQUAD \u2014 \u0441\u043a\u0430\u0447\u043a\u0438 \u0432 \u03b1, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043e\u0431\u0430 \u0433\u0440\u0430\u0444\u0438\u043a\u0430 \u0433\u043b\u0430\u0434\u043a\u0438\u0435.\" title=\"\u0420\u0438\u0441. 1. \u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c (\u0441\u0432\u0435\u0440\u0445\u0443) \u0438 \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 (\u0441\u043d\u0438\u0437\u0443) \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e \u043e\u0441\u0438 x \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438, \u0442\u0440\u0438 \u043c\u043e\u0434\u0435\u043b\u0438 \u043f\u043e \u043e\u0434\u043d\u0438\u043c \u0438 \u0442\u0435\u043c \u0436\u0435 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u043c \u043f\u043e\u0437\u0430\u043c. \u0423 SLERP \u2014 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0432 \u03c9, \u0443 SQUAD \u2014 \u0441\u043a\u0430\u0447\u043a\u0438 \u0432 \u03b1, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043e\u0431\u0430 \u0433\u0440\u0430\u0444\u0438\u043a\u0430 \u0433\u043b\u0430\u0434\u043a\u0438\u0435.\" width=\"1520\" height=\"1120\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/r\/w780\/extt\/ec\/44\/f6\/ec44f6d011ecdf275697c2d9a94d95a9.png 780w,&#10;       https:\/\/habrastorage.org\/r\/w1560\/extt\/ec\/44\/f6\/ec44f6d011ecdf275697c2d9a94d95a9.png 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<div><figcaption><em>\u0420\u0438\u0441. 1. \u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c (\u0441\u0432\u0435\u0440\u0445\u0443) \u0438 \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 (\u0441\u043d\u0438\u0437\u0443) \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e \u043e\u0441\u0438 x \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438, \u0442\u0440\u0438 \u043c\u043e\u0434\u0435\u043b\u0438 \u043f\u043e \u043e\u0434\u043d\u0438\u043c \u0438 \u0442\u0435\u043c \u0436\u0435 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u043c \u043f\u043e\u0437\u0430\u043c. \u0423 SLERP \u2014 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0432 \u03c9, \u0443 SQUAD \u2014 \u0441\u043a\u0430\u0447\u043a\u0438 \u0432 \u03b1, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043e\u0431\u0430 \u0433\u0440\u0430\u0444\u0438\u043a\u0430 \u0433\u043b\u0430\u0434\u043a\u0438\u0435.<\/em><\/figcaption><\/div>\n<\/figure>\n<p>\u0423\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043d\u0435 \u0432\u0445\u043e\u0434\u0438\u0442 \u043d\u0438 \u0432 \u043e\u0434\u043d\u0443 \u0438\u0437 \u0444\u043e\u0440\u043c\u0443\u043b \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u0439 \u0432\u044b\u0448\u0435. \u041e\u043d\u043e \u043d\u0430\u0447\u0438\u043d\u0430\u0435\u0442 \u0438\u0433\u0440\u0430\u0442\u044c \u0440\u043e\u043b\u044c, \u043a\u043e\u0433\u0434\u0430 \u043a\u0430\u043c\u0435\u0440\u0430 \u0438 IMU \u0441\u0442\u043e\u044f\u0442 \u0432 \u0440\u0430\u0437\u043d\u044b\u0445 \u043c\u0435\u0441\u0442\u0430\u0445.<\/p>\n<h3>\u041b\u043e\u0432\u0443\u0448\u043a\u0430 \u0440\u044b\u0447\u0430\u0433\u0430<\/h3>\n<p>\u041a\u0430\u043c\u0435\u0440\u0430 \u0438 IMU \u043f\u0440\u0430\u043a\u0442\u0438\u0447\u0435\u0441\u043a\u0438 \u0432\u0441\u0435\u0433\u0434\u0430 \u0441\u0442\u043e\u044f\u0442 \u0432 \u0440\u0430\u0437\u043d\u044b\u0445 \u0442\u043e\u0447\u043a\u0430\u0445. \u0418\u0437-\u0437\u0430 \u044d\u0442\u043e\u0433\u043e \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e\u043f\u0430\u0434\u0430\u0435\u0442 \u043f\u0440\u044f\u043c\u043e \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430.<\/p>\n<p>\u041a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u0437\u044b \u0435\u0441\u0442\u0435\u0441\u0442\u0432\u0435\u043d\u043d\u043e \u0437\u0430\u0434\u0430\u0432\u0430\u0442\u044c \u0434\u043b\u044f \u043a\u0430\u043c\u0435\u0440\u044b: \u0438\u043c\u0435\u043d\u043d\u043e \u043e\u043d\u0430 \u043e\u043f\u0440\u0435\u0434\u0435\u043b\u044f\u0435\u0442, \u0447\u0442\u043e \u0431\u0443\u0434\u0435\u0442 \u0432 \u043a\u0430\u0434\u0440\u0435. IMU \u0436\u0451\u0441\u0442\u043a\u043e \u0437\u0430\u043a\u0440\u0435\u043f\u043b\u0451\u043d \u0440\u044f\u0434\u043e\u043c, \u0432 \u0442\u043e\u0447\u043a\u0435 r \u0432 \u0441\u0438\u0441\u0442\u0435\u043c\u0435 \u043a\u0430\u043c\u0435\u0440\u044b, \u0442\u0430\u043a \u0447\u0442\u043e p_WB = p_WC + R_WC\u00b7r. \u0414\u0432\u0430\u0436\u0434\u044b \u043f\u0440\u043e\u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u0443\u0435\u043c \u0438 \u043f\u043e\u043b\u0443\u0447\u0430\u0435\u043c \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 IMU:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"\\ddot{\\mathbf p}_{WB} = \\ddot{\\mathbf p}_{WC} + R_{WC}\\bigl(\\boldsymbol\\alpha_C\\times\\mathbf r + \\boldsymbol\\omega_C\\times(\\boldsymbol\\omega_C\\times\\mathbf r)\\bigr)\" alt=\"\\ddot{\\mathbf p}_{WB} = \\ddot{\\mathbf p}_{WC} + R_{WC}\\bigl(\\boldsymbol\\alpha_C\\times\\mathbf r + \\boldsymbol\\omega_C\\times(\\boldsymbol\\omega_C\\times\\mathbf r)\\bigr)\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/6\/64\/648\/64863316dc83c4744662962a17935c4c.svg\" width=\"367\" height=\"22\" data-width=\"45.852\" data-height=\"2.713\" data-vertical-align=\"-0.791\" style=\"width: 45.852ex; height: 2.713ex; vertical-align: -0.791ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/6\/64\/648\/64863316dc83c4744662962a17935c4c.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/6\/64\/648\/64863316dc83c4744662962a17935c4c.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u042d\u0442\u043e \u0442\u0430 \u0436\u0435 \u0444\u0438\u0437\u0438\u043a\u0430, \u0447\u0442\u043e \u0443 \u0442\u043e\u0447\u043a\u0438 \u043d\u0430 \u0432\u0440\u0430\u0449\u0430\u044e\u0449\u0435\u043c\u0441\u044f \u0434\u0438\u0441\u043a\u0435: \u0446\u0435\u043d\u0442\u0440\u043e\u0441\u0442\u0440\u0435\u043c\u0438\u0442\u0435\u043b\u044c\u043d\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u03c9\u00d7(\u03c9\u00d7r) \u0438 \u043a\u0430\u0441\u0430\u0442\u0435\u043b\u044c\u043d\u043e\u0435 \u03b1\u00d7r. \u0423\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b \u0432\u0445\u043e\u0434\u0438\u0442 \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0447\u0435\u0440\u0435\u0437 \u0432\u0435\u043a\u0442\u043e\u0440\u043d\u043e\u0435 \u043f\u0440\u043e\u0438\u0437\u0432\u0435\u0434\u0435\u043d\u0438\u0435 \u03b1\u00d7r, \u0442\u043e \u0435\u0441\u0442\u044c \u043f\u0440\u043e\u043f\u043e\u0440\u0446\u0438\u043e\u043d\u0430\u043b\u044c\u043d\u043e \u0434\u043b\u0438\u043d\u0435 \u0440\u044b\u0447\u0430\u0433\u0430. \u041f\u043e\u044d\u0442\u043e\u043c\u0443 \u0441\u043a\u0430\u0447\u043a\u0438 \u03b1 \u0443 SQUAD \u043f\u0440\u0435\u0432\u0440\u0430\u0449\u0430\u044e\u0442\u0441\u044f \u0432 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430.<\/p>\n<p>\u0412 \u043c\u043e\u0451\u043c \u043f\u0440\u0438\u043c\u0435\u0440\u0435 IMU \u0441\u043c\u0435\u0449\u0451\u043d \u043e\u0442\u043d\u043e\u0441\u0438\u0442\u0435\u043b\u044c\u043d\u043e \u043a\u0430\u043c\u0435\u0440\u044b \u043d\u0430 8,5 \u0441\u043c \u0438 \u043f\u043e\u0432\u0451\u0440\u043d\u0443\u0442 \u043d\u0430 10\u00b0. \u0417\u043d\u0430\u0447\u0435\u043d\u0438\u044f \u044f \u0432\u044b\u0431\u0440\u0430\u043b\u0430 \u0441\u0430\u043c\u0430, \u043e\u0440\u0438\u0435\u043d\u0442\u0438\u0440\u0443\u044f\u0441\u044c \u043d\u0430 \u0440\u0430\u0437\u043c\u0435\u0440\u044b \u043d\u0435\u0431\u043e\u043b\u044c\u0448\u043e\u0433\u043e \u0434\u0440\u043e\u043d\u0430. \u041d\u0430 \u043d\u0430\u0441\u0442\u043e\u044f\u0449\u0435\u043c \u0443\u0441\u0442\u0440\u043e\u0439\u0441\u0442\u0432\u0435 \u0441\u043c\u0435\u0449\u0435\u043d\u0438\u0435 \u0431\u0435\u0440\u0451\u0442\u0441\u044f \u0438\u0437 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0438.<\/p>\n<figure class=\"full-width \"><img decoding=\"async\" src=\"https:\/\/habrastorage.org\/r\/w1560\/extt\/4d\/42\/de\/4d42de0c2728c175a07a25d088b2abc8.png\" alt=\"\u0420\u0438\u0441. 2. \u0412\u043a\u043b\u0430\u0434 \u0440\u044b\u0447\u0430\u0433\u0430 \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u043f\u043e \u043e\u0441\u0438 z IMU \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438. \u0423 SQUAD \u0432 \u043a\u0430\u0436\u0434\u043e\u043c \u0443\u0437\u043b\u0435 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0430, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043a\u0440\u0438\u0432\u0430\u044f \u0433\u043b\u0430\u0434\u043a\u0430\u044f.\" title=\"\u0420\u0438\u0441. 2. \u0412\u043a\u043b\u0430\u0434 \u0440\u044b\u0447\u0430\u0433\u0430 \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u043f\u043e \u043e\u0441\u0438 z IMU \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438. \u0423 SQUAD \u0432 \u043a\u0430\u0436\u0434\u043e\u043c \u0443\u0437\u043b\u0435 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0430, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043a\u0440\u0438\u0432\u0430\u044f \u0433\u043b\u0430\u0434\u043a\u0430\u044f.\" width=\"1520\" height=\"720\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/r\/w780\/extt\/4d\/42\/de\/4d42de0c2728c175a07a25d088b2abc8.png 780w,&#10;       https:\/\/habrastorage.org\/r\/w1560\/extt\/4d\/42\/de\/4d42de0c2728c175a07a25d088b2abc8.png 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<div><figcaption><em>\u0420\u0438\u0441. 2. \u0412\u043a\u043b\u0430\u0434 \u0440\u044b\u0447\u0430\u0433\u0430 \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u043f\u043e \u043e\u0441\u0438 z IMU \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438. \u0423 SQUAD \u0432 \u043a\u0430\u0436\u0434\u043e\u043c \u0443\u0437\u043b\u0435 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0430, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043a\u0440\u0438\u0432\u0430\u044f \u0433\u043b\u0430\u0434\u043a\u0430\u044f.<\/em><\/figcaption><\/div>\n<\/figure>\n<p>\u041f\u043e \u043e\u0441\u0438 z \u0441\u0430\u043c\u0430\u044f \u0431\u043e\u043b\u044c\u0448\u0430\u044f \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0430 \u2014 6 \u043c\u043c\/\u0441\u00b2 \u0432 \u0443\u0437\u043b\u0435 t = 0,5 \u0441, \u043f\u043e \u043c\u043e\u0434\u0443\u043b\u044e \u0432\u0435\u043a\u0442\u043e\u0440\u0430 \u2014 \u0434\u043e 6,5 \u043c\u043c\/\u0441\u00b2. \u0421\u0430\u043c \u0432\u043a\u043b\u0430\u0434 \u0440\u044b\u0447\u0430\u0433\u0430 \u0434\u043e\u0445\u043e\u0434\u0438\u0442 \u0434\u043e 11 \u043c\u043c\/\u0441\u00b2. \u042d\u0442\u043e \u043c\u0435\u043d\u044c\u0448\u0435 \u0448\u0443\u043c\u0430 \u043e\u0434\u043d\u043e\u0433\u043e \u043e\u0442\u0441\u0447\u0451\u0442\u0430 MEMS-\u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0443\u0440\u043e\u0432\u043d\u044f \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u0438\u0437 EuRoC: \u043f\u0440\u0438 200 \u0413\u0446 \u0442\u0430\u043c \u0434\u0435\u0441\u044f\u0442\u043a\u0438 \u043c\u043c\/\u0441\u00b2. \u0412 \u0437\u0430\u0448\u0443\u043c\u043b\u0451\u043d\u043d\u044b\u0445 \u0434\u0430\u043d\u043d\u044b\u0445 \u0442\u0430\u043a\u0438\u0435 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0433\u043b\u0430\u0437\u043e\u043c \u043d\u0435 \u0443\u0432\u0438\u0434\u0435\u0442\u044c. \u041d\u043e \u044d\u0442\u043e \u0441\u0438\u0441\u0442\u0435\u043c\u0430\u0442\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0430\u0440\u0442\u0435\u0444\u0430\u043a\u0442: \u043e\u043d \u0440\u0430\u0441\u0442\u0451\u0442 \u0441 \u0434\u043b\u0438\u043d\u043e\u0439 \u0440\u044b\u0447\u0430\u0433\u0430, \u0440\u0435\u0437\u043a\u043e\u0441\u0442\u044c\u044e \u043c\u0430\u043d\u0451\u0432\u0440\u043e\u0432 \u0438 \u0440\u0435\u0434\u043a\u043e\u0441\u0442\u044c\u044e \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0445 \u043f\u043e\u0437. \u0418, \u043a\u0430\u043a \u0431\u0443\u0434\u0435\u0442 \u0432\u0438\u0434\u043d\u043e \u0434\u0430\u043b\u044c\u0448\u0435, \u043e\u043d \u043b\u043e\u043c\u0430\u0435\u0442 \u043f\u0440\u043e\u0432\u0435\u0440\u043a\u0443 \u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u043d\u043e\u0441\u0442\u0438.<\/p>\n<h4>\u0423\u0441\u043b\u043e\u0432\u0438\u0435 \u0433\u043b\u0430\u0434\u043a\u043e\u0441\u0442\u0438<\/h4>\n<p>\u0423\u0442\u0432\u0435\u0440\u0436\u0434\u0435\u043d\u0438\u0435 \u043f\u0440\u043e\u0441\u0442\u043e\u0435, \u043f\u043e \u0441\u0443\u0442\u0438 \u044d\u0442\u043e \u0444\u043e\u0440\u043c\u0430\u043b\u0438\u0437\u0430\u0446\u0438\u044f, \u043d\u043e \u043f\u0440\u0438 \u0441\u043c\u0435\u0449\u0451\u043d\u043d\u043e\u0439 \u043a\u0430\u043c\u0435\u0440\u0435 \u0435\u0433\u043e \u043b\u0435\u0433\u043a\u043e \u0443\u043f\u0443\u0441\u0442\u0438\u0442\u044c. \u041f\u0443\u0441\u0442\u044c \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043a\u0430\u043c\u0435\u0440\u044b \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u0430, \u0430 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u0434\u0432\u0430\u0436\u0434\u044b \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u0443\u0435\u043c\u044b \u043d\u0430 \u043a\u0430\u0436\u0434\u043e\u043c \u043a\u0443\u0441\u043a\u0435 \u043d\u0435\u043a\u043e\u0442\u043e\u0440\u043e\u0433\u043e \u0440\u0430\u0437\u0431\u0438\u0435\u043d\u0438\u044f \u043e\u0442\u0440\u0435\u0437\u043a\u0430 \u0432\u0440\u0435\u043c\u0435\u043d\u0438. \u0422\u043e\u0433\u0434\u0430:<\/p>\n<blockquote>\n<p>\u0418\u0434\u0435\u0430\u043b\u044c\u043d\u044b\u0435 (\u0431\u0435\u0437 \u0448\u0443\u043c\u0430) \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f IMU \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u044b \u043f\u0440\u0438 \u0432\u0441\u0435\u0445 r \u0442\u043e\u0433\u0434\u0430 \u0438 \u0442\u043e\u043b\u044c\u043a\u043e \u0442\u043e\u0433\u0434\u0430, \u043a\u043e\u0433\u0434\u0430 \u0438 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435, \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u0440\u0438\u043d\u0430\u0434\u043b\u0435\u0436\u0430\u0442 \u043a\u043b\u0430\u0441\u0441\u0443 C\u00b2.<\/p>\n<\/blockquote>\n<p>\u0414\u043e\u0441\u0442\u0430\u0442\u043e\u0447\u043d\u043e\u0441\u0442\u044c \u0432\u0438\u0434\u043d\u0430 \u0438\u0437 \u0444\u043e\u0440\u043c\u0443\u043b\u044b \u0432\u044b\u0448\u0435. \u041d\u0435\u043e\u0431\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u044c \u043f\u043e\u043a\u0430\u0437\u044b\u0432\u0430\u0435\u0442\u0441\u044f \u0432 \u0442\u0440\u0438 \u0448\u0430\u0433\u0430:<\/p>\n<ol>\n<li>\n<p>\u0413\u0438\u0440\u043e\u0441\u043a\u043e\u043f \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u0435\u043d, \u0437\u043d\u0430\u0447\u0438\u0442 \u03c9 \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u0430.<\/p>\n<\/li>\n<li>\n<p>\u041f\u0440\u0438 r = 0 \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u0435\u043d, \u0437\u043d\u0430\u0447\u0438\u0442 \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b.<\/p>\n<\/li>\n<li>\n<p>\u0422\u043e\u0433\u0434\u0430 \u043f\u0440\u0438 \u043b\u044e\u0431\u043e\u043c r \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e \u03b1\u00d7r, \u0438\u0437 \u0447\u0435\u0433\u043e \u043f\u043e\u0434\u0441\u0442\u0430\u043d\u043e\u0432\u043a\u043e\u0439 r = e\u2081, e\u2082, e\u2083 \u043f\u043e\u043b\u0443\u0447\u0430\u0435\u043c \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0441\u0442\u044c \u03b1.<\/p>\n<\/li>\n<\/ol>\n<p>\u041d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0441\u0442\u044c \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u0438 \u0432 \u0443\u0441\u043b\u043e\u0432\u0438\u0438 \u0441\u0443\u0449\u0435\u0441\u0442\u0432\u0435\u043d\u043d\u0430. \u0423 \u043e\u0442\u0440\u0435\u0437\u043a\u043e\u0432 \u0441\u043e SLERP \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u0432 \u0443\u0437\u043b\u0430\u0445 \u0441\u043a\u0430\u0447\u0435\u0442, \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0441\u043e\u0434\u0435\u0440\u0436\u0438\u0442 \u03b4-\u0444\u0443\u043d\u043a\u0446\u0438\u044e, \u0438 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0432\u043e\u043e\u0431\u0449\u0435 \u043d\u0435 \u043e\u043f\u0440\u0435\u0434\u0435\u043b\u0435\u043d\u044b \u043a\u0430\u043a \u0444\u0443\u043d\u043a\u0446\u0438\u0438. \u042d\u0442\u0430 \u043c\u043e\u0434\u0435\u043b\u044c \u043f\u043e\u0434 \u0443\u0442\u0432\u0435\u0440\u0436\u0434\u0435\u043d\u0438\u0435 \u043d\u0435 \u043f\u043e\u0434\u043f\u0430\u0434\u0430\u0435\u0442.<\/p>\n<p>\u0421\u043b\u043e\u0432\u0430 \u00ab\u043f\u0440\u0438 \u0432\u0441\u0435\u0445 r\u00bb \u0442\u043e\u0436\u0435 \u0432\u0430\u0436\u043d\u044b. \u041f\u0440\u0438 \u043e\u0434\u043d\u043e\u043c \u0444\u0438\u043a\u0441\u0438\u0440\u043e\u0432\u0430\u043d\u043d\u043e\u043c r \u043d\u0435 \u043e\u0431\u044f\u0437\u0430\u0442\u0435\u043b\u044c\u043d\u044b \u043d\u0438 C\u00b2 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438, \u043d\u0438 \u0434\u0430\u0436\u0435 C\u00b2 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b: \u0441\u043a\u0430\u0447\u043e\u043a \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b \u043c\u043e\u0436\u0435\u0442 \u043a\u043e\u043c\u043f\u0435\u043d\u0441\u0438\u0440\u043e\u0432\u0430\u0442\u044c\u0441\u044f \u0441\u043a\u0430\u0447\u043a\u043e\u043c \u03b1\u00d7r. \u0422\u043e\u0447\u043d\u043e\u0435 \u0443\u0441\u043b\u043e\u0432\u0438\u0435 \u0434\u043b\u044f \u0444\u0438\u043a\u0441\u0438\u0440\u043e\u0432\u0430\u043d\u043d\u043e\u0433\u043e r \u2014 \u0433\u043b\u0430\u0434\u043a\u043e\u0441\u0442\u044c \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0441\u0430\u043c\u043e\u0433\u043e IMU: \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u043a\u043b\u0430\u0441\u0441\u0430 C\u00b2, \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u043a\u043b\u0430\u0441\u0441\u0430 C\u00b9.<\/p>\n<blockquote>\n<p>\u0418\u043c\u0435\u043d\u043d\u043e \u0442\u0430\u043a \u0443\u0441\u0442\u0440\u043e\u0435\u043d \u0441\u0438\u043c\u0443\u043b\u044f\u0442\u043e\u0440 OpenVINS [3]: \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u0437\u0430\u0434\u0430\u043d\u0430 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u043c B-\u0441\u043f\u043b\u0430\u0439\u043d\u043e\u043c \u043d\u0430 SE(3) \u0434\u043b\u044f \u0441\u0438\u0441\u0442\u0435\u043c\u044b IMU, \u0438 \u0432 \u0434\u043e\u043a\u0443\u043c\u0435\u043d\u0442\u0430\u0446\u0438\u0438 \u043f\u0440\u044f\u043c\u043e \u0441\u043a\u0430\u0437\u0430\u043d\u043e, \u0447\u0442\u043e \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0441\u043f\u043b\u0430\u0439\u043d \u0432\u044b\u0431\u0440\u0430\u043d \u0440\u0430\u0434\u0438 C\u00b2 \u0434\u043b\u044f \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u044b\u0445 \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u0439 (\u0441\u043c.\u00a0<a href=\"https:\/\/docs.ros.org\/en\/api\/ov_msckf\/html\/Simulator_8cpp_source.html\" rel=\"noopener nofollow\">Simulator.cpp<\/a>,\u00a0<a href=\"https:\/\/yuhaozhang7.github.io\/openvins-slamfuse\/classov__core_1_1BsplineSE3.html\" rel=\"noopener nofollow\">\u043e\u043f\u0438\u0441\u0430\u043d\u0438\u0435 \u043a\u043b\u0430\u0441\u0441\u0430 BsplineSE3<\/a>\u00a0\u0438 Python-\u043f\u043e\u0440\u0442\u00a0<a href=\"https:\/\/decargroup.github.io\/navlie\/_build\/html\/_autosummary\/navlie.bspline.html\" rel=\"noopener nofollow\">navlie.bspline<\/a>[9]). \u041f\u0440\u043e\u0431\u043b\u0435\u043c\u0430 \u0440\u044b\u0447\u0430\u0433\u0430 \u0442\u0430\u043c \u043d\u0435 \u0432\u043e\u0437\u043d\u0438\u043a\u0430\u0435\u0442.<\/p>\n<\/blockquote>\n<p>\u041f\u043e\u0447\u0435\u043c\u0443 \u0431\u044b \u043d\u0435 \u0441\u0434\u0435\u043b\u0430\u0442\u044c \u0442\u0430\u043a \u0436\u0435? \u041c\u043d\u0435 \u043d\u0443\u0436\u043d\u044b \u043a\u0430\u0434\u0440\u044b, \u043e\u0442\u0440\u0435\u043d\u0434\u0435\u0440\u0435\u043d\u043d\u044b\u0435 \u0433\u0430\u0443\u0441\u0441\u043e\u0432\u044b\u043c \u0441\u043f\u043b\u0430\u0442\u0442\u0438\u043d\u0433\u043e\u043c, \u0430 \u0440\u0435\u043d\u0434\u0435\u0440 \u2014 \u0441\u0430\u043c\u0430\u044f \u0434\u043e\u0440\u043e\u0433\u0430\u044f \u0447\u0430\u0441\u0442\u044c. \u0415\u0441\u043b\u0438 \u0441\u043f\u043b\u0430\u0439\u043d \u0437\u0430\u0434\u0430\u043d \u0434\u043b\u044f \u043a\u0430\u043c\u0435\u0440\u044b, \u043e\u0434\u043d\u0430\u0436\u0434\u044b \u043e\u0442\u0440\u0435\u043d\u0434\u0435\u0440\u0435\u043d\u043d\u044b\u0435 \u043a\u0430\u0434\u0440\u044b \u043c\u043e\u0436\u043d\u043e \u0438\u0441\u043f\u043e\u043b\u044c\u0437\u043e\u0432\u0430\u0442\u044c \u0441 \u0440\u0430\u0437\u043d\u044b\u043c\u0438 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0430\u043c\u0438 \u043a\u0430\u043c\u0435\u0440\u0430\u2013IMU: \u043c\u0435\u043d\u044f\u044e\u0442\u0441\u044f \u0442\u043e\u043b\u044c\u043a\u043e \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f IMU. \u0415\u0441\u043b\u0438 \u0441\u043f\u043b\u0430\u0439\u043d \u0437\u0430\u0434\u0430\u043d \u0434\u043b\u044f IMU, \u043f\u0440\u0438 \u0441\u043c\u0435\u043d\u0435 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0438 \u043c\u0435\u043d\u044f\u0435\u0442\u0441\u044f \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b, \u0438 \u0440\u0435\u043d\u0434\u0435\u0440\u0438\u0442\u044c \u043f\u0440\u0438\u0445\u043e\u0434\u0438\u0442\u0441\u044f \u0437\u0430\u043d\u043e\u0432\u043e. \u041f\u043b\u0430\u0442\u0430 \u0437\u0430 \u0442\u0430\u043a\u043e\u0439 \u0432\u044b\u0431\u043e\u0440 \u2014 \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0432 \u0444\u043e\u0440\u043c\u0443\u043b\u0435 \u0440\u044b\u0447\u0430\u0433\u0430 \u0438 \u0442\u0440\u0435\u0431\u043e\u0432\u0430\u043d\u0438\u0435 C\u00b2 \u043a \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438.<\/p>\n<h3>\u0420\u0435\u0448\u0435\u043d\u0438\u0435: B-\u0441\u043f\u043b\u0430\u0439\u043d\u044b \u0432 R\u00b3 \u0438 \u043d\u0430 SO(3)<\/h3>\n<p>\u041d\u0443\u0436\u043d\u0430 \u043c\u043e\u0434\u0435\u043b\u044c, \u0432 \u043a\u043e\u0442\u043e\u0440\u043e\u0439 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u043f\u0440\u0438\u043d\u0430\u0434\u043b\u0435\u0436\u0430\u0442 C\u00b2, \u0430 \u0432\u0441\u0435 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u0441\u0447\u0438\u0442\u0430\u044e\u0442\u0441\u044f \u043f\u043e \u0444\u043e\u0440\u043c\u0443\u043b\u0430\u043c. \u041e\u0431\u0430 \u0442\u0440\u0435\u0431\u043e\u0432\u0430\u043d\u0438\u044f \u0432\u044b\u043f\u043e\u043b\u043d\u044f\u0435\u0442 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 B-\u0441\u043f\u043b\u0430\u0439\u043d. \u0418\u0434\u0435\u044f \u043d\u0435 \u043d\u043e\u0432\u0430\u044f. \u041f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u044b\u0445 \u0434\u0430\u0442\u0447\u0438\u043a\u043e\u0432 \u043f\u043e \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0439 \u043c\u043e\u0434\u0435\u043b\u0438 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f \u0433\u0435\u043d\u0435\u0440\u0438\u0440\u0443\u0435\u0442, \u043d\u0430\u043f\u0440\u0438\u043c\u0435\u0440, IMUSim [18]. B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430\u043c\u0438 \u0437\u0430\u0434\u0430\u0451\u0442 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044e \u043f\u0430\u043a\u0435\u0442 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0438 Kalibr [10], \u0430 \u0441\u0438\u043c\u0443\u043b\u044f\u0442\u043e\u0440 OpenVINS [3] \u0432\u044b\u0431\u0438\u0440\u0430\u0435\u0442 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0441\u043f\u043b\u0430\u0439\u043d \u0438\u043c\u0435\u043d\u043d\u043e \u0440\u0430\u0434\u0438 C\u00b2. \u041a\u0443\u043c\u0443\u043b\u044f\u0442\u0438\u0432\u043d\u0443\u044e \u0444\u043e\u0440\u043c\u0443 \u043d\u0430 \u0433\u0440\u0443\u043f\u043f\u0435 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u043e\u0432, \u043e \u043a\u043e\u0442\u043e\u0440\u043e\u0439 \u043d\u0438\u0436\u0435, \u0432 \u0432\u0438\u0437\u0443\u0430\u043b\u044c\u043d\u043e-\u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u0443\u044e \u043e\u0446\u0435\u043d\u043a\u0443 \u043f\u0440\u0438\u043d\u0435\u0441\u043b\u0438 Lovegrove, Patron-Perez \u0438 Sibley [11, 12]. \u041d\u043e\u0432\u043e\u0435 \u0437\u0434\u0435\u0441\u044c \u0442\u043e\u043b\u044c\u043a\u043e \u043e\u0434\u043d\u043e: \u043f\u0440\u0438 \u0441\u043c\u0435\u0449\u0451\u043d\u043d\u043e\u0439 \u043a\u0430\u043c\u0435\u0440\u0435 C\u00b2 \u043d\u0443\u0436\u0435\u043d \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438, \u0438 \u044d\u0442\u043e \u0432\u0438\u0434\u043d\u043e \u0432 \u0446\u0438\u0444\u0440\u0430\u0445.<\/p>\n<h4>\u041f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435<\/h4>\n<p>\u041d\u0430 \u043a\u0430\u0436\u0434\u043e\u043c \u043e\u0442\u0440\u0435\u0437\u043a\u0435 \u0432\u0432\u043e\u0434\u0438\u043c \u043b\u043e\u043a\u0430\u043b\u044c\u043d\u044b\u0439 \u043f\u0430\u0440\u0430\u043c\u0435\u0442\u0440 u \u043e\u0442 0 \u0434\u043e 1. \u041f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0437\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0447\u0435\u0442\u044b\u0440\u0451\u0445 \u043a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0445 \u0442\u043e\u0447\u0435\u043a:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"u = \\frac{t - t_i}{\\Delta t},\\qquad \\mathbf p(u) = \\begin{pmatrix}\\mathbf c_i &amp; \\mathbf c_{i+1} &amp; \\mathbf c_{i+2} &amp; \\mathbf c_{i+3}\\end{pmatrix} \\frac16\\begin{pmatrix}1&amp;-3&amp;3&amp;-1\\\\4&amp;0&amp;-6&amp;3\\\\1&amp;3&amp;3&amp;-3\\\\0&amp;0&amp;0&amp;1\\end{pmatrix} \\begin{pmatrix}1\\\\u\\\\u^2\\\\u^3\\end{pmatrix}\" alt=\"u = \\frac{t - t_i}{\\Delta t},\\qquad \\mathbf p(u) = \\begin{pmatrix}\\mathbf c_i &amp; \\mathbf c_{i+1} &amp; \\mathbf c_{i+2} &amp; \\mathbf c_{i+3}\\end{pmatrix} \\frac16\\begin{pmatrix}1&amp;-3&amp;3&amp;-1\\\\4&amp;0&amp;-6&amp;3\\\\1&amp;3&amp;3&amp;-3\\\\0&amp;0&amp;0&amp;1\\end{pmatrix} \\begin{pmatrix}1\\\\u\\\\u^2\\\\u^3\\end{pmatrix}\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/e\/e0\/e0b\/e0be2b49d3629ae78bbfefd44be1685b.svg\" width=\"600\" height=\"97\" data-width=\"75.055\" data-height=\"12.143\" data-vertical-align=\"-5.506\" style=\"width: 75.055ex; height: 12.143ex; vertical-align: -5.506ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/e\/e0\/e0b\/e0be2b49d3629ae78bbfefd44be1685b.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/e\/e0\/e0b\/e0be2b49d3629ae78bbfefd44be1685b.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u0421\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u0438 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0441\u0447\u0438\u0442\u0430\u044e\u0442\u0441\u044f \u043f\u043e \u0442\u043e\u0439 \u0436\u0435 \u0444\u043e\u0440\u043c\u0443\u043b\u0435: \u0432\u043c\u0435\u0441\u0442\u043e \u0441\u0442\u043e\u043b\u0431\u0446\u0430 (1, u, u\u00b2, u\u00b3) \u0431\u0435\u0440\u0451\u043c (0, 1, 2u, 3u\u00b2)\/\u0394t \u0438 (0, 0, 2, 6u)\/\u0394t\u00b2.<\/p>\n<p>\u041a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0435 \u0442\u043e\u0447\u043a\u0438 \u043f\u043e\u0434\u0431\u0438\u0440\u0430\u044e\u0442\u0441\u044f \u0442\u0430\u043a, \u0447\u0442\u043e\u0431\u044b \u0441\u043f\u043b\u0430\u0439\u043d \u043f\u0440\u043e\u0448\u0451\u043b \u0447\u0435\u0440\u0435\u0437 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u0438 \u0438\u043c\u0435\u043b \u0437\u0430\u0434\u0430\u043d\u043d\u044b\u0435 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u0438 \u043d\u0430 \u043a\u043e\u043d\u0446\u0430\u0445:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"\\frac{\\mathbf c_k + 4\\mathbf c_{k+1} + \\mathbf c_{k+2}}{6} = \\mathbf p_k,\\quad k = 0,\\dots,K;\\qquad \\frac{\\mathbf c_2 - \\mathbf c_0}{2\\Delta t} = \\mathbf v_0,\\quad \\frac{\\mathbf c_{K+2} - \\mathbf c_K}{2\\Delta t} = \\mathbf v_K\" alt=\"\\frac{\\mathbf c_k + 4\\mathbf c_{k+1} + \\mathbf c_{k+2}}{6} = \\mathbf p_k,\\quad k = 0,\\dots,K;\\qquad \\frac{\\mathbf c_2 - \\mathbf c_0}{2\\Delta t} = \\mathbf v_0,\\quad \\frac{\\mathbf c_{K+2} - \\mathbf c_K}{2\\Delta t} = \\mathbf v_K\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/5\/54\/54e\/54eb21f03ae61cefd4af5f4757c9188e.svg\" width=\"632\" height=\"37\" data-width=\"78.976\" data-height=\"4.663\" data-vertical-align=\"-1.766\" style=\"width: 78.976ex; height: 4.663ex; vertical-align: -1.766ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/5\/54\/54e\/54eb21f03ae61cefd4af5f4757c9188e.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/5\/54\/54e\/54eb21f03ae61cefd4af5f4757c9188e.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u0423\u0441\u043b\u043e\u0432\u0438\u044f \u043d\u0430 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u0438 \u0441\u0432\u044f\u0437\u044b\u0432\u0430\u044e\u0442 \u0442\u043e\u0447\u043a\u0438 \u0447\u0435\u0440\u0435\u0437 \u043e\u0434\u043d\u0443. \u0418\u0437 \u043d\u0438\u0445 \u0432\u044b\u0440\u0430\u0436\u0430\u0435\u043c \u043a\u0440\u0430\u0439\u043d\u0438\u0435 \u0442\u043e\u0447\u043a\u0438 c\u2080 \u0438 c_{K+2} \u0438 \u043f\u043e\u0434\u0441\u0442\u0430\u0432\u043b\u044f\u0435\u043c \u0432 \u043f\u0435\u0440\u0432\u043e\u0435 \u0438 \u043f\u043e\u0441\u043b\u0435\u0434\u043d\u0435\u0435 \u0443\u0440\u0430\u0432\u043d\u0435\u043d\u0438\u044f. \u041f\u043e\u0441\u043b\u0435 \u044d\u0442\u043e\u0433\u043e \u0441\u0438\u0441\u0442\u0435\u043c\u0430 \u043e\u0442\u043d\u043e\u0441\u0438\u0442\u0435\u043b\u044c\u043d\u043e c\u2081, \u2026, c_{K+1} \u0441\u0442\u0430\u043d\u043e\u0432\u0438\u0442\u0441\u044f \u0442\u0440\u0451\u0445\u0434\u0438\u0430\u0433\u043e\u043d\u0430\u043b\u044c\u043d\u043e\u0439 \u0441\u043e \u0441\u0442\u0440\u043e\u0433\u0438\u043c \u0434\u0438\u0430\u0433\u043e\u043d\u0430\u043b\u044c\u043d\u044b\u043c \u043f\u0440\u0435\u043e\u0431\u043b\u0430\u0434\u0430\u043d\u0438\u0435\u043c. \u0420\u0435\u0448\u0435\u043d\u0438\u0435 \u0435\u0434\u0438\u043d\u0441\u0442\u0432\u0435\u043d\u043d\u043e\u0435 \u0438 \u043d\u0430\u0445\u043e\u0434\u0438\u0442\u0441\u044f \u043f\u0440\u043e\u0433\u043e\u043d\u043a\u043e\u0439.<\/p>\n<p>\u041f\u043e\u043b\u0443\u0447\u0435\u043d\u043d\u0430\u044f \u043a\u0440\u0438\u0432\u0430\u044f \u0441\u043e\u0432\u043f\u0430\u0434\u0430\u0435\u0442 \u0441\u00a0<code>CubicSpline<\/code>\u00a0\u0438\u0437 scipy \u0441 \u0442\u0435\u043c\u0438 \u0436\u0435 \u043a\u0440\u0430\u0435\u0432\u044b\u043c\u0438 \u0443\u0441\u043b\u043e\u0432\u0438\u044f\u043c\u0438,\u00a0<code>bc_type=((1, v0), (1, vK))<\/code>: \u0440\u0430\u0441\u0445\u043e\u0436\u0434\u0435\u043d\u0438\u0435 4\u00b710\u207b\u00b9\u2076 \u043c, \u043c\u0430\u0448\u0438\u043d\u043d\u044b\u0439 \u043d\u043e\u043b\u044c. \u0421 \u043a\u0440\u0430\u0435\u0432\u044b\u043c \u0443\u0441\u043b\u043e\u0432\u0438\u0435\u043c \u043f\u043e \u0443\u043c\u043e\u043b\u0447\u0430\u043d\u0438\u044e (not-a-knot) \u043a\u0440\u0438\u0432\u0430\u044f \u0431\u0443\u0434\u0435\u0442 \u0434\u0440\u0443\u0433\u043e\u0439, \u0442\u0430\u043a \u0447\u0442\u043e \u0443\u0441\u043b\u043e\u0432\u0438\u044f \u043d\u0430 \u043a\u043e\u043d\u0446\u0430\u0445 \u043d\u0443\u0436\u043d\u043e \u0437\u0430\u0434\u0430\u0442\u044c \u044f\u0432\u043d\u043e. \u041f\u043e\u043b\u0443\u0447\u0430\u0435\u0442\u0441\u044f, \u0447\u0442\u043e \u0441 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435\u043c \u0438 \u0440\u0430\u043d\u044c\u0448\u0435 \u0432\u0441\u0451 \u0431\u044b\u043b\u043e \u0445\u043e\u0440\u043e\u0448\u043e. \u0412\u0441\u044f \u0440\u0430\u0437\u043d\u0438\u0446\u0430 \u043c\u0435\u0436\u0434\u0443 \u00ab\u0441\u043f\u043b\u0430\u0439\u043d + SQUAD\u00bb \u0438 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430\u043c\u0438 \u2014 \u0432 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438.<\/p>\n<h4>\u041e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f<\/h4>\n<p>\u0421 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430\u043c\u0438 \u0442\u0430\u043a \u043f\u0440\u044f\u043c\u043e \u043d\u0435 \u043f\u043e\u043b\u0443\u0447\u0438\u0442\u0441\u044f: \u0432\u0437\u0432\u0435\u0448\u0435\u043d\u043d\u0430\u044f \u0441\u0443\u043c\u043c\u0430 \u043c\u0430\u0442\u0440\u0438\u0446 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u043e\u043c \u043d\u0435 \u0431\u0443\u0434\u0435\u0442. \u041f\u043e\u043c\u043e\u0433\u0430\u0435\u0442 \u043a\u0443\u043c\u0443\u043b\u044f\u0442\u0438\u0432\u043d\u0430\u044f \u0444\u043e\u0440\u043c\u0430 [13]. \u0421\u0443\u043c\u043c\u0443 \u0442\u043e\u0447\u0435\u043a \u043f\u0435\u0440\u0435\u043f\u0438\u0441\u044b\u0432\u0430\u0435\u043c \u0447\u0435\u0440\u0435\u0437 \u0440\u0430\u0437\u043d\u043e\u0441\u0442\u0438 \u0441\u043e\u0441\u0435\u0434\u043d\u0438\u0445 \u0442\u043e\u0447\u0435\u043a. \u0414\u043b\u044f \u0432\u0440\u0430\u0449\u0435\u043d\u0438\u0439 \u0440\u0430\u0437\u043d\u043e\u0441\u0442\u044c \u0437\u0430\u043c\u0435\u043d\u044f\u0435\u043c \u043b\u043e\u0433\u0430\u0440\u0438\u0444\u043c\u043e\u043c \u043e\u0442\u043d\u043e\u0441\u0438\u0442\u0435\u043b\u044c\u043d\u043e\u0433\u043e \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430, \u0441\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u2014 \u0443\u043c\u043d\u043e\u0436\u0435\u043d\u0438\u0435\u043c:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"R(u) = Q_i\\prod_{j=1}^{3}\\operatorname{Exp}\\bigl(\\tilde B_j(u)\\,\\mathbf d_j\\bigr),\\qquad \\mathbf d_j = \\operatorname{Log}\\bigl(Q_{i+j-1}^{\\mathsf T}Q_{i+j}\\bigr)\" alt=\"R(u) = Q_i\\prod_{j=1}^{3}\\operatorname{Exp}\\bigl(\\tilde B_j(u)\\,\\mathbf d_j\\bigr),\\qquad \\mathbf d_j = \\operatorname{Log}\\bigl(Q_{i+j-1}^{\\mathsf T}Q_{i+j}\\bigr)\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/c\/c8\/c84\/c84259127dea4362e83ed9ec1f784437.svg\" width=\"447\" height=\"55\" data-width=\"55.818\" data-height=\"6.906\" data-vertical-align=\"-2.887\" style=\"width: 55.818ex; height: 6.906ex; vertical-align: -2.887ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/c\/c8\/c84\/c84259127dea4362e83ed9ec1f784437.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/c\/c8\/c84\/c84259127dea4362e83ed9ec1f784437.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u0417\u0434\u0435\u0441\u044c Q \u2014 \u043a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0435 \u0432\u0440\u0430\u0449\u0435\u043d\u0438\u044f, Exp \u0438 Log \u2014 \u043f\u0435\u0440\u0435\u0445\u043e\u0434 \u043c\u0435\u0436\u0434\u0443 \u0432\u0435\u043a\u0442\u043e\u0440\u043e\u043c \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430 \u0438 \u043c\u0430\u0442\u0440\u0438\u0446\u0435\u0439 (\u0444\u043e\u0440\u043c\u0443\u043b\u0430 \u0420\u043e\u0434\u0440\u0438\u0433\u0430). \u041a\u0443\u043c\u0443\u043b\u044f\u0442\u0438\u0432\u043d\u044b\u0435 \u0431\u0430\u0437\u0438\u0441\u043d\u044b\u0435 \u0444\u0443\u043d\u043a\u0446\u0438\u0438 \u2014 \u043e\u0431\u044b\u0447\u043d\u044b\u0435 \u043c\u043d\u043e\u0433\u043e\u0447\u043b\u0435\u043d\u044b:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"\\tilde B_1 = \\tfrac16(5 + 3u - 3u^2 + u^3),\\quad \\tilde B_2 = \\tfrac16(1 + 3u + 3u^2 - 2u^3),\\quad \\tilde B_3 = \\tfrac16 u^3\" alt=\"\\tilde B_1 = \\tfrac16(5 + 3u - 3u^2 + u^3),\\quad \\tilde B_2 = \\tfrac16(1 + 3u + 3u^2 - 2u^3),\\quad \\tilde B_3 = \\tfrac16 u^3\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/f\/f1\/f12\/f123034662b51ec59d1dad38296600ee.svg\" width=\"569\" height=\"24\" data-width=\"71.119\" data-height=\"3.058\" data-vertical-align=\"-0.963\" style=\"width: 71.119ex; height: 3.058ex; vertical-align: -0.963ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/f\/f1\/f12\/f123034662b51ec59d1dad38296600ee.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/f\/f1\/f12\/f123034662b51ec59d1dad38296600ee.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u041f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u0443\u0434\u043e\u0431\u043d\u0435\u0435 \u0432\u0441\u0435\u0433\u043e \u0441\u0447\u0438\u0442\u0430\u0442\u044c \u0440\u0435\u043a\u0443\u0440\u0440\u0435\u043d\u0442\u043d\u043e, \u043f\u043e \u043e\u0434\u043d\u043e\u043c\u0443 \u043c\u043d\u043e\u0436\u0438\u0442\u0435\u043b\u044e \u0437\u0430 \u0448\u0430\u0433. \u042d\u0442\u0438 \u0444\u043e\u0440\u043c\u0443\u043b\u044b \u0432\u044b\u0432\u0435\u0434\u0435\u043d\u044b \u0432 [14]:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"A_j = \\operatorname{Exp}\\bigl(\\tilde B_j\\mathbf d_j\\bigr),\\quad \\mathbf w_j = \\dot{\\tilde B}_j\\,\\mathbf d_j,\\qquad \\boldsymbol\\omega^{(j+1)} = A_j^{\\mathsf T}\\boldsymbol\\omega^{(j)} + \\mathbf w_j,\\qquad \\boldsymbol\\alpha^{(j+1)} = A_j^{\\mathsf T}\\boldsymbol\\alpha^{(j)} + \\bigl(A_j^{\\mathsf T}\\boldsymbol\\omega^{(j)}\\bigr)\\times\\mathbf w_j + \\ddot{\\tilde B}_j\\,\\mathbf d_j\" alt=\"A_j = \\operatorname{Exp}\\bigl(\\tilde B_j\\mathbf d_j\\bigr),\\quad \\mathbf w_j = \\dot{\\tilde B}_j\\,\\mathbf d_j,\\qquad \\boldsymbol\\omega^{(j+1)} = A_j^{\\mathsf T}\\boldsymbol\\omega^{(j)} + \\mathbf w_j,\\qquad \\boldsymbol\\alpha^{(j+1)} = A_j^{\\mathsf T}\\boldsymbol\\alpha^{(j)} + \\bigl(A_j^{\\mathsf T}\\boldsymbol\\omega^{(j)}\\bigr)\\times\\mathbf w_j + \\ddot{\\tilde B}_j\\,\\mathbf d_j\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/f\/fe\/fe7\/fe7a9b1d4c0c1163a2c1da3d228c8dd8.svg\" width=\"827\" height=\"29\" data-width=\"103.436\" data-height=\"3.625\" data-vertical-align=\"-1.247\" style=\"width: 103.436ex; height: 3.625ex; vertical-align: -1.247ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/f\/fe\/fe7\/fe7a9b1d4c0c1163a2c1da3d228c8dd8.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/f\/fe\/fe7\/fe7a9b1d4c0c1163a2c1da3d228c8dd8.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u041d\u0430\u0447\u0430\u043b\u044c\u043d\u044b\u0435 \u0437\u043d\u0430\u0447\u0435\u043d\u0438\u044f \u2014 \u043d\u0443\u043b\u0435\u0432\u044b\u0435, \u043f\u043e\u0441\u043b\u0435 \u0442\u0440\u0435\u0442\u044c\u0435\u0433\u043e \u0448\u0430\u0433\u0430 \u043f\u043e\u043b\u0443\u0447\u0430\u0435\u043c \u03c9 \u0438 \u03b1 \u043a\u0430\u043c\u0435\u0440\u044b. \u041d\u0430 \u043e\u0434\u0438\u043d \u043e\u0442\u0441\u0447\u0451\u0442 \u0443\u0445\u043e\u0434\u0438\u0442 O(1) \u043e\u043f\u0435\u0440\u0430\u0446\u0438\u0439, \u0447\u0438\u0441\u043b\u0435\u043d\u043d\u043e\u0435 \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u0435 \u043d\u0435 \u043d\u0443\u0436\u043d\u043e.<\/p>\n<p>\u041f\u043e\u0447\u0435\u043c\u0443 \u0432 \u0443\u0437\u043b\u0430\u0445 \u043d\u0435\u0442 \u0441\u043a\u0430\u0447\u043a\u043e\u0432? \u041d\u0430 \u0441\u0442\u044b\u043a\u0435 \u043e\u0442\u0440\u0435\u0437\u043a\u043e\u0432 i \u0438 i+1 \u043c\u0435\u043d\u044f\u0435\u0442\u0441\u044f \u043d\u0430\u0431\u043e\u0440 \u043a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0445 \u0432\u0440\u0430\u0449\u0435\u043d\u0438\u0439, \u043d\u043e \u0437\u043d\u0430\u0447\u0435\u043d\u0438\u044f \u0431\u0430\u0437\u0438\u0441\u0430 \u043d\u0430 \u043a\u043e\u043d\u0446\u0430\u0445 \u043e\u0442\u0440\u0435\u0437\u043a\u0430 \u0440\u0430\u0432\u043d\u044b (1, 5\/6, 1\/6) \u043f\u0440\u0438 u = 1 \u0438 (5\/6, 1\/6, 0) \u043f\u0440\u0438 u = 0. \u0412 \u043a\u043e\u043d\u0446\u0435 \u043e\u0442\u0440\u0435\u0437\u043a\u0430 i \u043f\u0435\u0440\u0432\u044b\u0439 \u043c\u043d\u043e\u0436\u0438\u0442\u0435\u043b\u044c \u0434\u0430\u0451\u0442 Q\u1d62\u00b7Exp(d\u2081) = Q\u1d62\u208a\u2081, \u0430 \u043e\u0441\u0442\u0430\u0432\u0448\u0438\u0435\u0441\u044f \u0441\u043e\u0432\u043f\u0430\u0434\u0430\u044e\u0442 \u0441 \u043d\u0430\u0447\u0430\u043b\u043e\u043c \u043e\u0442\u0440\u0435\u0437\u043a\u0430 i+1. \u0422\u043e \u0436\u0435 \u0432\u0435\u0440\u043d\u043e \u0434\u043b\u044f \u043f\u0435\u0440\u0432\u043e\u0439 \u0438 \u0432\u0442\u043e\u0440\u043e\u0439 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0445. \u0427\u0438\u0441\u043b\u0435\u043d\u043d\u043e \u044f \u0441\u0440\u0430\u0432\u043d\u0438\u043b\u0430 \u0444\u043e\u0440\u043c\u0443\u043b\u0443 \u043e\u0442\u0440\u0435\u0437\u043a\u0430 i \u043f\u0440\u0438 u = 1 \u0441 \u0444\u043e\u0440\u043c\u0443\u043b\u043e\u0439 \u043e\u0442\u0440\u0435\u0437\u043a\u0430 i+1 \u043f\u0440\u0438 u = 0 \u0432\u043e \u0432\u0441\u0435\u0445 \u0443\u0437\u043b\u0430\u0445. \u0423 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u03c9 \u0438 \u03b1 \u0441\u043e\u0432\u043f\u0430\u043b\u0438 \u0442\u043e\u0447\u043d\u043e, \u0430 \u0443 SQUAD \u03b1 \u0440\u0430\u0441\u0445\u043e\u0434\u0438\u0442\u0441\u044f \u0434\u043e 0,12 \u0440\u0430\u0434\/\u0441\u00b2.<\/p>\n<p>\u041e\u0441\u0442\u0430\u043b\u043e\u0441\u044c \u0432\u044b\u0431\u0440\u0430\u0442\u044c \u043a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0435 \u0432\u0440\u0430\u0449\u0435\u043d\u0438\u044f. \u042f \u0431\u0435\u0440\u0443 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u044b \u043a\u0430\u043a \u0435\u0441\u0442\u044c, \u0430 \u0434\u0432\u0430 \u043a\u0440\u0430\u0439\u043d\u0438\u0445 \u043f\u043e\u043b\u0443\u0447\u0430\u044e \u043f\u0440\u043e\u0434\u043e\u043b\u0436\u0435\u043d\u0438\u0435\u043c \u043f\u0435\u0440\u0432\u043e\u0433\u043e \u0438 \u043f\u043e\u0441\u043b\u0435\u0434\u043d\u0435\u0433\u043e \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430:<\/p>\n<p><img decoding=\"async\" class=\"formula\" source=\"Q_{k+1} = R_k,\\quad k = 0,\\dots,K;\\qquad Q_0 = R_0\\operatorname{Exp}\\bigl(-\\operatorname{Log}(R_0^{\\mathsf T}R_1)\\bigr),\\qquad Q_{K+2} = R_K\\operatorname{Exp}\\bigl(\\operatorname{Log}(R_{K-1}^{\\mathsf T}R_K)\\bigr)\" alt=\"Q_{k+1} = R_k,\\quad k = 0,\\dots,K;\\qquad Q_0 = R_0\\operatorname{Exp}\\bigl(-\\operatorname{Log}(R_0^{\\mathsf T}R_1)\\bigr),\\qquad Q_{K+2} = R_K\\operatorname{Exp}\\bigl(\\operatorname{Log}(R_{K-1}^{\\mathsf T}R_K)\\bigr)\" src=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/5\/52\/526\/5260ed3590226762ff676c20e06d39d1.svg\" width=\"783\" height=\"23\" data-width=\"97.902\" data-height=\"2.826\" data-vertical-align=\"-0.847\" style=\"width: 97.902ex; height: 2.826ex; vertical-align: -0.847ex\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/getpro\/habr\/formulas\/5\/52\/526\/5260ed3590226762ff676c20e06d39d1.svg 780w,&#10;       https:\/\/habrastorage.org\/getpro\/habr\/formulas\/5\/52\/526\/5260ed3590226762ff676c20e06d39d1.svg 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<p>\u0423 \u0442\u0430\u043a\u043e\u0433\u043e \u0432\u044b\u0431\u043e\u0440\u0430 \u0435\u0441\u0442\u044c \u0446\u0435\u043d\u0430: \u043a\u0440\u0438\u0432\u0430\u044f \u0438\u0434\u0451\u0442 \u0440\u044f\u0434\u043e\u043c \u0441 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u043c\u0438 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430\u043c\u0438, \u043d\u043e \u0442\u043e\u0447\u043d\u043e \u0447\u0435\u0440\u0435\u0437 \u043d\u0438\u0445 \u043d\u0435 \u043f\u0440\u043e\u0445\u043e\u0434\u0438\u0442. \u041d\u0430 \u043c\u043e\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u043e\u0442\u043a\u043b\u043e\u043d\u0435\u043d\u0438\u0435 \u043d\u0435 \u043f\u0440\u0435\u0432\u044b\u0448\u0430\u0435\u0442 0,36\u00b0. \u0414\u043b\u044f \u0433\u0435\u043d\u0435\u0440\u0430\u0446\u0438\u0438 \u0434\u0430\u043d\u043d\u044b\u0445 \u044d\u0442\u043e \u043d\u0435 \u043c\u0435\u0448\u0430\u0435\u0442: \u044d\u0442\u0430\u043b\u043e\u043d\u043e\u043c \u0441\u043b\u0443\u0436\u0438\u0442 \u0441\u0430\u043c \u0441\u043f\u043b\u0430\u0439\u043d, \u0430 \u043d\u0435 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u0437\u044b. \u0415\u0441\u043b\u0438 \u0442\u043e\u0447\u043d\u043e\u0435 \u043f\u0440\u043e\u0445\u043e\u0436\u0434\u0435\u043d\u0438\u0435 \u0432\u0441\u0451 \u0436\u0435 \u043d\u0443\u0436\u043d\u043e, \u0443\u0447\u0442\u0438\u0442\u0435: \u043d\u0435\u0438\u0437\u0432\u0435\u0441\u0442\u043d\u044b\u0445 \u0432\u0440\u0430\u0449\u0435\u043d\u0438\u0439 K+3, \u0430 \u0443\u0441\u043b\u043e\u0432\u0438\u0439 K+1, \u0437\u0430\u0434\u0430\u0447\u0430 \u043d\u0435\u0434\u043e\u043e\u043f\u0440\u0435\u0434\u0435\u043b\u0435\u043d\u0430, \u0438 \u0447\u0438\u0441\u0442\u044b\u0439 \u043c\u0435\u0442\u043e\u0434 \u0413\u0430\u0443\u0441\u0441\u0430\u2013\u041d\u044c\u044e\u0442\u043e\u043d\u0430 \u0442\u0443\u0442 \u043d\u0435 \u0441\u0440\u0430\u0431\u043e\u0442\u0430\u0435\u0442: \u043c\u0430\u0442\u0440\u0438\u0446\u0430 J\u1d40J \u0432\u044b\u0440\u043e\u0436\u0434\u0435\u043d\u0430. \u041f\u043e\u0434\u043e\u0439\u0434\u0443\u0442 \u043c\u0435\u0442\u043e\u0434 \u041b\u0435\u0432\u0435\u043d\u0431\u0435\u0440\u0433\u0430\u2013\u041c\u0430\u0440\u043a\u0432\u0430\u0440\u0434\u0442\u0430, \u0434\u0432\u0430 \u0434\u043e\u043f\u043e\u043b\u043d\u0438\u0442\u0435\u043b\u044c\u043d\u044b\u0445 \u0443\u0441\u043b\u043e\u0432\u0438\u044f \u043d\u0430 \u03c9 \u043d\u0430 \u043a\u043e\u043d\u0446\u0430\u0445 \u0438\u043b\u0438 \u0433\u043e\u0442\u043e\u0432\u0430\u044f \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u0438\u0440\u0443\u044e\u0449\u0430\u044f C\u00b2-\u043a\u0440\u0438\u0432\u0430\u044f \u0438\u0437 [15].<\/p>\n<h3>\u041a\u043e\u0434<\/h3>\n<p>\u042f\u0434\u0440\u043e \u0433\u0435\u043d\u0435\u0440\u0430\u0442\u043e\u0440\u0430 \u0437\u0430\u043d\u0438\u043c\u0430\u0435\u0442 \u043f\u043e\u043b\u0441\u043e\u0442\u043d\u0438 \u0441\u0442\u0440\u043e\u043a \u043d\u0430 numpy \u0438 scipy. \u041d\u0438\u0436\u0435 \u0432\u0435\u0440\u0441\u0438\u044f \u0434\u043b\u044f \u043e\u0434\u043d\u043e\u0433\u043e \u043c\u043e\u043c\u0435\u043d\u0442\u0430 \u0432\u0440\u0435\u043c\u0435\u043d\u0438, \u0431\u0435\u0437 \u0432\u0435\u043a\u0442\u043e\u0440\u0438\u0437\u0430\u0446\u0438\u0438: \u0442\u0430\u043a \u043f\u0440\u043e\u0449\u0435 \u0447\u0438\u0442\u0430\u0442\u044c. \u0421 \u043f\u043e\u043b\u043d\u043e\u0439 \u0440\u0435\u0430\u043b\u0438\u0437\u0430\u0446\u0438\u0435\u0439 \u043e\u043d\u0430 \u0441\u043e\u0432\u043f\u0430\u0434\u0430\u0435\u0442 \u0434\u043e 3\u00b710\u207b\u00b9\u2076.<\/p>\n<pre><code class=\"python\">import numpy as npfrom scipy.spatial.transform import Rotation as RotG_W = np.array([0.0, 0.0, -9.81])def Exp(phi):    return Rot.from_rotvec(phi).as_matrix()def Log(R):    return Rot.from_matrix(R).as_rotvec()def cum_basis(u):    \"\"\"\u041a\u0443\u043c\u0443\u043b\u044f\u0442\u0438\u0432\u043d\u044b\u0439 \u0431\u0430\u0437\u0438\u0441 \u0438 \u0435\u0433\u043e \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u043f\u043e u.\"\"\"    B = np.array([(5 + 3*u - 3*u**2 + u**3) \/ 6,                  (1 + 3*u + 3*u**2 - 2*u**3) \/ 6,                  u**3 \/ 6])    dB = np.array([(3 - 6*u + 3*u**2) \/ 6,                   (3 + 6*u - 6*u**2) \/ 6,                   u**2 \/ 2])    ddB = np.array([u - 1, 1 - 2*u, u])    return B, dB, ddBdef rotation_spline(Q, t, t0, dt):    \"\"\"R, omega, alpha \u043a\u0443\u043c\u0443\u043b\u044f\u0442\u0438\u0432\u043d\u043e\u0433\u043e B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043d\u0430 SO(3) \u0432 \u043c\u043e\u043c\u0435\u043d\u0442 t.\"\"\"    i = min(int((t - t0) \/\/ dt), len(Q) - 4)    u = (t - t0) \/ dt - i    B, dB, ddB = cum_basis(u)    dB, ddB = dB \/ dt, ddB \/ dt**2    R, om, al = Q[i].copy(), np.zeros(3), np.zeros(3)    for j in range(3):        d = Log(Q[i + j].T @ Q[i + j + 1])        A = Exp(B[j] * d)        w = dB[j] * d        om_rot = A.T @ om        al = A.T @ al + np.cross(om_rot, w) + ddB[j] * d        om = om_rot + w        R = R @ A    return R, om, aldef ideal_imu(R_wc, acc_wc, om_c, al_c, R_bc, r):    \"\"\"\u0418\u0434\u0435\u0430\u043b\u044c\u043d\u044b\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f IMU \u043f\u043e \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044e \u043a\u0430\u043c\u0435\u0440\u044b.    r -- \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 IMU \u0432 \u0441\u0438\u0441\u0442\u0435\u043c\u0435 \u043a\u0430\u043c\u0435\u0440\u044b.\"\"\"    lever = np.cross(al_c, r) + np.cross(om_c, np.cross(om_c, r))    acc_wb = acc_wc + R_wc @ lever    R_wb = R_wc @ R_bc.T    gyro = R_bc @ om_c    accel = R_wb.T @ (acc_wb - G_W)    return gyro, accel<\/code><div class=\"code-explainer\"><a href=\"https:\/\/sourcecraft.dev\/\" class=\"tm-button code-explainer__link\" style=\"visibility: hidden;\"><span class=\"sc-logo-wrapper\"><\/span><\/a><\/div><\/pre>\n<p>\u0428\u0443\u043c \u0434\u043e\u0431\u0430\u0432\u043b\u044f\u0435\u0442\u0441\u044f \u043f\u043e\u0432\u0435\u0440\u0445 \u0438\u0434\u0435\u0430\u043b\u044c\u043d\u044b\u0445 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u0439 \u043f\u043e \u0441\u0442\u0430\u043d\u0434\u0430\u0440\u0442\u043d\u043e\u0439 \u0441\u0445\u0435\u043c\u0435 \u0434\u0438\u0441\u043a\u0440\u0435\u0442\u0438\u0437\u0430\u0446\u0438\u0438 [10, 16]. \u0411\u0435\u043b\u044b\u0439 \u0448\u0443\u043c \u0438\u043c\u0435\u0435\u0442 \u0434\u0438\u0441\u043f\u0435\u0440\u0441\u0438\u044e \u03c3\u00b2\/h, \u0441\u043c\u0435\u0449\u0435\u043d\u0438\u0435 \u043d\u0430 \u043a\u0430\u0436\u0434\u043e\u043c \u0448\u0430\u0433\u0435 \u043f\u043e\u043b\u0443\u0447\u0430\u0435\u0442 \u043f\u0440\u0438\u0440\u0430\u0449\u0435\u043d\u0438\u0435 \u03c3_b\u00b7\u221ah\u00b7\u03be, \u0433\u0434\u0435 \u03be \u2014 \u0441\u0442\u0430\u043d\u0434\u0430\u0440\u0442\u043d\u0430\u044f \u043d\u043e\u0440\u043c\u0430\u043b\u044c\u043d\u0430\u044f \u0432\u0435\u043b\u0438\u0447\u0438\u043d\u0430. \u0417\u0434\u0435\u0441\u044c \u03c3 \u2014 \u00abnoise density\u00bb \u0438 \u00abrandom walk\u00bb \u0438\u0437 \u043f\u0430\u0441\u043f\u043e\u0440\u0442\u0430 \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u0438\u043b\u0438 \u0438\u0437 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043e\u0447\u043d\u043e\u0433\u043e \u0444\u0430\u0439\u043b\u0430 \u0434\u0430\u0442\u0430\u0441\u0435\u0442\u0430. \u041f\u043e\u043b\u043d\u044b\u0439 \u043a\u043e\u0434 \u0441 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435\u043c, \u043f\u043e\u0434\u0431\u043e\u0440\u043e\u043c \u043a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0445 \u0442\u043e\u0447\u0435\u043a, \u0442\u0440\u0435\u043c\u044f \u043c\u043e\u0434\u0435\u043b\u044f\u043c\u0438 \u0438 \u043f\u0440\u043e\u0432\u0435\u0440\u043a\u043e\u0439 \u0438\u0437 \u0441\u043b\u0435\u0434\u0443\u044e\u0449\u0435\u0433\u043e \u0440\u0430\u0437\u0434\u0435\u043b\u0430 \u043b\u0435\u0436\u0438\u0442 \u0432 \u0440\u0435\u043f\u043e\u0437\u0438\u0442\u043e\u0440\u0438\u0438:\u00a0<a href=\"https:\/\/github.com\/1Bermud\/spline-imu-sim\" rel=\"noopener nofollow\">github.com\/1Bermud\/spline-imu-sim<\/a>.<\/p>\n<p>\u041e\u0434\u043d\u0430 \u043b\u043e\u0432\u0443\u0448\u043a\u0430, \u0432 \u043a\u043e\u0442\u043e\u0440\u0443\u044e \u044f \u043f\u043e\u043f\u0430\u043b\u0430: scipy \u0445\u0440\u0430\u043d\u0438\u0442 \u043a\u0432\u0430\u0442\u0435\u0440\u043d\u0438\u043e\u043d\u044b \u043a\u0430\u043a (x, y, z, w), \u0430 EuRoC \u2014 \u043a\u0430\u043a (w, x, y, z). \u0415\u0441\u043b\u0438 \u0437\u0430\u0431\u044b\u0442\u044c \u043f\u0435\u0440\u0435\u0441\u0442\u0430\u0432\u0438\u0442\u044c \u043a\u043e\u043c\u043f\u043e\u043d\u0435\u043d\u0442\u044b, \u043f\u0440\u043e\u0433\u0440\u0430\u043c\u043c\u0430 \u043d\u0435 \u043f\u0430\u0434\u0430\u0435\u0442, \u0430 \u043f\u0440\u043e\u0441\u0442\u043e \u0432\u044b\u0434\u0430\u0451\u0442 \u0441\u0442\u0440\u0430\u043d\u043d\u044b\u0435 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u044b. \u0412 \u0441\u0432\u0435\u0436\u0438\u0445 \u0432\u0435\u0440\u0441\u0438\u044f\u0445 scipy \u0443\u00a0<code>Rotation.from_quat<\/code>\u00a0\u0438\u00a0<code>as_quat<\/code>\u00a0\u0435\u0441\u0442\u044c \u043f\u0430\u0440\u0430\u043c\u0435\u0442\u0440\u00a0<code>scalar_first=True<\/code>\u00a0(\u0432 1.18 \u043f\u0440\u043e\u0432\u0435\u0440\u0438\u043b\u0430), \u0438 \u043f\u0435\u0440\u0435\u0441\u0442\u0430\u0432\u043b\u044f\u0442\u044c \u0440\u0443\u043a\u0430\u043c\u0438 \u043d\u0435 \u043d\u0443\u0436\u043d\u043e.<\/p>\n<h3>\u041a\u0430\u043a \u043f\u0440\u043e\u0432\u0435\u0440\u0438\u0442\u044c, \u0447\u0442\u043e \u0433\u0435\u043d\u0435\u0440\u0430\u0442\u043e\u0440 \u043d\u0435 \u0432\u0440\u0451\u0442<\/h3>\n<p>\u041b\u0443\u0447\u0448\u0438\u0439 \u0442\u0435\u0441\u0442, \u043a\u043e\u0442\u043e\u0440\u044b\u0439 \u044f \u043d\u0430\u0448\u043b\u0430, \u2014 \u043f\u0440\u043e\u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u0442\u044c \u0438\u0434\u0435\u0430\u043b\u044c\u043d\u044b\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u043e\u0431\u0440\u0430\u0442\u043d\u043e \u0438 \u0441\u0440\u0430\u0432\u043d\u0438\u0442\u044c \u0441 \u0438\u0441\u0445\u043e\u0434\u043d\u043e\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0435\u0439. \u0421\u043c\u043e\u0442\u0440\u0435\u0442\u044c \u043d\u0430\u0434\u043e \u043d\u0435 \u043d\u0430 \u0441\u0430\u043c\u0443 \u043e\u0448\u0438\u0431\u043a\u0443, \u0430 \u043d\u0430 \u0442\u043e, \u043a\u0430\u043a \u043e\u043d\u0430 \u0443\u0431\u044b\u0432\u0430\u0435\u0442 \u0441 \u0440\u043e\u0441\u0442\u043e\u043c \u0447\u0430\u0441\u0442\u043e\u0442\u044b. \u0415\u0441\u043b\u0438 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u044b \u0441 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435\u043c, \u043e\u0448\u0438\u0431\u043a\u0430 \u0434\u043e\u043b\u0436\u043d\u0430 \u0443\u0431\u044b\u0432\u0430\u0442\u044c \u043a\u0430\u043a h^q, \u0433\u0434\u0435 h \u2014 \u0448\u0430\u0433, \u0430 q \u2014 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u0445\u0435\u043c\u044b.<\/p>\n<p>\u042f \u0431\u0440\u0430\u043b\u0430 \u0434\u0432\u0435 \u0441\u0445\u0435\u043c\u044b. \u041f\u0435\u0440\u0432\u0430\u044f \u2014 \u043f\u0440\u043e\u0441\u0442\u0430\u044f \u0441\u0445\u0435\u043c\u0430 \u043f\u0435\u0440\u0432\u043e\u0433\u043e \u043f\u043e\u0440\u044f\u0434\u043a\u0430, \u043a\u0430\u043a \u0432 \u043f\u0440\u0435\u0434\u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u0438 IMU [16]. \u0412\u0442\u043e\u0440\u0430\u044f \u2014 \u043a\u043b\u0430\u0441\u0441\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0420\u0443\u043d\u0433\u0435\u2013\u041a\u0443\u0442\u0442\u0430 4-\u0433\u043e \u043f\u043e\u0440\u044f\u0434\u043a\u0430 (\u0420\u041a4). \u0414\u043b\u044f \u043d\u0435\u0433\u043e \u043d\u0443\u0436\u043d\u044b \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u044f \u0432 \u0441\u0435\u0440\u0435\u0434\u0438\u043d\u0435 \u0448\u0430\u0433\u0430. \u0413\u0435\u043d\u0435\u0440\u0430\u0442\u043e\u0440 \u0443\u043c\u0435\u0435\u0442 \u0441\u0447\u0438\u0442\u0430\u0442\u044c \u0438\u0445 \u0432 \u043b\u044e\u0431\u043e\u0439 \u043c\u043e\u043c\u0435\u043d\u0442, \u043d\u043e \u0444\u0430\u043a\u0442\u0438\u0447\u0435\u0441\u043a\u0438 \u044d\u0442\u043e IMU \u0434\u0432\u043e\u0439\u043d\u043e\u0439 \u0447\u0430\u0441\u0442\u043e\u0442\u044b. \u0414\u043b\u044f \u043f\u0440\u043e\u0432\u0435\u0440\u043a\u0438 \u043c\u043e\u0434\u0435\u043b\u0438 \u044d\u0442\u043e \u043d\u043e\u0440\u043c\u0430\u043b\u044c\u043d\u043e, \u0434\u043b\u044f \u0438\u043c\u0438\u0442\u0430\u0446\u0438\u0438 \u0440\u0435\u0430\u043b\u044c\u043d\u043e\u0433\u043e \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u2014 \u043d\u0435\u0442. \u041e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044e \u0420\u041a4 \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u0443\u0435\u0442 \u043a\u0430\u043a \u043e\u0431\u044b\u0447\u043d\u0443\u044e \u043c\u0430\u0442\u0440\u0438\u0447\u043d\u0443\u044e \u0441\u0438\u0441\u0442\u0435\u043c\u0443 \u1e58 = R[\u03c9]\u00d7, \u0430 \u043f\u043e\u0441\u043b\u0435 \u043a\u0430\u0436\u0434\u043e\u0433\u043e \u0448\u0430\u0433\u0430 \u043c\u0430\u0442\u0440\u0438\u0446\u0430 \u043f\u0440\u043e\u0435\u0446\u0438\u0440\u0443\u0435\u0442\u0441\u044f \u043e\u0431\u0440\u0430\u0442\u043d\u043e \u043d\u0430 SO(3) \u0447\u0435\u0440\u0435\u0437 SVD. \u0422\u0430\u043a\u0430\u044f \u043f\u0440\u043e\u0435\u043a\u0446\u0438\u044f \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u043d\u0435 \u043f\u043e\u0440\u0442\u0438\u0442, \u0447\u0442\u043e \u0432\u0438\u0434\u043d\u043e \u043f\u043e \u0440\u0435\u0437\u0443\u043b\u044c\u0442\u0430\u0442\u0443 \u0434\u043b\u044f \u0433\u043b\u0430\u0434\u043a\u043e\u0433\u043e \u0441\u043b\u0443\u0447\u0430\u044f.<\/p>\n<p>\u041d\u0430\u0447\u0430\u043b\u044c\u043d\u043e\u0435 \u0441\u043e\u0441\u0442\u043e\u044f\u043d\u0438\u0435 \u0431\u0435\u0440\u0451\u0442\u0441\u044f \u0438\u0437 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0442\u043e\u0447\u043d\u043e, \u0448\u0443\u043c\u0430 \u043d\u0435\u0442, \u0441\u043c\u0435\u0449\u0435\u043d\u0438\u044f \u043d\u0443\u043b\u0435\u0432\u044b\u0435, \u0447\u0430\u0441\u0442\u043e\u0442\u0430 IMU \u2014 \u043e\u0442 50 \u0434\u043e 1600 \u0413\u0446. \u042f \u043f\u0440\u043e\u0432\u0435\u0440\u044f\u043b\u0430 \u0434\u0432\u0430 \u0432\u0430\u0440\u0438\u0430\u043d\u0442\u0430 \u0441\u0435\u0442\u043a\u0438: \u043c\u043e\u043c\u0435\u043d\u0442\u044b \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u0439 \u043f\u043e\u043f\u0430\u0434\u0430\u044e\u0442 \u0442\u043e\u0447\u043d\u043e \u0432 \u0443\u0437\u043b\u044b \u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u0438\u043b\u0438 \u0441\u0435\u0442\u043a\u0430 \u0441\u0434\u0432\u0438\u043d\u0443\u0442\u0430 \u043d\u0430 0,37h. \u0421\u0434\u0432\u0438\u0433 \u0432\u0430\u0436\u043d\u043e \u0437\u0430\u0434\u0430\u0432\u0430\u0442\u044c \u0434\u043e\u043b\u0435\u0439 \u0448\u0430\u0433\u0430, \u0430 \u043d\u0435 \u0432 \u0441\u0435\u043a\u0443\u043d\u0434\u0430\u0445. \u0422\u043e\u0433\u0434\u0430 \u0443\u0437\u0435\u043b \u043f\u0440\u0438 \u043b\u044e\u0431\u043e\u043c h \u043b\u0435\u0436\u0438\u0442 \u0432 \u043e\u0434\u043d\u043e\u0439 \u0438 \u0442\u043e\u0439 \u0436\u0435 \u0442\u043e\u0447\u043a\u0435 \u0448\u0430\u0433\u0430. \u0418\u043d\u0430\u0447\u0435 \u043e\u043d \u043a\u0430\u0436\u0434\u044b\u0439 \u0440\u0430\u0437 \u043f\u043e\u043f\u0430\u0434\u0430\u0435\u0442 \u0432 \u0434\u0440\u0443\u0433\u043e\u0435 \u043c\u0435\u0441\u0442\u043e, \u0438 \u043d\u0430\u0431\u043b\u044e\u0434\u0430\u0435\u043c\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u043a\u0430\u0447\u0435\u0442 \u043e\u0442 \u0447\u0430\u0441\u0442\u043e\u0442\u044b \u043a \u0447\u0430\u0441\u0442\u043e\u0442\u0435. \u0421\u0434\u0432\u0438\u043d\u0443\u0442\u0430\u044f \u0441\u0435\u0442\u043a\u0430 \u0431\u043b\u0438\u0436\u0435 \u043a \u0436\u0438\u0437\u043d\u0438: \u0443 \u043d\u0430\u0441\u0442\u043e\u044f\u0449\u0435\u0433\u043e \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u043e\u0442\u0441\u0447\u0451\u0442\u044b \u0441 \u0443\u0437\u043b\u0430\u043c\u0438 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u043d\u0438\u043a\u0430\u043a \u043d\u0435 \u0441\u0432\u044f\u0437\u0430\u043d\u044b.<\/p>\n<figure class=\"full-width \"><img decoding=\"async\" src=\"https:\/\/habrastorage.org\/r\/w1560\/extt\/59\/8d\/85\/598d850989e0478d93d226d37d71fa10.png\" alt=\"\u0420\u0438\u0441. 3. \u0421\u041a\u041e \u043e\u0448\u0438\u0431\u043a\u0438 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043f\u043e\u0441\u043b\u0435 \u043e\u0431\u0440\u0430\u0442\u043d\u043e\u0433\u043e \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f \u0441\u0445\u0435\u043c\u043e\u0439 \u0420\u041a4 \u0432 \u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e\u0441\u0442\u0438 \u043e\u0442 \u0447\u0430\u0441\u0442\u043e\u0442\u044b IMU, \u043b\u043e\u0433\u0430\u0440\u0438\u0444\u043c\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u043c\u0430\u0441\u0448\u0442\u0430\u0431. \u041d\u0430\u043a\u043b\u043e\u043d \u043b\u0438\u043d\u0438\u0438 \u2014 \u043d\u0430\u0431\u043b\u044e\u0434\u0430\u0435\u043c\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u0438. \u0414\u043b\u044f \u043c\u043e\u0434\u0435\u043b\u0438 \u0412 \u043d\u0430 \u0441\u0435\u0442\u043a\u0435 \u0432 \u0443\u0437\u043b\u0430\u0445 \u043f\u043e\u0441\u043b\u0435 400 \u0413\u0446 \u043e\u0448\u0438\u0431\u043a\u0430 \u0443\u043f\u0438\u0440\u0430\u0435\u0442\u0441\u044f \u0432 \u043e\u043a\u0440\u0443\u0433\u043b\u0435\u043d\u0438\u0435 (\u043e\u043a\u043e\u043b\u043e 10\u207b\u00b9\u00b2 \u043c), \u044d\u0442\u0438 \u0442\u043e\u0447\u043a\u0438 \u043d\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u044b.\" title=\"\u0420\u0438\u0441. 3. \u0421\u041a\u041e \u043e\u0448\u0438\u0431\u043a\u0438 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043f\u043e\u0441\u043b\u0435 \u043e\u0431\u0440\u0430\u0442\u043d\u043e\u0433\u043e \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f \u0441\u0445\u0435\u043c\u043e\u0439 \u0420\u041a4 \u0432 \u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e\u0441\u0442\u0438 \u043e\u0442 \u0447\u0430\u0441\u0442\u043e\u0442\u044b IMU, \u043b\u043e\u0433\u0430\u0440\u0438\u0444\u043c\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u043c\u0430\u0441\u0448\u0442\u0430\u0431. \u041d\u0430\u043a\u043b\u043e\u043d \u043b\u0438\u043d\u0438\u0438 \u2014 \u043d\u0430\u0431\u043b\u044e\u0434\u0430\u0435\u043c\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u0438. \u0414\u043b\u044f \u043c\u043e\u0434\u0435\u043b\u0438 \u0412 \u043d\u0430 \u0441\u0435\u0442\u043a\u0435 \u0432 \u0443\u0437\u043b\u0430\u0445 \u043f\u043e\u0441\u043b\u0435 400 \u0413\u0446 \u043e\u0448\u0438\u0431\u043a\u0430 \u0443\u043f\u0438\u0440\u0430\u0435\u0442\u0441\u044f \u0432 \u043e\u043a\u0440\u0443\u0433\u043b\u0435\u043d\u0438\u0435 (\u043e\u043a\u043e\u043b\u043e 10\u207b\u00b9\u00b2 \u043c), \u044d\u0442\u0438 \u0442\u043e\u0447\u043a\u0438 \u043d\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u044b.\" width=\"1520\" height=\"960\" sizes=\"auto, (max-width: 780px) 100vw, 50vw\" srcset=\"https:\/\/habrastorage.org\/r\/w780\/extt\/59\/8d\/85\/598d850989e0478d93d226d37d71fa10.png 780w,&#10;       https:\/\/habrastorage.org\/r\/w1560\/extt\/59\/8d\/85\/598d850989e0478d93d226d37d71fa10.png 781w\" loading=\"lazy\" decode=\"async\"\/><\/p>\n<div><figcaption><em>\u0420\u0438\u0441. 3. \u0421\u041a\u041e \u043e\u0448\u0438\u0431\u043a\u0438 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043f\u043e\u0441\u043b\u0435 \u043e\u0431\u0440\u0430\u0442\u043d\u043e\u0433\u043e \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f \u0441\u0445\u0435\u043c\u043e\u0439 \u0420\u041a4 \u0432 \u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e\u0441\u0442\u0438 \u043e\u0442 \u0447\u0430\u0441\u0442\u043e\u0442\u044b IMU, \u043b\u043e\u0433\u0430\u0440\u0438\u0444\u043c\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u043c\u0430\u0441\u0448\u0442\u0430\u0431. \u041d\u0430\u043a\u043b\u043e\u043d \u043b\u0438\u043d\u0438\u0438 \u2014 \u043d\u0430\u0431\u043b\u044e\u0434\u0430\u0435\u043c\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u0438. \u0414\u043b\u044f \u043c\u043e\u0434\u0435\u043b\u0438 \u0412 \u043d\u0430 \u0441\u0435\u0442\u043a\u0435 \u0432 \u0443\u0437\u043b\u0430\u0445 \u043f\u043e\u0441\u043b\u0435 400 \u0413\u0446 \u043e\u0448\u0438\u0431\u043a\u0430 \u0443\u043f\u0438\u0440\u0430\u0435\u0442\u0441\u044f \u0432 \u043e\u043a\u0440\u0443\u0433\u043b\u0435\u043d\u0438\u0435 (\u043e\u043a\u043e\u043b\u043e 10\u207b\u00b9\u00b2 \u043c), \u044d\u0442\u0438 \u0442\u043e\u0447\u043a\u0438 \u043d\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u044b.<\/em><\/figcaption><\/div>\n<\/figure>\n<p>\u0421\u041a\u041e \u043e\u0448\u0438\u0431\u043a\u0438 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043f\u0440\u0438 200 \u0413\u0446, \u0442\u0438\u043f\u0438\u0447\u043d\u043e\u0439 \u0447\u0430\u0441\u0442\u043e\u0442\u0435 IMU \u0432 \u0434\u0430\u0442\u0430\u0441\u0435\u0442\u0430\u0445. \u0412 \u0441\u043a\u043e\u0431\u043a\u0430\u0445 \u043d\u0430\u0431\u043b\u044e\u0434\u0430\u0435\u043c\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u043d\u0430 \u0438\u043d\u0442\u0435\u0440\u0432\u0430\u043b\u0435 50\u2013200 \u0413\u0446:<\/p>\n<div>\n<div class=\"table\">\n<table>\n<tbody>\n<tr>\n<th>\n<p>\u041c\u043e\u0434\u0435\u043b\u044c<\/p>\n<\/th>\n<th>\n<p>\u0421\u0445\u0435\u043c\u0430 1-\u0433\u043e \u043f\u043e\u0440\u044f\u0434\u043a\u0430, \u043c<\/p>\n<\/th>\n<th>\n<p>\u0420\u041a4, \u0441\u0435\u0442\u043a\u0430 \u0441\u0434\u0432\u0438\u043d\u0443\u0442\u0430, \u043c<\/p>\n<\/th>\n<th>\n<p>\u0420\u041a4, \u0441\u0435\u0442\u043a\u0430 \u0432 \u0443\u0437\u043b\u0430\u0445, \u043c<\/p>\n<\/th>\n<\/tr>\n<tr>\n<td>\n<p align=\"left\">\u0410: \u043e\u0442\u0440\u0435\u0437\u043a\u0438 + SLERP<\/p>\n<\/td>\n<td>\n<p align=\"left\">8,09 (0)<\/p>\n<\/td>\n<td>\n<p align=\"left\">8,09 (0)<\/p>\n<\/td>\n<td>\n<p align=\"left\">8,10 (0)<\/p>\n<\/td>\n<\/tr>\n<tr>\n<td>\n<p align=\"left\">\u0411: \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0441\u043f\u043b\u0430\u0439\u043d + SQUAD<\/p>\n<\/td>\n<td>\n<p align=\"left\">9,7\u00b710\u207b\u00b2 (1)<\/p>\n<\/td>\n<td>\n<p align=\"left\">3,9\u00b710\u207b\u2075 (1)<\/p>\n<\/td>\n<td>\n<p align=\"left\">3,2\u00b710\u207b\u2075 (1)*<\/p>\n<\/td>\n<\/tr>\n<tr>\n<td>\n<p align=\"left\">\u0412: B-\u0441\u043f\u043b\u0430\u0439\u043d\u044b<\/p>\n<\/td>\n<td>\n<p align=\"left\">9,7\u00b710\u207b\u00b2 (1)<\/p>\n<\/td>\n<td>\n<p align=\"left\">7,6\u00b710\u207b\u2077 (2)<\/p>\n<\/td>\n<td>\n<p align=\"left\">1,0\u00b710\u207b\u00b9\u00b9 (4)<\/p>\n<\/td>\n<\/tr>\n<\/tbody>\n<\/table>\n<\/div>\n<\/div>\n<p>*\u0417\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0442\u043e\u0433\u043e, \u043a\u0430\u043a\u043e\u0435 \u0437\u043d\u0430\u0447\u0435\u043d\u0438\u0435 \u0433\u0435\u043d\u0435\u0440\u0430\u0442\u043e\u0440 \u043e\u0442\u0434\u0430\u0451\u0442 \u0440\u043e\u0432\u043d\u043e \u0432 \u0443\u0437\u043b\u0435, \u0441\u043c. \u043d\u0438\u0436\u0435.<\/p>\n<p><strong>\u0421\u0445\u0435\u043c\u0430 \u043f\u0435\u0440\u0432\u043e\u0433\u043e \u043f\u043e\u0440\u044f\u0434\u043a\u0430 \u043d\u0435 \u043e\u0442\u043b\u0438\u0447\u0430\u0435\u0442 \u0445\u043e\u0440\u043e\u0448\u0443\u044e \u043c\u043e\u0434\u0435\u043b\u044c \u043e\u0442 \u043f\u043b\u043e\u0445\u043e\u0439.<\/strong>\u00a0\u0423 \u0411 \u0438 \u0412 \u043e\u0448\u0438\u0431\u043a\u0430 \u043e\u0434\u0438\u043d\u0430\u043a\u043e\u0432\u0430\u044f, 9,7 \u0441\u043c: \u0435\u0451 \u0446\u0435\u043b\u0438\u043a\u043e\u043c \u0434\u0430\u0451\u0442 \u0441\u0430\u043c\u0430 \u0441\u0445\u0435\u043c\u0430. \u041f\u0440\u0438 \u0442\u0430\u043a\u043e\u0439 \u043f\u0440\u043e\u0432\u0435\u0440\u043a\u0435 \u043f\u0440\u043e\u0431\u043b\u0435\u043c\u0430 SQUAD \u043e\u0441\u0442\u0430\u043d\u0435\u0442\u0441\u044f \u043d\u0435\u0437\u0430\u043c\u0435\u0447\u0435\u043d\u043d\u043e\u0439.<\/p>\n<p><strong>\u041d\u0430 \u0441\u0434\u0432\u0438\u043d\u0443\u0442\u043e\u0439 \u0441\u0435\u0442\u043a\u0435 \u043c\u043e\u0434\u0435\u043b\u044c \u0411 \u0434\u0430\u0451\u0442 \u043f\u0435\u0440\u0432\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a.<\/strong>\u00a0\u041f\u0440\u0438 200 \u0413\u0446 \u0435\u0451 \u043e\u0448\u0438\u0431\u043a\u0430 \u0432 50 \u0440\u0430\u0437 \u0431\u043e\u043b\u044c\u0448\u0435, \u0447\u0435\u043c \u0443 \u0412 (3,9\u00b710\u207b\u2075 \u043f\u0440\u043e\u0442\u0438\u0432 7,6\u00b710\u207b\u2077 \u043c), \u0438 \u0440\u0430\u0437\u0440\u044b\u0432 \u0440\u0430\u0441\u0442\u0451\u0442 \u0441 \u0447\u0430\u0441\u0442\u043e\u0442\u043e\u0439. \u041f\u0440\u0438\u0447\u0438\u043d\u0430 \u2014 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0438\u0437 \u043f\u0440\u043e\u0448\u043b\u043e\u0433\u043e \u0440\u0430\u0437\u0434\u0435\u043b\u0430: \u0448\u0430\u0433, \u0432\u043d\u0443\u0442\u0440\u0438 \u043a\u043e\u0442\u043e\u0440\u043e\u0433\u043e \u0441\u0442\u043e\u0438\u0442 \u0443\u0437\u0435\u043b, \u0434\u0430\u0451\u0442 \u043e\u0448\u0438\u0431\u043a\u0443 \u043f\u043e\u0440\u044f\u0434\u043a\u0430 h. \u041d\u0430 \u0441\u0435\u0442\u043a\u0435 \u0432 \u0443\u0437\u043b\u0430\u0445 \u043a\u0430\u0440\u0442\u0438\u043d\u0430 \u0437\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0440\u0435\u0430\u043b\u0438\u0437\u0430\u0446\u0438\u0438. \u0415\u0441\u043b\u0438 \u0433\u0435\u043d\u0435\u0440\u0430\u0442\u043e\u0440 \u043e\u0442\u0434\u0430\u0451\u0442 \u0432 \u0443\u0437\u043b\u0435 \u043e\u0434\u043d\u043e \u0437\u043d\u0430\u0447\u0435\u043d\u0438\u0435 (\u043a\u0430\u043a \u043d\u0430\u0441\u0442\u043e\u044f\u0449\u0438\u0439 \u0434\u0430\u0442\u0447\u0438\u043a), \u043f\u043e\u0441\u043b\u0435\u0434\u043d\u044f\u044f \u0441\u0442\u0430\u0434\u0438\u044f \u0420\u041a4 \u0447\u0430\u0441\u0442\u043e \u043f\u043e\u043b\u0443\u0447\u0430\u0435\u0442 \u0437\u043d\u0430\u0447\u0435\u043d\u0438\u0435 \u0441 \u0434\u0440\u0443\u0433\u043e\u0439 \u0441\u0442\u043e\u0440\u043e\u043d\u044b \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438, \u0438 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u043d\u043e\u0432\u0430 \u043f\u0435\u0440\u0432\u044b\u0439. \u0415\u0441\u043b\u0438 \u0436\u0435 \u0432 \u043a\u043e\u043d\u0446\u0435 \u0448\u0430\u0433\u0430 \u0431\u0440\u0430\u0442\u044c \u043f\u0440\u0435\u0434\u0435\u043b \u0441\u043b\u0435\u0432\u0430, \u043c\u043e\u0434\u0435\u043b\u044c \u0411 \u0434\u0430\u0451\u0442 9,4\u00b710\u207b\u00b9\u00b2 \u043c \u0438 \u043f\u043e\u0440\u044f\u0434\u043e\u043a 3,8. \u042f \u043f\u0440\u043e\u0432\u0435\u0440\u0438\u043b\u0430 \u0438 \u0442\u0430\u043a. \u0422\u0430\u043a\u043e\u0435 \u0437\u0430\u043d\u0438\u0436\u0435\u043d\u0438\u0435 \u043e\u0448\u0438\u0431\u043a\u0438 \u2014 \u0441\u0432\u043e\u0439\u0441\u0442\u0432\u043e \u0440\u0435\u0430\u043b\u0438\u0437\u0430\u0446\u0438\u0438, \u0430 \u043d\u0435 \u043c\u043e\u0434\u0435\u043b\u0438, \u0438 \u043d\u0430 \u0440\u0435\u0430\u043b\u044c\u043d\u044b\u0445 \u0434\u0430\u043d\u043d\u044b\u0445 \u043e\u043d\u043e \u043d\u0435\u0434\u043e\u0441\u0442\u0443\u043f\u043d\u043e.<\/p>\n<p><strong>\u0423 \u043c\u043e\u0434\u0435\u043b\u0438 \u0412 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0437\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0441\u0435\u0442\u043a\u0438.<\/strong>\u00a0\u0415\u0441\u043b\u0438 \u0448\u0430\u0433\u0438 \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f \u043d\u0435 \u043f\u0435\u0440\u0435\u0441\u0435\u043a\u0430\u044e\u0442 \u0443\u0437\u043b\u043e\u0432, \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u043f\u043e\u043b\u043d\u044b\u0439, 4,0. \u0415\u0441\u043b\u0438 \u043f\u0435\u0440\u0435\u0441\u0435\u043a\u0430\u044e\u0442, \u043e\u043d \u043f\u0430\u0434\u0430\u0435\u0442 \u0434\u043e 2,0: \u0443 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u043e\u0433\u043e \u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u0440\u044b\u0432\u043e\u043a (\u0442\u0440\u0435\u0442\u044c\u044f \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u0430\u044f) \u0432 \u0443\u0437\u043b\u0430\u0445 \u0440\u0430\u0437\u0440\u044b\u0432\u0435\u043d. \u041d\u0430 \u043f\u0440\u0430\u043a\u0442\u0438\u043a\u0435 0,76 \u043c\u043a\u043c \u0437\u0430 10 \u0441 \u2014 \u043d\u0438\u0447\u0442\u043e \u043f\u043e \u0441\u0440\u0430\u0432\u043d\u0435\u043d\u0438\u044e \u0441 \u043b\u044e\u0431\u044b\u043c \u0440\u0435\u0430\u043b\u044c\u043d\u044b\u043c \u0448\u0443\u043c\u043e\u043c.<\/p>\n<h4>\u041f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u0438 \u043a\u0430\u043a \u043c\u0435\u0440\u0430 \u0433\u043b\u0430\u0434\u043a\u043e\u0441\u0442\u0438<\/h4>\n<p>\u0420\u0435\u0437\u0443\u043b\u044c\u0442\u0430\u0442\u044b \u0443\u043a\u043b\u0430\u0434\u044b\u0432\u0430\u044e\u0442\u0441\u044f \u0432 \u043f\u0440\u043e\u0441\u0442\u043e\u0435 \u043f\u0440\u0430\u0432\u0438\u043b\u043e. \u041f\u0443\u0441\u0442\u044c \u0443 \u043f\u0440\u0430\u0432\u043e\u0439 \u0447\u0430\u0441\u0442\u0438 \u0443\u0440\u0430\u0432\u043d\u0435\u043d\u0438\u0439 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f \u0432 \u0443\u0437\u043b\u0430\u0445 \u0440\u0430\u0437\u0440\u044b\u0432\u043d\u0430 m-\u044f \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u0430\u044f (m = 0 \u2014 \u0441\u043a\u0430\u0447\u043e\u043a \u0441\u0430\u043c\u043e\u0439 \u0444\u0443\u043d\u043a\u0446\u0438\u0438, m = 1 \u2014 \u0438\u0437\u043b\u043e\u043c). \u0422\u043e\u0433\u0434\u0430 \u0448\u0430\u0433, \u043f\u0435\u0440\u0435\u0441\u0435\u043a\u0430\u044e\u0449\u0438\u0439 \u0443\u0437\u0435\u043b, \u0434\u0430\u0451\u0442 \u043b\u043e\u043a\u0430\u043b\u044c\u043d\u0443\u044e \u043e\u0448\u0438\u0431\u043a\u0443 \u043f\u043e\u0440\u044f\u0434\u043a\u0430 h^(m+1). \u0423\u0437\u043b\u043e\u0432 \u043a\u043e\u043d\u0435\u0447\u043d\u043e\u0435 \u0447\u0438\u0441\u043b\u043e, \u043f\u043e\u044d\u0442\u043e\u043c\u0443 \u0420\u041a4 \u0434\u0430\u0451\u0442 \u043f\u043e\u0440\u044f\u0434\u043e\u043a min(4, m + 1). \u041f\u0440\u043e\u0432\u0435\u0440\u043a\u0430 \u043d\u0430 \u0441\u0434\u0432\u0438\u043d\u0443\u0442\u043e\u0439 \u0441\u0435\u0442\u043a\u0435:<\/p>\n<div>\n<div class=\"table\">\n<table>\n<tbody>\n<tr>\n<th>\n<p>\u0427\u0442\u043e \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u0443\u0435\u0442\u0441\u044f<\/p>\n<\/th>\n<th>\n<p>\u0427\u0442\u043e \u0440\u0430\u0437\u0440\u044b\u0432\u043d\u043e \u0432 \u0443\u0437\u043b\u0430\u0445<\/p>\n<\/th>\n<th>\n<p>m<\/p>\n<\/th>\n<th>\n<p>\u041e\u0436\u0438\u0434\u0430\u0435\u0442\u0441\u044f<\/p>\n<\/th>\n<th>\n<p>\u041f\u043e\u043b\u0443\u0447\u0435\u043d\u043e<\/p>\n<\/th>\n<\/tr>\n<tr>\n<td>\n<p align=\"left\">\u041f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435, \u043c\u043e\u0434\u0435\u043b\u044c \u0411<\/p>\n<\/td>\n<td>\n<p align=\"left\">\u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 IMU (\u0441\u043a\u0430\u0447\u043e\u043a)<\/p>\n<\/td>\n<td>\n<p align=\"left\">0<\/p>\n<\/td>\n<td>\n<p align=\"left\">1<\/p>\n<\/td>\n<td>\n<p align=\"left\">1,02<\/p>\n<\/td>\n<\/tr>\n<tr>\n<td>\n<p align=\"left\">\u041f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435, \u043c\u043e\u0434\u0435\u043b\u044c \u0412<\/p>\n<\/td>\n<td>\n<p align=\"left\">\u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u0430\u044f \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u044f<\/p>\n<\/td>\n<td>\n<p align=\"left\">1<\/p>\n<\/td>\n<td>\n<p align=\"left\">2<\/p>\n<\/td>\n<td>\n<p align=\"left\">2,01<\/p>\n<\/td>\n<\/tr>\n<tr>\n<td>\n<p align=\"left\">\u041e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f, \u043c\u043e\u0434\u0435\u043b\u044c \u0411<\/p>\n<\/td>\n<td>\n<p align=\"left\">\u03b1, \u0442\u043e \u0435\u0441\u0442\u044c \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u0430\u044f \u03c9<\/p>\n<\/td>\n<td>\n<p align=\"left\">1<\/p>\n<\/td>\n<td>\n<p align=\"left\">2<\/p>\n<\/td>\n<td>\n<p align=\"left\">2,00<\/p>\n<\/td>\n<\/tr>\n<tr>\n<td>\n<p align=\"left\">\u041e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f, \u043c\u043e\u0434\u0435\u043b\u044c \u0412<\/p>\n<\/td>\n<td>\n<p align=\"left\">\u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u0430\u044f \u03b1<\/p>\n<\/td>\n<td>\n<p align=\"left\">2<\/p>\n<\/td>\n<td>\n<p align=\"left\">3<\/p>\n<\/td>\n<td>\n<p align=\"left\">3,00<\/p>\n<\/td>\n<\/tr>\n<\/tbody>\n<\/table>\n<\/div>\n<\/div>\n<p>\u041f\u043e\u043b\u0443\u0447\u0430\u0435\u0442\u0441\u044f, \u0447\u0442\u043e \u043d\u0430\u0431\u043b\u044e\u0434\u0430\u0435\u043c\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u0438 \u043f\u043e\u043a\u0430\u0437\u044b\u0432\u0430\u0435\u0442, \u043d\u0430\u0441\u043a\u043e\u043b\u044c\u043a\u043e \u0433\u043b\u0430\u0434\u043a\u0430 \u043c\u043e\u0434\u0435\u043b\u044c \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f. \u0423 \u043c\u043e\u0434\u0435\u043b\u0438 \u0410 \u043e\u043d \u0440\u0430\u0432\u0435\u043d \u043d\u0443\u043b\u044e: \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0441 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435\u043c \u043d\u0435 \u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u044b \u0432\u043e\u043e\u0431\u0449\u0435.<\/p>\n<p>\u0412\u0430\u0436\u043d\u0430\u044f \u043e\u0433\u043e\u0432\u043e\u0440\u043a\u0430: \u044d\u043a\u0441\u043f\u0435\u0440\u0438\u043c\u0435\u043d\u0442 \u043f\u0440\u043e\u0432\u0435\u0434\u0451\u043d \u0431\u0435\u0437 \u0448\u0443\u043c\u0430 \u0438 \u043d\u0430 \u043e\u0434\u043d\u043e\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438. \u041a\u0430\u043a \u0432\u0441\u0451 \u044d\u0442\u043e \u0432\u044b\u0433\u043b\u044f\u0434\u0438\u0442 \u043d\u0430 \u0444\u043e\u043d\u0435 \u0440\u0435\u0430\u043b\u044c\u043d\u043e\u0433\u043e \u0448\u0443\u043c\u0430 \u0438 \u0434\u0440\u0435\u0439\u0444\u0430 \u0438 \u043a\u0430\u043a \u0441\u043a\u0430\u0437\u044b\u0432\u0430\u0435\u0442\u0441\u044f \u043d\u0430 \u043d\u0430\u0441\u0442\u043e\u044f\u0449\u0435\u043c VIO-\u0430\u043b\u0433\u043e\u0440\u0438\u0442\u043c\u0435 \u2014 \u0441\u043b\u0435\u0434\u0443\u044e\u0449\u0438\u0439 \u0448\u0430\u0433 \u0440\u0430\u0431\u043e\u0442\u044b.<\/p>\n<h3>\u0418\u0442\u043e\u0433\u0438 \u0438 \u043e\u0433\u0440\u0430\u043d\u0438\u0447\u0435\u043d\u0438\u044f<\/h3>\n<p>\u0415\u0441\u043b\u0438 \u0432\u044b \u0433\u0435\u043d\u0435\u0440\u0438\u0440\u0443\u0435\u0442\u0435 \u0441\u0438\u043d\u0442\u0435\u0442\u0438\u0447\u0435\u0441\u043a\u0438\u0439 IMU \u043f\u043e \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u043a\u0430\u043c\u0435\u0440\u044b, \u0437\u0430\u0434\u0430\u0432\u0430\u0439\u0442\u0435 \u0438 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435, \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044e \u0434\u0432\u0430\u0436\u0434\u044b \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u0443\u0435\u043c\u044b\u043c\u0438 \u043a\u0440\u0438\u0432\u044b\u043c\u0438 \u0438 \u043f\u0440\u043e\u0432\u0435\u0440\u044f\u0439\u0442\u0435 \u0433\u0435\u043d\u0435\u0440\u0430\u0442\u043e\u0440 \u0441\u0445\u0435\u043c\u043e\u0439 \u0432\u044b\u0441\u043e\u043a\u043e\u0433\u043e \u043f\u043e\u0440\u044f\u0434\u043a\u0430.<\/p>\n<ul>\n<li>\n<p>\u041e\u0442\u0440\u0435\u0437\u043a\u0438 \u0441 SLERP \u043d\u0435 \u043f\u043e\u0434\u0445\u043e\u0434\u044f\u0442 \u0441\u043e\u0432\u0441\u0435\u043c: \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u043d\u0435 \u0432\u0438\u0434\u0438\u0442 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u043e\u0432 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438, \u0438 \u043e\u0448\u0438\u0431\u043a\u0430 \u043d\u0435 \u0443\u043c\u0435\u043d\u044c\u0448\u0430\u0435\u0442\u0441\u044f \u0441 \u0440\u043e\u0441\u0442\u043e\u043c \u0447\u0430\u0441\u0442\u043e\u0442\u044b.<\/p>\n<\/li>\n<li>\n<p>\u041a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0441\u043f\u043b\u0430\u0439\u043d \u0441 SQUAD \u0432\u044b\u0433\u043b\u044f\u0434\u0438\u0442 \u0433\u043b\u0430\u0434\u043a\u0438\u043c, \u043d\u043e \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0432 \u0443\u0437\u043b\u0430\u0445 \u0441\u043a\u0430\u0447\u0435\u0442. \u0427\u0435\u0440\u0435\u0437 \u0440\u044b\u0447\u0430\u0433 \u043c\u0435\u0436\u0434\u0443 \u043a\u0430\u043c\u0435\u0440\u043e\u0439 \u0438 IMU \u044d\u0442\u0438 \u0441\u043a\u0430\u0447\u043a\u0438 \u043f\u043e\u043f\u0430\u0434\u0430\u044e\u0442 \u0432 \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u0438 \u043e\u043f\u0443\u0441\u043a\u0430\u044e\u0442 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0441\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u0438 \u0434\u043e \u043f\u0435\u0440\u0432\u043e\u0433\u043e.<\/p>\n<\/li>\n<li>\n<p>\u0418\u0437 \u0442\u0440\u0451\u0445 \u043c\u043e\u0434\u0435\u043b\u0435\u0439 \u0442\u043e\u043b\u044c\u043a\u043e B-\u0441\u043f\u043b\u0430\u0439\u043d \u043d\u0430 SO(3) \u0434\u0430\u0451\u0442 \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u044b\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u043f\u0440\u0438 \u043b\u044e\u0431\u043e\u043c \u0440\u0430\u0441\u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0438 \u043a\u0430\u043c\u0435\u0440\u044b. \u0412\u0441\u0435 \u0435\u0433\u043e \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u0441\u0447\u0438\u0442\u0430\u044e\u0442\u0441\u044f \u043f\u043e \u0444\u043e\u0440\u043c\u0443\u043b\u0430\u043c.<\/p>\n<\/li>\n<li>\n<p>\u041f\u0440\u043e\u0432\u0435\u0440\u043a\u0430 \u043e\u0431\u0440\u0430\u0442\u043d\u044b\u043c \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u0435\u043c \u0441\u0445\u0435\u043c\u043e\u0439 \u043f\u0435\u0440\u0432\u043e\u0433\u043e \u043f\u043e\u0440\u044f\u0434\u043a\u0430 \u0440\u0430\u0437\u043d\u0438\u0446\u044b \u043c\u0435\u0436\u0434\u0443 \u043c\u043e\u0434\u0435\u043b\u044f\u043c\u0438 \u043d\u0435 \u0432\u0438\u0434\u0438\u0442. \u0420\u041a4 \u0435\u0451 \u043f\u043e\u043a\u0430\u0437\u044b\u0432\u0430\u0435\u0442, \u0430 \u043d\u0430\u0431\u043b\u044e\u0434\u0430\u0435\u043c\u044b\u0439 \u043f\u043e\u0440\u044f\u0434\u043e\u043a \u0433\u043e\u0432\u043e\u0440\u0438\u0442, \u043a\u0430\u043a\u0430\u044f \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u0430\u044f \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0440\u0430\u0437\u0440\u044b\u0432\u043d\u0430.<\/p>\n<\/li>\n<\/ul>\n<p>\u041e\u0433\u0440\u0430\u043d\u0438\u0447\u0435\u043d\u0438\u0435 \u043c\u043e\u0434\u0435\u043b\u0438: \u043e\u043d\u0430 \u0447\u0438\u0441\u0442\u043e \u043a\u0438\u043d\u0435\u043c\u0430\u0442\u0438\u0447\u0435\u0441\u043a\u0430\u044f, \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u0437\u0430\u0434\u0430\u044e\u0442\u0441\u044f \u043d\u0435\u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e. \u0423 \u043a\u0432\u0430\u0434\u0440\u043e\u043a\u043e\u043f\u0442\u0435\u0440\u0430 \u043e\u043d\u0438 \u0441\u0432\u044f\u0437\u0430\u043d\u044b: \u0442\u044f\u0433\u0430 \u043d\u0430\u043f\u0440\u0430\u0432\u043b\u0435\u043d\u0430 \u0432\u0434\u043e\u043b\u044c \u043e\u0441\u0438 \u043a\u043e\u0440\u043f\u0443\u0441\u0430, \u0438 \u043d\u0430\u043a\u043b\u043e\u043d \u0437\u0430\u0434\u0430\u0451\u0442\u0441\u044f \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435\u043c. \u041f\u043e\u044d\u0442\u043e\u043c\u0443 \u0443\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u0437\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0442\u0440\u0435\u0442\u044c\u0435\u0439 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u043e\u0439 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f (\u0440\u044b\u0432\u043a\u0430), \u0430 \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u2014 \u043e\u0442 \u0447\u0435\u0442\u0432\u0451\u0440\u0442\u043e\u0439 (\u0441\u043d\u044d\u043f\u0430). \u0414\u043b\u044f \u0444\u0438\u0437\u0438\u0447\u0435\u0441\u043a\u0438 \u0434\u043e\u0441\u0442\u0438\u0436\u0438\u043c\u043e\u0433\u043e \u043f\u043e\u043b\u0451\u0442\u0430 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0434\u043e\u043b\u0436\u043d\u043e \u0431\u044b\u0442\u044c \u0433\u043b\u0430\u0434\u043a\u0438\u043c \u0445\u043e\u0442\u044f \u0431\u044b \u0434\u043e C\u2074, \u0438 \u0437\u0434\u0435\u0441\u044c \u0441\u0442\u043e\u0438\u0442 \u0441\u043c\u043e\u0442\u0440\u0435\u0442\u044c \u0432 \u0441\u0442\u043e\u0440\u043e\u043d\u0443 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0439 \u0441 \u043c\u0438\u043d\u0438\u043c\u0430\u043b\u044c\u043d\u044b\u043c \u0441\u043d\u044d\u043f\u043e\u043c [17]. \u0414\u043b\u044f \u0442\u0435\u0441\u0442\u0430 VIO \u043a\u0438\u043d\u0435\u043c\u0430\u0442\u0438\u0447\u0435\u0441\u043a\u043e\u0439 \u043c\u043e\u0434\u0435\u043b\u0438 \u043e\u0431\u044b\u0447\u043d\u043e \u0445\u0432\u0430\u0442\u0430\u0435\u0442.<\/p>\n<p>\u0414\u0430\u043b\u044c\u0448\u0435 \u0432 \u0434\u0438\u043f\u043b\u043e\u043c\u0435 \u043f\u043e \u044d\u0442\u043e\u0439 \u0436\u0435 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0431\u0443\u0434\u0443\u0442 \u0440\u0435\u043d\u0434\u0435\u0440\u0438\u0442\u044c\u0441\u044f \u043a\u0430\u0434\u0440\u044b \u0441\u0446\u0435\u043d\u044b, \u0432\u043e\u0441\u0441\u0442\u0430\u043d\u043e\u0432\u043b\u0435\u043d\u043d\u043e\u0439 \u0433\u0430\u0443\u0441\u0441\u043e\u0432\u044b\u043c \u0441\u043f\u043b\u0430\u0442\u0442\u0438\u043d\u0433\u043e\u043c. \u041f\u043e\u043b\u0443\u0447\u0438\u0442\u0441\u044f \u043f\u043e\u043b\u043d\u044b\u0439 \u0432\u0438\u0437\u0443\u0430\u043b\u044c\u043d\u043e-\u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u044b\u0439 \u043d\u0430\u0431\u043e\u0440 \u0441 \u0438\u0437\u0432\u0435\u0441\u0442\u043d\u044b\u043c \u044d\u0442\u0430\u043b\u043e\u043d\u043e\u043c, \u043d\u0430 \u043a\u043e\u0442\u043e\u0440\u043e\u043c \u043c\u043e\u0436\u043d\u043e \u0433\u043e\u043d\u044f\u0442\u044c VIO \u0438 SLAM. \u041e\u0431 \u044d\u0442\u043e\u043c \u2014 \u0432 \u0441\u043b\u0435\u0434\u0443\u044e\u0449\u0438\u0439 \u0440\u0430\u0437.<\/p>\n<h4>\u041b\u0438\u0442\u0435\u0440\u0430\u0442\u0443\u0440\u0430<\/h4>\n<ol>\n<li>\n<p>Qin T., Li P., Shen S. VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator \/\/ IEEE Transactions on Robotics. 2018. Vol. 34, No. 4. P. 1004\u20131020.<\/p>\n<\/li>\n<li>\n<p>Campos C., Elvira R., G\u00f3mez Rodr\u00edguez J.J., Montiel J.M.M., Tard\u00f3s J.D. ORB-SLAM3: An Accurate Open-Source Library for Visual, Visual-Inertial, and Multimap SLAM \/\/ IEEE Transactions on Robotics. 2021. Vol. 37, No. 6. P. 1874\u20131890.<\/p>\n<\/li>\n<li>\n<p>Geneva P., Eckenhoff K., Lee W., Yang Y., Huang G. OpenVINS: A Research Platform for Visual-Inertial Estimation \/\/ ICRA 2020. P. 4666\u20134672. \u041a\u043e\u0434 \u0441\u0438\u043c\u0443\u043b\u044f\u0442\u043e\u0440\u0430:\u00a0<a href=\"https:\/\/docs.ros.org\/en\/api\/ov_msckf\/html\/Simulator_8cpp_source.html\" rel=\"noopener nofollow\">Simulator.cpp<\/a>.<\/p>\n<\/li>\n<li>\n<p>Burri M. et al. The EuRoC Micro Aerial Vehicle Datasets \/\/ The International Journal of Robotics Research. 2016. Vol. 35, No. 10. P. 1157\u20131163.<\/p>\n<\/li>\n<li>\n<p>Schubert D., Goll T., Demmel N., Usenko V., St\u00fcckler J., Cremers D. The TUM VI Benchmark for Evaluating Visual-Inertial Odometry \/\/ IROS 2018. P. 1680\u20131687.<\/p>\n<\/li>\n<li>\n<p>Shoemake K. Animating Rotation with Quaternion Curves \/\/ ACM SIGGRAPH Computer Graphics. 1985. Vol. 19, No. 3. P. 245\u2013254.<\/p>\n<\/li>\n<li>\n<p>Shoemake K. Quaternion Calculus and Fast Animation \/\/ SIGGRAPH 1987 Course Notes No. 10 \u00abComputer Animation: 3D Motion Specification and Control\u00bb. P. 101\u2013121.<\/p>\n<\/li>\n<li>\n<p>\u0414\u043e\u043a\u0443\u043c\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u0431\u0438\u0431\u043b\u0438\u043e\u0442\u0435\u043a\u0438 splines:\u00a0<a href=\"https:\/\/splines.readthedocs.io\/en\/latest\/rotation\/squad.html\" rel=\"noopener nofollow\">Spherical Quadrangle Interpolation (Squad)<\/a>.<\/p>\n<\/li>\n<li>\n<p>Python-\u043f\u043e\u0440\u0442 \u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u0438\u0437 OpenVINS:\u00a0<a href=\"https:\/\/decargroup.github.io\/navlie\/_build\/html\/_autosummary\/navlie.bspline.html\" rel=\"noopener nofollow\">navlie.bspline<\/a>.<\/p>\n<\/li>\n<li>\n<p>Furgale P., Rehder J., Siegwart R. Unified Temporal and Spatial Calibration for Multi-Sensor Systems \/\/ IROS 2013. P. 1280\u20131286.<\/p>\n<\/li>\n<li>\n<p>Lovegrove S., Patron-Perez A., Sibley G. Spline Fusion: A Continuous-Time Representation for Visual-Inertial Fusion with Application to Rolling Shutter Cameras \/\/ BMVC 2013.<\/p>\n<\/li>\n<li>\n<p>Patron-Perez A., Lovegrove S., Sibley G. A Spline-Based Trajectory Representation for Sensor Fusion and Rolling Shutter Cameras \/\/ International Journal of Computer Vision. 2015. Vol. 113, No. 3. P. 208\u2013219.<\/p>\n<\/li>\n<li>\n<p>Kim M.-J., Kim M.-S., Shin S.Y. A General Construction Scheme for Unit Quaternion Curves with Simple High Order Derivatives \/\/ SIGGRAPH 1995. P. 369\u2013376.<\/p>\n<\/li>\n<li>\n<p>Sommer C., Usenko V., Schubert D., Demmel N., Cremers D. Efficient Derivative Computation for Cumulative B-Splines on Lie Groups \/\/ CVPR 2020. P. 11145\u201311153.<\/p>\n<\/li>\n<li>\n<p>Kim M.-J., Kim M.-S., Shin S.Y. A C\u00b2-Continuous B-spline Quaternion Curve Interpolating a Given Sequence of Solid Orientations \/\/ Computer Animation \u201995. P. 72\u201381.<\/p>\n<\/li>\n<li>\n<p>Forster C., Carlone L., Dellaert F., Scaramuzza D. On-Manifold Preintegration for Real-Time Visual-Inertial Odometry \/\/ IEEE Transactions on Robotics. 2017. Vol. 33, No. 1. P. 1\u201321.<\/p>\n<\/li>\n<li>\n<p>Mellinger D., Kumar V. Minimum Snap Trajectory Generation and Control for Quadrotors \/\/ ICRA 2011.<\/p>\n<\/li>\n<li>\n<p>Young A.D., Ling M.J., Arvind D.K. IMUSim: A Simulation Environment for Inertial Sensing Algorithm Design and Evaluation \/\/ IPSN 2011. P. 199\u2013210.<\/p>\n<\/li>\n<\/ol>\n<\/div>\n<p>\u0441\u0441\u044b\u043b\u043a\u0430 \u043d\u0430 \u043e\u0440\u0438\u0433\u0438\u043d\u0430\u043b \u0441\u0442\u0430\u0442\u044c\u0438 <a href=\"https:\/\/habr.com\/ru\/articles\/1110044\/\">https:\/\/habr.com\/ru\/articles\/1110044\/<\/a><\/p>\n","protected":false},"excerpt":{"rendered":"<p>\u0417\u0430\u0447\u0435\u043c \u0432\u0441\u0451 \u044d\u0442\u043e\u042f \u0441\u0433\u0435\u043d\u0435\u0440\u0438\u0440\u043e\u0432\u0430\u043b\u0430 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0438\u0434\u0435\u0430\u043b\u044c\u043d\u043e\u0433\u043e IMU \u2014 \u0431\u0435\u0437 \u0448\u0443\u043c\u0430 \u0438 \u0434\u0440\u0435\u0439\u0444\u0430 \u2014 \u043f\u043e \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438, \u0437\u0430\u0434\u0430\u043d\u043d\u043e\u0439 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u043c\u0438 \u043f\u043e\u0437\u0430\u043c\u0438 \u0438 \u0441\u0444\u0435\u0440\u0438\u0447\u0435\u0441\u043a\u043e\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u0435\u0439, \u0438 \u043f\u0440\u043e\u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043b\u0430 \u0438\u0445 \u043e\u0431\u0440\u0430\u0442\u043d\u043e. \u0421\u0440\u0435\u0434\u043d\u0435\u043a\u0432\u0430\u0434\u0440\u0430\u0442\u0438\u0447\u043d\u0430\u044f \u043e\u0448\u0438\u0431\u043a\u0430 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u0437\u0430 10 \u0441\u0435\u043a\u0443\u043d\u0434 \u043f\u043e\u043b\u0443\u0447\u0438\u043b\u0430\u0441\u044c \u043e\u043a\u043e\u043b\u043e 8 \u043c\u0435\u0442\u0440\u043e\u0432. \u041f\u043e\u0432\u044b\u0448\u0435\u043d\u0438\u0435 \u0447\u0430\u0441\u0442\u043e\u0442\u044b \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u0441 50 \u0434\u043e 1600 \u0413\u0446 \u0435\u0451 \u043d\u0435 \u0443\u043c\u0435\u043d\u044c\u0448\u0438\u043b\u043e.\u0421 \u0434\u0440\u0443\u0433\u043e\u0439 \u043c\u043e\u0434\u0435\u043b\u044c\u044e \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0442\u0430 \u0436\u0435 \u043f\u0440\u043e\u0432\u0435\u0440\u043a\u0430 \u043f\u0440\u0438 200 \u0413\u0446 \u0434\u0430\u0451\u0442 \u043e\u0442 10 \u0441\u043c \u0434\u043e 10\u207b\u00b9\u00b9 \u043c \u2014 \u0432 \u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e\u0441\u0442\u0438 \u043e\u0442 \u0441\u0445\u0435\u043c\u044b \u0438\u043d\u0442\u0435\u0433\u0440\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f. \u0413\u043b\u0430\u0432\u043d\u043e\u0435 \u0434\u0430\u0436\u0435 \u043d\u0435 \u0441\u0430\u043c\u0438 \u0447\u0438\u0441\u043b\u0430, \u0430 \u0442\u043e, \u0447\u0442\u043e \u043e\u0448\u0438\u0431\u043a\u0430 \u0443\u043c\u0435\u043d\u044c\u0448\u0430\u0435\u0442\u0441\u044f \u0441 \u0448\u0430\u0433\u043e\u043c \u0442\u0430\u043a, \u043a\u0430\u043a \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u043e \u0434\u0430\u043d\u043d\u043e\u0439 \u0441\u0445\u0435\u043c\u0435. \u042d\u0442\u0430 \u0441\u0442\u0430\u0442\u044c\u044f \u043e \u0442\u043e\u043c, \u043e\u0442\u043a\u0443\u0434\u0430 \u0442\u0430\u043a\u0430\u044f \u0440\u0430\u0437\u043d\u0438\u0446\u0430.\u0410\u043b\u0433\u043e\u0440\u0438\u0442\u043c\u044b \u0432\u0438\u0437\u0443\u0430\u043b\u044c\u043d\u043e-\u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u043e\u0439 \u043e\u0434\u043e\u043c\u0435\u0442\u0440\u0438\u0438 (VIO) \u0438 SLAM \u2014 VINS-Mono [1], ORB-SLAM3 [2], OpenVINS [3] \u2014 \u043e\u0446\u0435\u043d\u0438\u0432\u0430\u044e\u0442 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e \u0438\u0437\u043e\u0431\u0440\u0430\u0436\u0435\u043d\u0438\u044f\u043c \u0438 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f\u043c \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u043e\u0433\u043e \u0431\u043b\u043e\u043a\u0430: \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0438 \u0433\u0438\u0440\u043e\u0441\u043a\u043e\u043f\u0430. \u0427\u0442\u043e\u0431\u044b \u0438\u0445 \u0441\u0440\u0430\u0432\u043d\u0438\u0432\u0430\u0442\u044c \u0438 \u043e\u0442\u043b\u0430\u0436\u0438\u0432\u0430\u0442\u044c, \u043d\u0443\u0436\u043d\u044b \u0434\u0430\u043d\u043d\u044b\u0435 \u0441 \u0442\u043e\u0447\u043d\u043e \u0438\u0437\u0432\u0435\u0441\u0442\u043d\u043e\u0439 \u0438\u0441\u0442\u0438\u043d\u043d\u043e\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0435\u0439.\u0412 \u0440\u0435\u0430\u043b\u044c\u043d\u044b\u0445 \u043d\u0430\u0431\u043e\u0440\u0430\u0445 \u0432\u0440\u043e\u0434\u0435 EuRoC [4] \u0438 TUM VI [5] \u044d\u0442\u0430\u043b\u043e\u043d \u0441\u043d\u044f\u0442 \u0432\u043d\u0435\u0448\u043d\u0435\u0439 \u0441\u0438\u0441\u0442\u0435\u043c\u043e\u0439: \u0437\u0430\u0445\u0432\u0430\u0442\u0430 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f \u0438\u043b\u0438, \u0432 \u0447\u0430\u0441\u0442\u0438 \u0441\u0435\u0440\u0438\u0439 EuRoC, \u043b\u0430\u0437\u0435\u0440\u043d\u044b\u043c \u0442\u0440\u0435\u043a\u0435\u0440\u043e\u043c, \u043a\u043e\u0442\u043e\u0440\u044b\u0439 \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 \u0442\u043e\u043b\u044c\u043a\u043e \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435. \u042d\u0442\u0430\u043b\u043e\u043d \u0434\u043e\u0441\u0442\u0443\u043f\u0435\u043d \u0442\u043e\u043b\u044c\u043a\u043e \u0432 \u0437\u043e\u043d\u0435 \u0434\u0435\u0439\u0441\u0442\u0432\u0438\u044f \u044d\u0442\u043e\u0439 \u0441\u0438\u0441\u0442\u0435\u043c\u044b \u0438 \u0441\u0430\u043c \u0441\u043e\u0434\u0435\u0440\u0436\u0438\u0442 \u043f\u043e\u0433\u0440\u0435\u0448\u043d\u043e\u0441\u0442\u044c. \u041a \u0442\u043e\u043c\u0443 \u0436\u0435 \u0443\u0441\u043b\u043e\u0432\u0438\u044f \u0437\u0430\u043f\u0438\u0441\u0438 \u0437\u0430\u0444\u0438\u043a\u0441\u0438\u0440\u043e\u0432\u0430\u043d\u044b: \u043d\u0435\u043b\u044c\u0437\u044f \u0432\u0437\u044f\u0442\u044c \u0442\u0443 \u0436\u0435 \u0437\u0430\u043f\u0438\u0441\u044c \u0438 \u043e\u0442\u0434\u0435\u043b\u044c\u043d\u043e \u043f\u043e\u043c\u0435\u043d\u044f\u0442\u044c \u0448\u0443\u043c \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u0438\u043b\u0438 \u0440\u0430\u0441\u0441\u0442\u043e\u044f\u043d\u0438\u0435 \u043c\u0435\u0436\u0434\u0443 \u043a\u0430\u043c\u0435\u0440\u043e\u0439 \u0438 IMU. \u0412 \u0441\u0438\u043d\u0442\u0435\u0442\u0438\u0447\u0435\u0441\u043a\u0438\u0445 \u0434\u0430\u043d\u043d\u044b\u0445 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u0437\u0430\u0434\u0430\u0451\u0442\u0441\u044f \u043f\u0440\u043e\u0433\u0440\u0430\u043c\u043c\u043d\u043e, \u0438 \u0432\u0441\u0435 \u043f\u0430\u0440\u0430\u043c\u0435\u0442\u0440\u044b \u043c\u0435\u043d\u044f\u044e\u0442\u0441\u044f \u043d\u0435\u0437\u0430\u0432\u0438\u0441\u0438\u043c\u043e.\u0421\u0438\u043d\u0442\u0435\u0442\u0438\u043a\u0430 \u043f\u043e\u043b\u0435\u0437\u043d\u0430, \u0442\u043e\u043b\u044c\u043a\u043e \u0435\u0441\u043b\u0438 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0434\u0430\u0442\u0447\u0438\u043a\u043e\u0432 \u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u044b \u0441 \u0437\u0430\u0434\u0430\u043d\u043d\u044b\u043c \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435\u043c, \u0430 \u044d\u0442\u043e \u0437\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0442\u043e\u0433\u043e, \u043a\u0430\u043a \u0438\u043c\u0435\u043d\u043d\u043e \u0437\u0430\u0434\u0430\u043d\u0430 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f. \u042d\u0442\u043e \u0447\u0430\u0441\u0442\u044c \u043c\u043e\u0435\u0439 \u0434\u0438\u043f\u043b\u043e\u043c\u043d\u043e\u0439 \u0440\u0430\u0431\u043e\u0442\u044b \u0432 \u041d\u0418\u0422\u0423 \u00ab\u041c\u0418\u0421\u0418\u0421\u00bb: \u0442\u0430\u043c \u043f\u043e \u0442\u043e\u0439 \u0436\u0435 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0440\u0435\u043d\u0434\u0435\u0440\u044f\u0442\u0441\u044f \u043a\u0430\u0434\u0440\u044b \u0441\u0446\u0435\u043d\u044b, \u0432\u043e\u0441\u0441\u0442\u0430\u043d\u043e\u0432\u043b\u0435\u043d\u043d\u043e\u0439 \u0433\u0430\u0443\u0441\u0441\u043e\u0432\u044b\u043c \u0441\u043f\u043b\u0430\u0442\u0442\u0438\u043d\u0433\u043e\u043c. \u0417\u0434\u0435\u0441\u044c \u0442\u043e\u043b\u044c\u043a\u043e \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u0430\u044f \u0447\u0430\u0441\u0442\u044c.\u0427\u0442\u043e \u043d\u0430 \u0441\u0430\u043c\u043e\u043c \u0434\u0435\u043b\u0435 \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 IMU\u041f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0437\u0430\u0432\u0438\u0441\u044f\u0442 \u043e\u0442 \u0432\u0442\u043e\u0440\u043e\u0439 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u043e\u0439 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f, \u0430 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0433\u0438\u0440\u043e\u0441\u043a\u043e\u043f\u0430 \u2014 \u043e\u0442 \u043f\u0435\u0440\u0432\u043e\u0439 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u043e\u0439 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438. \u0418\u0437 \u044d\u0442\u043e\u0433\u043e \u0441\u043b\u0435\u0434\u0443\u044e\u0442 \u0432\u0441\u0435 \u0442\u0440\u0435\u0431\u043e\u0432\u0430\u043d\u0438\u044f \u043a \u043c\u043e\u0434\u0435\u043b\u0438 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f.\u0412\u0432\u0435\u0434\u0443 \u0442\u0440\u0438 \u0441\u0438\u0441\u0442\u0435\u043c\u044b \u043a\u043e\u043e\u0440\u0434\u0438\u043d\u0430\u0442: \u043c\u0438\u0440 W (\u043e\u0441\u044c z \u0432\u0432\u0435\u0440\u0445), IMU B \u0438 \u043a\u0430\u043c\u0435\u0440\u0430 C. \u041c\u0430\u0442\u0440\u0438\u0446\u0430 R_XY \u043f\u0435\u0440\u0435\u0432\u043e\u0434\u0438\u0442 \u043a\u043e\u043e\u0440\u0434\u0438\u043d\u0430\u0442\u044b \u0438\u0437 \u0441\u0438\u0441\u0442\u0435\u043c\u044b Y \u0432 X, \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0441\u0432\u043e\u0431\u043e\u0434\u043d\u043e\u0433\u043e \u043f\u0430\u0434\u0435\u043d\u0438\u044f g = (0, 0, \u22129,81) \u043c\/\u0441\u00b2. \u0421\u0442\u0430\u043d\u0434\u0430\u0440\u0442\u043d\u0430\u044f \u043c\u043e\u0434\u0435\u043b\u044c \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u0439:\u0417\u0434\u0435\u0441\u044c b \u2014 \u043c\u0435\u0434\u043b\u0435\u043d\u043d\u043e \u0443\u043f\u043b\u044b\u0432\u0430\u044e\u0449\u0438\u0435 \u0441\u043c\u0435\u0449\u0435\u043d\u0438\u044f \u043d\u0443\u043b\u044f, \u03b7 \u2014 \u0431\u0435\u043b\u044b\u0439 \u0448\u0443\u043c. \u0414\u043b\u044f \u0440\u0430\u0437\u0433\u043e\u0432\u043e\u0440\u0430 \u043e \u043c\u043e\u0434\u0435\u043b\u0438 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f \u0438\u0445 \u043c\u043e\u0436\u043d\u043e \u0441\u0447\u0438\u0442\u0430\u0442\u044c \u043d\u0443\u043b\u0435\u0432\u044b\u043c\u0438: \u0432\u0441\u0435 \u043f\u0440\u043e\u0431\u043b\u0435\u043c\u044b \u043d\u0438\u0436\u0435 \u0432\u043e\u0437\u043d\u0438\u043a\u0430\u044e\u0442 \u0438 \u0431\u0435\u0437 \u043d\u0438\u0445.\u0410\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 \u043d\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435, \u0430 \u0443\u0434\u0435\u043b\u044c\u043d\u0443\u044e \u0441\u0438\u043b\u0443: \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043c\u0438\u043d\u0443\u0441 g, \u043f\u043e\u0432\u0451\u0440\u043d\u0443\u0442\u043e\u0435 \u0432 \u0441\u0438\u0441\u0442\u0435\u043c\u0443 \u0434\u0430\u0442\u0447\u0438\u043a\u0430. \u041d\u0435\u043f\u043e\u0434\u0432\u0438\u0436\u043d\u044b\u0439 \u0434\u0430\u0442\u0447\u0438\u043a \u043d\u0430 \u0441\u0442\u043e\u043b\u0435 \u043f\u043e\u043a\u0430\u0437\u044b\u0432\u0430\u0435\u0442 +9,81 \u043c\/\u0441\u00b2 \u0432\u0432\u0435\u0440\u0445, \u0430 \u043f\u0430\u0434\u0430\u044e\u0449\u0438\u0439 \u2014 \u043d\u043e\u043b\u044c.\u0413\u0438\u0440\u043e\u0441\u043a\u043e\u043f \u0438\u0437\u043c\u0435\u0440\u044f\u0435\u0442 \u0443\u0433\u043b\u043e\u0432\u0443\u044e \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u03c9. \u041e\u043d\u0430 \u0441\u0432\u044f\u0437\u0430\u043d\u0430 \u0441 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u043e\u0439 \u043c\u0430\u0442\u0440\u0438\u0446\u044b \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u0430 \u0441\u043e\u043e\u0442\u043d\u043e\u0448\u0435\u043d\u0438\u0435\u043c\u0433\u0434\u0435 [\u03c9]\u00d7 \u2014 \u043a\u043e\u0441\u043e\u0441\u0438\u043c\u043c\u0435\u0442\u0440\u0438\u0447\u043d\u0430\u044f \u043c\u0430\u0442\u0440\u0438\u0446\u0430 \u0432\u0435\u043a\u0442\u043e\u0440\u043d\u043e\u0433\u043e \u043f\u0440\u043e\u0438\u0437\u0432\u0435\u0434\u0435\u043d\u0438\u044f. \u041f\u043e\u044d\u0442\u043e\u043c\u0443, \u0447\u0442\u043e\u0431\u044b \u0441\u0433\u0435\u043d\u0435\u0440\u0438\u0440\u043e\u0432\u0430\u0442\u044c \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f, \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044e \u043d\u0443\u0436\u043d\u043e \u0443\u043c\u0435\u0442\u044c \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u043e\u0432\u0430\u0442\u044c: \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0434\u0432\u0430\u0436\u0434\u044b, \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044e \u0445\u043e\u0442\u044f \u0431\u044b \u043e\u0434\u0438\u043d \u0440\u0430\u0437. \u041f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u043f\u0440\u0438 \u044d\u0442\u043e\u043c \u0434\u043e\u043b\u0436\u043d\u044b \u0432\u0435\u0441\u0442\u0438 \u0441\u0435\u0431\u044f \u043a\u0430\u043a \u0443 \u0444\u0438\u0437\u0438\u0447\u0435\u0441\u043a\u043e\u0433\u043e \u0442\u0435\u043b\u0430, \u0431\u0435\u0437 \u0441\u043a\u0430\u0447\u043a\u043e\u0432, \u043a\u043e\u0442\u043e\u0440\u044b\u0445 \u0432 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0438 \u043d\u0435 \u0431\u044b\u043b\u043e.\u0418 \u043f\u0440\u0430\u043a\u0442\u0438\u0447\u0435\u0441\u043a\u0430\u044f \u0434\u0435\u0442\u0430\u043b\u044c: \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u043b\u0443\u0447\u0448\u0435 \u0441\u0447\u0438\u0442\u0430\u0442\u044c \u0430\u043d\u0430\u043b\u0438\u0442\u0438\u0447\u0435\u0441\u043a\u0438, \u0430 \u043d\u0435 \u043a\u043e\u043d\u0435\u0447\u043d\u044b\u043c\u0438 \u0440\u0430\u0437\u043d\u043e\u0441\u0442\u044f\u043c\u0438. \u0418\u043d\u0430\u0447\u0435 \u043f\u043e\u0433\u0440\u0435\u0448\u043d\u043e\u0441\u0442\u044c \u0447\u0438\u0441\u043b\u0435\u043d\u043d\u043e\u0433\u043e \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u043e\u0432\u0430\u043d\u0438\u044f \u0441\u043c\u0435\u0448\u0430\u0435\u0442\u0441\u044f \u0441 \u0448\u0443\u043c\u043e\u043c, \u043a\u043e\u0442\u043e\u0440\u044b\u0439 \u043c\u044b \u0441\u0430\u043c\u0438 \u0434\u043e\u0431\u0430\u0432\u043b\u044f\u0435\u043c, \u0438 \u0440\u0430\u0437\u0434\u0435\u043b\u0438\u0442\u044c \u0438\u0445 \u0443\u0436\u0435 \u043d\u0435 \u043f\u043e\u043b\u0443\u0447\u0438\u0442\u0441\u044f.\u041f\u0440\u043e\u0441\u0442\u043e \u0441\u043e\u0435\u0434\u0438\u043d\u0438\u0442\u044c \u0442\u043e\u0447\u043a\u0438: \u0447\u0442\u043e \u0438\u0434\u0451\u0442 \u043d\u0435 \u0442\u0430\u043a\u0421\u0430\u043c\u044b\u0439 \u043e\u0447\u0435\u0432\u0438\u0434\u043d\u044b\u0439 \u0441\u043f\u043e\u0441\u043e\u0431 \u0437\u0430\u0434\u0430\u0442\u044c \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435 \u2014 \u0432\u0437\u044f\u0442\u044c \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u0437\u044b \u0438 \u0441\u043e\u0435\u0434\u0438\u043d\u0438\u0442\u044c \u0438\u0445: \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u043e\u0442\u0440\u0435\u0437\u043a\u0430\u043c\u0438 \u043f\u0440\u044f\u043c\u044b\u0445, \u043f\u043e\u0432\u043e\u0440\u043e\u0442 \u0441\u0444\u0435\u0440\u0438\u0447\u0435\u0441\u043a\u043e\u0439 \u043b\u0438\u043d\u0435\u0439\u043d\u043e\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u0435\u0439 \u043a\u0432\u0430\u0442\u0435\u0440\u043d\u0438\u043e\u043d\u043e\u0432 (SLERP [6]). \u041d\u0430 \u0430\u043d\u0438\u043c\u0430\u0446\u0438\u0438 \u044d\u0442\u043e \u0432\u044b\u0433\u043b\u044f\u0434\u0438\u0442 \u043d\u043e\u0440\u043c\u0430\u043b\u044c\u043d\u043e, \u043d\u043e \u0434\u0430\u0442\u0447\u0438\u043a\u0438 \u0432\u0438\u0434\u044f\u0442 \u0434\u0440\u0443\u0433\u0443\u044e \u043a\u0430\u0440\u0442\u0438\u043d\u0443.\u0412\u043d\u0443\u0442\u0440\u0438 \u043e\u0442\u0440\u0435\u0437\u043a\u0430 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043f\u043e\u0441\u0442\u043e\u044f\u043d\u043d\u0430 \u0438 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0440\u0430\u0432\u043d\u043e \u043d\u0443\u043b\u044e. \u0410\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u0432\u0438\u0434\u0438\u0442 \u0442\u043e\u043b\u044c\u043a\u043e \u0433\u0440\u0430\u0432\u0438\u0442\u0430\u0446\u0438\u044e (\u0438 \u0446\u0435\u043d\u0442\u0440\u043e\u0441\u0442\u0440\u0435\u043c\u0438\u0442\u0435\u043b\u044c\u043d\u044b\u0439 \u0447\u043b\u0435\u043d, \u0435\u0441\u043b\u0438 \u043a\u0430\u043c\u0435\u0440\u0430 \u0441\u043c\u0435\u0449\u0435\u043d\u0430 \u043e\u0442\u043d\u043e\u0441\u0438\u0442\u0435\u043b\u044c\u043d\u043e IMU).\u0412 \u0443\u0437\u043b\u0435 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043c\u0435\u043d\u044f\u0435\u0442\u0441\u044f \u043c\u0433\u043d\u043e\u0432\u0435\u043d\u043d\u043e. \u0423\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0432 \u044d\u0442\u043e\u0442 \u043c\u043e\u043c\u0435\u043d\u0442 \u2014 \u0434\u0435\u043b\u044c\u0442\u0430-\u0444\u0443\u043d\u043a\u0446\u0438\u044f, \u0438 \u0434\u0438\u0441\u043a\u0440\u0435\u0442\u043d\u044b\u0439 \u0434\u0430\u0442\u0447\u0438\u043a \u0435\u0451 \u043d\u0435 \u0437\u0430\u043c\u0435\u0447\u0430\u0435\u0442.\u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043f\u043e\u0441\u0442\u043e\u044f\u043d\u043d\u0430 \u043d\u0430 \u043e\u0442\u0440\u0435\u0437\u043a\u0435 \u0438 \u0441\u043a\u0430\u0447\u0435\u0442 \u0432 \u0443\u0437\u043b\u0430\u0445 \u2014 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u043d\u0430 \u0432\u0435\u0440\u0445\u043d\u0435\u043c \u0433\u0440\u0430\u0444\u0438\u043a\u0435 \u0440\u0438\u0441. 1.\u0418\u043d\u0442\u0435\u0433\u0440\u0430\u0442\u043e\u0440 \u0442\u0430\u043a\u0438\u0445 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u0439 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u043e\u0432 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0432 \u0443\u0437\u043b\u0430\u0445 \u043d\u0435 \u0432\u0438\u0434\u0438\u0442 \u0438 \u043d\u0430\u0432\u0441\u0435\u0433\u0434\u0430 \u0441\u043e\u0445\u0440\u0430\u043d\u044f\u0435\u0442 \u043d\u0430\u0447\u0430\u043b\u044c\u043d\u0443\u044e \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c. \u041c\u043e\u044f \u0442\u0435\u0441\u0442\u043e\u0432\u0430\u044f \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u2014 \u0432\u043e\u0441\u044c\u043c\u0451\u0440\u043a\u0430 4 \u00d7 3 \u043c \u0441 \u043a\u043e\u043b\u0435\u0431\u0430\u043d\u0438\u044f\u043c\u0438 \u043f\u043e \u0432\u044b\u0441\u043e\u0442\u0435, \u043a\u0440\u0435\u043d\u0443, \u0442\u0430\u043d\u0433\u0430\u0436\u0443 \u0438 \u0440\u044b\u0441\u043a\u0430\u043d\u0438\u044e, 21 \u043a\u043b\u044e\u0447\u0435\u0432\u0430\u044f \u043f\u043e\u0437\u0430 \u0447\u0435\u0440\u0435\u0437 0,5 \u0441, \u0432\u0441\u0435\u0433\u043e 10 \u0441. \u041d\u0430 \u043d\u0435\u0439 \u0441\u0440\u0435\u0434\u043d\u0435\u043a\u0432\u0430\u0434\u0440\u0430\u0442\u0438\u0447\u043d\u0430\u044f \u043e\u0448\u0438\u0431\u043a\u0430 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043e\u043a\u043e\u043b\u043e 8 \u043c \u043f\u0440\u0438 \u043b\u044e\u0431\u043e\u0439 \u0447\u0430\u0441\u0442\u043e\u0442\u0435 IMU. \u042d\u0442\u043e \u043d\u0435 \u043f\u043e\u0433\u0440\u0435\u0448\u043d\u043e\u0441\u0442\u044c, \u043a\u043e\u0442\u043e\u0440\u0430\u044f \u0443\u043c\u0435\u043d\u044c\u0448\u0430\u0435\u0442\u0441\u044f \u0441 \u0448\u0430\u0433\u043e\u043c, \u0430 \u0440\u0430\u0441\u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u0438\u0435 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u0439 \u0441 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u0435\u043c.\u041e\u0447\u0435\u0432\u0438\u0434\u043d\u0430\u044f \u043f\u043e\u043f\u0440\u0430\u0432\u043a\u0430 \u2014 \u043f\u043b\u0430\u0432\u043d\u0430\u044f \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u044f. \u0414\u043b\u044f \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u0431\u0435\u0440\u0451\u043c \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u043e\u043d\u043d\u044b\u0439 \u0441\u043f\u043b\u0430\u0439\u043d \u0441 \u0437\u0430\u0434\u0430\u043d\u043d\u044b\u043c\u0438 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044f\u043c\u0438 \u043d\u0430 \u043a\u043e\u043d\u0446\u0430\u0445, \u0432 scipy \u044d\u0442\u043e\u00a0CubicSpline(t, p, bc_type=((1, v0), (1, vK))). \u0414\u043b\u044f \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438 \u0431\u0435\u0440\u0451\u043c SQUAD [7] \u2014 \u0441\u0444\u0435\u0440\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0430\u043d\u0430\u043b\u043e\u0433 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u043e\u0439 \u0438\u043d\u0442\u0435\u0440\u043f\u043e\u043b\u044f\u0446\u0438\u0438 \u0438\u0437 \u043a\u043e\u043c\u043f\u044c\u044e\u0442\u0435\u0440\u043d\u043e\u0439 \u0430\u043d\u0438\u043c\u0430\u0446\u0438\u0438 (\u043f\u043e\u043d\u044f\u0442\u043d\u044b\u0439 \u0440\u0430\u0437\u0431\u043e\u0440 \u0435\u0441\u0442\u044c \u0432\u00a0\u0434\u043e\u043a\u0443\u043c\u0435\u043d\u0442\u0430\u0446\u0438\u0438 \u0431\u0438\u0431\u043b\u0438\u043e\u0442\u0435\u043a\u0438 splines\u00a0[8]). \u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u0441\u0442\u0430\u043d\u043e\u0432\u0438\u0442\u0441\u044f \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0439, \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0438\u0441\u0447\u0435\u0437\u0430\u044e\u0442.\u041d\u043e \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u03b1 = d\u03c9\/dt \u0443 SQUAD \u0432 \u043a\u0430\u0436\u0434\u043e\u043c \u0443\u0437\u043b\u0435 \u0441\u043a\u0430\u0447\u0435\u0442 (\u043d\u0438\u0436\u043d\u0438\u0439 \u0433\u0440\u0430\u0444\u0438\u043a, \u043e\u0440\u0430\u043d\u0436\u0435\u0432\u0430\u044f \u043f\u0438\u043b\u0430). \u041f\u043e \u043e\u0441\u0438 x \u0441\u0430\u043c\u044b\u0439 \u0431\u043e\u043b\u044c\u0448\u043e\u0439 \u0441\u043a\u0430\u0447\u043e\u043a \u2014 0,11 \u0440\u0430\u0434\/\u0441\u00b2 \u0432 \u0443\u0437\u043b\u0435 t = 9,5 \u0441, \u043f\u0440\u0438 \u0442\u043e\u043c \u0447\u0442\u043e \u0441\u0430\u043c\u043e \u03b1 \u0437\u0434\u0435\u0441\u044c \u043d\u0435 \u043f\u0440\u0435\u0432\u044b\u0448\u0430\u0435\u0442 0,19 \u0440\u0430\u0434\/\u0441\u00b2. \u041f\u043e \u043c\u043e\u0434\u0443\u043b\u044e \u0432\u0435\u043a\u0442\u043e\u0440\u0430 \u0441\u043a\u0430\u0447\u043a\u0438 \u0434\u043e\u0445\u043e\u0434\u044f\u0442 \u0434\u043e 0,12 \u0440\u0430\u0434\/\u0441\u00b2.\u0420\u0438\u0441. 1. \u0423\u0433\u043b\u043e\u0432\u0430\u044f \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c (\u0441\u0432\u0435\u0440\u0445\u0443) \u0438 \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 (\u0441\u043d\u0438\u0437\u0443) \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e \u043e\u0441\u0438 x \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438, \u0442\u0440\u0438 \u043c\u043e\u0434\u0435\u043b\u0438 \u043f\u043e \u043e\u0434\u043d\u0438\u043c \u0438 \u0442\u0435\u043c \u0436\u0435 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u043c \u043f\u043e\u0437\u0430\u043c. \u0423 SLERP \u2014 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0432 \u03c9, \u0443 SQUAD \u2014 \u0441\u043a\u0430\u0447\u043a\u0438 \u0432 \u03b1, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043e\u0431\u0430 \u0433\u0440\u0430\u0444\u0438\u043a\u0430 \u0433\u043b\u0430\u0434\u043a\u0438\u0435.\u0423\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043d\u0435 \u0432\u0445\u043e\u0434\u0438\u0442 \u043d\u0438 \u0432 \u043e\u0434\u043d\u0443 \u0438\u0437 \u0444\u043e\u0440\u043c\u0443\u043b \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u0439 \u0432\u044b\u0448\u0435. \u041e\u043d\u043e \u043d\u0430\u0447\u0438\u043d\u0430\u0435\u0442 \u0438\u0433\u0440\u0430\u0442\u044c \u0440\u043e\u043b\u044c, \u043a\u043e\u0433\u0434\u0430 \u043a\u0430\u043c\u0435\u0440\u0430 \u0438 IMU \u0441\u0442\u043e\u044f\u0442 \u0432 \u0440\u0430\u0437\u043d\u044b\u0445 \u043c\u0435\u0441\u0442\u0430\u0445.\u041b\u043e\u0432\u0443\u0448\u043a\u0430 \u0440\u044b\u0447\u0430\u0433\u0430\u041a\u0430\u043c\u0435\u0440\u0430 \u0438 IMU \u043f\u0440\u0430\u043a\u0442\u0438\u0447\u0435\u0441\u043a\u0438 \u0432\u0441\u0435\u0433\u0434\u0430 \u0441\u0442\u043e\u044f\u0442 \u0432 \u0440\u0430\u0437\u043d\u044b\u0445 \u0442\u043e\u0447\u043a\u0430\u0445. \u0418\u0437-\u0437\u0430 \u044d\u0442\u043e\u0433\u043e \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u043e\u043f\u0430\u0434\u0430\u0435\u0442 \u043f\u0440\u044f\u043c\u043e \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430.\u041a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u0437\u044b \u0435\u0441\u0442\u0435\u0441\u0442\u0432\u0435\u043d\u043d\u043e \u0437\u0430\u0434\u0430\u0432\u0430\u0442\u044c \u0434\u043b\u044f \u043a\u0430\u043c\u0435\u0440\u044b: \u0438\u043c\u0435\u043d\u043d\u043e \u043e\u043d\u0430 \u043e\u043f\u0440\u0435\u0434\u0435\u043b\u044f\u0435\u0442, \u0447\u0442\u043e \u0431\u0443\u0434\u0435\u0442 \u0432 \u043a\u0430\u0434\u0440\u0435. IMU \u0436\u0451\u0441\u0442\u043a\u043e \u0437\u0430\u043a\u0440\u0435\u043f\u043b\u0451\u043d \u0440\u044f\u0434\u043e\u043c, \u0432 \u0442\u043e\u0447\u043a\u0435 r \u0432 \u0441\u0438\u0441\u0442\u0435\u043c\u0435 \u043a\u0430\u043c\u0435\u0440\u044b, \u0442\u0430\u043a \u0447\u0442\u043e p_WB = p_WC + R_WC\u00b7r. \u0414\u0432\u0430\u0436\u0434\u044b \u043f\u0440\u043e\u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u0443\u0435\u043c \u0438 \u043f\u043e\u043b\u0443\u0447\u0430\u0435\u043c \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 IMU:\u042d\u0442\u043e \u0442\u0430 \u0436\u0435 \u0444\u0438\u0437\u0438\u043a\u0430, \u0447\u0442\u043e \u0443 \u0442\u043e\u0447\u043a\u0438 \u043d\u0430 \u0432\u0440\u0430\u0449\u0430\u044e\u0449\u0435\u043c\u0441\u044f \u0434\u0438\u0441\u043a\u0435: \u0446\u0435\u043d\u0442\u0440\u043e\u0441\u0442\u0440\u0435\u043c\u0438\u0442\u0435\u043b\u044c\u043d\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u03c9\u00d7(\u03c9\u00d7r) \u0438 \u043a\u0430\u0441\u0430\u0442\u0435\u043b\u044c\u043d\u043e\u0435 \u03b1\u00d7r. \u0423\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b \u0432\u0445\u043e\u0434\u0438\u0442 \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0447\u0435\u0440\u0435\u0437 \u0432\u0435\u043a\u0442\u043e\u0440\u043d\u043e\u0435 \u043f\u0440\u043e\u0438\u0437\u0432\u0435\u0434\u0435\u043d\u0438\u0435 \u03b1\u00d7r, \u0442\u043e \u0435\u0441\u0442\u044c \u043f\u0440\u043e\u043f\u043e\u0440\u0446\u0438\u043e\u043d\u0430\u043b\u044c\u043d\u043e \u0434\u043b\u0438\u043d\u0435 \u0440\u044b\u0447\u0430\u0433\u0430. \u041f\u043e\u044d\u0442\u043e\u043c\u0443 \u0441\u043a\u0430\u0447\u043a\u0438 \u03b1 \u0443 SQUAD \u043f\u0440\u0435\u0432\u0440\u0430\u0449\u0430\u044e\u0442\u0441\u044f \u0432 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430.\u0412 \u043c\u043e\u0451\u043c \u043f\u0440\u0438\u043c\u0435\u0440\u0435 IMU \u0441\u043c\u0435\u0449\u0451\u043d \u043e\u0442\u043d\u043e\u0441\u0438\u0442\u0435\u043b\u044c\u043d\u043e \u043a\u0430\u043c\u0435\u0440\u044b \u043d\u0430 8,5 \u0441\u043c \u0438 \u043f\u043e\u0432\u0451\u0440\u043d\u0443\u0442 \u043d\u0430 10\u00b0. \u0417\u043d\u0430\u0447\u0435\u043d\u0438\u044f \u044f \u0432\u044b\u0431\u0440\u0430\u043b\u0430 \u0441\u0430\u043c\u0430, \u043e\u0440\u0438\u0435\u043d\u0442\u0438\u0440\u0443\u044f\u0441\u044c \u043d\u0430 \u0440\u0430\u0437\u043c\u0435\u0440\u044b \u043d\u0435\u0431\u043e\u043b\u044c\u0448\u043e\u0433\u043e \u0434\u0440\u043e\u043d\u0430. \u041d\u0430 \u043d\u0430\u0441\u0442\u043e\u044f\u0449\u0435\u043c \u0443\u0441\u0442\u0440\u043e\u0439\u0441\u0442\u0432\u0435 \u0441\u043c\u0435\u0449\u0435\u043d\u0438\u0435 \u0431\u0435\u0440\u0451\u0442\u0441\u044f \u0438\u0437 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0438.\u0420\u0438\u0441. 2. \u0412\u043a\u043b\u0430\u0434 \u0440\u044b\u0447\u0430\u0433\u0430 \u0432 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u043f\u043e \u043e\u0441\u0438 z IMU \u043d\u0430 \u0432\u0441\u0435\u0439 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438. \u0423 SQUAD \u0432 \u043a\u0430\u0436\u0434\u043e\u043c \u0443\u0437\u043b\u0435 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0430, \u0443 B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430 \u043a\u0440\u0438\u0432\u0430\u044f \u0433\u043b\u0430\u0434\u043a\u0430\u044f.\u041f\u043e \u043e\u0441\u0438 z \u0441\u0430\u043c\u0430\u044f \u0431\u043e\u043b\u044c\u0448\u0430\u044f \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0430 \u2014 6 \u043c\u043c\/\u0441\u00b2 \u0432 \u0443\u0437\u043b\u0435 t = 0,5 \u0441, \u043f\u043e \u043c\u043e\u0434\u0443\u043b\u044e \u0432\u0435\u043a\u0442\u043e\u0440\u0430 \u2014 \u0434\u043e 6,5 \u043c\u043c\/\u0441\u00b2. \u0421\u0430\u043c \u0432\u043a\u043b\u0430\u0434 \u0440\u044b\u0447\u0430\u0433\u0430 \u0434\u043e\u0445\u043e\u0434\u0438\u0442 \u0434\u043e 11 \u043c\u043c\/\u0441\u00b2. \u042d\u0442\u043e \u043c\u0435\u043d\u044c\u0448\u0435 \u0448\u0443\u043c\u0430 \u043e\u0434\u043d\u043e\u0433\u043e \u043e\u0442\u0441\u0447\u0451\u0442\u0430 MEMS-\u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0443\u0440\u043e\u0432\u043d\u044f \u0434\u0430\u0442\u0447\u0438\u043a\u0430 \u0438\u0437 EuRoC: \u043f\u0440\u0438 200 \u0413\u0446 \u0442\u0430\u043c \u0434\u0435\u0441\u044f\u0442\u043a\u0438 \u043c\u043c\/\u0441\u00b2. \u0412 \u0437\u0430\u0448\u0443\u043c\u043b\u0451\u043d\u043d\u044b\u0445 \u0434\u0430\u043d\u043d\u044b\u0445 \u0442\u0430\u043a\u0438\u0435 \u0441\u0442\u0443\u043f\u0435\u043d\u044c\u043a\u0438 \u0433\u043b\u0430\u0437\u043e\u043c \u043d\u0435 \u0443\u0432\u0438\u0434\u0435\u0442\u044c. \u041d\u043e \u044d\u0442\u043e \u0441\u0438\u0441\u0442\u0435\u043c\u0430\u0442\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0430\u0440\u0442\u0435\u0444\u0430\u043a\u0442: \u043e\u043d \u0440\u0430\u0441\u0442\u0451\u0442 \u0441 \u0434\u043b\u0438\u043d\u043e\u0439 \u0440\u044b\u0447\u0430\u0433\u0430, \u0440\u0435\u0437\u043a\u043e\u0441\u0442\u044c\u044e \u043c\u0430\u043d\u0451\u0432\u0440\u043e\u0432 \u0438 \u0440\u0435\u0434\u043a\u043e\u0441\u0442\u044c\u044e \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0445 \u043f\u043e\u0437. \u0418, \u043a\u0430\u043a \u0431\u0443\u0434\u0435\u0442 \u0432\u0438\u0434\u043d\u043e \u0434\u0430\u043b\u044c\u0448\u0435, \u043e\u043d \u043b\u043e\u043c\u0430\u0435\u0442 \u043f\u0440\u043e\u0432\u0435\u0440\u043a\u0443 \u0441\u043e\u0433\u043b\u0430\u0441\u043e\u0432\u0430\u043d\u043d\u043e\u0441\u0442\u0438.\u0423\u0441\u043b\u043e\u0432\u0438\u0435 \u0433\u043b\u0430\u0434\u043a\u043e\u0441\u0442\u0438\u0423\u0442\u0432\u0435\u0440\u0436\u0434\u0435\u043d\u0438\u0435 \u043f\u0440\u043e\u0441\u0442\u043e\u0435, \u043f\u043e \u0441\u0443\u0442\u0438 \u044d\u0442\u043e \u0444\u043e\u0440\u043c\u0430\u043b\u0438\u0437\u0430\u0446\u0438\u044f, \u043d\u043e \u043f\u0440\u0438 \u0441\u043c\u0435\u0449\u0451\u043d\u043d\u043e\u0439 \u043a\u0430\u043c\u0435\u0440\u0435 \u0435\u0433\u043e \u043b\u0435\u0433\u043a\u043e \u0443\u043f\u0443\u0441\u0442\u0438\u0442\u044c. \u041f\u0443\u0441\u0442\u044c \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u043a\u0430\u043c\u0435\u0440\u044b \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u0430, \u0430 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u0434\u0432\u0430\u0436\u0434\u044b \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e \u0434\u0438\u0444\u0444\u0435\u0440\u0435\u043d\u0446\u0438\u0440\u0443\u0435\u043c\u044b \u043d\u0430 \u043a\u0430\u0436\u0434\u043e\u043c \u043a\u0443\u0441\u043a\u0435 \u043d\u0435\u043a\u043e\u0442\u043e\u0440\u043e\u0433\u043e \u0440\u0430\u0437\u0431\u0438\u0435\u043d\u0438\u044f \u043e\u0442\u0440\u0435\u0437\u043a\u0430 \u0432\u0440\u0435\u043c\u0435\u043d\u0438. \u0422\u043e\u0433\u0434\u0430:\u0418\u0434\u0435\u0430\u043b\u044c\u043d\u044b\u0435 (\u0431\u0435\u0437 \u0448\u0443\u043c\u0430) \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f IMU \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u044b \u043f\u0440\u0438 \u0432\u0441\u0435\u0445 r \u0442\u043e\u0433\u0434\u0430 \u0438 \u0442\u043e\u043b\u044c\u043a\u043e \u0442\u043e\u0433\u0434\u0430, \u043a\u043e\u0433\u0434\u0430 \u0438 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435, \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b \u043f\u0440\u0438\u043d\u0430\u0434\u043b\u0435\u0436\u0430\u0442 \u043a\u043b\u0430\u0441\u0441\u0443 C\u00b2.\u0414\u043e\u0441\u0442\u0430\u0442\u043e\u0447\u043d\u043e\u0441\u0442\u044c \u0432\u0438\u0434\u043d\u0430 \u0438\u0437 \u0444\u043e\u0440\u043c\u0443\u043b\u044b \u0432\u044b\u0448\u0435. \u041d\u0435\u043e\u0431\u0445\u043e\u0434\u0438\u043c\u043e\u0441\u0442\u044c \u043f\u043e\u043a\u0430\u0437\u044b\u0432\u0430\u0435\u0442\u0441\u044f \u0432 \u0442\u0440\u0438 \u0448\u0430\u0433\u0430:\u0413\u0438\u0440\u043e\u0441\u043a\u043e\u043f \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u0435\u043d, \u0437\u043d\u0430\u0447\u0438\u0442 \u03c9 \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u0430.\u041f\u0440\u0438 r = 0 \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440 \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u0435\u043d, \u0437\u043d\u0430\u0447\u0438\u0442 \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u043a\u0430\u043c\u0435\u0440\u044b.\u0422\u043e\u0433\u0434\u0430 \u043f\u0440\u0438 \u043b\u044e\u0431\u043e\u043c r \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e \u03b1\u00d7r, \u0438\u0437 \u0447\u0435\u0433\u043e \u043f\u043e\u0434\u0441\u0442\u0430\u043d\u043e\u0432\u043a\u043e\u0439 r = e\u2081, e\u2082, e\u2083 \u043f\u043e\u043b\u0443\u0447\u0430\u0435\u043c \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0441\u0442\u044c \u03b1.\u041d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0441\u0442\u044c \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u0438 \u0432 \u0443\u0441\u043b\u043e\u0432\u0438\u0438 \u0441\u0443\u0449\u0435\u0441\u0442\u0432\u0435\u043d\u043d\u0430. \u0423 \u043e\u0442\u0440\u0435\u0437\u043a\u043e\u0432 \u0441\u043e SLERP \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u0432 \u0443\u0437\u043b\u0430\u0445 \u0441\u043a\u0430\u0447\u0435\u0442, \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0441\u043e\u0434\u0435\u0440\u0436\u0438\u0442 \u03b4-\u0444\u0443\u043d\u043a\u0446\u0438\u044e, \u0438 \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0430\u043a\u0441\u0435\u043b\u0435\u0440\u043e\u043c\u0435\u0442\u0440\u0430 \u0432\u043e\u043e\u0431\u0449\u0435 \u043d\u0435 \u043e\u043f\u0440\u0435\u0434\u0435\u043b\u0435\u043d\u044b \u043a\u0430\u043a \u0444\u0443\u043d\u043a\u0446\u0438\u0438. \u042d\u0442\u0430 \u043c\u043e\u0434\u0435\u043b\u044c \u043f\u043e\u0434 \u0443\u0442\u0432\u0435\u0440\u0436\u0434\u0435\u043d\u0438\u0435 \u043d\u0435 \u043f\u043e\u0434\u043f\u0430\u0434\u0430\u0435\u0442.\u0421\u043b\u043e\u0432\u0430 \u00ab\u043f\u0440\u0438 \u0432\u0441\u0435\u0445 r\u00bb \u0442\u043e\u0436\u0435 \u0432\u0430\u0436\u043d\u044b. \u041f\u0440\u0438 \u043e\u0434\u043d\u043e\u043c \u0444\u0438\u043a\u0441\u0438\u0440\u043e\u0432\u0430\u043d\u043d\u043e\u043c r \u043d\u0435 \u043e\u0431\u044f\u0437\u0430\u0442\u0435\u043b\u044c\u043d\u044b \u043d\u0438 C\u00b2 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438, \u043d\u0438 \u0434\u0430\u0436\u0435 C\u00b2 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b: \u0441\u043a\u0430\u0447\u043e\u043a \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b \u043c\u043e\u0436\u0435\u0442 \u043a\u043e\u043c\u043f\u0435\u043d\u0441\u0438\u0440\u043e\u0432\u0430\u0442\u044c\u0441\u044f \u0441\u043a\u0430\u0447\u043a\u043e\u043c \u03b1\u00d7r. \u0422\u043e\u0447\u043d\u043e\u0435 \u0443\u0441\u043b\u043e\u0432\u0438\u0435 \u0434\u043b\u044f \u0444\u0438\u043a\u0441\u0438\u0440\u043e\u0432\u0430\u043d\u043d\u043e\u0433\u043e r \u2014 \u0433\u043b\u0430\u0434\u043a\u043e\u0441\u0442\u044c \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u0438 \u0441\u0430\u043c\u043e\u0433\u043e IMU: \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u043a\u043b\u0430\u0441\u0441\u0430 C\u00b2, \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u043a\u043b\u0430\u0441\u0441\u0430 C\u00b9.\u0418\u043c\u0435\u043d\u043d\u043e \u0442\u0430\u043a \u0443\u0441\u0442\u0440\u043e\u0435\u043d \u0441\u0438\u043c\u0443\u043b\u044f\u0442\u043e\u0440 OpenVINS [3]: \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u0437\u0430\u0434\u0430\u043d\u0430 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u043c B-\u0441\u043f\u043b\u0430\u0439\u043d\u043e\u043c \u043d\u0430 SE(3) \u0434\u043b\u044f \u0441\u0438\u0441\u0442\u0435\u043c\u044b IMU, \u0438 \u0432 \u0434\u043e\u043a\u0443\u043c\u0435\u043d\u0442\u0430\u0446\u0438\u0438 \u043f\u0440\u044f\u043c\u043e \u0441\u043a\u0430\u0437\u0430\u043d\u043e, \u0447\u0442\u043e \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0441\u043f\u043b\u0430\u0439\u043d \u0432\u044b\u0431\u0440\u0430\u043d \u0440\u0430\u0434\u0438 C\u00b2 \u0434\u043b\u044f \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u044b\u0445 \u0438\u0437\u043c\u0435\u0440\u0435\u043d\u0438\u0439 (\u0441\u043c.\u00a0Simulator.cpp,\u00a0\u043e\u043f\u0438\u0441\u0430\u043d\u0438\u0435 \u043a\u043b\u0430\u0441\u0441\u0430 BsplineSE3\u00a0\u0438 Python-\u043f\u043e\u0440\u0442\u00a0navlie.bspline[9]). \u041f\u0440\u043e\u0431\u043b\u0435\u043c\u0430 \u0440\u044b\u0447\u0430\u0433\u0430 \u0442\u0430\u043c \u043d\u0435 \u0432\u043e\u0437\u043d\u0438\u043a\u0430\u0435\u0442.\u041f\u043e\u0447\u0435\u043c\u0443 \u0431\u044b \u043d\u0435 \u0441\u0434\u0435\u043b\u0430\u0442\u044c \u0442\u0430\u043a \u0436\u0435? \u041c\u043d\u0435 \u043d\u0443\u0436\u043d\u044b \u043a\u0430\u0434\u0440\u044b, \u043e\u0442\u0440\u0435\u043d\u0434\u0435\u0440\u0435\u043d\u043d\u044b\u0435 \u0433\u0430\u0443\u0441\u0441\u043e\u0432\u044b\u043c \u0441\u043f\u043b\u0430\u0442\u0442\u0438\u043d\u0433\u043e\u043c, \u0430 \u0440\u0435\u043d\u0434\u0435\u0440 \u2014 \u0441\u0430\u043c\u0430\u044f \u0434\u043e\u0440\u043e\u0433\u0430\u044f \u0447\u0430\u0441\u0442\u044c. \u0415\u0441\u043b\u0438 \u0441\u043f\u043b\u0430\u0439\u043d \u0437\u0430\u0434\u0430\u043d \u0434\u043b\u044f \u043a\u0430\u043c\u0435\u0440\u044b, \u043e\u0434\u043d\u0430\u0436\u0434\u044b \u043e\u0442\u0440\u0435\u043d\u0434\u0435\u0440\u0435\u043d\u043d\u044b\u0435 \u043a\u0430\u0434\u0440\u044b \u043c\u043e\u0436\u043d\u043e \u0438\u0441\u043f\u043e\u043b\u044c\u0437\u043e\u0432\u0430\u0442\u044c \u0441 \u0440\u0430\u0437\u043d\u044b\u043c\u0438 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0430\u043c\u0438 \u043a\u0430\u043c\u0435\u0440\u0430\u2013IMU: \u043c\u0435\u043d\u044f\u044e\u0442\u0441\u044f \u0442\u043e\u043b\u044c\u043a\u043e \u043f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f IMU. \u0415\u0441\u043b\u0438 \u0441\u043f\u043b\u0430\u0439\u043d \u0437\u0430\u0434\u0430\u043d \u0434\u043b\u044f IMU, \u043f\u0440\u0438 \u0441\u043c\u0435\u043d\u0435 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0438 \u043c\u0435\u043d\u044f\u0435\u0442\u0441\u044f \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044f \u043a\u0430\u043c\u0435\u0440\u044b, \u0438 \u0440\u0435\u043d\u0434\u0435\u0440\u0438\u0442\u044c \u043f\u0440\u0438\u0445\u043e\u0434\u0438\u0442\u0441\u044f \u0437\u0430\u043d\u043e\u0432\u043e. \u041f\u043b\u0430\u0442\u0430 \u0437\u0430 \u0442\u0430\u043a\u043e\u0439 \u0432\u044b\u0431\u043e\u0440 \u2014 \u0443\u0433\u043b\u043e\u0432\u043e\u0435 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0432 \u0444\u043e\u0440\u043c\u0443\u043b\u0435 \u0440\u044b\u0447\u0430\u0433\u0430 \u0438 \u0442\u0440\u0435\u0431\u043e\u0432\u0430\u043d\u0438\u0435 C\u00b2 \u043a \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438.\u0420\u0435\u0448\u0435\u043d\u0438\u0435: B-\u0441\u043f\u043b\u0430\u0439\u043d\u044b \u0432 R\u00b3 \u0438 \u043d\u0430 SO(3)\u041d\u0443\u0436\u043d\u0430 \u043c\u043e\u0434\u0435\u043b\u044c, \u0432 \u043a\u043e\u0442\u043e\u0440\u043e\u0439 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u044f \u043f\u0440\u0438\u043d\u0430\u0434\u043b\u0435\u0436\u0430\u0442 C\u00b2, \u0430 \u0432\u0441\u0435 \u043f\u0440\u043e\u0438\u0437\u0432\u043e\u0434\u043d\u044b\u0435 \u0441\u0447\u0438\u0442\u0430\u044e\u0442\u0441\u044f \u043f\u043e \u0444\u043e\u0440\u043c\u0443\u043b\u0430\u043c. \u041e\u0431\u0430 \u0442\u0440\u0435\u0431\u043e\u0432\u0430\u043d\u0438\u044f \u0432\u044b\u043f\u043e\u043b\u043d\u044f\u0435\u0442 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 B-\u0441\u043f\u043b\u0430\u0439\u043d. \u0418\u0434\u0435\u044f \u043d\u0435 \u043d\u043e\u0432\u0430\u044f. \u041f\u043e\u043a\u0430\u0437\u0430\u043d\u0438\u044f \u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u044b\u0445 \u0434\u0430\u0442\u0447\u0438\u043a\u043e\u0432 \u043f\u043e \u043d\u0435\u043f\u0440\u0435\u0440\u044b\u0432\u043d\u043e\u0439 \u043c\u043e\u0434\u0435\u043b\u0438 \u0434\u0432\u0438\u0436\u0435\u043d\u0438\u044f \u0433\u0435\u043d\u0435\u0440\u0438\u0440\u0443\u0435\u0442, \u043d\u0430\u043f\u0440\u0438\u043c\u0435\u0440, IMUSim [18]. B-\u0441\u043f\u043b\u0430\u0439\u043d\u0430\u043c\u0438 \u0437\u0430\u0434\u0430\u0451\u0442 \u0442\u0440\u0430\u0435\u043a\u0442\u043e\u0440\u0438\u044e \u043f\u0430\u043a\u0435\u0442 \u043a\u0430\u043b\u0438\u0431\u0440\u043e\u0432\u043a\u0438 Kalibr [10], \u0430 \u0441\u0438\u043c\u0443\u043b\u044f\u0442\u043e\u0440 OpenVINS [3] \u0432\u044b\u0431\u0438\u0440\u0430\u0435\u0442 \u043a\u0443\u0431\u0438\u0447\u0435\u0441\u043a\u0438\u0439 \u0441\u043f\u043b\u0430\u0439\u043d \u0438\u043c\u0435\u043d\u043d\u043e \u0440\u0430\u0434\u0438 C\u00b2. \u041a\u0443\u043c\u0443\u043b\u044f\u0442\u0438\u0432\u043d\u0443\u044e \u0444\u043e\u0440\u043c\u0443 \u043d\u0430 \u0433\u0440\u0443\u043f\u043f\u0435 \u043f\u043e\u0432\u043e\u0440\u043e\u0442\u043e\u0432, \u043e \u043a\u043e\u0442\u043e\u0440\u043e\u0439 \u043d\u0438\u0436\u0435, \u0432 \u0432\u0438\u0437\u0443\u0430\u043b\u044c\u043d\u043e-\u0438\u043d\u0435\u0440\u0446\u0438\u0430\u043b\u044c\u043d\u0443\u044e \u043e\u0446\u0435\u043d\u043a\u0443 \u043f\u0440\u0438\u043d\u0435\u0441\u043b\u0438 Lovegrove, Patron-Perez \u0438 Sibley [11, 12]. \u041d\u043e\u0432\u043e\u0435 \u0437\u0434\u0435\u0441\u044c \u0442\u043e\u043b\u044c\u043a\u043e \u043e\u0434\u043d\u043e: \u043f\u0440\u0438 \u0441\u043c\u0435\u0449\u0451\u043d\u043d\u043e\u0439 \u043a\u0430\u043c\u0435\u0440\u0435 C\u00b2 \u043d\u0443\u0436\u0435\u043d \u0438 \u043e\u0440\u0438\u0435\u043d\u0442\u0430\u0446\u0438\u0438, \u0438 \u044d\u0442\u043e \u0432\u0438\u0434\u043d\u043e \u0432 \u0446\u0438\u0444\u0440\u0430\u0445.\u041f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435\u041d\u0430 \u043a\u0430\u0436\u0434\u043e\u043c \u043e\u0442\u0440\u0435\u0437\u043a\u0435 \u0432\u0432\u043e\u0434\u0438\u043c \u043b\u043e\u043a\u0430\u043b\u044c\u043d\u044b\u0439 \u043f\u0430\u0440\u0430\u043c\u0435\u0442\u0440 u \u043e\u0442 0 \u0434\u043e 1. \u041f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u0435 \u0437\u0430\u0432\u0438\u0441\u0438\u0442 \u043e\u0442 \u0447\u0435\u0442\u044b\u0440\u0451\u0445 \u043a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0445 \u0442\u043e\u0447\u0435\u043a:\u0421\u043a\u043e\u0440\u043e\u0441\u0442\u044c \u0438 \u0443\u0441\u043a\u043e\u0440\u0435\u043d\u0438\u0435 \u0441\u0447\u0438\u0442\u0430\u044e\u0442\u0441\u044f \u043f\u043e \u0442\u043e\u0439 \u0436\u0435 \u0444\u043e\u0440\u043c\u0443\u043b\u0435: \u0432\u043c\u0435\u0441\u0442\u043e \u0441\u0442\u043e\u043b\u0431\u0446\u0430 (1, u, u\u00b2, u\u00b3) \u0431\u0435\u0440\u0451\u043c (0, 1, 2u, 3u\u00b2)\/\u0394t \u0438 (0, 0, 2, 6u)\/\u0394t\u00b2.\u041a\u043e\u043d\u0442\u0440\u043e\u043b\u044c\u043d\u044b\u0435 \u0442\u043e\u0447\u043a\u0438 \u043f\u043e\u0434\u0431\u0438\u0440\u0430\u044e\u0442\u0441\u044f \u0442\u0430\u043a, \u0447\u0442\u043e\u0431\u044b \u0441\u043f\u043b\u0430\u0439\u043d \u043f\u0440\u043e\u0448\u0451\u043b \u0447\u0435\u0440\u0435\u0437 \u043a\u043b\u044e\u0447\u0435\u0432\u044b\u0435 \u043f\u043e\u043b\u043e\u0436\u0435\u043d\u0438\u044f \u0438 \u0438\u043c\u0435\u043b \u0437\u0430\u0434\u0430\u043d\u043d\u044b\u0435 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u0438 \u043d\u0430 \u043a\u043e\u043d\u0446\u0430\u0445:\u0423\u0441\u043b\u043e\u0432\u0438\u044f \u043d\u0430 \u0441\u043a\u043e\u0440\u043e\u0441\u0442\u0438 \u0441\u0432\u044f\u0437\u044b\u0432\u0430\u044e\u0442 \u0442\u043e\u0447\u043a\u0438 \u0447\u0435\u0440\u0435\u0437 \u043e\u0434\u043d\u0443. \u0418\u0437 \u043d\u0438\u0445 \u0432\u044b\u0440\u0430\u0436\u0430\u0435\u043c \u043a\u0440\u0430\u0439\u043d\u0438\u0435 \u0442\u043e\u0447\u043a\u0438 c\u2080 \u0438 c_{K+2} \u0438 \u043f\u043e\u0434\u0441\u0442\u0430\u0432\u043b\u044f\u0435\u043c \u0432 \u043f\u0435\u0440\u0432\u043e\u0435 \u0438 \u043f\u043e\u0441\u043b\u0435\u0434\u043d\u0435\u0435 \u0443\u0440\u0430\u0432\u043d\u0435\u043d\u0438\u044f. \u041f\u043e\u0441\u043b\u0435 \u044d\u0442\u043e\u0433\u043e \u0441\u0438\u0441\u0442\u0435\u043c\u0430 \u043e\u0442\u043d\u043e\u0441\u0438\u0442\u0435\u043b\u044c\u043d\u043e c\u2081, \u2026, c_{K+1} \u0441\u0442\u0430\u043d\u043e\u0432\u0438\u0442\u0441\u044f \u0442\u0440\u0451\u0445\u0434\u0438\u0430\u0433\u043e\u043d\u0430\u043b\u044c\u043d\u043e\u0439 \u0441\u043e \u0441\u0442\u0440\u043e\u0433\u0438\u043c \u0434\u0438\u0430\u0433\u043e\u043d\u0430\u043b\u044c\u043d\u044b\u043c \u043f\u0440\u0435\u043e\u0431\u043b\u0430\u0434\u0430\u043d\u0438\u0435\u043c. \u0420\u0435\u0448\u0435\u043d\u0438\u0435 \u0435\u0434\u0438\u043d\u0441\u0442\u0432\u0435\u043d\u043d\u043e\u0435 \u0438 \u043d\u0430\u0445\u043e\u0434\u0438\u0442\u0441\u044f \u043f\u0440\u043e\u0433\u043e\u043d\u043a\u043e\u0439.\u041f\u043e\u043b\u0443\u0447\u0435\u043d\u043d\u0430\u044f \u043a\u0440\u0438\u0432\u0430\u044f \u0441\u043e\u0432\u043f\u0430\u0434\u0430\u0435\u0442 \u0441\u00a0CubicSpline\u00a0\u0438\u0437 scipy \u0441 \u0442\u0435\u043c\u0438 \u0436\u0435 \u043a\u0440\u0430\u0435\u0432\u044b\u043c\u0438 \u0443\u0441\u043b\u043e\u0432\u0438\u044f\u043c\u0438,\u00a0bc_type=((1, v0), (1, vK)): \u0440\u0430\u0441\u0445\u043e\u0436\u0434\u0435\u043d\u0438\u0435 4\u00b710\u207b\u00b9\u2076 \u043c, \u043c\u0430\u0448\u0438\u043d\u043d\u044b\u0439 \u043d\u043e\u043b\u044c. \u0421 \u043a\u0440\u0430\u0435\u0432\u044b\u043c \u0443\u0441\u043b\u043e\u0432\u0438\u0435\u043c \u043f\u043e \u0443\u043c\u043e\u043b\u0447\u0430\u043d\u0438\u044e (not-a-knot)&#8230;<\/p>\n","protected":false},"author":1,"featured_media":0,"comment_status":"closed","ping_status":"closed","sticky":false,"template":"","format":"standard","meta":{"footnotes":""},"categories":[],"tags":[],"class_list":["post-504004","post","type-post","status-publish","format-standard","hentry"],"_links":{"self":[{"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=\/wp\/v2\/posts\/504004","targetHints":{"allow":["GET"]}}],"collection":[{"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=\/wp\/v2\/posts"}],"about":[{"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=\/wp\/v2\/types\/post"}],"author":[{"embeddable":true,"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=\/wp\/v2\/users\/1"}],"replies":[{"embeddable":true,"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=%2Fwp%2Fv2%2Fcomments&post=504004"}],"version-history":[{"count":0,"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=\/wp\/v2\/posts\/504004\/revisions"}],"wp:attachment":[{"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=%2Fwp%2Fv2%2Fmedia&parent=504004"}],"wp:term":[{"taxonomy":"category","embeddable":true,"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=%2Fwp%2Fv2%2Fcategories&post=504004"},{"taxonomy":"post_tag","embeddable":true,"href":"https:\/\/savepearlharbor.com\/index.php?rest_route=%2Fwp%2Fv2%2Ftags&post=504004"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}