<?xml version="1.0" encoding="UTF-8"?>
<!DOCTYPE article PUBLIC "-//NLM//DTD JATS (Z39.96) Journal Publishing DTD v1.3 20210610//EN" "JATS-journalpublishing1-3.dtd">
<article article-type="research-article" dtd-version="1.3" xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink" xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance" xml:lang="ru"><front><journal-meta><journal-id journal-id-type="publisher-id">gyroscopy</journal-id><journal-title-group><journal-title xml:lang="ru">Гироскопия и навигация</journal-title><trans-title-group xml:lang="en"><trans-title>Giroskopiya i Navigatsiya</trans-title></trans-title-group></journal-title-group><issn pub-type="ppub">0869-7035</issn><issn pub-type="epub">2075-0927</issn><publisher><publisher-name>AO «Концерн «ЦНИИ «Электроприбор»</publisher-name></publisher></journal-meta><article-meta><article-id pub-id-type="doi">10.17285/0869-7035.0080</article-id><article-id custom-type="elpub" pub-id-type="custom">gyroscopy-196</article-id><article-categories><subj-group subj-group-type="heading"><subject>Research Article</subject></subj-group><subj-group subj-group-type="section-heading" xml:lang="ru"><subject>Статьи</subject></subj-group></article-categories><title-group><article-title>Алгоритм радиолокационной инерциальной одометрии с использованием нескольких радаров и коррекцией по курсовому углу</article-title><trans-title-group xml:lang="en"><trans-title>x-RIO: Radar Inertial Odometry with Multiple Radar Sensors and Yaw Aiding</trans-title></trans-title-group></title-group><contrib-group><contrib contrib-type="author" corresp="yes"><name-alternatives><name name-style="eastern" xml:lang="ru"><surname>Доер</surname><given-names>К.</given-names></name><name name-style="western" xml:lang="en"><surname>Doer</surname><given-names>Ch.</given-names></name></name-alternatives><xref ref-type="aff" rid="aff-1"/></contrib><contrib contrib-type="author" corresp="yes"><name-alternatives><name name-style="eastern" xml:lang="ru"><surname>Троммер</surname><given-names>Г. Ф.</given-names></name><name name-style="western" xml:lang="en"><surname>Trommer</surname><given-names>G.F.</given-names></name></name-alternatives><bio xml:lang="ru"><p>Троммер Герт Франц. Профессор, действительный член международной общественной организации «Академия навигации и управления движением».</p></bio><xref ref-type="aff" rid="aff-2"/></contrib></contrib-group><aff-alternatives id="aff-1"><aff xml:lang="ru"><institution>Кристофер Доер. Институт систем управления, Технологический институт Карлсруэ</institution><country>Германия</country></aff><aff xml:lang="en"><institution>Institute of Control Systems, Karlsruhe Institute of Technology (KIT), Karlsruhe,&#13;
Germany</institution><country>Germany</country></aff></aff-alternatives><aff-alternatives id="aff-2"><aff xml:lang="ru"><institution>Институт систем управления, Технологический институт Карлсруэ</institution><country>Германия</country></aff><aff xml:lang="en"><institution>Institute of Control Systems, Karlsruhe Institute of Technology (KIT), Karlsruhe,&#13;
Germany</institution><country>Germany</country></aff></aff-alternatives><pub-date pub-type="collection"><year>2021</year></pub-date><pub-date pub-type="epub"><day>22</day><month>10</month><year>2025</year></pub-date><volume>29</volume><issue>4</issue><fpage>78</fpage><lpage>96</lpage><permissions><copyright-statement>Copyright &amp;#x00A9; Доер К., Троммер Г., 2025</copyright-statement><copyright-year>2025</copyright-year><copyright-holder xml:lang="ru">Доер К., Троммер Г.</copyright-holder><copyright-holder xml:lang="en">Doer C., Trommer G.</copyright-holder><license xml:lang="ru" license-type="creative-commons-attribution" xlink:href="https://creativecommons.org/licenses/by/4.0/" xlink:type="simple"><license-p>Данная работа распространяется под лицензией Creative Commons Attribution 4.0.</license-p></license><license xml:lang="en" license-type="creative-commons-attribution" xlink:href="https://creativecommons.org/licenses/by/4.0/" xlink:type="simple"><license-p>This work is licensed under a Creative Commons Attribution 4.0 License.</license-p></license></permissions><self-uri xlink:href="https://www.gyroscopy.ru/jour/article/view/196">https://www.gyroscopy.ru/jour/article/view/196</self-uri><abstract><p>Для навигации автономных роботов необходима робастная и точная система навигации, работающая в режиме реального времени. В таких сложных условиях, как пропадание сигналов глобальных навигационных спутниковых систем (ГНСС) и плохая видимость (темнота, туман, дым или прямой солнечный свет), методы на основе технического зрения не могут обеспечить надежную навигацию. В связи с этим возникает необходимость использовать инерциальные датчики и частотно-модулированные радары непрерывного излучения, не подверженные влиянию таких факторов. В работе предлагается система с несколькими одновременно работающими миллиметровыми радарами. Калибровка измерительного канала каждого радара производится в процессе решения задачи. На основе данных одного радиолокационного обзора (далее – скана) осуществляется совместная обработка измерений трехмерной собственной скорости и курсового угла, определяемого исходя из предположения о манхэттенской геометрии окружающего пространства. Представлен подробный анализ работы алгоритма по реальным данным. Показано, что алгоритм радиолокационной инерциальной одометрии (РИО) превосходит по качеству работы современный метод стереовизуальной инерциальной одометрии (ВИО), поскольку обеспечивает работу при плохой видимости и требует небольших вычислительных ресурсов.</p></abstract><trans-abstract xml:lang="en"><p>A robust and accurate real-time navigation system is crucial for autonomous robotics. In particular, GNSS denied and poor visual conditions are still very challenging as vision based approaches tend to fail in darkness, direct sunlight, fog or smoke. Therefore, we are taking advantage of inertial data and FMCW radar sensors as both are not affected by such conditions. In this work, we propose a framework, which uses several 4D mm Wave radar sensors simultaneously. The extrinsic calibration of each radar sensor is estimated online. Based on a single radar scan, the 3D ego velocity and optionally yaw measurements based on Manhattan world assumptions are fused. An extensive evaluation with real world datasets is presented. We achieve even better accuracies than state of the art stereo Visual Inertial Odometry (VIO) while being able to cope with degraded visual conditions and requiring only very little computational resources.</p></trans-abstract><kwd-group xml:lang="ru"><kwd>Радиолокационная инерциальная одометрия</kwd><kwd>навигационная система</kwd><kwd>автономные роботы.</kwd></kwd-group><kwd-group xml:lang="en"><kwd>Radar Inertial Odometry</kwd><kwd>navigation system</kwd><kwd>autonomous robotics.</kwd></kwd-group></article-meta></front><back><ref-list><title>References</title><ref id="cit1"><label>1</label><citation-alternatives><mixed-citation xml:lang="ru">Bloesch, M., Omari, S., Hutter, M., and Siegwart, R., Robust visual inertial odometry using a direct EKF-based approach, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2015, pp. 298–304.</mixed-citation><mixed-citation xml:lang="en">Bloesch, M., Omari, S., Hutter, M., and Siegwart, R., Robust visual inertial odometry using a direct EKF-based approach, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2015, pp. 298–304.</mixed-citation></citation-alternatives></ref><ref id="cit2"><label>2</label><citation-alternatives><mixed-citation xml:lang="ru">Sun, K., Mohta, K., Pfrommer, B., Watterson, M., Liu, S., Mulgaonkar, Y., Taylor, C.J., and Kumar, V., Robust stereo visual inertial odometry for fast autonomous flight, IEEE Robotics and Automation Letters, 2018, vol. 3, no. 2, pp. 965–972.</mixed-citation><mixed-citation xml:lang="en">Sun, K., Mohta, K., Pfrommer, B., Watterson, M., Liu, S., Mulgaonkar, Y., Taylor, C.J., and Kumar, V., Robust stereo visual inertial odometry for fast autonomous flight, IEEE Robotics and Automation Letters, 2018, vol. 3, no. 2, pp. 965–972.</mixed-citation></citation-alternatives></ref><ref id="cit3"><label>3</label><citation-alternatives><mixed-citation xml:lang="ru">Qin, T., Li, P., and Shen, S., VINS-Mono: A robust and versatile monocular visual-inertial state estimator, IEEE Transactions on Robotics, 2018, vol. 34, no. 4, pp. 1004–1020.</mixed-citation><mixed-citation xml:lang="en">Qin, T., Li, P., and Shen, S., VINS-Mono: A robust and versatile monocular visual-inertial state estimator, IEEE Transactions on Robotics, 2018, vol. 34, no. 4, pp. 1004–1020.</mixed-citation></citation-alternatives></ref><ref id="cit4"><label>4</label><citation-alternatives><mixed-citation xml:lang="ru">Khattak, S., Papachristos, C., and Alexis, K., Keyframe-based thermal-inertial odometry, Journal of Field Robotics, 2020, vol. 37, no. 4, pp. 552–579.</mixed-citation><mixed-citation xml:lang="en">Khattak, S., Papachristos, C., and Alexis, K., Keyframe-based thermal-inertial odometry, Journal of Field Robotics, 2020, vol. 37, no. 4, pp. 552–579.</mixed-citation></citation-alternatives></ref><ref id="cit5"><label>5</label><citation-alternatives><mixed-citation xml:lang="ru">Saputra, M.R.U., de Gusmao, P.P.B., Lu, C.X., Almalioglu, Y., Rosa, S., Chen, C., Wahlstroem, J., Wang, W., Markham, A., and Trigoni, N., DeepTIO: A deep thermal-inertial odometry with visual hallucination, IEEE Robotics and Automation Letters, 2020, vol. 5, no. 2.</mixed-citation><mixed-citation xml:lang="en">Saputra, M.R.U., de Gusmao, P.P.B., Lu, C.X., Almalioglu, Y., Rosa, S., Chen, C., Wahlstroem, J., Wang, W., Markham, A., and Trigoni, N., DeepTIO: A deep thermal-inertial odometry with visual hallucination, IEEE Robotics and Automation Letters, 2020, vol. 5, no. 2.</mixed-citation></citation-alternatives></ref><ref id="cit6"><label>6</label><citation-alternatives><mixed-citation xml:lang="ru">Zhao, S., Wang, P., Zhang, H., Fang, Z., and Scherer, S., TP-TIO: A robust thermal-inertial odometry with deep thermalpoint, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).</mixed-citation><mixed-citation xml:lang="en">Zhao, S., Wang, P., Zhang, H., Fang, Z., and Scherer, S., TP-TIO: A robust thermal-inertial odometry with deep thermalpoint, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).</mixed-citation></citation-alternatives></ref><ref id="cit7"><label>7</label><citation-alternatives><mixed-citation xml:lang="ru">Dickmann, J., Klappstein, J., Hahn, M., Appenrodt, N., Bloecher, H., Werber, K., and Sailer, A., Automotive radar – The key technology for autonomous driving: From detection and ranging to environmental understanding, 2016 IEEE Radar Conference (RadarConf).</mixed-citation><mixed-citation xml:lang="en">Dickmann, J., Klappstein, J., Hahn, M., Appenrodt, N., Bloecher, H., Werber, K., and Sailer, A., Automotive radar – The key technology for autonomous driving: From detection and ranging to environmental understanding, 2016 IEEE Radar Conference (RadarConf).</mixed-citation></citation-alternatives></ref><ref id="cit8"><label>8</label><citation-alternatives><mixed-citation xml:lang="ru">Doer, C. and Trommer, G.F., Radar inertial odometry with online calibration, 2020 European Navigation Conference (ENC), 2020, pp. 1–10.</mixed-citation><mixed-citation xml:lang="en">Doer, C. and Trommer, G.F., Radar inertial odometry with online calibration, 2020 European Navigation Conference (ENC), 2020, pp. 1–10.</mixed-citation></citation-alternatives></ref><ref id="cit9"><label>9</label><citation-alternatives><mixed-citation xml:lang="ru">Doer, C. and Trommer, G.F., Yaw aided radar inertial odometry uisng Manhattan world assumptions, 28th St. Petersburg International Conference on Integrated Navigation Systems (ICINS), 2021.</mixed-citation><mixed-citation xml:lang="en">Doer, C. and Trommer, G.F., Yaw aided radar inertial odometry uisng Manhattan world assumptions, 28th St. Petersburg International Conference on Integrated Navigation Systems (ICINS), 2021.</mixed-citation></citation-alternatives></ref><ref id="cit10"><label>10</label><citation-alternatives><mixed-citation xml:lang="ru">Kramer, A., Stahoviak, C., Santamaria-Navarro, A., Aghamohammadi, A.-A., and Heckman, C., Radar-inertial ego-velocity estimation for visually degraded environments, IEEE International Conference on Robotics and Automation, 2020.</mixed-citation><mixed-citation xml:lang="en">Kramer, A., Stahoviak, C., Santamaria-Navarro, A., Aghamohammadi, A.-A., and Heckman, C., Radar-inertial ego-velocity estimation for visually degraded environments, IEEE International Conference on Robotics and Automation, 2020.</mixed-citation></citation-alternatives></ref><ref id="cit11"><label>11</label><citation-alternatives><mixed-citation xml:lang="ru">Doer, C. and Trommer, G.F., An EKF-based approach to radar inertial odometry, IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI), 2020, pp. 152–159.</mixed-citation><mixed-citation xml:lang="en">Doer, C. and Trommer, G.F., An EKF-based approach to radar inertial odometry, IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI), 2020, pp. 152–159.</mixed-citation></citation-alternatives></ref><ref id="cit12"><label>12</label><citation-alternatives><mixed-citation xml:lang="ru">Lu, C.X., Saputra, M.R.U., Zhao, P., Almalioglu, Y., de Gusmao, P.P.B., Chen, C., Sun, K., Trigoni, N., and Markham, A., Milliego: Single-chip mmWave radar aided egomotion estimation via deep sensor fusion, Proceedings of the 18th Conference on Embedded Networked Sensor Systems, ser. SenSys ’20, 2020.</mixed-citation><mixed-citation xml:lang="en">Lu, C.X., Saputra, M.R.U., Zhao, P., Almalioglu, Y., de Gusmao, P.P.B., Chen, C., Sun, K., Trigoni, N., and Markham, A., Milliego: Single-chip mmWave radar aided egomotion estimation via deep sensor fusion, Proceedings of the 18th Conference on Embedded Networked Sensor Systems, ser. SenSys ’20, 2020.</mixed-citation></citation-alternatives></ref><ref id="cit13"><label>13</label><citation-alternatives><mixed-citation xml:lang="ru">Quist, E.B. and Beard, R.W., Radar odometry on fixed-wing small unmanned aircraft, IEEE Transactions on Aerospace and Electronic Systems, 2016, vol. 52, no. 1, pp. 396–410.</mixed-citation><mixed-citation xml:lang="en">Quist, E.B. and Beard, R.W., Radar odometry on fixed-wing small unmanned aircraft, IEEE Transactions on Aerospace and Electronic Systems, 2016, vol. 52, no. 1, pp. 396–410.</mixed-citation></citation-alternatives></ref><ref id="cit14"><label>14</label><citation-alternatives><mixed-citation xml:lang="ru">Cen, S.H. and Newman, P., Precise ego-motion estimation with millimeter-wave radar under diverse and challenging conditions, IEEE International Conference on Robotics and Automation (ICRA), IEEE, 2018, pp. 1–8. 15. Aldera, R., De Martini, D., Gadd, M., and Newman, P., Fast radar motion estimation with a learnt focus of attention using weak supervision, 2019 International Conference on Robotics and Automation (ICRA), 2019, pp. 1190–1196.</mixed-citation><mixed-citation xml:lang="en">Cen, S.H. and Newman, P., Precise ego-motion estimation with millimeter-wave radar under diverse and challenging conditions, IEEE International Conference on Robotics and Automation (ICRA), IEEE, 2018, pp. 1–8. 15. Aldera, R., De Martini, D., Gadd, M., and Newman, P., Fast radar motion estimation with a learnt focus of attention using weak supervision, 2019 International Conference on Robotics and Automation (ICRA), 2019, pp. 1190–1196.</mixed-citation></citation-alternatives></ref><ref id="cit15"><label>15</label><citation-alternatives><mixed-citation xml:lang="ru">Park, Y. S., Shin, Y. S., and Kim, A., Pharao: Direct radar odometry using phase correlation, 2020 IEEE International Conference on Robotics and Automation (ICRA), 2020, pp. 2617–2623.</mixed-citation><mixed-citation xml:lang="en">Park, Y. S., Shin, Y. S., and Kim, A., Pharao: Direct radar odometry using phase correlation, 2020 IEEE International Conference on Robotics and Automation (ICRA), 2020, pp. 2617–2623.</mixed-citation></citation-alternatives></ref><ref id="cit16"><label>16</label><citation-alternatives><mixed-citation xml:lang="ru">Almalioglu, Y., Turan, M., Lu, C.X., Trigoni, N., and Markham, A., Milli-RIO: Ego-motion estimation with low-cost millimetre-wave radar, IEEE Sensors Journal, 2021, vol. 21, no. 3, pp. 3314–3323. 18. Rapp, M., Barjenbruch, M., Dietmayer, K., Hahn, M., and Dickmann, J., A fast probabilistic ego-motion estimation framework for radar, 2015 European Conference on Mobile Robots (ECMR), 2015, pp. 1–6. 19. Kellner, D., Barjenbruch, M., Klappstein, J., Dickmann, J., and Dietmayer, K., Instantaneous ego-motion estimation using Doppler radar, Conference on Intelligent Transportation Systems (ITSC 2013), IEEE, 2013, pp. 869–874.</mixed-citation><mixed-citation xml:lang="en">Almalioglu, Y., Turan, M., Lu, C.X., Trigoni, N., and Markham, A., Milli-RIO: Ego-motion estimation with low-cost millimetre-wave radar, IEEE Sensors Journal, 2021, vol. 21, no. 3, pp. 3314–3323. 18. Rapp, M., Barjenbruch, M., Dietmayer, K., Hahn, M., and Dickmann, J., A fast probabilistic ego-motion estimation framework for radar, 2015 European Conference on Mobile Robots (ECMR), 2015, pp. 1–6. 19. Kellner, D., Barjenbruch, M., Klappstein, J., Dickmann, J., and Dietmayer, K., Instantaneous ego-motion estimation using Doppler radar, Conference on Intelligent Transportation Systems (ITSC 2013), IEEE, 2013, pp. 869–874.</mixed-citation></citation-alternatives></ref><ref id="cit17"><label>17</label><citation-alternatives><mixed-citation xml:lang="ru">Doer, C. and Trommer, G.F., Radar visual inertial odometry and radar thermal inertial odometry: Robust navigation even in challenging visual conditions, 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2021.</mixed-citation><mixed-citation xml:lang="en">Doer, C. and Trommer, G.F., Radar visual inertial odometry and radar thermal inertial odometry: Robust navigation even in challenging visual conditions, 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2021.</mixed-citation></citation-alternatives></ref><ref id="cit18"><label>18</label><citation-alternatives><mixed-citation xml:lang="ru">Sola, J., Quaternion kinematics for the error-state KF, 2017.</mixed-citation><mixed-citation xml:lang="en">Sola, J., Quaternion kinematics for the error-state KF, 2017.</mixed-citation></citation-alternatives></ref><ref id="cit19"><label>19</label><citation-alternatives><mixed-citation xml:lang="ru">Roumeliotis, S.I. and Burdick, J.W., Stochastic cloning: A generalized framework for processing relative state measurements, Proc. 2002 IEEE International Conference on Robotics and Automation, 2002.</mixed-citation><mixed-citation xml:lang="en">Roumeliotis, S.I. and Burdick, J.W., Stochastic cloning: A generalized framework for processing relative state measurements, Proc. 2002 IEEE International Conference on Robotics and Automation, 2002.</mixed-citation></citation-alternatives></ref><ref id="cit20"><label>20</label><citation-alternatives><mixed-citation xml:lang="ru">Fischler, M.A. and Bolles, R.C., Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography, Communications of the ACM, 1981.</mixed-citation><mixed-citation xml:lang="en">Fischler, M.A. and Bolles, R.C., Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography, Communications of the ACM, 1981.</mixed-citation></citation-alternatives></ref><ref id="cit21"><label>21</label><citation-alternatives><mixed-citation xml:lang="ru">Ghilani, C.D., Adjustment Computations: Spatial Data Analysis, Hoboken, New Jersey: John Wiley &amp; Sons, 2017.</mixed-citation><mixed-citation xml:lang="en">Ghilani, C.D., Adjustment Computations: Spatial Data Analysis, Hoboken, New Jersey: John Wiley &amp; Sons, 2017.</mixed-citation></citation-alternatives></ref><ref id="cit22"><label>22</label><citation-alternatives><mixed-citation xml:lang="ru">Delmerico, J. and Scaramuzza, D., A benchmark comparison of monocular visual-inertial odometry algorithms for flying robots, 2018 IEEE International Conference on Robotics and Automation (ICRA), 2018, pp. 2502–2509.</mixed-citation><mixed-citation xml:lang="en">Delmerico, J. and Scaramuzza, D., A benchmark comparison of monocular visual-inertial odometry algorithms for flying robots, 2018 IEEE International Conference on Robotics and Automation (ICRA), 2018, pp. 2502–2509.</mixed-citation></citation-alternatives></ref><ref id="cit23"><label>23</label><citation-alternatives><mixed-citation xml:lang="ru">Umeyama, S., Least-squares estimation of transformation parameters between two point patterns, IEEE Transactions on Pattern Analysis and Machine Intelligence, 1991, vol. 13, no. 4, pp. 376–380.</mixed-citation><mixed-citation xml:lang="en">Umeyama, S., Least-squares estimation of transformation parameters between two point patterns, IEEE Transactions on Pattern Analysis and Machine Intelligence, 1991, vol. 13, no. 4, pp. 376–380.</mixed-citation></citation-alternatives></ref><ref id="cit24"><label>24</label><citation-alternatives><mixed-citation xml:lang="ru">Zhang, Z. and Scaramuzza, D., A tutorial on quantitative trajectory evaluation for visual(-inertial) odometry, IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2018.</mixed-citation><mixed-citation xml:lang="en">Zhang, Z. and Scaramuzza, D., A tutorial on quantitative trajectory evaluation for visual(-inertial) odometry, IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2018.</mixed-citation></citation-alternatives></ref><ref id="cit25"><label>25</label><citation-alternatives><mixed-citation xml:lang="ru">Guennebaud, G., Jacob, B. et al., Eigen v3, http://eigen.tuxfamily.org, 2010.</mixed-citation><mixed-citation xml:lang="en">Guennebaud, G., Jacob, B. et al., Eigen v3, http://eigen.tuxfamily.org, 2010.</mixed-citation></citation-alternatives></ref></ref-list><fn-group><fn fn-type="conflict"><p>The authors declare that there are no conflicts of interest present.</p></fn></fn-group></back></article>
