sravan/UMICH-NCLT-SLAP
1
0
Fork 0
mirror of https://github.com/Mobile-Robotics-W20-Team-9/UMICH-NCLT-SLAP.git synced 2025-09-09 12:23:14 +00:00
Code Issues Packages Projects Releases Wiki Activity

manage file

Browse Source
This commit is contained in:
Yushu Zhang
2020-04-30 19:55:31 -04:00
parent 10f1406871
commit de53da281a
4 changed files with 4 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

0
Astar.py → src/control/Astar.py
View File

6
mpc_along_trajectory.py → src/control/mpc_along_trajectory.py
View File

@@ -3,7 +3,7 @@ from Astar import *
poses = load_poses('pose_gt.csv') poses = load_poses('pose_gt.csv')
sparseness = 100 sparseness = 100
print(poses.shape[0]/sparseness) # print(poses.shape[0]/sparseness)
# plot_position(poses[1::sparseness]) # plot_position(poses[1::sparseness])
sparse_poses = poses[1::sparseness, 1:3] sparse_poses = poses[1::sparseness, 1:3]
@@ -16,8 +16,8 @@ goal_idx = np.random.randint(sparse_poses.shape[0])
cur_node, parent_idx = Astar(start_idx, goal_idx, sparse_poses, k=20) cur_node, parent_idx = Astar(start_idx, goal_idx, sparse_poses, k=20)
path = find_path(cur_node, parent_idx, start_idx) path = find_path(cur_node, parent_idx, start_idx)
# print(time.time() - start_time) # print(time.time() - start_time)
print(start_idx, goal_idx) #print(start_idx, goal_idx)
print(path) #print(path)
# print(len(path)) # print(len(path))
# print(total_dist(path)) # print(total_dist(path))

0
mpc_func.py → src/control/mpc_func.py
View File

0
one_round_demo.py → src/control/one_round_demo.py
View File