Localization of Mobile Robot Using Smooth Two-Part Kalman Filter
Subject Areas : electrical and computer engineering
1 - دانشگاه بیرجند
2 -
Keywords: Mobile robot, Kalman filter, two-part Kalman filter, robot localization,
Abstract :
The most important issue for a mobile robot is orientation. Success in localization is one of the four main needs in orientation, which include: perception, localization, recognition and movement control. How to provide an accurate localization solution for mobile robots is essential in many IoT applications. To achieve this goal, in this article, a method based on two-part Kalman filter is proposed for localization of mobile robot. The proposed algorithm consists of two parts, the first part is statistical linear regression and the second part is a Kalman filter with state error vector. The proposed method is tested in comparison with the new hybrid TLNF/UK method on circular, rectangular and z-shaped motion paths that are accompanied by noise. The experimental results show that the proposed method has been able to achieve better localization accuracy and it is also observed that the estimation errors in the proposed method are less and it has been able to increase the estimation accuracy compared to the combined TLNF/UK method.
[1] D. Pramod, "Robotic process automation for industry: adoption status, benefits, challenges and research agenda," Bench-Marking: An Int. J., vol. 29, no. 5, pp. 1141-1148, May 2021.
[2] S. Tomazic, "Indoor positioning and navigation," Sensors (Basel), vol. 21, no. 14, Article: 4793, Jul. 2021.
[3] C. Wang, A. Xu, J. Kuang, X. Sui, Y. Hao, and X. Niu, "A high-accuracy indoor localization system and applications based on tightly coupled UWB/INS/floor map integration," J. IEEE Sens, vol. 21, no. 16, pp. 18166-18177, 15 Aug. 2021.
[4] Y. Zhuang, J. Yang, L. Qi, Y. Li, Y. Cao, and N. El-Sheimy, "A pervasive integration platform of low-cost MEMS sensors and wireless signals for indoor localization," IEEE Internet of Things J., vol. 5, no. 6, pp. 4616-4631, Dec. 2017.
[5] Y. Yu, R. Chen, L. Chen, W. Li, and Y. Wu, "Autonomous 3D indoor localization based on crowdsourced Wi-Fi fingerprinting and MEMS sensors," J. IEEE Sens, vol. 22, no. 6, pp. 5248-5259, 15 Mar. 2021.
[6] L. Chen, X. Zhou, F. Chen, L. L. Yang, and R. Chen, "Carrier phase ranging for indoor positioning with 5G NR signals," J. IEEE Internet Things, vol. 9, no. 13, pp. 10908-10919, 1 Jul. 2021.
[7] R. Chen, et al., "Precise indoor positioning based on acoustic ranging in smartphone," IEEE Trans. Instrum, Meas., vol. 70, Article ID: 9509512, 2021.
[8] J. Li, et al. "PSOTrack: a RFID-based system for random moving objects tracking in unconstrained indoor environment," IEEE Internet of Things J., vol. 5, no. 6, pp. 4632-4641, Dec. 2018.
[9] Y. Zhuang, L. Hua, L. Qi, J. Yang, P. Cao, and Y. Cao, "A survey of positioning systems using visible LED lights," IEEE Communications Surveys & Tutorials, vol. 20, no. 3, pp. 1963-1988, Third quarter 2018.
[10] R. Garcia, H. Kuga, and W. Silva, "Unscented kalman filter and smoothing applied to attitude estimation of artificial satellites," Computational and Applied Mathematics, vol. 37, no. 4, pp. 55-64, 2018.
[11] P. Balenzuela, et al. "Accurate Gaussian mixture model smoothing usinga two-filter approach," in Proc. of the IEEE Conf. on Decision and Control, pp. 694-699, Miami Beach, FL, USA, 17-18 Dec. 2018.
[12] F. Deng, H. L. Yang, and L. J. Wang, "Adaptive unscented kalman filter based estimation and filtering for dynamic positioning with model uncertainties," J. of Control, Automation and Systems, vol. 17, no. 1, pp. 667-678, Feb. 2019.
[13] L. Dang, W. Wang, and B. Chen, "Square root unscented kalman filter with modified measurement for dynamic state estimation of power systems," IEEE Trans. on Instrumentation and Measurement, vol. 71, Article ID: 9002213 2022.
[14] A. Tuveri, F. Pérez-García, P. A. Lira-Parada, L. Imsland, and N. Bar, "Sensor fusion based on extended and unscented kalma filter for bioprocess monitoring," J. of Process Control, vol. 106, pp. 195-207, Oct. 2021.
[15] M. N. Lv, T. Sun, and J. Li, "Estimation of vehicle state parameters based on extended kalman filter," Agricultural Equipment and Vehicle Engineering, vol. 56, no. 5, pp. 77-80, 2019.
[16] A. Varsi, S. Maskell, and P. G. Spirakis, "An O(log2N) fully-balanced resampling algorithm for particle filters on distributed memory architectures," Algorithms, vol. 14, no. 12, Article ID: 342, 2021.
[17] L. Yuan, J. Gu, H. Wen, and Z. Jin, "Improved particle filter for non-gaussian forecasting-aided state estimation," J. of Modern Power Systems and Clean Energy, vol. 11, no. 4, pp. 1075-1085, Jul. 2023.
[18] A. Alessandri, T. Parisini, and R. Zoppoli, "Neural approximators for nonlinear finite-memory state estimation," Int. J. Control, vol. 67, no. 2, pp. 275-302, Jan. 1997.
[19] P. S. Kim, E. H. Lee, M. S. Jang, and S. Y. Kang, "A finite memory structure filtering for indoor positioning in wireless sensor networks with measurement delay," Int. J. Distrib. Sensor Netw, vol. 13, no. 1, 8 pp., Jan. 2017.
[20] A. Jazwinski, "Limited memory optimal filtering," IEEE Trans. Autom. Control, vol. 13, no. 5, pp. 558-563, Oct. 1968.
[21] W. H. Kwon and S. Han, Receding Horizon Control: Model Predictive Control for State Models, Cham, Switzerland: Springer, 2015.
[22] C. K. Ahn, Y. S. Shmaliy, and S. Zhao, "A new unbiased FIR filter with improved robustness based on frobenius norm with exponential weight," IEEE Trans. Circuits Syst. II, Exp. Briefs, vol. 65, no. 4, pp. 521-525, Apr. 2018.
[23] Y. S. Shmaliy, "An iterative kalman-like algorithm ignoring noise and initial conditions," IEEE Trans. Signal Process., vol. 59, no. 6, pp. 2465-2473, Jun. 2011.
[24] Y. S. Shmaliy, S. H. Khan, S. Zhao, and O. Ibarra-Manzano, "General unbiased FIR filter with applications to GPS-based steering of oscillator frequency," IEEE Trans. Control Syst. Technol, vol. 25, no. 3, pp. 1141-1148, May 2017.
[25] S. L. Sun and Z. L. Deng, "Multi-sensor optimal information fusion kalman filter," Automatica, vol. 40, no. 6, pp. 1017-1023, Jun. 2004.
[26] G. Hao, S. L. Sun, and Y. Li, "Nonlinear weighted measurement fusion unscented kalman filter with asymptotic optimality," Inf. Sci., vol. 299, pp. 85-98, Apr. 2015.
[27] G. Hao and S. Sun, "Distributed fusion cubature kalman filters for nonlinear systems," Int. J., vol. 29, no. 17, pp. 5979-5991, 25 Nov. 2019.
[28] S. Sun, H. Lin, J. Ma, and X. Li, "Multi-sensor distributed fusion estimation with applications in networked systems: a review paper," Inf. Fusion, vol. 38, pp. 122-134, Nov. 2017.
[29] Y. Hu, S. Bian, B. Ji, and J. Li, "GNSS spoofing detection technique using fraction parts of double difference carrier phases," J. of Navigation, vol. 71, no. 5, pp. 1111-1129, 2018.
[30] B. S. Çiftler, S. Dikmese, İ. Güvenç, K. Akkaya, and A. Kadri, "Occupancy counting with burst and intermittent signals in smart buildings," IEEE Internet of Things J., vol. 5, no. 2, pp. 724-735, Apr. 2017.
[31] Q. Sun, Y. Tian, and M. Diao, "Cooperative localization algorithm based on hybrid topology architecture for multiple mobile robot system," IEEE Internet of Things J., vol. 5, no. 6, pp. 4753-4763, Dec. 2018.
[32] W. Ye, J. Li, J. Fang, and X. Yuan, "EGP-CDKF for performance improvement of the SINS/GNSS integrated system," IEEE Trans. on Industrial Electronics, vol. 65, no. 4, pp. 3601-3609, Apr. 2017.
[33] R. Zhan and J. Wan, "Iterated unscented kalman filter for passive target tracking," Aerospace & Electronic Systems IEEE Trans. on, vol. 43, no. 3, pp. 1155-1163, Jul. 2007.
[34] W. Li and Y. Jia, "Location of mobile station with maneuvers using an IMM-based cubature kalman filter," IEEE Trans. on Industrial Electronics, vol. 59, no. 11 pp. 4338-4348, Nov. 2012.
[35] N. K. Singh, S. Bhaumik, and S. Bhattacharya, "Tracking of ballistic target on re-entry using ensemble kalman filter," in Proc. 2012 Annual IEEE India Conf., pp. 508-513, Kochi, India, 7-9 Dec. 2012.
[36] J. Yu, J. G. Lee, G. P. Chan, and H. S. Han, "An offline navigation of a geometry PIG using a modified nonlinear fixed-interval smoothing filter," Control Engineering Practice, vol. 13, no. 3, pp. 1403-1411, Nov. 2005.
[37] Y. Xu, X. Chen, and Q. Li, "Autonomous integrated navigation for indoor robots utilizing online iterated extended rauch-tung-striebel smoothing," Sensors, vol. 13, no. 12, pp. 15937-15953, 2013.
[38] A. S. Paul and E. A. Wan, "RSSI-based indoor localization and tracking using sigma-point Kalman smoothers," IEEE J. of Selected Topics in Signal Processing, vol. 3, no. 5, pp. 860-873, Oct. 2009.
[39] R. V. D. Merwe, Sigma-Point Kalman Filters for Probabilistic Inference in Dynamic State-Space Models, Oregon Health & Science University, Ph.D. Theses, Apr. 2004.
[40] X. Gong, J. Zhang, and J. Fang, "A modified nonlinear two-filter smoothing for high-precision airborne integrated GPS and inertial navigation," IEEE Trans. on Instrumentation & Measurement, vol. 64, no. 12, pp. 3315-3322, Dec. 2015.
[41] Z. Lu, J. Li, J. Fang, S. Wang, and S. Zou, "Adaptive unscented two-filter smoother applied to transfer alignment for ADPOS," IEEE Sensors J., vol. 18, no. 8, pp. 3410-3418, 15 Apr. 2018.
[42] H. Liu, K. Yang, and Q. Yang, Y. Ma, and C. Huang, "Sequential geoacoustic inversion and source tracking using ensemble Kalman-particle filter," in Proc. Global Oceans 2020: Singapore – U.S. Gulf Coast, 4- pp., Biloxi, MS, USA, 5-30 Oct. 2020.
[43] M. Murata and K. Isao, "Degeneracy-free particle filter: ensemble kalman smoother multiple distribution estimation filter," IEEE Trans. on Automatic Control, vol. 67, no. 12, pp. 6956-6961, Dec. 2022.
[44] H. M. Wu, M. Karkoub, and C. L. Hwang, "Mixed fuzzy sliding-mode tracking with backstepping formation control for multi-nonholonomic mobile robots subject to uncertainties," J. Intell. Robotic Syst., vol. 79, no. 1, pp. 73-86, Jul. 2015.
[45] Y. Eun Kim, H. Ho Kang, and C. Ki Ahn, "Two-layer nonlinear FIR filter and unscented Kalman filter fusion with application to mobile robot localization," IEEE Access, vol. 8, pp. 87173-87183, 2020.
نشریه مهندسی برق و مهندسی کامپیوتر ایران، الف- مهندسی برق، سال 22، شماره 1، بهار 1403 39
مقاله پژوهشی
موقعیتیابی ربات سیار با استفاده از فیلتر کالمن دوبخشی هموار
رمضان هاونگی و سیمین حسینزاده
چکیده: مهمترین مسئله برای یک ربات متحرک، جهتیابی است. موفقیت در موقعیتیابی یکی از چهار نیاز اصلی در جهتیابی است که شامل ادراک، موقعیتیابی، شناخت و کنترل حرکت میباشد. چگونگی ارائه یک راه حل دقیق موقعیتیابی برای رباتهای سیار در بسیاری از کاربردهای اینترنت اشیا ضروری است. برای رسیدن به این هدف در این مقاله روشی مبتنی بر فیلتر کالمن دوبخشی برای موقعیتیابی رباتهای سیار پیشنهاد شده است. الگوریتم پیشنهادی شامل دو بخش است که بخش اول رگرسیون خطی آماری و بخش دوم یک فیلتر کالمن با بردار خطای حالت میباشد. روش پیشنهادی در مقایسه با روش جدید ترکیبی TLNF/UK در مسیرهای حرکت دایرهای، مستطیلی و
Z شکل که همراه با نویز است، آزمایش شده است. نتایج تجربی نشان میدهند که روش پیشنهادی قادر به دستیابی به دقت موقعیتیابی بهتری بوده و همچنین مشاهده میشود که خطاهای تخمین در روش پیشنهادی کمتر است و توانسته دقت تخمین را نسبت به روش ترکیبی TLNF/UK افزایش دهد.
کلیدواژه: ربات سیار، فیلتر کالمن، فیلتر کالمن دوبخشی، موقعیتیابی ربات.
1- مقدمه
در سالهای اخیر، کاربرد رباتهای سیار بهخصوص در اینترنت اشیا 2(IoT) نظیر شهرهای هوشمند [۱] و ردیابی دارایی [۲] به توسعه سیستمهای موقعیتیابی3 ربات و فناوریهای متناظر با آن، مثل تجهیزات و حسگرهای اینرسی [۳] و [۴]، شبکههای محلی بیسیم [5] و [6]، بلوتوث [۷]، تشخیص فرکانس رادیویی [8] و تجهیزات نور مرئی [9] منجر شده است. از این میان، استفاده از حسگر موقعیتیاب نور مرئی 4(VLP) با استقبال فراوانی روبهرو بوده که مهمترین علت این محبوبیت، هزینه پایین آن با توجه به استفاده از دیودهای نوری محوشونده (LED) و امکانات روشنایی محیطی در کنار دقت موقعیتیابی بالای آن میباشد. در یک سیستم موقعیتیابی، اغلب دادههای نمونهبرداریشده در معرض نویزهای مختلفی قرار دارند که تعیین دقیق حالت سیستم را دشوار میسازد. از این رو تاکنون روشهای بسیاری برای تخمین مقادیر واقعی اندازهگیریهای نویزی پیشنهاد شدهاند که میتوان تمامی الگوریتمهای تخمین موجود را در یکی از سه دسته پیشبینی، فیلترینگ و هموارسازی جای داد [۱۰]. الگوریتم هموارسازی بهینه بهدلیل استفاده از حجم بالایی از مشاهدات، بیشترین دقت را از لحاظ نظری ارائه مینماید [۱۱].
طراحی یک تخمینگر حالت بهینه و مقاوم برای سیستمهای دینامیکی در حوزه پردازش و کنترل سیگنال حائز اهمیت است. در طی دهههای پیشین، تخمینگرهای مختلفی در زمینه تخمین حالت سیستمهای خطی مورد مطالعه قرار گرفتهاند که از میان آنها فیلتر کالمن بهعنوان یک راه حل بهینه در زمینههای بسیاری از جمله مخابرات، سیستمهای اکتساب داده و الگوریتمهای ردیابی هدف مورد استفاده وسیعی قرار گرفته است. با وجود این به دلیل ماهیت غیرخطی اغلب فرایندهای صنعتی، استفاده از تخمینگرهای خطی در عمل با محدودیت مواجه است. بنابراین استفاده از تخمینگرهای حالت غیرخطی بهمنظور مقابله با پیچیدگیهای مدلهای غیرخطی پیشنهاد شدهاند. یکی از برجستهترین تخمینگرهای حالت غیرخطی، فیلتر کالمن بدون رد 5(UKF) است [12] و [13] که بهدلیل ماهیت آماری فرایند خطیسازی، فاقد خطاهای خطیسازی ژاکوبین نسبت به فیلترهای کالمن توسعهیافته 6(EKF) است [14] و [15]. فیلتر کالمن توسعهیافته در مقایسه با فیلتر ذرهای 7(PF) بهدلیل حجم محاسبات پایینتر دارای ارجحیت است [16] و [17]. فیلتر UKF در شرایط ایدهآل، امکان ارائه تخمینی دقیق از سیستمهای غیرخطی را دارا میباشد؛ زیرا الگوریتم تخمین حالت در این فیلتر مبتنی بر کمینهسازی واریانس خطای تخمین است. اما از آنجا که UKF فیلتری مبتنی بر پاسخ ضربه نامحدود 8(IIR) است که از تمامی اندازهگیریهای گذشته استفاده میکند، تجمیع خطاهای مدلسازی در عمل میتواند منجر به واگرایی فیلتر شود. علاوه بر این، نامعینیهای موجود در پارامترهای مدل در بسیاری از کاربردها بهصورت عدم قطعیت بر عملکرد این فیلتر تأثیر منفی خواهد گذاشت. بهمنظور مقابله با معایب فیلتر IIR، استفاده از فیلتر پاسخ ضربه محدود 9(FIR) در بسیاری از مطالعات پیشنهاد شده است [18] و [19]. نخست استفاده از تخمینگر حالت ساختاری FIR در [20] پیشنهاد شد. در ادامه در [21] به توسعه فیلتر حداقل واریانس عمومی FIR 10(MVF) با فرض پایداری ورودی- خروجی کراندار و توسعه راه حلهای مختلف برای مدلهای خطی نامشخص پرداخته شد. پس از آن در [22] فیلتر غیراریبی تکرارشونده 11(UFIR) برای یک سیستم خطی گسسته و متغیر با زمان معرفی گردید [23]. فیلتر -FIR12HGS عملکرد خود را از طریق مقایسه با EKF، PF و UKF ثابت کرده است؛ با این حال، این روش به دلیل حجم محاسبات بالا، محدودیتهای بسیاری را در محیطهای واقعی دارا
جدول 1: مقایسه الگوریتمهای تخمین.
حجم محاسبات | توزیع چگالی نویز | مدل | تخمینگر |
کم | گاوسی | خطی | KF [29] |
کم یا متوسط | گاوسی | خطیشده | EKF [14] |
متوسط | گاوسی | غیرخطی | UKF [12] |
زیاد | غیرگاوسی | غیرخطی | PKF* [16] |
متوسط | گاوسی | غیرخطی | CKF [33] |
کم یا متوسط | گاوسی | غیرخطی/ خطی | EnKF [42] |
* Particle Kalman Filter
میباشد [24]. مرجع [25] یک معیار جدید را برای ترکیب بهینه اطلاعات چندحسگری با استفاده از 13KF غیرمتمرکز پیشنهاد داد. در [26] یک الگوریتم ترکیب اندازهگیری وزندار 14(WMF) پیشنهاد شد که بهینگی مجانبی را با استفاده از UKF برای یک سیستم غیرخطی با حسگرهای متعدد نشان میداد. سپس یک ترکیب توزیعشده CKF با ماتریسهای وزندار (MW-CKF) بر اساس چارچوب KF و قانون مکعب کروی برای سیستمهای غیرخطی چندحسگری در [27] پیشنهاد شد. پس از آن
با الگوریتمهای مختلف تخمین، ترکیب توزیعشده 15(DFE) را برای سیستمهای چندحسگری تحت شبکه و بر اساس فیلتر ساختاریافته IIR بررسی کردند و به مقایسه عملکرد این تخمینگرها در [28] پرداختهاند.
سیستم موقعیتیابی ربات نیازمند تخمین تمام نقاط نمونهبرداری است؛ اما در عمل، افزون بر آن نیاز به استفاده از هموارساز جهت دستیابی
به دقت قابل قبول تخمین با کمک بردار اندازهگیریهای پس از تخمین است. به طور کلی سه نوع مهم هموارساز وجود دارد که عبارت هستند
از هموارساز فاصله ثابت، هموارساز نقطه ثابت و هموارساز با تأخیر ثابت [29].
در موقعیتیابی ربات با توجه به اهمیت دقت تخمین، استفاده از هموارساز بازه ثابت بهدلیل استفاده از تمامی بردار مشاهدات پیشنهاد میشود؛ البته این نوع از هموارساز نیز شامل دو الگوریتم متفاوت میگردد: فیلتر یکنواخت 16(TFS) و راوچونگ- استریبل یکنواخت 17(RTSS) که این دو روش هر کدام متشکل از دو هموارساز دومرحلهای است. مرحله اول شامل یک فیلتر کالمن پیشرو (KF) برای ارائه یک تخمین بهینه از موقعیت میباشد [30]. با توجه به ماهیت غیرخطی اغلب سیستمهای موقعیتیابی و محدودیت فیلتر KF در ارائه تخمین بهینه، استفاده از فیلتر کالمن توسعهیافته [31]، فیلتر کالمن اختلاف مرکزی 18(CDKF) [32]، فیلتر کالمن بدون رد [32]، فیلتر کالمن مکعبی 19(CKF) [33] و فیلتر کالمن دوبخشی 20(EnKF) [34] در مراجع پیشنهاد شده است. مرحله دوم در الگوریتم RTSS در روند بازگشت به عقب به هموارسازی مقادیر تخمینی به کمک تمام اطلاعات فیلتر پیشرو میپردازد؛ اما در مرحله دوم الگوریتم TFS، هموارسازی تخمین به کمک یک KF پسرو و با ترکیب نتایج هر دو فیلتر پیشرو و پسرو حاصل میشود. با توجه به ارائه دو
راهحل مستقل توسط TFS، امکان شناسایی بهتر خطاها حین موقعیتیابی با این الگوریتم فراهم میگردد [35]. در [36]، یک TFS با EKF بهعنوان فیلتر پیشرو (ETFS) پیشنهاد شده که از بردار وضعیت خطا بهجای بردار وضعیت مرسوم در فیلتر پسرو استفاده میکند. استفاده از این بهینهسازی منجر به سادهسازی ساختار و بهبود کارایی الگوریتم میگردد. با این حال بهدلیل ارائه تقریب خطی با بسط سری تیلور، بروز خطاهای تقریب در این روش اجتنابناپذیر است [37] که به تضعیف عملکرد EKF در سیستمهای غیرخطی مقاوم منجر میگردد. از طرف دیگر، فیلتر پسرو تخمینها را بر اساس دینامیک معکوس فیلتر پیشرو محاسبه میکند؛ بنابراین خطای کمشده در فیلتر پیشرو منجر به ایجاد خطا در فیلتر پسرو میشود. برای حل این مشکل در [38] یک TFS مبتنی بر فیلتر کالمن نقطه- سیگما استاندارد 21(SPKF) ارائه شده که از فرمولاسیون رگرسیون خطی وزندار 22(WSLR) بدون معکوسکردن دینامیک غیرخطی برای بهبود دقت فیلتر پسرو استفاده میکند. WSLR یک تکنیک خطیسازی است که عدم قطعیت متغیر تصادفی قبلی را هنگام خطیسازی مدل غیرخطی در نظر میگیرد [39]. استفاده از این روش برای تحقق TFS اصلاحشده مبتنی بر CDKF در [40] و UKF در [41] اتخاذ شده است. SPKF شامل CDKF و UKF، یک الگوریتم نمونهگیری قطعی با نقاط نمونهگیری خاص است. در الگوریتمهای نمونهگیری قطعی، تعداد نقاط نمونه با ابعاد بردار حالت سیستم یکسان است که باعث ناتوانی این روش جهت انعکاس دقیق حالات در سیستمهای غیرخطی با ابعاد بالا میگردد.
از این رو ایده اصلی مقاله، ارائه یک TFS اصلاحشده جدید با EnKF بهعنوان فیلتر پیشرو است. EnKF با بسط الگوریتم کالمن با روشهای تخمین مونتکارلو بهدست میآید. یکی از مشکلات روشهای تخمین در فرایند موقعیتیابی، کار با سیستمهای دینامیکی با متغیرهای زیاد است؛ چرا که در پیادهسازی بهدلیل نبود راه حلی مناسب برای تقریب ماتریس کوواریانس خطا با محدودیتهای محاسباتی مواجه است. در EnKF از مجموعههای تصادفی و روش مونتکارلو برای محاسبه تقریب کواریانس خطا استفاده میشود. در واقع میتوان این فیلتر را بهعنوان کلاس خاصی از فیلترهای ذرهای بشمار آورد با این تفاوت که در آن، تمامی توزیعهای احتمالی گاوسی هستند و بنابراین در عمل بسیار کارآمدتر از فیلتر کالمن ذرهای است. با توجه به فرض گاوسیبودن تمامی توابع چگالی احتمال و خطیبودن سیستم میتوان در الگوریتم فیلتر کالمن با استفاده از روابط جبری به محاسبه مقادیر میانگین و ماتریس کوواریانس خطا توسط قانون بهروزرسانی بیزین پرداخت. اما در مواجهه با سیستمهای دارای ابعاد بالا، تعیین ماتریس کوواریانس خطا با روش جبری بهدلیل حجم محاسبات بالا مناسب نیست. در جدول ۱ به مقایسه کلی مهمترین الگوریتمهای تخمین اشاره شده است.
فیلتر کالمن دوبخشی، مجموعهای از بردارهای حالت را جایگزین تخمین بردار حالت نموده و ماتریس کوواریانس را با کوواریانس نمونههای محاسبهشده از مجموعه بهدست میآورد [43]. بدین ترتیب مهمترین دلایل محبوبیت این روش را میتوان ناشی از فرمولبندی ساده و سهولت در اجرای آن دانست. زیرا برخلاف سایر الگوریتمهای کالمن، بینیاز از انجام محاسباتی نظیر تعیین مشتق یک عملگر خطی و یا معادلات الحاقی و انتگرالگیری نسبت به زمان میباشد. از این رو استفاده از EnKF بهدلیل قابلیت کار با مسائل دارای متغیرهای زیاد و دقت تخمین مناسب
شکل 1: نمونهای از موقعیتیابی حرکت ربات در حالت مربع.
در فرایند موقعیتیابی ربات سیار با استفاده از نور مرئی پیشنهاد میگردد.
تمرکز این مقاله بر ارائه یک تخمینگر برای موقعیتیابی ربات است که شامل یک فیلتر پیشروی EnKF با رگرسیون خطی آماری 23(SLR) و یک فیلتر کالمن اطلاعات پسرو (IKF) با بردار حالتهای خطا میباشد. مهمترین مزایای روش پیشنهادی را میتوان در کاهش خطای تخمین بهدلیل استفاده از فیلتر کالمن دوبخشی، کاهش وابستگی به مدل و پارامترهای نویز بهدلیل جبران خطای مبتنی بر مدل خطی آماری در مسیر رو به عقب و همچنین کاهش هزینههای پیادهسازی بهدلیل استفاده از حسگر نور مرئی و موقعیتیابی مبتنی بر نور محیط برشمرد.
مزیت استفاده از فیلتر پیشرو و پسرو در روش پیشنهادی را میتوان بهصورت زیر بیان کرد:
- فیلتر پیشرو در روش پیشنهادی، متفاوت از SPKF و EKF بوده و از الگوریتم نمونهگیری تصادفی مبتنی بر روش مونتکارلو استفاده مینماید. نمونههای EnKF بهطور تصادفی به محاسبه عددی ماتریس کوواریانس حالت میپردازند که علاوه بر کاهش پیچیدگی محاسباتی در مقایسه با KF به بهبود عملکرد تخمین نیز منتهی میگردد. نقاط نمونه تصادفی در EnKF دارای وزنهای یکسان هستند و از این رو دلیل بهکارگرفتن SLR در EnKF پیشرو،
ارائه پارامترهای لازم بهمنظور بهبود دقت فیلتر پسرو در روش پیشنهادی است.
- فیلتر پسرو در روش پیشنهادی یک IKF است که برای جبران خطای تخمین فیلتر پیشرو و با هدف دستیابی به دقت بیشتر بهکار رفته است. علاوه بر این، فیلتر پسرو در روش پیشنهادی متفاوت از فیلتر مرسوم و مبتنی بر بردار خطای حالت است که بهبود دقت را به دنبال دارد.
این مقاله بهصورت زیر سازماندهی شده که در بخش 2 موقعیتیابی ربات سیار مرور گردیده است. روش پیشنهادی برای موقعیتیابی ربات سیار در بخش ۳ توضیح داده شده و نتایج تجربی و تجزیه و تحلیل در بخش 4 آمدهاند. نهایتاً نتیجهگیری در بخش 5 ارائه گردیده است.
2- موقعیتیابی ربات سیار
تمرکز مسأله موقعیتیابی ربات متحرک بر تعیین موقعیت ربات در هر لحظه از زمان است. ربات با کسب اطلاعات حسگرها به تعیین محل خود میپردازد؛ اما با توجه به اینکه اغلب دادههای حسگر در معرض نویز قرار دارند، موقعیت را با اندکی خطا ثبت خواهد کرد و با انباشت این خطا در طول زمان، تعیین موقعیت با مشکل مواجه خواهد شد. برای حل این مسئله، نخست باید به تخمین خطاها پرداخته و سپس در هر مرحله از تخمین، آنها را رفع نمود. بهطور کلی فرایند موقعیتیابی ربات متحرک از دو طریق انجام میپذیرد: موقعیتیابی سراسری و ردیابی محلی.
شکل 2: شرح شماتیک یک ربات سیار.
در موقعیتیابی سراسری، محل اولیه ربات ناشناخته است و ربات باید خود را بدون هیچ اطلاعاتی در رابطه با محلش موقعیتیابی کند؛ در حالی که در ردگیری محلی، موقعیت اولیه ربات معین است اما ربات باید ردیابی را تا جهتیابی24 کامل در محیط ادامه دهد. در شکل 1 نمونهای از حرکت ربات در مسیر مربع مشخص شده که نشان میدهد برای انجام حرکت در مسیر درست نیاز به موقعیتیابی دارد.
مدل سینماتیکی ربات سیار چرخدار به صورت زیر است [43]
(1)
که در آن و موقعیت ربات در دستگاه مختصات، جهتگیری آن با توجه به مختصات دوبعدی محیط شبیهسازی، فاصله مرکز جرم تا مرکز محور چرخهای عقب، و بهترتیب نشاندهنده سرعت خطی و زاویهای ورودیهای کنترلی ربات سیار نسبت به مختصات سراسری OXY، یک فاصله نمونهبرداری و بردار نویز است که فرض میشود گاوسی با میانگین صفر باشد. شرح شماتیک مدل سینماتیکی در شکل 2 نشان داده شده است.
معادله اندازهگیری به شرح زیر است [44]
(2)
که در آن برای اندازهگیری نشانههای25 مشاهدهشده، و مختصات محل نشانه ام و بردار نویز گاوسی اندازهگیری با میانگین صفر است.
3- موقعیتیابی ربات مبتنی بر
فیلتر کالمن دوبخشی هموار
در این بخش به توصیف موقعیتیابی ربات مبتنی بر فیلتر کالمن دوبخشی هموار پرداخته میشود. این الگوریتم شامل یک EnKF با SLR و یک IKF اصلاحشده است که بهترتیب بهعنوان فیلتر پیشرو و پسرو عمل میکنند. فیلتر پیشرو دادهها را در یک دوره زمانی پردازش میکند و سپس فیلتر پسرو بهصورت معکوس، خطای تخمین فیلتر پیشرو را جبران مینماید. نهایتاً هموارکننده، تخمین فیلتر پیشرو و پسرو را با هم ترکیب میکند تا تخمین دقیقتری ارائه دهد. مسأله موقعیتیابی را اغلب میتوان بهعنوان یک مسأله تخمین حالت در یک سیستم دینامیکی غیرخطی زمان گسسته توصیف کرد. مدل غیرخطی فضای حالت ربات سیار در لحظه بهصورت زیر توصیف میشود
(3)
(4)
که بردار حالت، بردار اندازهگیری، نویز فرایند در سیستم دینامیکی، نویز اندازهگیری، مدل دینامیکی سیستم و مدل اندازهگیری است.
برای خطیکردن مدل فضای حالت غیرخطی، SLR در روش پیشنهادی اعمال میشود. SLR با درنظرگرفتن حداقل میانگین مربع خطا (MMSE) و کوواریانس متغیر تصادفی، تقریب خطی بهینه یک تابع غیرخطی را بهدست میآورد. در یک مفهوم آماری، SLR دقت بهتری برای خطیسازی نسبت به بسط سری تیلور دارد. علاوه بر این در مقایسه با WSLR استفادهشده، محاسبات SLR کمتر و سادهتر است. مدل فضای حالت خطیشده آماری بهصورت رابطه زیر داده میشود
(5)
(6)
که ، ، و پارامترهای استاتیکی خطیسازی و و خطاهای خطیسازیشده با میانگین صفر و نویز گاوسی هستند که بهترتیب با کوواریانس و مدل شدهاند. مدل فضای حالت خطیشده آماری برای فیلتر پسرو اعمال میشود. فیلتر پیشرو یک EnKF با SLR است. EnKF یک تخمینگر زیربهینه است که در آن خطا با استفاده از مونتکارلو یا انتگرالگیری جمعی برای حل معادله فوکر پلانک پیشبینی میشود.
برای مقداردهی اولیه، تخمین اولیه توسط مجموعهای از بردارهای با خطاهای نمونه تصادفی ایجاد میشود. لازم به ذکر است که تخمین اولیه نامعلوم بوده و با استفاده از روش حداقل مربعات (LS) در روش پیشنهادی بهدست میآید. جهت پیشبینی فرض میشود که و بهترتیب حالت پیشبینی ام و حالت بهروزرسانی را در زمان تعریف میکنند. سپس وضعیت پیشبینی در زمان را میتوان از حالت بهروزرسانی در زمان قبلی بهدست آورد
(7)
که یک متغیر تصادفی با میانگین صفر و کوواریانس مدل دینامیکی است. حالت پیشبینی میانگین گروه برابر است با
(8)
پس کوواریانس خطای مرحله پیشبینی به شکل زیر داده میشود
(9)
در همگامسازی امین حالت در زمان میتوان از حالت پیشبینی توسط معادله زیر استفاده کرد
(10)
که بهره کالمن، دادههای اندازهگیری واقعی در زمان و تخمین اندازهگیری محاسبهشده از حالت پیشبینی است. بهطور خاص، مجموعه دادههای اندازهگیری واقعی به شرح زیر است
(11)
که در آن یک متغیر تصادفی با میانگین صفر و کوواریانس است. تخمین اندازهگیری محاسبهشده از حالت پیشبینی بهصورت زیر است
(12)
که در آن مدل اندازهگیری است. تخمین اندازهگیری میانگین گروه توسط معادله زیر داده میشود
(13)
پس را میتوان با استفاده از ماتریسهای کوواریانس خطا تعیین کرد
(14)
که در آن و داده شدهاند
(15)
که ماتریس کوواریانس نویز در زمان است. نهایتاً بردار حالت اندازهگیری همگامسازیشده را میتوان تعیین کرد و سپس حالت بهروزرسانی میانگین بهصورت زیر ارائه میشود
(16)
و کوواریانس خطای متناظر مرحله بهروزرسانی برابر است با
(17)
پارامترهای مدل خطی خطیشده سیستم غیرخطی در (5) و (6) بهصورت زیر است
(18)
(19)
(20)
(21)
که کوواریانسهای و بهصورت زیر داده میشود
(22)
(23)
یک IKF برای تخمین وضعیت پسرو در زمان با مدل فضای حالت خطیشده آماری در (5) و (6) استفاده میگردد. علاوه بر این، IKF با استفاده از بردار خطای EnKF پیشرو فرموله میشود که متفاوت از الگوریتمهای مرسوم است. تابع فیلتر پسرو جبران خطای تخمین فیلتر پیشرو با استفاده از نتایج خطیسازی از فیلتر پیشرو است.
شکل 3: سیستم موقعیتیابی ربات با استفاده از روش پیشنهادی.
شکل 4: ردیابی در مسیر همراه با نویز در حرکت دایرهای.
بلوک دیاگرام سیستم موقعیتیابی ربات با استفاده از روش پیشنهادی در شکل 3 نشان داده شده است.
4- نتایج
در این بخش، روش پیشنهادی در مقایسه با 26TLNF/UK [45] برای موقعیتیابی ربات مورد ارزیابی قرار میگیرد. سناریو دوبعدی است، چهار نشانه در محیط در نظر گرفته شده و فرض بر آنست که مکان نشانهها دقیقاً مشخص میباشد. زمان نمونهبرداری بر روی 01/0 تنظیم گردیده است. فرض میکنیم که واریانس نویز پروسه و اندازهگیری در وضعیت نرمال بهترتیب دارای مقادیر ،
و میباشد و در بازه تغییرات، هنگامی
که و است، مقادیر عددی نویز
پروسه و اندازهگیری بهترتیب ، و میباشد. برای اثبات عملکرد روش پیشنهادی، این روش با روش [45] که ترکیب TLNF/UK است مورد مقایسه قرار گرفته است. برای فیلتر TLNF مقادیر بهصورت ، و در نظر گرفته شده است.
در ابتدا عملکرد روش پیشنهادی در مقایسه با روش TLNF/UK [45] در ردیابی مسیر دایرهای ربات سیار مورد آزمایش قرار گرفته است. فرض بر آنست دو بازه وجود دارد که در آن، اندازهگیریها بهشدت توسط نویز تحت تأثیر قرار میگیرد و در آن واریانس در مقایسه با وضعیت نرمال
شکل 5: RMSE تجمیعی موقعیتهای و در ردیابی مسیر دایرهای.
شکل 6: RMSE جهتیابی در ردیابی مسیر دایرهای.
بسیار بالاست. همان طور که در شکل 4 مشاهده میشود، خروجی مبتنی بر تخمین حالت با روش ترکیبی TLNF/UK و روش پیشنهادی در ردیابی مسیر دایرهای ربات سیار مورد آزمایش قرار گرفته است. با توجه به نتایج، عملکرد موقعیتیابی روش پیشنهادی بهتر از روش TLNF/UK است. روش پیشنهادی توانسته با تغییرات کمتری در حرکت دایرهای نسبت به روش TLNF/UK عمل کند. در بازههایی که نویز اعمال شده است، هر دو روش انحراف از مسیر داشتهاند؛ اما روش پیشنهادی انحراف و تغییرات کمتری داشته است.
برای ارزیابی دقیقتر، RMSE تخمین موقعیت در طول زمان توسط دو روش بررسی شده است. RMSE تجمیعی و در شکل 5 و در شکل 6 در ردیابی مسیر دایرهای نشان داده شده و لازم به ذکر است همان طور که از شکلها مشخص میباشد، روش پیشنهادی و روش TLNF/UK در بازهای از زمان خطای بیشتری دارند و این زمانی است که در ناحیه نویزی قرار دارند. همان طور که مشاهده میشود در روش پیشنهادی، دامنه RMSE تجمیعی و بیشتر از 2/2 نبوده است. بیشترین میزان خطا در ثانیه 200 تا 400 و همچنین 600 تا 800 بوده و این زمانی است که حرکت در ناحیه با نویز قرار دارد. در نواحی دیگر دامنه RMSE کمتر از 2/0 است. در شکل 6 در ناحیه نویزی میزان RMSE تخمین حالت در روش پیشنهادی بیشتر از 05/0 نبوده است. در شکلهای 7 تا 9 میتوان عملکرد هر یک از این دو تخمینگر را در روند تخمین متغیرهای حالت ، و مشاهده نمود.
شکل 7: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر دایرهای.
شکل 8: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر دایرهای.
جدول 2: مقایسه RMSE خطای تخمین در ردیابی مسیر دایرهای.
| روش پیشنهادی | TLNF/UK | میزان بهبود (درصد) |
| 31/0 | 38/0 | 04/25 |
| 41/0 | 51/0 | 30/24 |
| 43/0 | 48/0 | 82/11 |
جدول 3: مقایسه زمان پردازش الگوریتمها در ردیابی مسیر دایرهای.
روش TLNF/UK [45] | 71/1 ثانیه |
روش پیشنهادی | 12/3 ثانیه |
بهمنظور مقایسه دقت و سرعت همگرایی روش پیشنهادی با TLNF/UK، RMSE متغیرهای حالت دینامیک ربات بههمراه مدت زمان پردازش در جداول 2 و 3 ارائه شده است. همان طور که مشاهده میشود روش پیشنهادی توانسته که دقت موقعیتیابی را تا 25 درصد نسبت به روش ترکیبی TLNF/UK بهبود بخشد و میزان خطای تخمین کمتری داشته باشد.
با توجه به شدت نویزهای اندازهگیری در روند کنترل دینامیک ربات، بهمنظور نمایش وابستگی کمتر روش پیشنهادی به مقادیر مدل فرایند و نویزهای اندازهگیری به مقایسه RMSE خطای تخمین در حضور عدم قطعیت واریانس نویز پرداخته میشود. در جدول 4 جذر مربع خطای تخمین متغیرها در حالت افزایش واریانس نویز ارائه شده است. با مقایسه
شکل 9: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر دایرهای.
شکل 10: ردیابی در مسیر همراه با نویز در حرکت مستطیلی.
جدول 4: مقایسه RMSE خطای تخمین در حضور عدم قطعیت واریانس نویز
در ردیابی مسیر دایرهای.
| روش پیشنهادی | TLNF/UK | میزان بهبود (درصد) |
| 71/0 | 17/1 | 78/64 |
| 09/1 | 58/1 | 95/44 |
| 97/0 | 48/1 | 57/52 |
نتایج جدول 2 با نتایج جدول 4 میتوان حساسیت کمتر روش پیشنهادی به تغییرات نویز را بهخوبی مشاهده نمود. با مقایسه نتایج این دو جدول مشاهده میشود که در ازای تغییر یکسان پارامترهای نویز برای هر دو روش، در حالی که مقدار افزایش جذر خطای تخمین روش ترکیبی TLNF/UK نزدیک به 1/3 برابر شده است، این افزایش برای روش پیشنهادی برابر با 2/2 میباشد. روش پیشنهادی توانسته در ردیابی مسیر دایرهای و در حضور عدم قطعیت واریانس نویز تا 64 درصد دقت تخمین را افزایش دهد. روش پیشنهادی برخلاف TLNF/UK نسبت به عدم قطعیت در نویز مقاوم است. از آنجایی که وجود عدم قطعیتها در فرایند تخمین حالت اجتنابناپذیر هستند، اهمیت روش پیشنهادی بهخوبی مشخص میگردد.
در ادامه برای بررسی بیشتر عملکرد روش پیشنهادی، مسیر دایرهای به مسیر مستطیلی تغییر یافته و شبیهسازی مجدد تکرار شده است. مشابه حالت قبل، فرض بر آنست که در دو بازه، اندازهگیریها بهشدت تحت تأثیر نویز قرار گرفته و نتایج بهدستآمده از الگوریتمها در شکل 10
شکل 11: RMSE تجمیعی موقعیتهای و در ردیابی مسیر مستطیلی.
شکل 12: RMSE جهتیابی در ردیابی مسیر مستطیلی.
مشخص گردیده است. مشابه حالت قبل، عملکرد موقعیتیابی روش پیشنهادی از روش TLNF/UK بهتر است؛ لذا این روش توانسته با تغییرات کمتری در حرکت مستطیلی نسبت به روش TLNF/UK عمل کند. مطابق شکل در حرکت مستطیلی در بازه 5 تا 5- نویز وارد شده و در دیگر نقاط نویزی وجود نداشته است. همان طور که مشخص است روش پیشنهادی و روش TLNF/UK هنگامی که نویزی در محیط نباشد میتوانند با دقت خوبی بر روی مسیر اصلی حرکت کنند؛ ولی هنگام اعمال نویز، روش پیشنهادی انحراف کمتری دارد.
در شکل 11 و 12، جذر مربع خطای تخمین موقعیت دو الگوریتم در مسیر مستطیلی نسبت به زمان بهترتیب برای ، و نشان داده شده است. ملاحظه میشود روش پیشنهادی نسبت به روش TLNF/UK دارای خطای کمتری در حرکت است؛ اما هر دو روش در بازهای از زمان خطای بیشتری دارند. شکل 11، حداکثر خطای تجمیعی موقعیتهای و در ردیابی مسیر است که میزان آن بیشتر از 5/2 نبوده و این خطا در ناحیه همراه با نویز اتفاق افتاده است. در قسمتهای دیگر حرکت مستطیلی، بیشترین خطای تجمیعی به عدد 2/0 میرسد و کمترین میزان خطا نیز در قسمتهایی صفر بوده است. همان طور که در شکل 12 مشخص میباشد، حداکثر خطای متغیر در ناحیه نویزی در روش پیشنهادی بیشتر از 13/0 نبوده است. در شکلهای 13 تا 15 میتوان عملکرد هر یک از این دو تخمینگر را در روند تخمین متغیرهای حالت ، و در 1000 ثانیه مشاهده نمود.
شکل 13: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر مستطیلی.
شکل 14: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر مستطیلی.
شکل 15: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر مستطیلی.
در ادامه به مقایسه دقت و سرعت همگرایی روش پیشنهادی با روش TLNF/UK در زمان اعمال نویز پرداخته میشود. لذا RMSE تخمین متغیرهای حالت دینامیک ربات بههمراه مدت زمان پردازش در حلقه کنترل ردیابی مسیر مستطیلیشکل در جداول 5 و 6 ارائه شده است.
بهمنظور بررسی حساسیت کمتر روش پیشنهادی به پارامترهای مدل و نویز فرایند با افزایش واریانس نویز اندازهگیری، شبیهسازی مجدداً تکرار شده است. در جدول 7 مقادیر جذر مربع خطای تخمین متغیرهای حالت
شکل 16: ردیابی در حرکت همراه با نویز در مسیر Z شکل.
شکل 17: RMSE تجمیعی موقعیتهای و در ردیابی مسیر Z شکل.
در زمان افزایش واریانس نویز اندازهگیری بیان شده است. با مقایسه نتایج جدول 5 با 7 میتوان حساسیت کمتر روش پیشنهادی را به تغییرات پارامترهای مدل و نویز بهخوبی مشاهده نمود.
پارامترهای نویز برای هر دو روش به میزان یکسانی افزایش داده شده است. همان طور که مشاهده میشود در روش ترکیبی TLNF/UK، مقدار افزایش جذر خطای تخمین نزدیک به 4/3 برابر است؛ این افزایش برای روش پیشنهادی برابر با 3/2 میباشد. در ردیابی مسیر مستطیلی میزان دقت روش پیشنهادی در حضور عدم قطعیت تا 53 درصد بهبود یافته است.
در این بخش عملکرد موقعیتیابی روش پیشنهادی در مقایسه با TLNF/UK در یک مسیر پیچیدهتر به شکل Z مورد بررسی قرار گرفته است. موقعیتیابی ربات سیار در این مسیر نسبت به دو مسیر مرجع پیشین، دشوارتر و مسیر حرکت آن طولانیتر است. با فرض مقادیر نامی واریانس نویز اندازهگیری مشابه با بخش پیشین به بررسی عملکرد در ردیابی مسیر مرجع Z شکل و مقایسه تخمین متغیرهای حالت با روش TLNF/UK و روش پیشنهادی پرداخته شده است. در شکل 8 میتوان خروجی دینامیک حلقه بسته مبتنی بر تخمین حالت با روش TLNF/UK و تخمینگر پیشنهادی را مشاهده نمود. در این مسیر نیز در دو بازه، حرکت تحت تأثیر نویز قرار میگیرد. نتایج این بررسی در شکل 16 نشان داده شده و همان طور که مشخص است روش پیشنهادی توانسته با تغییرات کمتری در حرکت Z نسبت به روش TLNF/UK عمل کند. در این
شکل 18: RMSE جهتیابی در ردیابی مسیر Z شکل.
جدول 5: مقایسه RMSE خطای تخمین در ردیابی مسیر مستطیلی.
| روش پیشنهادی | TLNF/UK | میزان بهبود (درصد) |
| 04/0 | 45/0 | 53/11 |
| 59/0 | 62/0 | 42/5 |
| 03/0 | 04/0 | 65/10 |
جدول 6: مقایسه زمان پردازش الگوریتمها در ردیابی مسیر مستطیلی.
روش TLNF/UK [45] | 14/2 ثانیه |
روش پیشنهادی | 15/4 ثانیه |
جدول 7: مقایسه RMSE خطای تخمین در حضور عدم قطعیت واریانس نویز
در ردیابی مسیر مستطیلی.
| روش پیشنهادی | TLNF/UK | میزان بهبود (درصد) |
| 10/1 | 55/1 | 90/40 |
| 37/1 | 10/2 | 28/53 |
| 02/1 | 07/1 | 9/4 |
حرکت، دامنه نویز در محیط از 7 تا 7- بوده و نسبت به حرکت مستطیلی محیط، نویز بیشتری داشته است. همان طور که مشخص است روش TLNF/UK در دامنه نویزی و نیز در گوشههای حرکت Z انحرافاتی دارد؛ اما در روش پیشنهادی این انحرافات کمتر است.
در ادامه در شکلهای 17و 18 میزان خطا در طول زمان 1000 ثانیه آمده و مشاهده میشود که روش پیشنهادی نسبت به روش TLNF/UK دارای خطای کمتری در حرکت Z است. خطا در قسمتهایی از ناحیه نویزی صفر میباشد؛ ولی همواره هر دو روش دارای خطا بودهاند. RMSE تجمیعی موقعیتهای و در ردیابی مسیر Z شکل در شکل 17 آمده است. همان طور که مشاهده میشود میزان خطا در قسمتهای نویزی در روش پیشنهادی از حدود 3/2 فراتر نرفته است؛ اما بیشترین میزان افزایش برای روش TLNF/UK از 3 بیشتر و RMSE روش پیشنهادی در نواحی دیگر، کمتر از 3/0 است. شکل 18، RMSE جهتیابی در ردیابی مسیر Z شکل است که بهوضوح عملکرد بهتر روش پیشنهادی نسبت به TLNF/UK مشخص میباشد. در شکلهای 19
تا 21 میتوان عملکرد هر یک از این دو تخمینگر را در روند تخمین متغیرهای حالت ، و مشاهده نمود.
مشابه بخشهای پیشین بهمنظور درک میزان افزایش دقت فیلتر پیشنهادی و همچنین افزایش سرعت همگرایی، مقدار جذر مربع خطای
شکل 19: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر Z شکل.
شکل 20: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر Z شکل.
تخمین متغیرهای حالت دینامیک ربات بههمراه مدت زمان پردازش در حلقه کنترل ردیابی مسیر Z شکل بررسی میگردد. این نتایج در جداول 8 و 9 ارائه شدهاند.
همان طور که در شکل 16 مشخص شد، روش پیشنهادی توانسته با تغییرات کمتری در حرکت Z شکل نسبت به روش TLNF/UK عمل کند. بهمنظور نمایش وابستگی کمتر روش پیشنهادی به مقادیر مدل فرایند و نویزهای اندازهگیری، مقدار واریانس نویز را افزایش داده و سپس نتایج آن در جدول 10 ارائه شده است. با مقایسه نتایج جدول 10 با 8 میتوان حساسیت کمتر روش پیشنهادی به تغییرات پارامترهای مدل و نویز را مشاهده نمود. با مقایسه نتایج جداول 8 و 10 مشاهده میشود که در ازای تغییر یکسان پارامترهای نویز برای هر دو روش، در حالی که مقدار افزایش جذر خطای تخمین روش ترکیبی TLNF/UK نزدیک به 2/3 برابر شده است، این افزایش برای روش پیشنهادی برابر با 3/2 میباشد که صحت حساسیت کمتر روش پیشنهادی را تأیید مینماید و دقت تخمین را در حضور عدم قطعیت تا 58 درصد نسبت به روش TLNF/UK بهبود بخشیده است.
همان طور که مشاهده شد، دقت روش TLNF/UK نسبت به روش پیشنهادی کمتر است و روش پیشنهادی، هم در وضعیت نرمال و هم در فاصلهای که در نویز است، پایدار میباشد. با این حال، همان طور که نشان داده شد، هزینه محاسباتی روش پیشنهادی از روش TLNF/UK بیشتر است؛ از این رو هنگامی که برای ربات سرعت عمل و زمان رسیدن
شکل 21: تخمین حالت با روش پیشنهادی و TLNF/UK در مسیر Z شکل.
جدول 8: مقایسه RMSE خطای تخمین در ردیابی مسیر Z شکل.
| روش پیشنهادی | TLNF/UK | میزان بهبود (درصد) |
| 53/0 | 59/0 | 22/11 |
| 58/0 | 60/0 | 14/3 |
| 52/0 | 56/0 | 26/7 |
جدول 9: مقایسه زمان پردازش الگوریتمها در ردیابی مسیر Z شکل.
روش TLNF/UK [45] | 26/4 ثانیه |
روش پیشنهادی | 12/8 ثانیه |
جدول 10: مقایسه RMSE خطای تخمین در حضور عدم قطعیت واریانس نویز
در ردیابی مسیر Z شکل.
| روش پیشنهادی | TLNF/UK | میزان بهبود (درصد) |
| 19/1 | 89/1 | 82/58 |
| 34/1 | 93/1 | 02/44 |
| 21/1 | 81/1 | 58/49 |
از مبدأ به مقصد حائز اهمیت است، میتوان از روش TLNF/UK استفاده کرد که نیاز به صرف انرژی کمتری برای حرکت دارد. اما در مقایسه با روش پیشنهادی از دقت پایینتری در تخمین حالت و ردیابی برخوردار بوده و لذا میتوان مشاهده نمود که خطاهای تخمین در روش پیشنهادی کمتر است و توانسته در حرکت دایرهای تا 25 درصد دقت تخمین را افزایش دهد و با وجود عدم قطعیت واریانس نویز توانسته تا 64 درصد در حرکت دایرهای بهتر عمل کند. اما زمان محاسبات روش پیشنهادی نسبت به مدل TLNF/UK تقریباً دوبرابر بیشتر است و این بهبود در حرکت مستطیلی و حرکت Z نیز دیده میشود. با بررسی نتایج بهدستآمده از سه مسیر مرجع متفاوت میتوان مشاهده نمود که زمان کل پردازش هنگام ردیابی مسیر Z شکل بیشتر از حالت دایره و مستطیل است و این به طول مسیر حرکت نیز مربوط میباشد. مزیت دیگر روش پیشنهادی، حساسیت کمتر به تغییر پارامترهای مدل و نویز است که این مسأله بهخصوص در فرایند کنترل رباتهای خودمختار که با عدم قطعیتهای بسیاری مواجه هستند، اهمیت ویژهای مییابد.
5- نتیجهگیری
با توجه به اهمیت مسأله تخمین موقعیت ربات در حلقه کنترل ردیابی مسیر در این مقاله، طراحی یک تخمینگر هموار دوبخشی برای موقعیتیابی ربات سیار پیشنهاد شد. این تخمینگر شامل فیلتر پیشرو EnKF با نمونهبرداری تصادفی و فیلتر پسرو مبتنی بر بردار خطای حالت است. فیلتر پسرو به جبران خطای تخمین فیلتر پیشرو میپردازد و نهایتاً هموارکننده، تخمین فیلتر پیشرو و پسرو را با هم ترکیب میکند تا تخمین دقیقتری ارائه دهد. در ادامه بهمنظور بررسی صحت عملکرد الگوریتم پیشنهادی، فرایند موقعیتیابی ربات در سه مسیر مرجع دایرهای، مستطیلی و Z شکل مورد مطالعه قرار گرفت. نتایج بهدستآمده از موقعیتیابی روش پیشنهادی در مقایسه با روش TLNF/UK [45]، حاکی از افزایش دقت 25 درصدی در مسیر دایره و 11 درصدی در مسیر مستطیل و مسیر
Z شکل است. شبیهسازی با حضور عدم قطعیت واریانس نویز در ردیابی تکرار شد و دقت تخمین نسبت به روش TLNF/UK به میزان 64 درصد در مسیر دایرهای و حدود 50 درصد در دو مسیر مرجع دیگر بهبود یافت؛ لذا حساسیت کمتر روش پیشنهادی نسبت به پارامترهای مدل و نویز بهخوبی نشان داده شد. در مقابل، افزایش زمان پردازش روش پیشنهادی، نقطه ضعف آن نسبت به روش TLNF/UK [45] است. افزون بر این استفاده از حسگر نور مرئی و موقعیتیابی مبتنی بر نور محیط، منجر به کاهش چشمگیر هزینههای اجرایی در محیط واقعی میگردد. بهمنظور ارائه پیشنهاد برای پژوهشهای آتی، استفاده از الگوریتم این مقاله با مکانیزم ارسال داده اندازهگیری مبتنی بر رویداد بهعنوان راه حلی در جهت کاهش محاسبات و زمان پردازش، تحت مطالعه قرار میگیرد.
مراجع
[1] D. Pramod, "Robotic process automation for industry: adoption status, benefits, challenges and research agenda," Bench-Marking: An Int. J., vol. 29, no. 5, pp. 1141-1148, May 2021.
[2] S. Tomazic, "Indoor positioning and navigation," Sensors (Basel), vol. 21, no. 14, Article: 4793, Jul. 2021.
[3] C. Wang, A. Xu, J. Kuang, X. Sui, Y. Hao, and X. Niu, "A high-accuracy indoor localization system and applications based on tightly coupled UWB/INS/floor map integration," J. IEEE Sens, vol. 21, no. 16, pp. 18166-18177, 15 Aug. 2021.
[4] Y. Zhuang, J. Yang, L. Qi, Y. Li, Y. Cao, and N. El-Sheimy, "A pervasive integration platform of low-cost MEMS sensors and wireless signals for indoor localization," IEEE Internet of Things J., vol. 5, no. 6, pp. 4616-4631, Dec. 2017.
[5] Y. Yu, R. Chen, L. Chen, W. Li, and Y. Wu, "Autonomous 3D indoor localization based on crowdsourced Wi-Fi fingerprinting and MEMS sensors," J. IEEE Sens, vol. 22, no. 6, pp. 5248-5259, 15 Mar. 2021.
[6] L. Chen, X. Zhou, F. Chen, L. L. Yang, and R. Chen, "Carrier phase ranging for indoor positioning with 5G NR signals," J. IEEE Internet Things, vol. 9, no. 13, pp. 10908-10919, 1 Jul. 2021.
[7] R. Chen, et al., "Precise indoor positioning based on acoustic ranging in smartphone," IEEE Trans. Instrum, Meas., vol. 70, Article ID: 9509512, 2021.
[8] J. Li, et al. "PSOTrack: a RFID-based system for random moving objects tracking in unconstrained indoor environment," IEEE Internet of Things J., vol. 5, no. 6, pp. 4632-4641, Dec. 2018.
[9] Y. Zhuang, L. Hua, L. Qi, J. Yang, P. Cao, and Y. Cao, "A survey
of positioning systems using visible LED lights," IEEE Communications Surveys & Tutorials, vol. 20, no. 3, pp. 1963-1988, Third quarter 2018.
[10] R. Garcia, H. Kuga, and W. Silva, "Unscented kalman filter and smoothing applied to attitude estimation of artificial satellites," Computational and Applied Mathematics, vol. 37, no. 4, pp. 55-64, 2018.
[11] P. Balenzuela, et al. "Accurate Gaussian mixture model smoothing usinga two-filter approach," in Proc. of the IEEE Conf. on Decision and Control, pp. 694-699, Miami Beach, FL, USA, 17-18 Dec. 2018.
[12] F. Deng, H. L. Yang, and L. J. Wang, "Adaptive unscented kalman filter based estimation and filtering for dynamic positioning with model uncertainties," J. of Control, Automation and Systems, vol. 17, no. 1, pp. 667-678, Feb. 2019.
[13] L. Dang, W. Wang, and B. Chen, "Square root unscented kalman filter with modified measurement for dynamic state estimation of power systems," IEEE Trans. on Instrumentation and Measurement, vol. 71, Article ID: 9002213 2022.
[14] A. Tuveri, F. Pérez-García, P. A. Lira-Parada, L. Imsland, and N. Bar, "Sensor fusion based on extended and unscented kalma filter for bioprocess monitoring," J. of Process Control, vol. 106, pp. 195-207, Oct. 2021.
[15] M. N. Lv, T. Sun, and J. Li, "Estimation of vehicle state parameters based on extended kalman filter," Agricultural Equipment and Vehicle Engineering, vol. 56, no. 5, pp. 77-80, 2019.
[16] A. Varsi, S. Maskell, and P. G. Spirakis, "An O(log2N) fully-balanced resampling algorithm for particle filters on distributed memory architectures," Algorithms, vol. 14, no. 12, Article ID: 342, 2021.
[17] L. Yuan, J. Gu, H. Wen, and Z. Jin, "Improved particle filter for non-gaussian forecasting-aided state estimation," J. of Modern Power Systems and Clean Energy, vol. 11, no. 4, pp. 1075-1085, Jul. 2023.
[18] A. Alessandri, T. Parisini, and R. Zoppoli, "Neural approximators for nonlinear finite-memory state estimation," Int. J. Control, vol. 67, no. 2, pp. 275-302, Jan. 1997.
[19] P. S. Kim, E. H. Lee, M. S. Jang, and S. Y. Kang, "A finite memory structure filtering for indoor positioning in wireless sensor networks with measurement delay," Int. J. Distrib. Sensor Netw, vol. 13, no. 1, 8 pp., Jan. 2017.
[20] A. Jazwinski, "Limited memory optimal filtering," IEEE Trans. Autom. Control, vol. 13, no. 5, pp. 558-563, Oct. 1968.
[21] W. H. Kwon and S. Han, Receding Horizon Control: Model Predictive Control for State Models, Cham, Switzerland: Springer, 2015.
[22] C. K. Ahn, Y. S. Shmaliy, and S. Zhao, "A new unbiased FIR filter with improved robustness based on frobenius norm with exponential weight," IEEE Trans. Circuits Syst. II, Exp. Briefs, vol. 65, no. 4, pp. 521-525, Apr. 2018.
[23] Y. S. Shmaliy, "An iterative kalman-like algorithm ignoring noise and initial conditions," IEEE Trans. Signal Process., vol. 59, no. 6, pp. 2465-2473, Jun. 2011.
[24] Y. S. Shmaliy, S. H. Khan, S. Zhao, and O. Ibarra-Manzano, "General unbiased FIR filter with applications to GPS-based steering of oscillator frequency," IEEE Trans. Control Syst. Technol, vol. 25, no. 3, pp. 1141-1148, May 2017.
[25] S. L. Sun and Z. L. Deng, "Multi-sensor optimal information fusion kalman filter," Automatica, vol. 40, no. 6, pp. 1017-1023, Jun. 2004.
[26] G. Hao, S. L. Sun, and Y. Li, "Nonlinear weighted measurement fusion unscented kalman filter with asymptotic optimality," Inf. Sci., vol. 299, pp. 85-98, Apr. 2015.
[27] G. Hao and S. Sun, "Distributed fusion cubature kalman filters for nonlinear systems," Int. J., vol. 29, no. 17, pp. 5979-5991, 25 Nov. 2019.
[28] S. Sun, H. Lin, J. Ma, and X. Li, "Multi-sensor distributed fusion estimation with applications in networked systems: a review paper," Inf. Fusion, vol. 38, pp. 122-134, Nov. 2017.
[29] Y. Hu, S. Bian, B. Ji, and J. Li, "GNSS spoofing detection technique using fraction parts of double difference carrier phases," J. of Navigation, vol. 71, no. 5, pp. 1111-1129, 2018.
[30] B. S. Çiftler, S. Dikmese, İ. Güvenç, K. Akkaya, and A. Kadri, "Occupancy counting with burst and intermittent signals in smart buildings," IEEE Internet of Things J., vol. 5, no. 2, pp. 724-735, Apr. 2017.
[31] Q. Sun, Y. Tian, and M. Diao, "Cooperative localization algorithm based on hybrid topology architecture for multiple mobile robot system," IEEE Internet of Things J., vol. 5, no. 6, pp. 4753-4763, Dec. 2018.
[32] W. Ye, J. Li, J. Fang, and X. Yuan, "EGP-CDKF for performance improvement of the SINS/GNSS integrated system," IEEE Trans. on Industrial Electronics, vol. 65, no. 4, pp. 3601-3609, Apr. 2017.
[33] R. Zhan and J. Wan, "Iterated unscented kalman filter for passive target tracking," Aerospace & Electronic Systems IEEE Trans. on, vol. 43, no. 3, pp. 1155-1163, Jul. 2007.
[34] W. Li and Y. Jia, "Location of mobile station with maneuvers using an IMM-based cubature kalman filter," IEEE Trans. on Industrial Electronics, vol. 59, no. 11 pp. 4338-4348, Nov. 2012.
[35] N. K. Singh, S. Bhaumik, and S. Bhattacharya, "Tracking of ballistic target on re-entry using ensemble kalman filter," in Proc. 2012 Annual IEEE India Conf., pp. 508-513, Kochi, India, 7-9 Dec. 2012.
[36] J. Yu, J. G. Lee, G. P. Chan, and H. S. Han, "An offline navigation of a geometry PIG using a modified nonlinear fixed-interval smoothing filter," Control Engineering Practice, vol. 13, no. 3, pp. 1403-1411, Nov. 2005.
[37] Y. Xu, X. Chen, and Q. Li, "Autonomous integrated navigation for indoor robots utilizing online iterated extended rauch-tung-striebel smoothing," Sensors, vol. 13, no. 12, pp. 15937-15953, 2013.
[38] A. S. Paul and E. A. Wan, "RSSI-based indoor localization and tracking using sigma-point Kalman smoothers," IEEE J. of Selected Topics in Signal Processing, vol. 3, no. 5, pp. 860-873, Oct. 2009.
[39] R. V. D. Merwe, Sigma-Point Kalman Filters for Probabilistic Inference in Dynamic State-Space Models, Oregon Health & Science University, Ph.D. Theses, Apr. 2004.
[40] X. Gong, J. Zhang, and J. Fang, "A modified nonlinear two-filter smoothing for high-precision airborne integrated GPS and inertial navigation," IEEE Trans. on Instrumentation & Measurement, vol. 64, no. 12, pp. 3315-3322, Dec. 2015.
[41] Z. Lu, J. Li, J. Fang, S. Wang, and S. Zou, "Adaptive unscented two-filter smoother applied to transfer alignment for ADPOS," IEEE Sensors J., vol. 18, no. 8, pp. 3410-3418, 15 Apr. 2018.
[42] H. Liu, K. Yang, and Q. Yang, Y. Ma, and C. Huang, "Sequential geoacoustic inversion and source tracking using ensemble Kalman-particle filter," in Proc. Global Oceans 2020: Singapore – U.S. Gulf Coast, 4- pp., Biloxi, MS, USA, 5-30 Oct. 2020.
[43] M. Murata and K. Isao, "Degeneracy-free particle filter: ensemble kalman smoother multiple distribution estimation filter," IEEE Trans. on Automatic Control, vol. 67, no. 12, pp. 6956-6961, Dec. 2022.
[44] H. M. Wu, M. Karkoub, and C. L. Hwang, "Mixed fuzzy sliding-mode tracking with backstepping formation control for multi-nonholonomic mobile robots subject to uncertainties," J. Intell. Robotic Syst., vol. 79, no. 1, pp. 73-86, Jul. 2015.
[45] Y. Eun Kim, H. Ho Kang, and C. Ki Ahn, "Two-layer nonlinear FIR filter and unscented Kalman filter fusion with application to mobile robot localization," IEEE Access, vol. 8, pp. 87173-87183, 2020.
رمضان هاونگی تحصيلات خود را در مقاطع كارشناسي ارشد و دكتري مهندسی برق-کنترل بهترتيب در سالهاي 1382 و 1391 از دانشگاه صنعتی خواجه نصیرالدین طوسی تهران به پايان رسانده است و هم اكنون دانشیار دانشكده مهندسي برق و کامپیوتر دانشگاه بیرجند ميباشد. زمينههاي تحقيقاتي مورد علاقه ايشان عبارتند از: ناوبری اینرسی، ناوبری تلفیقی، تخمین و فیلترینگ، فیلترهای تکاملی، موقعیتیابی و نقشهبرداری همزمان، فازی، شبکه عصبی و محاسبات نرم.
سیمین حسینزاده تحصیلات خود را در مقطع کارشناسی در رشته مهندسی برق گرایش کنترل از دانشگاه فردوسی مشهد در سال 1395 به پایان رساند. سپس در سال 1398 در مقطع کارشناسی ارشد مهندسی برق گرایش کنترل از دانشگاه صنعتی قوچان فارق التحصیل گردید و هماکنون دانشجوی دکتری مهندسی برق در گرایش کنترل دانشگاه بیرجند است. زمینههای تحقیقاتی مورد علاقه ایشان، کنترل غیرخطی، کنترل هوشمند، تئوری تخمین و شبکه عصبی میباشد.
[1] این مقاله در تاریخ 10 آذر ماه 1400 دریافت و در تاریخ 25 فروردین ماه 1403 بازنگری شد.
رمضان هاونگی (نویسنده مسئول)، گروه کنترل، دانشکده مهندسی برق و کامپیوتر، دانشگاه بیرجند، بیرجند، آیران، (email: Havangi@birjand.ac.ir).
سیمین حسینزاده، گروه کنترل، دانشکده مهندسی برق و کامپیوتر، دانشگاه بیرجند، بیرجند، آیران، (email: simin_hosseinzade@birjand.ac.ir).
[2] . Internet of Things
[3] . Localization
[4] . Visible Light Positioning
[5] . Unscented Kalman Filter
[6] . Extended Kalman Filter
[7] . Particle Filter
[8] . Infinite Impulse Response
[9] . Finite Impulse Response
[10] . Minimum Variance FIR
[11] . Unbiased FIR
[12] . Horizon Group Shift
[13] . Forward Kalman Filter
[14] . Weighted Measurement Fusion
[15] . Distributed Fusion Estimation
[16] . Two-Filter Smoother
[17] . Rauch-Tung-Striebel Smoother
[18] . Central Difference Kalman Filter
[19] . Cubature Kalman Filter
[20] . Ensemble Kalman Filter
[21] . Sigma-Point Kalman Filter
[22] . Weighted Statistical Linear Regression
[23] . Statistical Linear Regression
[24] . Navigation
[25] . Landmark
[26] . Two-Layer Nonlinear Finite Impulse Response/Unscented Kalman Filter