{"id":243,"date":"2019-04-06T02:44:53","date_gmt":"2019-04-06T02:44:53","guid":{"rendered":"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/?page_id=243"},"modified":"2019-10-09T04:48:11","modified_gmt":"2019-10-09T04:48:11","slug":"navigation-localization-and-planning","status":"publish","type":"page","link":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/system-design\/navigation-localization-and-planning\/","title":{"rendered":"Navigation, Localization and Planning"},"content":{"rendered":"<h2>Progress Review 2<\/h2>\n<h3>3D Mapping using LOAM algorithm (Lidar Odometry and Mapping)<img loading=\"lazy\" decoding=\"async\" class=\"size-full wp-image-244 aligncenter\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_implementation.png\" alt=\"\" width=\"1102\" height=\"485\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_implementation.png 1102w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_implementation-300x132.png 300w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_implementation-768x338.png 768w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_implementation-1024x451.png 1024w\" sizes=\"auto, (max-width: 709px) 85vw, (max-width: 909px) 67vw, (max-width: 1362px) 62vw, 840px\" \/><\/h3>\n<p><img loading=\"lazy\" decoding=\"async\" class=\"size-full wp-image-245 aligncenter\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_3D_mapping_results.png\" alt=\"\" width=\"1098\" height=\"742\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_3D_mapping_results.png 1098w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_3D_mapping_results-300x203.png 300w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_3D_mapping_results-768x519.png 768w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/LOAM_3D_mapping_results-1024x692.png 1024w\" sizes=\"auto, (max-width: 709px) 85vw, (max-width: 909px) 67vw, (max-width: 1362px) 62vw, 840px\" \/><\/p>\n<h3>Particle Filter Measurement Model performance analysis\u00a0<img loading=\"lazy\" decoding=\"async\" class=\"size-full wp-image-246 aligncenter\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/measurement_mode-performance.png\" alt=\"\" width=\"676\" height=\"529\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/measurement_mode-performance.png 676w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/measurement_mode-performance-300x235.png 300w\" sizes=\"auto, (max-width: 676px) 85vw, 676px\" \/><\/h3>\n<p>We started with a navigation architecture that relied on doing lidar SLAM of the farm to generate a dense pointcloud map, and deriving a sensor model from that using a gaussian mixture model. We found this particle filter unstable and ultimately abandoned it for a simpler approach.<\/p>\n<h2>Progress Review 3 and 4<\/h2>\n<h3>Navigation System Architecture\u00a0<img loading=\"lazy\" decoding=\"async\" class=\"size-full wp-image-247 aligncenter\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/navigation_architecture.png\" alt=\"\" width=\"1894\" height=\"1012\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/navigation_architecture.png 1894w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/navigation_architecture-300x160.png 300w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/navigation_architecture-768x410.png 768w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/navigation_architecture-1024x547.png 1024w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/navigation_architecture-1200x641.png 1200w\" sizes=\"auto, (max-width: 709px) 85vw, (max-width: 909px) 67vw, (max-width: 1362px) 62vw, 840px\" \/><\/h3>\n<h3>Graphical representation of mapping and planning\u00a0<img loading=\"lazy\" decoding=\"async\" class=\"size-full wp-image-248 aligncenter\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/map_path.png\" alt=\"\" width=\"1090\" height=\"520\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/map_path.png 1090w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/map_path-300x143.png 300w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/map_path-768x366.png 768w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/04\/map_path-1024x489.png 1024w\" sizes=\"auto, (max-width: 709px) 85vw, (max-width: 909px) 67vw, (max-width: 1362px) 62vw, 840px\" \/><\/h3>\n<p>We planned a simpler navigation system which would rely on a pre-defined &#8220;map&#8221; of row lines and would use row detections of those row lines to localize within the field.<\/p>\n<h2>Progress Reviews 5 &amp; 6 (SVD &amp; SVD Encore)<\/h2>\n<p><img loading=\"lazy\" decoding=\"async\" class=\"alignnone wp-image-409 size-full\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/nav_arch.png\" alt=\"\" width=\"1498\" height=\"444\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/nav_arch.png 1498w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/nav_arch-300x89.png 300w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/nav_arch-768x228.png 768w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/nav_arch-1024x304.png 1024w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/nav_arch-1200x356.png 1200w\" sizes=\"auto, (max-width: 709px) 85vw, (max-width: 909px) 67vw, (max-width: 1362px) 62vw, 840px\" \/><\/p>\n<p>We converged on a navigation strategy for SVD which relied on fusing visual odometry and row detections with a particle filter. We were able to achieve our SVD goals with this approach.<\/p>\n<h2>Progress Review 7<\/h2>\n<p><img loading=\"lazy\" decoding=\"async\" class=\"wp-image-412 aligncenter\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/RTK-System.png\" alt=\"\" width=\"561\" height=\"286\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/RTK-System.png 865w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/RTK-System-300x153.png 300w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/RTK-System-768x392.png 768w\" sizes=\"auto, (max-width: 561px) 85vw, 561px\" \/><\/p>\n<p>Our spring field testing with real plants at Rivendale was not promising. In order to de-risk, we implemented an RTK based localization system in Fall 2019. This system unfortunately suffered from poor yaw estimation from our magetometer, leading to poor roll correction and ultimately poor localization.<\/p>\n<h2>Progress Review 8<\/h2>\n<p><img loading=\"lazy\" decoding=\"async\" class=\"alignnone  wp-image-413\" src=\"http:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/row_segmentation.png\" alt=\"\" width=\"688\" height=\"295\" srcset=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/row_segmentation.png 979w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/row_segmentation-300x129.png 300w, https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-content\/uploads\/sites\/35\/2019\/10\/row_segmentation-768x329.png 768w\" sizes=\"auto, (max-width: 688px) 85vw, 688px\" \/><\/p>\n<p>With a new weed suppression net installed on the field, and challenges faced with RTK localization, we re-visited lidar row segmentation based localization and concluded our previous lidar segmentation + particle filter approach was plausible.<\/p>\n","protected":false},"excerpt":{"rendered":"<p>Progress Review 2 3D Mapping using LOAM algorithm (Lidar Odometry and Mapping) Particle Filter Measurement Model performance analysis\u00a0 We started with a navigation architecture that relied on doing lidar SLAM of the farm to generate a dense pointcloud map, and deriving a sensor model from that using a gaussian mixture model. We found this particle &hellip; <a href=\"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/system-design\/navigation-localization-and-planning\/\" class=\"more-link\">Continue reading<span class=\"screen-reader-text\"> &#8220;Navigation, Localization and Planning&#8221;<\/span><\/a><\/p>\n","protected":false},"author":158,"featured_media":0,"parent":45,"menu_order":0,"comment_status":"closed","ping_status":"closed","template":"","meta":{"footnotes":""},"class_list":["post-243","page","type-page","status-publish","hentry"],"_links":{"self":[{"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/pages\/243","targetHints":{"allow":["GET"]}}],"collection":[{"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/pages"}],"about":[{"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/types\/page"}],"author":[{"embeddable":true,"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/users\/158"}],"replies":[{"embeddable":true,"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/comments?post=243"}],"version-history":[{"count":5,"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/pages\/243\/revisions"}],"predecessor-version":[{"id":408,"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/pages\/243\/revisions\/408"}],"up":[{"embeddable":true,"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/pages\/45"}],"wp:attachment":[{"href":"https:\/\/mrsdprojects.ri.cmu.edu\/2018teame\/wp-json\/wp\/v2\/media?parent=243"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}