PythonRobotics/searchindex.js

Search.setIndex({docnames:["getting_started","how_to_contribute","index","modules/aerial_navigation/aerial_navigation","modules/aerial_navigation/drone_3d_trajectory_following/drone_3d_trajectory_following","modules/aerial_navigation/rocket_powered_landing/rocket_powered_landing","modules/appendix/Kalmanfilter_basics","modules/appendix/Kalmanfilter_basics_2","modules/appendix/appendix","modules/arm_navigation/arm_navigation","modules/arm_navigation/n_joint_arm_to_point_control","modules/arm_navigation/obstacle_avoidance_arm_navigation","modules/arm_navigation/planar_two_link_ik","modules/bipedal/bipedal","modules/bipedal/bipedal_planner/bipedal_planner","modules/control/control","modules/control/inverted_pendulum_control/inverted_pendulum_control","modules/control/move_to_a_pose_control/move_to_a_pose_control","modules/introduction","modules/localization/ensamble_kalman_filter_localization_files/ensamble_kalman_filter_localization","modules/localization/extended_kalman_filter_localization_files/extended_kalman_filter_localization","modules/localization/histogram_filter_localization/histogram_filter_localization","modules/localization/localization","modules/localization/particle_filter_localization/particle_filter_localization","modules/localization/unscented_kalman_filter_localization/unscented_kalman_filter_localization","modules/mapping/circle_fitting/circle_fitting","modules/mapping/gaussian_grid_map/gaussian_grid_map","modules/mapping/k_means_object_clustering/k_means_object_clustering","modules/mapping/lidar_to_grid_map_tutorial/lidar_to_grid_map_tutorial","modules/mapping/mapping","modules/mapping/point_cloud_sampling/point_cloud_sampling","modules/mapping/ray_casting_grid_map/ray_casting_grid_map","modules/mapping/rectangle_fitting/rectangle_fitting","modules/path_planning/bezier_path/bezier_path","modules/path_planning/bspline_path/bspline_path","modules/path_planning/bugplanner/bugplanner","modules/path_planning/clothoid_path/clothoid_path","modules/path_planning/coverage_path/coverage_path","modules/path_planning/cubic_spline/cubic_spline","modules/path_planning/dubins_path/dubins_path","modules/path_planning/dynamic_window_approach/dynamic_window_approach","modules/path_planning/eta3_spline/eta3_spline","modules/path_planning/frenet_frame_path/frenet_frame_path","modules/path_planning/grid_base_search/grid_base_search","modules/path_planning/hybridastar/hybridastar","modules/path_planning/lqr_path/lqr_path","modules/path_planning/model_predictive_trajectory_generator/model_predictive_trajectory_generator","modules/path_planning/path_planning","modules/path_planning/prm_planner/prm_planner","modules/path_planning/quintic_polynomials_planner/quintic_polynomials_planner","modules/path_planning/reeds_shepp_path/reeds_shepp_path","modules/path_planning/rrt/rrt","modules/path_planning/state_lattice_planner/state_lattice_planner","modules/path_planning/visibility_road_map_planner/visibility_road_map_planner","modules/path_planning/vrm_planner/vrm_planner","modules/path_tracking/cgmres_nmpc/cgmres_nmpc","modules/path_tracking/lqr_speed_and_steering_control/lqr_speed_and_steering_control","modules/path_tracking/lqr_steering_control/lqr_steering_control","modules/path_tracking/model_predictive_speed_and_steering_control/model_predictive_speed_and_steering_control","modules/path_tracking/path_tracking","modules/path_tracking/pure_pursuit_tracking/pure_pursuit_tracking","modules/path_tracking/rear_wheel_feedback_control/rear_wheel_feedback_control","modules/path_tracking/stanley_control/stanley_control","modules/slam/FastSLAM1/FastSLAM1","modules/slam/FastSLAM2/FastSLAM2","modules/slam/ekf_slam/ekf_slam","modules/slam/graph_slam/graph_slam","modules/slam/iterative_closest_point_matching/iterative_closest_point_matching","modules/slam/slam","modules/utils/plot/plot","modules/utils/utils"],envversion:{"sphinx.domains.c":2,"sphinx.domains.changeset":1,"sphinx.domains.citation":1,"sphinx.domains.cpp":4,"sphinx.domains.index":1,"sphinx.domains.javascript":2,"sphinx.domains.math":2,"sphinx.domains.python":3,"sphinx.domains.rst":2,"sphinx.domains.std":2,"sphinx.ext.viewcode":1,sphinx:56},filenames:["getting_started_main.rst","how_to_contribute_main.rst","index_main.rst","modules/aerial_navigation/aerial_navigation_main.rst","modules/aerial_navigation/drone_3d_trajectory_following/drone_3d_trajectory_following_main.rst","modules/aerial_navigation/rocket_powered_landing/rocket_powered_landing_main.rst","modules/appendix/Kalmanfilter_basics_main.rst","modules/appendix/Kalmanfilter_basics_2_main.rst","modules/appendix/appendix_main.rst","modules/arm_navigation/arm_navigation_main.rst","modules/arm_navigation/n_joint_arm_to_point_control_main.rst","modules/arm_navigation/obstacle_avoidance_arm_navigation_main.rst","modules/arm_navigation/planar_two_link_ik_main.rst","modules/bipedal/bipedal_main.rst","modules/bipedal/bipedal_planner/bipedal_planner_main.rst","modules/control/control_main.rst","modules/control/inverted_pendulum_control/inverted_pendulum_control_main.rst","modules/control/move_to_a_pose_control/move_to_a_pose_control_main.rst","modules/introduction_main.rst","modules/localization/ensamble_kalman_filter_localization_files/ensamble_kalman_filter_localization_main.rst","modules/localization/extended_kalman_filter_localization_files/extended_kalman_filter_localization_main.rst","modules/localization/histogram_filter_localization/histogram_filter_localization_main.rst","modules/localization/localization_main.rst","modules/localization/particle_filter_localization/particle_filter_localization_main.rst","modules/localization/unscented_kalman_filter_localization/unscented_kalman_filter_localization_main.rst","modules/mapping/circle_fitting/circle_fitting_main.rst","modules/mapping/gaussian_grid_map/gaussian_grid_map_main.rst","modules/mapping/k_means_object_clustering/k_means_object_clustering_main.rst","modules/mapping/lidar_to_grid_map_tutorial/lidar_to_grid_map_tutorial_main.rst","modules/mapping/mapping_main.rst","modules/mapping/point_cloud_sampling/point_cloud_sampling_main.rst","modules/mapping/ray_casting_grid_map/ray_casting_grid_map_main.rst","modules/mapping/rectangle_fitting/rectangle_fitting_main.rst","modules/path_planning/bezier_path/bezier_path_main.rst","modules/path_planning/bspline_path/bspline_path_main.rst","modules/path_planning/bugplanner/bugplanner_main.rst","modules/path_planning/clothoid_path/clothoid_path_main.rst","modules/path_planning/coverage_path/coverage_path_main.rst","modules/path_planning/cubic_spline/cubic_spline_main.rst","modules/path_planning/dubins_path/dubins_path_main.rst","modules/path_planning/dynamic_window_approach/dynamic_window_approach_main.rst","modules/path_planning/eta3_spline/eta3_spline_main.rst","modules/path_planning/frenet_frame_path/frenet_frame_path_main.rst","modules/path_planning/grid_base_search/grid_base_search_main.rst","modules/path_planning/hybridastar/hybridastar_main.rst","modules/path_planning/lqr_path/lqr_path_main.rst","modules/path_planning/model_predictive_trajectory_generator/model_predictive_trajectory_generator_main.rst","modules/path_planning/path_planning_main.rst","modules/path_planning/prm_planner/prm_planner_main.rst","modules/path_planning/quintic_polynomials_planner/quintic_polynomials_planner_main.rst","modules/path_planning/reeds_shepp_path/reeds_shepp_path_main.rst","modules/path_planning/rrt/rrt_main.rst","modules/path_planning/state_lattice_planner/state_lattice_planner_main.rst","modules/path_planning/visibility_road_map_planner/visibility_road_map_planner_main.rst","modules/path_planning/vrm_planner/vrm_planner_main.rst","modules/path_tracking/cgmres_nmpc/cgmres_nmpc_main.rst","modules/path_tracking/lqr_speed_and_steering_control/lqr_speed_and_steering_control_main.rst","modules/path_tracking/lqr_steering_control/lqr_steering_control_main.rst","modules/path_tracking/model_predictive_speed_and_steering_control/model_predictive_speed_and_steering_control_main.rst","modules/path_tracking/path_tracking_main.rst","modules/path_tracking/pure_pursuit_tracking/pure_pursuit_tracking_main.rst","modules/path_tracking/rear_wheel_feedback_control/rear_wheel_feedback_control_main.rst","modules/path_tracking/stanley_control/stanley_control_main.rst","modules/slam/FastSLAM1/FastSLAM1_main.rst","modules/slam/FastSLAM2/FastSLAM2_main.rst","modules/slam/ekf_slam/ekf_slam_main.rst","modules/slam/graph_slam/graph_slam_main.rst","modules/slam/iterative_closest_point_matching/iterative_closest_point_matching_main.rst","modules/slam/slam_main.rst","modules/utils/plot/plot_main.rst","modules/utils/utils_main.rst"],objects:{"Mapping.point_cloud_sampling.point_cloud_sampling":[[30,0,1,"","farthest_point_sampling"],[30,0,1,"","poisson_disk_sampling"],[30,0,1,"","voxel_point_sampling"]],"PathPlanning.BSplinePath.bspline_path":[[34,0,1,"","approximate_b_spline_path"],[34,0,1,"","interpolate_b_spline_path"]],"PathPlanning.CubicSpline.cubic_spline_planner":[[38,1,1,"","CubicSpline1D"],[38,1,1,"","CubicSpline2D"]],"PathPlanning.CubicSpline.cubic_spline_planner.CubicSpline1D":[[38,2,1,"","calc_first_derivative"],[38,2,1,"","calc_position"],[38,2,1,"","calc_second_derivative"]],"PathPlanning.CubicSpline.cubic_spline_planner.CubicSpline2D":[[38,2,1,"","calc_curvature"],[38,2,1,"","calc_position"],[38,2,1,"","calc_yaw"]],"PathPlanning.DubinsPath.dubins_path_planner":[[39,0,1,"","plan_dubins_path"]],"utils.plot":[[69,0,1,"","plot_curvature"]]},objnames:{"0":["py","function","Python function"],"1":["py","class","Python class"],"2":["py","method","Python method"]},objtypes:{"0":"py:function","1":"py:class","2":"py:method"},terms:{"0":[2,5,6,7,12,16,20,21,28,34,36,38,39,49,55,58,65,66,68,69],"000000":66,"0004460978857535104":66,"001":65,"0068996":6,"00766623":6,"01":[5,63,66,69],"010":66,"010729072751057656":66,"0126109674819155":66,"02":[28,66],"0224618077401504":6,"023098460073039763":63,"05":12,"05064471":6,"06219243":6,"06326":51,"07":63,"084":66,"08855629":6,"08868895":6,"0f":66,"0x139196438":6,"1":[5,6,7,12,16,17,20,21,23,28,34,36,39,49,55,58,64,66,68],"10":[6,10,28,63,65,66],"100":[6,12,28,63,66],"1000":[6,30,34],"10703":[0,2],"11":[0,5,6,66],"11555291":6,"12":[6,66],"122":28,"1227":66,"1228":66,"125083004":66,"12561859":6,"12a_4t":49,"12t":49,"13":6,"130":6,"1344":66,"13957621":6,"14":[5,6],"14142933":6,"142":66,"1483":66,"15":[6,12,39,50,63,65,66],"150":28,"151":66,"1571437":6,"16":6,"1601":51,"17":6,"18":[6,66],"180":6,"1808":[0,2],"189":66,"19":6,"1972439134893":66,"1985":28,"1d":[47,66],"1e":5,"1n":6,"2":[2,5,6,8,12,16,17,21,23,28,34,36,39,49,50,55,58,68],"20":[6,7,28,63,65,66],"2010":66,"20a_5t":49,"20t":49,"21":6,"215":66,"21534324":6,"22":6,"23":6,"230":6,"232":66,"24":6,"25":[6,12,63,66],"256":66,"27":6,"2_":7,"2a":36,"2a_2":49,"2a_2t":49,"2c":38,"2c_":38,"2cx":38,"2d":[6,17,20,21,26,27,28,31,35,36,37,39,40,43,47,49,66,67,69],"2l":16,"2l_0l_1":12,"2lmsin":16,"2n":6,"2x1":65,"2x2":[63,65],"2z":6,"3":[0,2,5,6,7,12,17,21,28,34,39,47,49,50,65,66,68],"30":[6,28,65,66],"30943011":6,"31":66,"320031728":66,"3299":66,"338155":66,"34638597":6,"35":12,"3825":66,"38334183":6,"3a_3t":49,"3d":[2,3,6],"3dof":66,"3dx":38,"3f":66,"3t":49,"3x1":65,"4":[5,6,7,12,20,21,28,33,34,49,66],"40":28,"400":7,"4000000000000001":6,"414":66,"42029769":6,"427649841628278":66,"428":66,"43":66,"448":66,"45":[12,39,66],"45725355":6,"49420941":6,"499":63,"4a_4t":49,"4d":66,"4n":38,"4t":49,"5":[5,6,7,12,28,34,49,63,65,66],"50":[28,63,65,66],"500234":66,"512":66,"524048014922737":66,"53116527":6,"56812114":6,"5a_5t":49,"5a_st":49,"5t":49,"6":[5,6,7,12,28,38,39,49,58,66],"60":6,"600":5,"605077":6,"609154":66,"64203286":6,"65":5,"652":66,"67898872":6,"6a_3t":49,"6dx":38,"6t":49,"7":[5,6,7,12,38,49,63,66],"706393":66,"716":66,"7191686":66,"73":66,"735":66,"75":12,"750000000000007":66,"76":6,"785":66,"8":[6,7,12,28,39,49,63,66],"80":[6,7],"82":63,"8405":66,"8624":66,"9":[1,6,7,12,49,66],"90":7,"9074":66,"95":5,"951154575772496e":63,"976":66,"985":66,"99":[5,7],"997297":66,"997826":66,"\u03b4":58,"\u03c6":58,"\u03c7":66,"\u975e\u7dda\u5f62\u30e2\u30c7\u30eb\u4e88\u6e2c\u5236\u5fa1\u306b\u304a\u3051\u308bcgmres\u6cd5\u3092python\u3067\u5b9f\u88c5\u3059\u308b":55,"a\u00e7\u0131kme\u015f":5,"beh\u00e7et":5,"case":[1,6,7,21,34,63,65,66],"class":[12,15,38,63],"default":[30,34,39],"do":[7,12,63],"final":[5,7,17,21,36,39,48,53,54],"float":[17,28,30,38,39,69],"function":[1,6,7,12,16,20,28,30,34,43,47,55,58,65,66,69],"import":[5,6,7,12,28,34,38,63,65,66],"int":[7,28,30,34,63,65],"n\u03c7":66,"new":[2,6,7,63,65],"return":[5,6,7,12,17,28,30,34,38,39,63,65,66],"short":1,"true":[5,6,7,20,21,23,25,28,38,39,63,65,66],"try":[1,12,63],"var":6,"while":[28,63,65],A:[1,5,6,7,12,16,17,28,33,36,38,39,44,45,47,50,51,58,60,61,65,66],And:[20,49],As:[38,63,65,66],At:[1,63,65,66],But:[6,17,21,28],By:66,For:[0,6,7,21,28,38,39,49,63,65,66,69],If:[1,7,12,16,21,33,34,39,49,53,63,65],In:[0,1,6,7,10,12,17,20,21,28,30,36,43,48,49,51,53,54,63,65,66],It:[0,1,6,7,12,21,23,33,34,38,39,49,63,66,67],Its:[20,43],No:66,Not:[34,66],OF:63,Of:[2,65],On:[7,37,39],One:1,That:[6,66],The:[0,1,2,6,7,12,16,17,20,21,23,24,25,28,30,34,36,38,40,42,43,48,51,53,54,58,60,62,63,64,65],Then:[12,49,66],There:21,These:[6,38,65,66],To:[2,6,17,28,63,65,66],With:65,_0:38,_1:66,_2:66,_:[6,7,12,17,20,38,39,63,66],__init__:[12,63],_dom_class:63,_edg:66,_generic_alia:30,_i:[34,66],_j:[38,66],_last_:6,_m:66,_n:66,_probabilist:[21,23],_t:20,_type:30,_vertic:66,a_0:49,a_1:49,a_1t:49,a_2:49,a_2t:49,a_3:49,a_3t:49,a_4:49,a_4t:49,a_5:49,a_5t:49,a_:[38,49],a_st:49,ab:[0,63,66],abid:6,abil:28,abl:[7,66],about:[6,17,65,66],abov:[6,7,38,63],ac_j:38,academia:0,accel:58,acceler:[7,49],accept:1,access:1,accord:[6,63,66],account:[7,12,17,65],accumul:65,accur:[34,36],aco:39,acquir:30,across:6,act:65,actual:[12,63,65],actuat:17,ad:[2,6,7,12,21,34,65,66],add:[0,63,65],add_new_lm:63,addit:[6,7,34,66],adjac:[16,53],adjust:[6,34,63],admiss:51,aerial:2,after:[1,7,21,38,63,65,66],again:[7,49,63,66],agre:1,agv:49,albeit:66,algebra:16,algorithm:[0,2,6,8,15,22,27,28,30,35,36,37,39,46,47,51,56,67,68],algotihm:28,align:[6,7,17,36,66],all:[1,6,7,21,30,34,39,49,65,66],allow:[6,7,12,66],almost:66,along:[7,17,49,65],alpha:[12,17,28,39,66],alpha_m:5,alreadi:12,also:[1,6,7,12,20,34,38,63,65,66],although:30,alwai:6,among:[39,66],an:[0,6,7,12,16,17,25,28,30,32,37,43,51,57,58,63,65,66],analyt:[38,39,66],anatom:12,anchor:66,andrew:65,ang:28,angl:[6,12,16,17,28,38,39,58,63,65,66],angle1:66,angle2:66,anglen:[63,65],angular:[5,17,63,65],ani:[1,7,30,34],anim:[0,43,48,53,54,64],annot:12,antialias:6,anywher:66,api:47,apollo:57,apolloauto:57,appear:65,append:[28,38,63,65,66],appendix:2,appendleft:28,appli:[16,65,66],applic:[1,2,17,51,65,66],appreci:1,approach:[2,28,47,63,66],appropri:65,approx:[16,66],approxim:[38,47],approximate_b_spline_path:34,ar:[0,1,2,6,7,17,20,21,23,24,25,28,30,34,38,39,42,43,48,49,51,53,54,55,63,65,66],arang:[6,28,38],arc:53,arctan2:17,area:[10,12,28,53],arg:66,argmin:66,arithmet:6,arm:2,around:[6,58],arrai:[5,6,7,12,28,34,38,39,63,65,66],array_lik:[34,69],arriv:66,arrow_length:39,arrowprop:12,artifact:1,artifici:23,arxiv:0,ascend:38,assign:7,associ:[6,63,65,66],assum:[21,23,38,49,53,66],ast:7,atan2:[12,39,63,65],atsushi:65,atsushi_twi:65,atsushisakai:[0,1,20,58],attach:16,attempt:12,au:12,author:[65,66],autom:28,automat:[51,62],automobil:62,autonom:[0,33,51,56,57,62],avail:[65,66],averag:[6,21,30,39,63],avoid:[2,9,40,43,66],awai:65,ax1:63,ax2:63,ax3:63,ax:[6,16,49],axes3d:6,axi:[6,12,17,28,38,39,49,63,65],az_k:58,az_t:58,b:[2,5,6,7,12,16,20,36,38,47,49,58,63,65,66],b_0:49,b_1t:49,b_2t:49,b_3t:49,b_4t:49,b_5t:49,b_:[34,38],b_orig:34,back:12,backer:1,background:1,backward:50,bailei:64,balanc:16,bar:[6,7,58,65],base:[2,7,12,16,17,21,28,30,33,38,39,44,47,49,51,58,63,64,65,68],basi:34,basic:[0,2,8,28,47],batch:47,bay:[6,8,21,66],bayes_filt:7,bayesian:[7,21],beacon:65,beam:28,bear:[65,66],becaus:[6,7,12,17,30,69],becom:[1,6,7,30,65],been:[7,65,66],befor:[1,7,12,63,65,66],begin:[5,6,7,16,20,34,36,38,49,55,58,63,65,66],beginn:0,behavior:0,behind:[0,66],beizer:33,bel:7,belief:[7,63,65,66],believ:65,bell:6,belong:63,below:[7,17,38,53],berkelei:58,best:12,beta:[12,17,39],better:66,between:[6,7,12,17,28,30,36,38,39,53,63,65,66,67],beyond:66,bezier:[2,47],bf:[7,55],bia:6,bias:47,bibtex:2,bidirect:47,big:6,bigger:34,binari:66,biped:2,bit:51,bivari:6,black:[12,20,21,23,42,51,53,63,65,66],blanco2010tutori:66,blanco:66,blog:6,blue:[20,21,23,25,43,48,53,54,60,63,65,66],bmatrix:[6,16,20,49,55,58,63,65,66],boldsymbol:66,boor:34,both:[0,6,50,65,66],bottom:28,bound:28,boundari:[28,38,49,52],box:7,boxplu:66,breadth:47,breast:7,bresenham:28,brown:66,bspline:47,bspline_path:34,bsplinepath:34,bu:[7,16,58,63,65],bu_k:58,bu_t:20,bug:[1,2,47],build:1,build_doc:1,builder:1,bullet:[7,66],burgard:[6,7,66],c1:34,c2:34,c:[2,6,7,16,34,36,38,58,59,63,66,69],c_0:38,c_1:38,c_2:38,c_:38,c_b_i:5,c_i:34,c_i_b:5,c_sigma1:66,c_sigma2:66,c_sigma3:66,cal_observation_sigma:66,calc:[38,63],calc_chi2:66,calc_control_command:17,calc_curvatur:38,calc_first_deriv:38,calc_innov:65,calc_input:[65,66],calc_jacobian:66,calc_lm_po:65,calc_n_lm:65,calc_posit:38,calc_rotational_matrix:66,calc_second_deriv:38,calc_yaw:38,calcul:[6,7,12,17,21,22,34,39,47,49,65,66,67,69],call:[6,12,34,66],camera:30,can:[1,6,7,10,12,17,20,21,23,28,33,34,36,38,39,49,53,58,63,65,66,67],cancel:17,cancer:7,cannot:[6,7,12,38],captur:65,car:[6,17,39,50,51],care:65,carlon:66,carri:7,cart:16,cast:[2,29],categor:39,categori:66,caus:7,cccccc:38,cccccccccccccc:5,cd:0,cdot:[6,7,38],cell:[28,63,66],center:[21,28],certain:[7,30],challeng:62,chanc:7,chang:[10,21,33,34,63,65,66],chapter:53,character:66,charecterist:6,charg:65,check:[0,1,28,53],chi:66,chi_:66,chi_k:66,children:63,choleski:63,choos:7,chosen:[7,63],ci:1,circl:[2,21,29,51],circleci:1,cla:65,classic:12,classifi:66,clear:1,click:[1,10,12],clim:28,clone:0,close:[28,47],closer:17,closest:[2,68],closur:66,clothoid:[2,47],cloud:[2,29],cluster:[2,29],cm:6,cmap:[6,28],cn:66,co:[12,16,20,28,36,39,55,58,63,65,66],code:[0,2,20,33,34,36,38,39,40,45,50,51,52,53,58,63,65,66],coeffici:38,coin:7,collect:[0,2,28,66],collid:53,collis:[40,53],color:[12,17,28,66,69],colorbar:28,column:23,com:[0,5,6],combin:[65,66],come:[58,66],comma:28,command:[7,17,63,66],comment:1,common:[12,70],commun:1,compact:66,compactli:66,compani:1,compar:[17,30,65,66],complet:[6,7,37,65,66],complex:[30,51,52],compon:12,composit:66,comprehend:6,comprehens:39,compromis:30,comput:[7,17,30,39,63,65,66],compute_jacobian:63,compute_weight:63,concept:[6,7,66],concetr:63,concis:[1,65],concret:66,conda:0,condit:[8,38,49,66],condition:7,conf:28,confid:65,configur:[12,17],confus:6,conjug:23,consecut:66,consid:[1,12,65,66],consist:[16,39,66],constant:66,constrain:[12,66],constraint:[17,39,55,66],construct:[6,17,28,39,47,66],consumpt:5,contact:1,contain:[5,7,28,65,69],context:66,contin:6,continu:[6,21,33,36,47],contour:6,contourf:6,contrast:66,contribut:[2,66],control:[2,7,9,33,34,49,51,59,60,63,65,66],converg:[63,66],convert:[28,66],convexif:5,convolut:7,coord:12,coordin:[12,16,28,38,63,65,66],copi:[63,66],cork:17,correct:[7,17,63,65],correctli:[7,12],correl:8,correspond:[7,28,65,66],cosin:12,cost:[16,55,58],cotrol:58,could:66,cours:[33,39,42,58,60,65],cov:6,covari:[7,8,20,22,63,65,66],covariac:20,cover:65,coverag:[2,47],cow:6,cpoint:28,creat:[0,1,6,17,66],credit:12,cross:[21,25,42,48,51,53,54,60,63,65],crux:7,cset:6,cstride:6,csv:28,cubic:[2,47],cubic_spline_plann:38,cubicsplin:38,cubicspline1d:38,cubicspline2d:38,cumsum:63,current:[1,7,17,21,28,65,66],curv:[6,33,34,36,39,47,50],curvatur:[33,34,36,39,69],cvxpy:[0,58],cx:[16,65],cyan:[42,43,48,51,54],d1:66,d2:[63,66],d:[6,16,21,36,38,39,47,63,65,66],d_1:39,d_2:39,d_3:39,d_:[38,55],d_a:55,d_i:66,d_j:66,dare:16,darpa:62,data:[5,6,21,28,30,38,63,65,66,69],dataset:[6,68],ddot:[6,16,38],ddy:38,de:34,dead:[20,23,63,65,66],deal:6,decomposit:67,decreas:[7,63],deepcopi:[63,66],def:[5,6,12,28,34,63,65,66],defect:2,defin:[6,7,12,16,17,38,65,66],definit:[2,16],deg2rad:[39,63,65,66],deg:38,degre:[17,34,58,66],delta:[20,36,55,58,63,65,66],delta_i:17,delta_x:17,deltax:66,den:63,denomin:7,denot:[6,7,66],depend:[0,1,2,8,12,38,66],depth:47,dequ:28,deriv:[12,51,66],describ:[1,17,63,65],descript:[1,63],design:[14,22],desir:12,det:[6,63,66],detail:[0,1,2,7,16,53,66],detect:7,determin:[12,17,28,30,38,65,66],determinist:[6,63],develop:[0,1],deviat:[6,66],diag:[5,63,65,66],diagon:6,diagram:[7,12],dict:12,didn:7,die:63,dieter:[6,7],diff:17,differ:[7,17,21,33,36,63,65,66],differenti:[38,49,55,66],difficult:6,dijkstra:[47,48,54],dimens:[6,17,23,34,38],dimension:[6,30,38,47],dir:[0,1],dir_cosin:5,direct:[12,17,21,51,66],directli:[12,66],directori:0,discrep:66,discret:[16,21,28,58],discretis:28,discrimin:24,discuss:66,disk:29,displac:12,displai:[5,7,28],displaystyl:7,dist:28,distanc:[12,17,21,23,28,30,33,36,38,39,43,63,65,66,69],distribut:[21,30,63,66],div:5,dn:[63,65,66],doc:1,docstr:1,document:[0,6,58],doe:[6,15,21,30,53],doesn:[7,65],dof:[5,17],domain:51,donat:1,done:[63,65,66],door:7,doorwai:7,dot:[16,20,55,58,63,65],doubl:[45,51],down:[12,17],download:66,dr:65,draw:12,draw_angl:12,drawn:63,drewtu2:65,drive:[6,17,51,56,57,60,61,65],drone:[2,3],ds:38,dt:[17,58,63,65,66],dta:58,dtb:58,dtype:[30,65],du:16,du_:58,dubin:[2,47],dubins_path_plann:39,dubinspath:39,due:[7,21],dure:[1,12,63,66],dx:[6,7,12,63,65,66],dy:[38,63,65],dynam:[2,42,47,58],dz:63,e:[6,7,17,28,39,63,65,66],e_:66,e_j:66,e_x:6,each:[0,1,2,6,7,20,21,28,30,34,38,39,43,49,53,63,65,66],earlier:[63,66],eas:0,easi:[1,2,7,28],easier:[12,65],easili:[17,66],east:28,eb6d1cbe6fc90c7be9210bf153b3a04f177cc138:58,ece452:35,edg:66,edges_odom:66,edges_scan:66,effect:[17,63,66],effector:[10,12],einsum:6,either:66,ekf:[2,20,24,63,66,68],ekf_slam:65,elbow:12,elbow_i:12,elbow_x:12,element:[6,23,28,34,65],elf:28,ellips:[6,20,51],ellipsoid:51,els:[34,63,66],embersarc:5,empti:[6,28,66],end:[5,6,7,10,12,16,20,33,34,36,38,39,49,55,58,63,65,66],end_i:39,end_x:39,end_yaw:39,endpoint:34,enkf:19,ensambl:[2,22],ensur:38,enter:66,entri:66,env:0,environ:[0,1,6,7,12,21,28,37,51,52,66],eq:[49,66],equal:[7,12,17,28,38,39,65,66],equat:[3,7,12,16,17,20,23,34,38,49,55,58,63,65,66],equival:34,error:[1,6,7,17,21,65,66],estim:[7,20,23,25,63,65,66],eta:[2,7,47],eta_j:66,etc:[7,30],euclid:43,euler:[58,66],event:7,everi:[6,65],evid:7,evolv:63,ex:20,exactli:7,exampl:[2,6,8,12,21,26,28,31,34,38,39,63,64,65,67,68],except:63,execut:[0,1,63],exist:[2,21,65],exp:[6,21,63,66],expand:53,expans:28,expant:58,expect:[1,65,66],experi:63,experienc:65,explain:[1,17,30],explor:[2,47,66],express:[12,34,38],extend:[2,12,17,22,65],extended_kalman_filt:20,extens:51,extent:66,extern:30,extract:30,ey:65,f1:65,f2:65,f51a73f47cb922a12659f8ce2d544c347a2a8156:58,f:[0,5,6,7,20,28,34,58,63,65,66],f_:7,f_x:7,fac:6,facecolor:12,facilit:66,fact:66,factor:69,fair:7,fake:7,fals:[7,28,34],famili:63,far:[30,65],farther:30,farthest:29,farthest_point_sampl:30,fashion:66,fast:[30,36,43,63],fastslam1:[2,68],fastslam:[2,63,68],feasibl:52,featur:[2,63,64,66],feedback:[2,16,59],field:47,fig:[6,63],figsiz:28,figtext:63,figur:[5,6,28,34,38,53,63,66],file:[1,28,66],file_read:28,filenam:[5,7],fill:[6,28,66],filter:[2,6,8,22,63,65,66],financi:1,find:[1,12,17,43,53,65,66],first:[1,7,12,28,47,58,66],firstli:66,fit:[2,29,36],five:38,fix:[2,66],flip:7,flood:28,flood_fil:28,focu:[0,1],focus:51,folder:66,follow:[1,2,3,6,7,23,34,36,38,49,63,65,66],fontsiz:66,footstep:14,forc:16,form:[6,7,12,65],format:[28,66],formul:[7,49,59,68],formula:[21,34,66],forward:[7,12,50,58,66],forward_kinemat:12,found:66,fox:[6,7],fpf:7,frac:[5,6,7,12,16,20,21,23,34,36,38,55,58,63,65,66],frame:[2,47,65],free:[1,5,28,53],freedom:[17,66],frenet:[2,47],fresnel:47,fring:28,frm:53,from:[1,5,6,7,12,16,17,20,22,25,28,30,33,34,38,39,49,53,58,63,65,66,69],fuel:5,full:66,fulli:[56,66],funciton:63,further:66,fusion:[19,20,23,24],futur:7,fx:[7,63,65],fx_t:20,g1:36,g2o:66,g:[6,16,17,20,28,39,47,65,66],g_i:5,g_odom:66,g_scan:66,g_x:39,g_y:39,g_yaw:39,gain:[8,17,65],gamma:12,gather:6,gaussian:[2,7,8,21,29,63,66],gca:[6,28],gco:16,gener:[0,2,3,6,8,20,28,30,33,34,38,39,41,42,47,52,66],generate_ray_casting_grid_map:28,geometr:51,geometri:12,get:[1,2,6,7,12,17,20,21,33,38,49,58,63,66],get_h_b:66,get_lm_pos_from_st:65,ghliu:50,gif:[1,63],gird:21,git:0,github:[0,1,2,5],give:[6,7,12,28,66],given:[6,7,12,17,28,38,63,65,66],gm:16,gmre:[2,59],gnss:20,go:[0,1,12,17,65,66],goal:[0,1,10,12,17,36,39,51,53,66],goe:[12,50],good:[30,55],govern:17,gp:[20,65,66],grand:62,graph:[1,2,34,48,51,54,68],graph_based_slam:66,graphics_radiu:66,graphslam:66,graviti:5,great:1,greater:30,green:[20,28,51,60,65],grid:[2,21,29,30,38,39,47,63,65,66],grind:21,gripper:12,grisetti2010tutori:66,grisetti:66,ground:[63,65,66],grow:65,guess:7,guid:51,gyro:20,gz:63,h:[7,20,21,55,65,66],h_:38,h_i:38,h_t:65,ha:[6,7,20,21,28,38,39,63,64,66],had:[7,63],hallwai:7,hamiltonian:55,han:28,hand:7,handi:28,happen:1,hat:[63,66],have:[1,6,7,12,30,63,65,66],head:[7,17,34,38,69],header:1,heading_list:69,heat:43,height:6,help:[1,7,12,17,66],henc:[6,7,12],here:[6,7,28,34,65],hermit:36,heurist:[43,51],hf:63,hi:66,high:[23,28,52,65],higher:[1,17,21],highest:[6,63],hist:[6,63],histogram:[2,7,22],histori:[2,63,65,66],hline:7,hobbi:1,hold:[7,63,66],holonom:15,horizont:[16,66],how:[2,6,7,15,22,28,53,63,65,66],howev:[7,10,63,65,66],hphantom:66,hspace:63,hstack:[63,65,66],html:[5,63],http:[0,5,6,12],hv:63,hx_:20,hxdr:[65,66],hxest:65,hxtrue:[65,66],hybrid:[2,47],hz:66,i:[1,2,7,8,12,17,20,23,34,38,58,63,65,66],i_:38,i_j:23,i_k:23,icp:[2,68],id1:66,id2:66,id:[1,21,65,66],idea:[0,2,17,66],ident:[12,65,66],ieee:[28,66],ignor:12,ii:6,ij:[6,66],illustr:66,imag:[5,7,28],immateri:7,implement:[5,12,20,50,55,58,63,65,66],implicit:51,imposs:6,improv:[7,23,43,66],imshow:[28,66],imu:66,includ:[0,1,12,17,20,53,63,65,66],incorpor:[7,65,66],increas:[6,7,38,63],increment:[17,51],ind:[63,65],independ:[6,8,17,63,66],index:[2,63,65],indic:[63,66],industri:0,inertia:5,inf:[6,66],infom:20,inform:[1,6,7,21,23,39,47,53,65,66],infti:6,init_print:5,initi:[7,16,28,39,58,63,65,66],initp:65,inlin:[12,63,66],innermost:6,innov:65,input:[6,7,20,21,34,38,55,58,63,65,66],input_intel:66,insert:66,insight:63,inspir:5,instal:0,instanc:7,instanti:17,instead:[12,66],int_:[6,36],integr:[45,47,51],intellig:66,interact:[10,12,63],interest:63,interpol:[36,38,47],interpolate_b_spline_path:34,interv:[20,38],intial:63,introduc:7,introduct:[2,8,67,68],intslid:63,intuit:[0,63,65],inv:[6,63,65,66],invers:[9,66],invert:[2,15],involv:[6,12],ip:63,ipython:[5,7,63],ipywidget:63,irion:66,issu:[1,30],item:1,iter:[2,7,28,30,65,66,68],itertool:66,ith:6,its:[6,7,12,17,30,36,39,43,51,65,66],itself:[7,12],ix:[34,38],iy:38,iyaw:38,iz1:66,iz2:66,iz:[63,65],j:[6,16,23,38,55,66],j_b:5,j_f:20,j_g:20,jacob_mot:65,jacobh:65,jacobian:[5,20,65,66],jame:38,jeff:66,jetbrain:1,jf:65,join:39,joint:[2,9],joint_angl:12,jth:6,just:[1,6,7,12],k:[2,6,7,12,16,20,23,29,34,38,58,65,66,69],k_p:17,k_th_t:65,kalman:[2,6,8,22,65],kappa:[36,38],keep:[1,30],keesl:38,kei:7,kf:[2,8],kh:7,kick:7,kind:38,kinemat:9,kl:6,knot:34,know:[7,12,65],known:[12,21,38,49,63,65,66],ko:12,kp_alpha:17,kp_beta:17,kp_rho:17,kp_x:17,kp_y:17,kummerl:66,ky:[7,20],l0:12,l1:12,l:[6,7,16,28,36,39,58,66],l_0:12,l_1:12,l_1co:12,l_1sin:12,lab:58,labb:[6,7],label:[1,6,34,38,39,66,69],label_diagram:12,lagrang:16,lambda_1co:55,lambda_1vco:55,lambda_1vsin:55,lambda_2sin:55,lambda_2vco:55,lambda_2vsin:55,lambda_3:55,lambda_4:55,lambda_4u_a:55,land:[2,3],landmark:[23,63,65,66],lane:47,languag:[1,12],larg:[30,66],larger:[6,66],largest:63,laser:28,last:65,lastli:17,later:69,lattic:[2,46,47],law:[6,8,12,16],lco:58,ldot:66,lead:[12,66],learn:[2,30],least:[1,39,65,66],lectur:63,left:[5,6,7,10,12,21,36,38,39,65,66,69],legend:[6,38,39,66],len:[34,63,65,66],length:[12,16,36,38,39],leq:[34,55],less:[30,34,63],lesson:12,let:[1,7,12,28,66],lg:28,li:66,librari:[0,1,12],licens:1,lidar01:28,lidar:[2,29,30,66],lidar_to_grid_map:28,lie:7,lieu:66,like:[0,1,6,7,21,30,53,63],likelihood:[7,66],linalg:[6,63,65,66],linalgerror:63,line:[17,20,23,24,28,37,38,39,42,48,51,53,54,60,63,65,66,69],linear:[2,16,17,38,49,59,63,65,66],linearli:[36,58],linewidth:[6,12,28],link:[9,16],link_length:12,linspac:[6,34,38,63],list:[6,34,38,39,66,69],lite:47,literatur:66,littl:65,ll:[6,12],lm:[63,65],lm_id:63,lm_size:[63,65],lmid:[63,65],lmp:63,load:[16,66],load_g2o_se2:66,loc:6,local:[1,2,8,49,51,66,68],locat:[6,7,63,65,66],logic:17,look:[7,21,63,66],lookup:47,loop:[47,66],lose:7,lost:7,low:[63,65],lower:[6,63,66],lowest:63,lqr:[2,15,47,59],lrl:39,lsl:39,lsr:39,luca:66,m:[5,16,30,38,39,63,65,66],m_dist_th:[63,65],m_k:66,machin:30,made:65,magazin:66,magic:7,magnitud:69,mahalanobi:[63,65],mahanfathi:51,mai:6,main:[1,34,65,66],maintain:63,maintoolbar:5,major:[6,7],make:[1,6,12,38,66],malaga:66,mammogram:7,manag:21,maneuv:49,manifold:66,manipul:12,manual:1,map1:28,map:[2,7,17,21,30,43,47,63,65,66,68],map_float:28,mar:5,margin:7,mark:28,markers:[63,66],mass:16,master:[20,58],match:[2,28,66,68],materi:58,math:[6,12,28,63,65,66],mathbb:[6,66],mathbf:[7,34,66],mathcal:[7,66],mathemat:[1,7,59],mathit:6,mathjax:5,mathop:66,mathrm:[7,36,66],mathsf:[7,66],mathtt:6,matmul:12,matplotlib:[0,6,12,28,38,63,65,66],matri:66,matric:[7,66],matrix:[5,6,20,22,38,65,66,67],max:[34,55,58,63,66],max_angular_spe:17,max_it:30,max_itr:66,max_linear_spe:17,max_rang:[63,65,66],maxi:28,maximum:[6,17,21,30,39,58,63,65,66],maxx:28,mayb:12,mco:16,mdist:65,mean:[2,6,7,20,21,23,24,28,29,30,34,48,54,60,64,66],measur:[6,7,23,28,63,65,66],measure_constraint:66,mechan:12,mention:63,menubar:5,merg:[17,30],mesh:6,meshgrid:6,method:[12,28,30,38,48,51,53,54,62,65],mgrid:6,michael:5,mid:6,might:[1,12,21,30,34],min:[34,58,65,66],min_dist:30,mind:1,mini:28,minid:65,minim:[16,39,58],minimum:[2,30,39,58],minor:28,minx:28,miss:[2,7],mit:[6,7],mix:7,ml:16,mlab:6,mm:65,mobil:[24,37,41,46,52,66,67],mod:[17,39],mode:[6,39,55,58],model:[2,6,7,15,21,22,38,39,44,45,47,51,52,59,63,65,66],model_predictive_speed_and_steer_control:58,modifi:14,modul:[0,1,2,69],moment:5,mono:38,moravec:28,more:[0,2,7,16,34,63,65,66],most:12,mostli:66,motion:[6,7,22,43,47,51,52,54,55,60,61,63,65,66],motion_model:[63,65,66],move:[2,6,7,12,15,16,21,66],move_to_pos:17,move_to_pose_robot:17,movement:21,mpc:[15,59],mpl_toolkit:6,mplot3d:6,mu1:6,mu2:6,mu:[6,7,63],mu_1:6,mu_2:6,mu_:[6,7],mu_i:6,mu_j:23,mu_k:23,mu_n:6,mu_new:6,mu_p:6,mu_x:6,mu_z:[6,7],much:[6,63,65],multipl:[6,7,38,65,66],multipli:[6,7,17,66],multivari:[6,8,65],multivariate_gaussian:6,multivariate_norm:6,must:[12,34,38,65],mx:65,my:1,mypi:0,n1:6,n2:6,n:[2,6,9,28,30,34,38,63,65,66],n_:23,n_lm:63,n_particl:63,n_path_point:34,n_point:[12,30],name:[12,17,66],natur:38,navig:[0,2,17,40,43,52],ncol:63,ndarrai:30,nearbi:65,necessari:28,need:[12,17,21,28,38,66],neff:63,neg:7,neighbour:28,net:12,new_indic:63,next:[1,7,21,28,65,66],ngraphslam:66,nlm:65,node:[38,43,66],nois:[7,20,23,63,65,66],noisi:65,noiz:21,non:[15,66],none:[34,38,39],nonlinear:[2,36,59],nonlinear_control:55,norm:[5,6],normal:[6,7,17,63,66],normalize_weight:63,north:28,notag:66,notat:66,note:[1,6,7,17,34,65,66],notebook:[5,63,65,66],noth:[6,7],notic:[1,12,63,65],now:[7,12,49,66],np:[5,6,12,28,34,38,39,63,65,66],nrow:63,nt:6,nth:63,num:63,num_landmark:65,number:[7,17,28,30,34,38,63,65,66,69],number_of_nod:66,numer:[6,66],numpi:[0,5,6,12,28,30,38,63,65,66],nx1:65,nx:28,nxn:65,ny:28,o:66,ob:[58,66],object:[2,6,12,16,29,65,66],observ:[22,25,63,66,68],obstacl:[2,9,28,42,43,51],obtain:[30,66],obvious:6,occup:[28,63],occupi:28,occur:7,od:58,odom:66,odometri:66,off:6,offlin:66,offset:[6,12,17,33],offset_yawrate_nois:63,often:66,ok:1,okai:12,old:63,omega:[5,17,20,66],omega_i:63,omega_j:66,omega_t:20,ominu:66,one:[6,7,12,17,38,39,47,64,66],ones:[28,63,65],onli:[0,1,6,7,16,17,30,63,65,66],onlin:66,ons:66,open:[0,28,57],oper:[30,66],optim:[2,36,47,50,51,52,55,58],optimz:66,option:[34,39],order:[28,38,66],org:[0,20],orient:[17,20,21,28,36,49,66],orig_point:30,origin:[12,65,66,69],original_point:30,os:1,oss:[0,1],other:[1,6,7,12,30,36,66],otherwis:34,our:[1,6,7,12,38],out:[17,63,66],output:[6,17,39,63,66],outsid:[38,65],outward:53,over:[6,65,66],overdetermin:66,overlin:7,overview:1,ox:28,oy:28,p102:17,p:[6,7,12,16,17,34,39,63,65,66],p_:[20,21,65],p_ix_i:6,p_t:[20,21,65],pack:6,packag:28,page:2,pair:66,panel:1,paper:[0,1,2,5],parallel:[0,17],param:65,paramet:[5,6,17,30,34,39,47,49,63,65,66,69],parameter:66,pars:66,parse_edg:66,part:[2,8,38,65,66],partial:[20,55,58,66],particl:[2,22,63,66],particular:[65,66],partwai:7,pass:[34,38,63,65],past:7,patch:6,path:[2,12,17,34,38,42,43,44,48,49,50,52,54,56,57,58,60,61,62,66,69],path_finder_control:17,path_i:39,path_x:39,path_yaw:39,pathfindercontrol:15,pathplan:[34,38,39],patienc:1,patreon:1,paug:65,paus:65,paypal:1,peak:[6,7],peaki:21,pendulum:[2,15,51],peopl:1,percent:65,perfect:66,perform:[30,52,65,66],permiss:66,pest:65,pf:[23,63],phase:[51,65],phi1:66,phi2:66,phi:[20,58],phi_:[36,55],phi_a:55,phi_t:20,philosophi:1,pht:63,pi:[6,12,17,21,28,39,63,65],pi_2_pi:[63,65,66],pick:[12,63],pid:[51,57,60,61,62],piecewis:34,pip:0,pivot:16,piyg_r:28,plan:[2,12,35,37,43,51,60,61],plan_dubins_path:39,planar:9,plane:[17,49],planner:[2,13,39,44,46,47,48,51,54],platform:57,playback:63,pleas:[1,66],plot:[2,6,10,12,28,34,38,39,51,63,65,66,70],plot_arrow:39,plot_curvatur:[34,70],plot_particl:63,plot_surfac:6,plt:[6,12,28,34,38,39,63,65,66],plug:66,pmap:28,png:[5,7],po:6,point:[2,5,9,20,21,24,28,29,33,34,39,43,48,53,54,60,63,66,68],point_cloud_sampl:30,poisson:29,poisson_disk_sampl:30,polar:47,pole:16,polici:30,polynomi:[2,34,38,47],pop:28,popul:[6,66],popular:28,pose:[2,15,36,39,63,65],pose_start:17,pose_target:17,posit:[1,6,7,10,12,15,16,20,34,38,39,49,51,58,63,65,66,69],possibl:[6,7,12,30,39,66],post:1,posterior:[6,7,66],postion:17,potenti:47,power:[2,3,63],pr:[1,7],practic:[0,1,2,6,66],pragma:65,precis:66,pred:20,predict:[2,7,20,42,47,51,52,59,68],predict_particl:63,prescrib:39,presenc:7,present:[7,17,66],press:[6,7],previou:[7,66],primarili:65,prime2:38,prime:[36,38],print:[6,63,65,66],prior:[6,7],prm:[2,47],probabilist:[2,6,8,20,21,28,47,63,64,65,66],probabilit:6,probabl:[6,7,63,66],problem:[1,12,52,65],proc:28,proceed:66,process:[1,7,20,21,23,30,63,65],prod_:66,profil:49,program:[12,17],project:[0,2,6,66],prone:6,propag:66,proper:17,properti:[7,8],proport:17,propos:1,propto:66,provid:[1,17,21,34,53,63,65],psi_i:66,psi_j:66,pure:[2,51,59],pursuit:[2,51,59],put:6,pw:63,px:63,py:[1,17,20,28,58,66],pyplot:[6,12,28,38,63,65,66],pyreedsshepp:50,pytest:0,pythagorean:12,python3:0,python:[0,1,2,5,66],pythonrobot:[0,20,30,58,70],q0:5,q1:5,q2:5,q3:5,q:[5,7,16,20,58,63,65,66],q_:5,q_f:58,q_t:65,q_w:66,q_x:66,q_y:66,q_z:66,qiita:55,qquad:17,qsim:[63,65,66],quad:34,quadcontourset:6,quadrat:[2,59],quadrotor:4,quaternion:66,question:65,queue:28,quintic:[2,47],quit:17,r:[0,7,12,16,20,36,38,39,58,63,65,66],r_:34,r_d:58,r_t_b:5,rad2deg:38,rad:[28,39,63,65],radian:28,rai:[2,28,29],rajamani:58,rajesh:58,rand:[6,63],randn:[6,63,65],random:[2,7,30,47,63,65,66],randomli:30,rang:[6,12,17,21,25,28,34,38,63,65,66],rapidli:[2,47],rate:36,ratio:65,raw:65,rd:21,re:[12,63],read:[2,7,28,65,66],readabl:0,readi:1,readm:1,real:[5,6,28,30,51,65,68],realist:66,realli:6,rear:[2,59],reckon:[20,23,63,65,66],recognit:[2,29],record:63,recov:66,rectangl:[2,29],rectilinear:66,recurs:34,red:[20,21,23,25,28,42,48,51,53,54,60,63,65,66],reduc:30,reed:[2,47],ref:[22,33,41,42,43,46,48,50,52,54,58,59],refer:[3,8,15,22,47,59,68],reflect:21,regard:66,regul:[2,59],regular:[7,21,30],rel:[12,63,65,66],relat:[1,6,12,66],relationship:17,remain:[7,12],remov:53,rep:66,repeat:[6,66],replac:30,replan:43,repo:[0,6,7,66],report:2,repres:[7,21,28,30,34,38,63,65,66],represent:[7,28,38],repsect:63,requir:[1,2,66],resampl:68,resampleid:63,rescal:28,reseampl:63,reshap:[6,63],residu:[7,66],resolut:28,respect:[7,17,49,65],respons:12,restructuredtext:1,result:[7,34,39,63,65,66],rf:21,rfid:[21,23,63,65,66],rh:7,rho:17,rho_1:55,rho_1d_a:55,rho_1u_a:55,rho_2:55,rho_2d_:55,rho_2u_:55,riccati:16,right:[5,7,12,21,36,38,39,66,69],rightarrow:7,rk:38,rlr:39,ro:28,road:[2,17,47],roadmap:48,robot:[0,1,2,6,7,9,15,20,21,23,24,28,37,41,43,46,47,51,52,54,62,63,64,65,66,67],robotacademi:12,robust:21,rocket:[2,3],rod:16,roger:[6,7],rotat:[17,66,67],rough:[46,52],routin:34,row:23,rrt:[2,47],rrtstar:51,rsim:[63,65,66],rsl:39,rsr:39,rst:1,rstride:6,rt1:66,rt2:66,ruff:0,rule:[8,66],run:[1,63,66],runtest:1,rv:6,rx:[5,38],ry:[5,38],ryaw:38,rz:5,s:[1,7,12,16,20,21,28,34,36,38,39,43,63,65,66],s_:38,s_j:38,s_x:39,s_y:39,s_yaw:39,sai:7,sakai:65,same:[6,7,12,21,24,30,64,66],sampl:[0,1,2,6,29,33,36,38,39,40,45,47,48,50,51,58,63],save:66,scalartyp:30,scale:[7,66,69],scan:66,scenario:[7,42],schol:63,scholinv:63,scipi:[0,6,34],scipython:6,scope:66,screenshot:1,script:[0,1,52],scriptstyl:66,se:68,search:[2,47,48,51,54],search_correspond_lm_id:65,sebastian:[6,7],second:[7,12],secondli:66,section:[17,30],see:[0,2,7,16,17,28,63,65,66],seed:[30,66],seek:66,seen:66,segment:[36,39],select:[0,2,7,30,39],selected_typ:39,self:[12,60,61,63],sens:[6,7],sensor:[6,7,19,20,21,23,24,25,30,63,65],separ:[28,38],seper:6,sequenc:66,seri:7,set:[6,10,12,17,21,63,65,66],set_printopt:66,set_start_target_pos:17,set_titl:63,set_xtick:28,set_ytick:28,set_zlim:6,set_ztick:6,setup:1,sever:12,sf:63,sh:1,shall:66,shape:[2,6,28,29,63,65,66],share:1,sheep:47,shepp:[2,47],shift:[7,21],shortest:[39,43],should:[1,65,66],shoulder:12,show:[1,6,7,12,21,28,34,38,39,43,63,65,66,69],show_anim:65,shown:[7,12,16,38,63,65],shrink:12,shunichi09:55,side:[6,65,69],sig:63,sigma:[6,7,58,65,66],sigma_1:[6,7],sigma_2:[6,7],sigma_:[6,7,65],sigma_det:6,sigma_inv:6,sigma_n:6,sigma_p:6,sigma_v:[63,65],sigma_w:[63,65],sigma_x:[6,7],sigma_z:[6,7],sign:12,signal:65,sim_tim:[63,65,66],similar:66,similarli:[6,66],simpl:[1,28,34,39,44,51,66],simpli:[6,12,65],simplic:66,simplifi:[5,65,66],simul:[0,1,3,4,10,11,12,17,20,21,24,37,56,57,58,60,61,62,64,66,68],simultan:[17,68],sin:[12,16,20,28,36,39,55,58,63,65,66],sinc:[6,7,12,66],singl:[6,36,63,65,66],singul:63,singular:[66,67],situat:30,six:[39,66],size:[6,12,28,30,39,63,65,66],skew:5,slam:[2,63,64],slide:55,slipperi:17,slow:17,small:[16,66],smaller:[7,34],smooth:[17,34,38,41],smoother:34,smoothli:[34,38],snippet:[63,66],so:[6,12,16,20,21,30,34,38,49,55,58,66],softwar:[0,2],solut:[12,16,66],solv:[1,12,30,38,47,49,52,66],solver:[36,66],some:[0,1,6,7,28,66],someon:1,someth:6,sonar:28,sort:38,sourc:[0,30,34,38,39,66,69],south:28,sp:[5,38],space:[6,16,21,30,38,52,66],span:47,specif:[17,65],specifi:[12,30],speed:[2,17,20,21,51,57,59,60,61,62],sphinx:[0,1],spiral:47,spline:[2,47],split:[28,66],spread:[6,63],springer:58,springerlink:17,sq:65,sqrt:[5,6,12,17,21,63,65],squar:[65,66],srate:63,stachniss:66,stage:65,standard:[0,6,66],stanlei:[2,59],star:[0,2,43,47,65,66],start:[1,2,17,28,33,36,38,39,49,51,53,63,65],start_i:39,start_x:39,start_yaw:39,stat:6,state:[2,7,16,20,23,46,47,49,58,63,65,66],state_s:[63,65,66],stc:37,steelblu:66,steer:[2,51,59,60,61,62],step1:47,step2:47,step3:47,step:[6,7,17,20,21,39,63,66,68],step_siz:39,still:49,stochast:6,stop:28,store:65,stori:6,str:63,straight:[28,39,69],straightforward:[17,66],street:42,string:[17,39,69],structur:[8,66],style:[0,1,5],subdirectori:1,subject:[16,58,66],subplot:[28,38,63,66],subplots_adjust:63,subset:66,succeed:1,success:[1,5],successiveconvexificationfreefinaltim:5,suffici:66,suggest:7,suit:1,suitabl:30,sum:[6,7,23,63,66],sum_:[6,34,66],summat:34,sumw:63,support:2,suppress:66,surfac:6,surpris:66,surround:65,survei:[60,61],surviv:63,sw:63,sweep:47,sx:28,sy:28,symbol:5,symmetr:65,sympi:5,system:[7,15,16,56,63,65,66],szmuk:5,t1:66,t2:66,t:[6,7,12,16,20,21,34,39,49,58,63,65,66],t_:34,t_i:[34,66],tabl:47,take:[6,7,17,65],taken:65,tan:[12,38,55,58],tangent:[12,39],tangle1:66,tangle2:66,target:[17,42,58,60],task:66,tau:36,tayer:58,tbd:18,tech:66,techniqu:[30,60,61,66],tell:[6,12],tend:6,term:[7,12,17],termin:[39,49],terrain:[43,46,52],tesla:6,test:[0,1,7,65],test_a_star:1,test_diff_codestyl:1,text:[7,34,66],textbf:20,th:[23,38],than:[7,12,30],thei:[1,6,7,28,63],them:[6,66],theorem:[7,12],theoret:65,theori:66,therefor:[6,7,65,66],theta0:12,theta1:12,theta:[12,16,17,38,39,55,63,65,66],theta_0:12,theta_1:12,theta_:[17,49,63,65],theta_engin:17,theta_go:17,theta_i:66,theta_j:66,theta_steering_wheel:17,thi:[2,4,6,7,10,12,16,17,19,20,21,23,24,25,26,27,28,30,31,32,34,35,36,37,38,40,41,42,43,44,46,48,51,52,53,54,58,63,64,65,66,67,69],thin:30,three:[7,17,30,66],threshold:[63,65],through:[7,34,38,66,68],throught:66,thrun:[6,7],thrust:5,thu:[17,66],thumb:1,tick:[6,63,65,66],tight_layout:63,till:66,tim:64,time:[1,5,6,7,12,16,17,20,21,30,49,51,58,63,65,66],timestep:66,titl:[34,66],tmp1:66,tmp2:66,tmp3:66,tmp4:66,todo:66,togeth:[6,34],too:[6,7],tool:58,top:[1,16,28],toss:7,total:[6,7],toward:[17,21,56,66],tparticl:63,tpg:65,trace:28,track:[2,7,56,57,58,61,62,65],train:24,trajectori:[2,3,20,23,47,52,63,65,66],transform:66,transform_point:12,transit:[7,65],translat:[17,67],transport:66,transpos:5,travel:66,travers:66,tree:[2,47],triangl:12,trigonometr:12,trust:[63,65],truth:[63,65,66],tu:65,tune:17,tupl:34,turn:[7,17,39,69],tutori:[28,39,66],twice:7,two:[2,6,7,9,17,21,28,30,34,36,38,39,47,53,65,66],twolinkarm:12,txt:0,type:[0,30,34,38,39,66],typic:66,u:[5,7,16,17,20,55,58,63,65,66],u_:[7,55,58],u_a:55,u_k:58,u_t:[7,58,66],ubar:58,uc:58,uco:16,ud1:63,ud2:63,ud:[63,65,66],ukf:[24,66],unari:66,uncertain:21,uncertainti:[63,65],under:[1,6],underbrac:66,underset:66,understand:[0,1,2,65],uniform:[6,47,63],uniformli:[63,66],uniqu:[16,66],unit:[0,1,65],univari:8,univariatesplin:34,univers:66,unknown:[21,28,43,49,66],unlik:[7,63],unobserv:28,unscent:[2,22],unstructur:37,until:[30,66],up:[1,6,12,63,65],updat:[6,7,20,66,68],update_joint:12,update_kf_with_choleski:63,update_landmark:63,update_with_observ:63,upper:[6,34],urban:[21,51,60,61,66],us:[1,2,6,7,12,16,17,20,21,23,28,29,30,34,36,38,39,43,45,46,48,49,51,52,54,58,63,64,65,66],usag:1,use_latex:5,user:[1,34],usual:66,util:[2,34],ux:5,uy:5,uz:5,v:[5,17,20,55,58,63,65,66],v_:[49,58,63,65],v_e:49,v_eco:49,v_esin:49,v_i:66,v_sco:49,v_ssin:49,v_st:49,v_t:[20,58,65],valid:66,valu:[6,7,12,16,17,21,28,34,43,63,65,66,67],var_new:6,vari:6,variabl:66,varianc:[7,8,63],variance1:6,variance2:6,variant:66,variat:[6,65],vartheta_:36,vco:[55,58],vdot:[6,38,65,66],vec:17,vecor:20,vector:[5,6,7,12,20,34,53,58,65,66,67],vehicl:[21,33,44,51,59,60,61],veloc:[7,17,20,49,58,63,65],veri:[30,63],versa:65,version:1,vertex:[53,66],vertex_id:66,vertic:[16,17,53,66],via:[1,51,66],vice:65,vicin:17,view:[6,66],view_init:6,viridi:6,virtual:66,visibl:[2,47],vision:17,visual:[6,66],vornoi:54,voronoi:[2,47],voxel:29,voxel_point_sampl:30,voxel_s:30,vsin:[55,58],vstack:65,vtan:58,vx:5,vy:5,vz:5,w1:63,w:[5,17,20,23,28,63,65,66],w_1:7,w_2:7,w_:[63,65],w_i:63,w_t:65,wa:[1,7,66],wai:[1,6,7,21,66],walk:[14,66,68],want:[1,7,12,21,30,66],wavefront:47,waypoint:[34,38],wb:55,wcum:63,we:[7,12,17,21,28,36,38,49,53,63,65,66],websit:66,weight:[6,7,21,23,34,63],welcom:58,well:[17,38,53,65,66],were:[7,65],west:28,what:[1,2,7,12,66],wheel:[2,17,41,46,52,59],when:[1,7,16,17,21,34,38,49,53,66],where:[7,12,16,20,30,36,38,39,58,63,65,66],wherea:66,whereabout:7,which:[0,6,7,12,28,30,34,36,38,39,63,65,66],why:66,wide:[0,1,2,28],widget:63,width:[5,7],wikipedia:[34,39,43,48,53],wildcard:66,window:[2,47],wise:6,within:65,without:[1,7,21,30],wolfram:[6,7],women:7,won:62,word:[36,66],work:[1,7,15,28],world:[6,65,68],would:[1,6,7,12],wrist:12,wrist_i:12,wrist_x:12,write:[12,28,66],written:[0,1,12],wrong:[12,63],wx:5,wy:5,wz:5,x1:[6,66],x2:[6,66],x3:6,x:[0,5,6,7,12,16,17,20,21,23,28,34,36,38,39,47,55,58,63,65,66,69],x_1:[6,63,65],x_2:[6,63,65],x_3:6,x_:[7,17,20,36,38,39,49,63,65,66],x_cor:6,x_diff:17,x_e:[39,49],x_end:12,x_i:[6,66],x_j:[38,66],x_k:6,x_list:[39,69],x_n:[63,65],x_nx:65,x_nx_1:65,x_nx_2:65,x_nx_n:65,x_ny:65,x_ny_1:65,x_ny_2:65,x_ny_n:65,x_opt:66,x_po:63,x_pos2:63,x_start:12,x_state:65,x_t:[6,7,20],x_true:66,x_y:65,xaug:65,xb:38,xd:[63,65],xdist:0,xdr:[63,65,66],xe:49,xest:[20,65],xf:63,xg:65,xi:[23,38,66],xi_:23,xlabel:[38,63],xlim:6,xlist:66,xm:65,xs:49,xtrue:[63,65,66],xupdat:65,xx:65,xx_1:65,xx_2:65,xx_n:65,xy:[6,12,65],xy_1:65,xy_2:65,xy_n:65,xyre:28,xyreso:28,xytext:12,y1:66,y2:66,y:[6,7,12,16,17,20,21,28,34,36,38,39,47,55,58,63,65,66,69],y_1:[63,65],y_2:[63,65],y_:[17,36,38,49,63,65],y_cor:6,y_diff:17,y_e:49,y_i:[38,66],y_j:[38,66],y_list:[39,69],y_n:[63,65],y_t:20,yaw1:66,yaw2:66,yaw:[21,28,36,38,39,58,63,65,66],yaw_list:39,yawrat:[63,65],yawreso:28,ye:[12,49],yellow:28,yet:7,yi:38,yield:66,ylabel:[38,63],ylim:28,yml:0,you:[0,1,7,10,12,17,30,33,34,38,39,49,53,58],your:[1,7,17],ys:49,yx:65,yx_1:65,yx_2:65,yx_n:65,yy:65,yy_1:65,yy_2:65,yy_n:65,z1:66,z2:66,z:[6,7,20,21,58,63,65,66],z_0:58,z_:[7,20,58],z_i:63,z_k:58,z_ref:58,z_t:[6,7,63,65],zangl:65,zbar:58,zdir:6,zero:[5,6,28,63,65,66],zerodivisionerror:63,zeros_lik:34,zi:[63,65],zid:66,zlist:66,zp:[63,65]},titles:["Getting Started","How To Contribute","Welcome to PythonRobotics\u2019s documentation!","Aerial Navigation","Drone 3d trajectory following","Rocket powered landing","KF Basics - Part I","KF Basics - Part 2","Appendix","Arm Navigation","N joint arm to point control","Arm navigation with obstacle avoidance","Two joint arm to point control","Bipedal","Bipedal Planner","Control","Inverted Pendulum Control","Move to a Pose Control","Introduction","Ensamble Kalman Filter Localization","Extended Kalman Filter Localization","Histogram filter localization","Localization","Particle filter localization","Unscented Kalman Filter localization","Object shape recognition using circle fitting","Gaussian grid map","k-means object clustering","Lidar to grid map","Mapping","Point cloud Sampling","Ray casting grid map","Object shape recognition using rectangle fitting","Bezier path planning","B-Spline planning","Bug planner","Clothoid path planning","Coverage path planner","Cubic spline planning","Dubins path planning","Dynamic Window Approach","Eta^3 Spline path planning","Optimal Trajectory in a Frenet Frame","Grid based search","Hybrid a star","LQR based path planning","Model Predictive Trajectory Generator","Path Planning","Probabilistic Road-Map (PRM) planning","Quintic polynomials planning","Reeds Shepp planning","Rapidly-Exploring Random Trees (RRT)","State Lattice Planning","Visibility Road-Map planner","Voronoi Road-Map planning","Nonlinear Model Predictive Control with C-GMRES","Linear\u2013quadratic regulator (LQR) speed and steering control","Linear\u2013quadratic regulator (LQR) steering control","Model predictive speed and steering control","Path Tracking","Pure pursuit tracking","Rear wheel feedback control","Stanley control","FastSLAM1.0","FastSLAM 2.0","EKF SLAM","Graph based SLAM","Iterative Closest Point (ICP) Matching","SLAM","Plotting Utilities","Utilities"],titleterms:{"0":[63,64],"1":[1,38,63,65],"1d":38,"1st":7,"2":[1,7,38,63,64,65,66],"2d":38,"2nd":7,"3":[1,38,41,63],"3d":4,"4":[1,38],"5":[1,38],"class":17,"do":6,"function":[17,36],"new":1,A:43,Of:18,The:66,To:1,a_j:38,about:1,ad:1,add:1,advantag:6,aerial:3,algorithm:[1,7,17,18,21,43,53,63,65,66],an:1,anim:1,api:[30,34,38,39],appendix:8,applic:18,approach:40,approxim:34,arm:[9,10,11,12],avoid:11,b:34,b_j:38,base:[1,37,43,45,53,66],basic:[6,7,34,51],batch:51,bay:7,belief:6,bezier:33,bias:52,bidirect:43,biped:[13,14],breadth:43,bspline:34,bug:35,c:55,c_j:38,calcul:[23,36,38],cast:31,central:6,choos:1,circl:25,close:51,closest:67,clothoid:36,cloud:30,cluster:27,code:1,condit:7,connect:53,constraint:38,construct:36,constructor:17,content:[2,3,8,9,13,15,22,29,47,59,68,70],continu:38,contribut:1,control:[10,12,15,16,17,55,56,57,58,61,62],correl:6,covari:[6,23],coverag:37,cubic:38,curv:38,curvatur:38,d:43,d_j:38,dataset:66,defect:1,definit:18,depend:7,depth:43,deriv:38,describ:6,design:20,dijkstra:[43,53],dimension:[49,66],disk:30,distribut:6,document:[1,2],doe:17,drone:4,dubin:[39,51],dynam:40,ekf:65,ensambl:19,equat:5,estim:21,eta:41,exampl:[1,7,66],exist:1,expect:6,explor:51,extend:20,farthest:30,fastslam1:63,fastslam:64,feedback:61,field:43,filter:[7,19,20,21,23,24],first:[38,43],fit:[25,32],fix:1,follow:4,formul:[55,66],frame:42,frenet:42,fresnel:36,from:[21,23],g:36,gain:7,gaussian:[6,26],gener:[5,7,46,53],get:0,gmre:55,graph:[53,66],grid:[26,28,31,37,43],histogram:21,histori:18,holonom:17,how:[0,1,17,23,38],hybrid:44,i:6,icp:67,implement:1,independ:7,indic:2,inform:51,initi:21,integr:36,interpol:34,introduct:[6,18,63,65,66],invers:12,invert:16,iter:67,joint:[10,12],k:27,kalman:[7,19,20,24],kf:[6,7],kinemat:12,land:5,lane:52,lattic:52,law:7,learn:18,lidar:28,limit:6,linear:[56,57,58],link:12,lite:43,local:[7,19,20,21,22,23,24],lookup:46,loop:51,lqr:[16,45,51,56,57],map:[26,28,29,31,48,53,54],match:67,mathemat:55,matplotlib:1,matrix:23,mean:27,member:17,minim:66,miss:1,model:[16,20,46,55,58],motion:[20,21,49],move:17,mpc:[16,58],multimod:6,multivari:7,n:10,navig:[3,9,11],need:6,node:53,non:17,nonlinear:55,object:[25,27,32],observ:[20,21,65],obstacl:[11,53],one:49,oppos:6,optim:[42,46,66],paramet:[36,38],part:[6,7],particl:23,path:[33,36,37,39,41,45,46,47,51,53,59],pathfindercontrol:17,pdf:6,pendulum:16,plan:[33,34,36,38,39,41,45,47,48,49,50,52,54],planar:[12,66],planner:[14,35,37,53],plot:69,plot_curvatur:69,point:[10,12,30,38,67],poisson:30,polar:52,polygon:53,polynomi:49,pose:[17,66],posit:[17,21],potenti:43,power:5,predict:[21,46,55,58,63,65],prm:48,probabilist:[7,48],probabl:21,problem:66,project:1,properti:6,pull:1,pure:60,pursuit:60,python:18,pythonrobot:2,quadrat:[56,57],quintic:49,rai:31,random:[6,51],rapidli:51,real:66,rear:61,recognit:[25,32],rectangl:32,reed:[50,51],ref:[20,51,55],refer:[5,6,7,17,21,23,24,34,36,38,39,49,53,56,57,58,60,61,62,63,64,65,66,67],regul:[56,57],report:1,repres:6,represent:66,request:1,requir:0,resampl:63,review:1,road:[48,53,54],robot:[12,17,18,49],rocket:5,rrt:51,rule:7,s:[2,6,17],sampl:[30,46,52],se:66,search:[43,53],second:38,shape:[25,32],sheep:51,shepp:50,shortest:53,simul:[5,51,63,65],slam:[65,66,68],softwar:18,solv:36,span:37,speed:[56,58],spiral:37,spline:[34,38,41],sponsor:1,stanlei:62,star:44,start:0,state:52,steer:[56,57,58],step1:[21,36,38,53],step2:[21,36,38,53],step3:[21,36,38,53],step4:[21,38],step:[1,65],structur:7,submit:1,support:1,sweep:37,system:17,tabl:[2,46],tangent:38,term:6,termin:38,theorem:6,thi:[0,1],through:[63,65],track:[59,60],trajectori:[4,42,46],tree:[37,51],two:[12,49],uniform:52,unimod:6,unittest:1,univari:7,unknown:38,unscent:24,updat:[21,63,65],us:[0,25,32,53],util:[69,70],variabl:6,varianc:6,vector:38,vehicl:58,visibl:53,voronoi:54,voxel:30,walk:[63,65],wavefront:37,we:6,welcom:2,what:[0,6],wheel:61,why:6,window:40,work:17,world:66,write:1,x:49,y:49}})