Skip to content

Commit

Permalink
nonholonomic data
Browse files Browse the repository at this point in the history
  • Loading branch information
NakuraMino committed Jun 4, 2020
1 parent 5582a9f commit 4993fe4
Show file tree
Hide file tree
Showing 604 changed files with 2,439 additions and 11,703 deletions.
22 changes: 13 additions & 9 deletions nonholonomic_data/CarEnvironment.py
Original file line number Diff line number Diff line change
Expand Up @@ -33,8 +33,8 @@ def __init__(self, mapFile, image_num, radius=15,

self.i = image_num

self.delta_step = int(delta_step / 2) # Number of steps in simulation rollout
self.max_linear_vel = int(max_linear_vel / 2)
self.delta_step = int(delta_step * 3 / 4) # Number of steps in simulation rollout
self.max_linear_vel = int(max_linear_vel * 3 / 4)
self.max_steer_angle = max_steer_angle

start = self.get_random_state()
Expand Down Expand Up @@ -281,6 +281,14 @@ def visualize_plan(self, plan=None, tree=None, visited=None):
self.ax1.cla()
self.ax1.imshow(visit_map, interpolation="nearest", cmap="gray")

if plan is not None:
for i in range(np.shape(plan)[1]):
self.plot_car(plan[:,i:i+1])
# self.fig.canvas.draw()
# plt.pause(.025)

self.fig.savefig('./paths/' + str(self.i) + 'notree.png')

if tree is not None:
for idx in range(len(tree.vertices)):
if idx == tree.GetRootID():
Expand All @@ -291,12 +299,8 @@ def visualize_plan(self, plan=None, tree=None, visited=None):
y = [sconfig[1], econfig[1]]
self.ax1.plot(y, x, 'r')

if plan is not None:
for i in range(np.shape(plan)[1]):
self.plot_car(plan[:,i:i+1])
# self.fig.canvas.draw()
# plt.pause(.025)


self.fig.canvas.draw()
plt.pause(1)
# self.fig.canvas.draw()
# plt.pause(1)
self.fig.savefig('./paths/' + str(self.i) + '.png')
8 changes: 3 additions & 5 deletions nonholonomic_data/createData.py
Original file line number Diff line number Diff line change
Expand Up @@ -8,8 +8,6 @@
def main(planning_env, planner, start, goal, argplan = 'astar'):

# Notify.
# input('Press any key to begin planning...')

planning_env.init_visualizer()

# Plan.
Expand Down Expand Up @@ -43,8 +41,8 @@ def main(planning_env, planner, start, goal, argplan = 'astar'):
dim = 3 # change to 3 for holonomic

image_num = 0
total_paths = 1
with open("test_data.csv", mode='w', newline='') as csv_file:
total_paths = 200
with open("data.csv", mode='w', newline='') as csv_file:
csv_writer = csv.writer(csv_file, delimiter=',')
for dirname, dirnames, filenames in os.walk('../train_maps'):
while image_num < total_paths:
Expand Down Expand Up @@ -73,4 +71,4 @@ def main(planning_env, planner, start, goal, argplan = 'astar'):
for i in range(plan.shape[1] - 1):
xt = plan[:,i]
y = actions[i]
csv_writer.writerow([xt[0],xt[1],gool[0],gool[1],img_path,y[0], y[1]])
csv_writer.writerow([xt[0],xt[1],xt[2],gool[0],gool[1],gool[2],img_path,y[0], y[1]])
14,096 changes: 2,423 additions & 11,673 deletions nonholonomic_data/data.csv

Large diffs are not rendered by default.

Binary file modified nonholonomic_data/images/0.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/1.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/10.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/100.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/101.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/102.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/103.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/104.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/105.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/106.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/107.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/108.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/109.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/11.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/110.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/111.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/112.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/113.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/114.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/115.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/116.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/117.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/118.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/119.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/12.jpg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added nonholonomic_data/images/120.jpg
Binary file added nonholonomic_data/images/121.jpg
Binary file added nonholonomic_data/images/122.jpg
Binary file added nonholonomic_data/images/123.jpg
Binary file added nonholonomic_data/images/124.jpg
Binary file added nonholonomic_data/images/125.jpg
Binary file added nonholonomic_data/images/126.jpg
Binary file added nonholonomic_data/images/127.jpg
Binary file added nonholonomic_data/images/128.jpg
Binary file added nonholonomic_data/images/129.jpg
Binary file added nonholonomic_data/images/13.jpg
Binary file added nonholonomic_data/images/130.jpg
Binary file added nonholonomic_data/images/131.jpg
Binary file added nonholonomic_data/images/132.jpg
Binary file added nonholonomic_data/images/133.jpg
Binary file added nonholonomic_data/images/134.jpg
Binary file added nonholonomic_data/images/135.jpg
Binary file added nonholonomic_data/images/136.jpg
Binary file added nonholonomic_data/images/137.jpg
Binary file added nonholonomic_data/images/138.jpg
Binary file added nonholonomic_data/images/139.jpg
Binary file added nonholonomic_data/images/14.jpg
Binary file added nonholonomic_data/images/140.jpg
Binary file added nonholonomic_data/images/141.jpg
Binary file added nonholonomic_data/images/142.jpg
Binary file added nonholonomic_data/images/143.jpg
Binary file added nonholonomic_data/images/144.jpg
Binary file added nonholonomic_data/images/145.jpg
Binary file added nonholonomic_data/images/146.jpg
Binary file added nonholonomic_data/images/147.jpg
Binary file added nonholonomic_data/images/148.jpg
Binary file added nonholonomic_data/images/149.jpg
Binary file added nonholonomic_data/images/15.jpg
Binary file added nonholonomic_data/images/150.jpg
Binary file added nonholonomic_data/images/151.jpg
Binary file added nonholonomic_data/images/152.jpg
Binary file added nonholonomic_data/images/153.jpg
Binary file added nonholonomic_data/images/154.jpg
Binary file added nonholonomic_data/images/155.jpg
Binary file added nonholonomic_data/images/156.jpg
Binary file added nonholonomic_data/images/157.jpg
Binary file added nonholonomic_data/images/158.jpg
Binary file added nonholonomic_data/images/159.jpg
Binary file added nonholonomic_data/images/16.jpg
Binary file added nonholonomic_data/images/160.jpg
Binary file added nonholonomic_data/images/161.jpg
Binary file added nonholonomic_data/images/162.jpg
Binary file added nonholonomic_data/images/163.jpg
Binary file added nonholonomic_data/images/164.jpg
Binary file added nonholonomic_data/images/165.jpg
Binary file added nonholonomic_data/images/166.jpg
Binary file added nonholonomic_data/images/167.jpg
Binary file added nonholonomic_data/images/168.jpg
Binary file added nonholonomic_data/images/169.jpg
Binary file added nonholonomic_data/images/17.jpg
Binary file added nonholonomic_data/images/170.jpg
Binary file added nonholonomic_data/images/171.jpg
Binary file added nonholonomic_data/images/172.jpg
Binary file added nonholonomic_data/images/173.jpg
Binary file added nonholonomic_data/images/174.jpg
Binary file added nonholonomic_data/images/175.jpg
Binary file added nonholonomic_data/images/176.jpg
Binary file added nonholonomic_data/images/177.jpg
Binary file added nonholonomic_data/images/178.jpg
Binary file added nonholonomic_data/images/179.jpg
Binary file added nonholonomic_data/images/18.jpg
Binary file added nonholonomic_data/images/180.jpg
Binary file added nonholonomic_data/images/181.jpg
Binary file added nonholonomic_data/images/182.jpg
Binary file added nonholonomic_data/images/183.jpg
Binary file added nonholonomic_data/images/184.jpg
Binary file added nonholonomic_data/images/185.jpg
Binary file added nonholonomic_data/images/186.jpg
Binary file added nonholonomic_data/images/187.jpg
Binary file added nonholonomic_data/images/188.jpg
Binary file added nonholonomic_data/images/189.jpg
Binary file added nonholonomic_data/images/19.jpg
Binary file added nonholonomic_data/images/190.jpg
Binary file added nonholonomic_data/images/191.jpg
Binary file added nonholonomic_data/images/192.jpg
Binary file added nonholonomic_data/images/193.jpg
Binary file added nonholonomic_data/images/194.jpg
Binary file added nonholonomic_data/images/195.jpg
Binary file added nonholonomic_data/images/196.jpg
Binary file added nonholonomic_data/images/197.jpg
Binary file added nonholonomic_data/images/198.jpg
Binary file added nonholonomic_data/images/199.jpg
Binary file added nonholonomic_data/images/2.jpg
Binary file added nonholonomic_data/images/20.jpg
Binary file added nonholonomic_data/images/21.jpg
Binary file added nonholonomic_data/images/22.jpg
Binary file added nonholonomic_data/images/23.jpg
Binary file added nonholonomic_data/images/24.jpg
Binary file added nonholonomic_data/images/25.jpg
Binary file added nonholonomic_data/images/26.jpg
Binary file added nonholonomic_data/images/27.jpg
Binary file added nonholonomic_data/images/28.jpg
Binary file added nonholonomic_data/images/29.jpg
Binary file added nonholonomic_data/images/3.jpg
Binary file added nonholonomic_data/images/30.jpg
Binary file added nonholonomic_data/images/31.jpg
Binary file added nonholonomic_data/images/32.jpg
Binary file added nonholonomic_data/images/33.jpg
Binary file added nonholonomic_data/images/34.jpg
Binary file added nonholonomic_data/images/35.jpg
Binary file added nonholonomic_data/images/36.jpg
Binary file added nonholonomic_data/images/37.jpg
Binary file added nonholonomic_data/images/38.jpg
Binary file added nonholonomic_data/images/39.jpg
Binary file added nonholonomic_data/images/4.jpg
Binary file added nonholonomic_data/images/40.jpg
Binary file added nonholonomic_data/images/41.jpg
Binary file added nonholonomic_data/images/42.jpg
Binary file added nonholonomic_data/images/43.jpg
Binary file added nonholonomic_data/images/44.jpg
Binary file added nonholonomic_data/images/45.jpg
Binary file added nonholonomic_data/images/46.jpg
Binary file added nonholonomic_data/images/47.jpg
Binary file added nonholonomic_data/images/48.jpg
Binary file added nonholonomic_data/images/49.jpg
Binary file added nonholonomic_data/images/5.jpg
Binary file added nonholonomic_data/images/50.jpg
Binary file added nonholonomic_data/images/51.jpg
Binary file added nonholonomic_data/images/52.jpg
Binary file added nonholonomic_data/images/53.jpg
Binary file added nonholonomic_data/images/54.jpg
Binary file added nonholonomic_data/images/55.jpg
Binary file added nonholonomic_data/images/56.jpg
Binary file added nonholonomic_data/images/57.jpg
Binary file added nonholonomic_data/images/58.jpg
Binary file added nonholonomic_data/images/59.jpg
Binary file added nonholonomic_data/images/6.jpg
Binary file added nonholonomic_data/images/60.jpg
Binary file added nonholonomic_data/images/61.jpg
Binary file added nonholonomic_data/images/62.jpg
Binary file added nonholonomic_data/images/63.jpg
Binary file added nonholonomic_data/images/64.jpg
Binary file added nonholonomic_data/images/65.jpg
Binary file added nonholonomic_data/images/66.jpg
Binary file added nonholonomic_data/images/67.jpg
Binary file added nonholonomic_data/images/68.jpg
Binary file added nonholonomic_data/images/69.jpg
Binary file added nonholonomic_data/images/7.jpg
Binary file added nonholonomic_data/images/70.jpg
Binary file added nonholonomic_data/images/71.jpg
Binary file added nonholonomic_data/images/72.jpg
Binary file added nonholonomic_data/images/73.jpg
Binary file added nonholonomic_data/images/74.jpg
Binary file added nonholonomic_data/images/75.jpg
Binary file added nonholonomic_data/images/76.jpg
Binary file added nonholonomic_data/images/77.jpg
Binary file added nonholonomic_data/images/78.jpg
Binary file added nonholonomic_data/images/79.jpg
Binary file added nonholonomic_data/images/8.jpg
Binary file added nonholonomic_data/images/80.jpg
Binary file added nonholonomic_data/images/81.jpg
Binary file added nonholonomic_data/images/82.jpg
Binary file added nonholonomic_data/images/83.jpg
Binary file added nonholonomic_data/images/84.jpg
Binary file added nonholonomic_data/images/85.jpg
Binary file added nonholonomic_data/images/86.jpg
Binary file added nonholonomic_data/images/87.jpg
Binary file added nonholonomic_data/images/88.jpg
Binary file added nonholonomic_data/images/89.jpg
Binary file added nonholonomic_data/images/9.jpg
Binary file added nonholonomic_data/images/90.jpg
Binary file added nonholonomic_data/images/91.jpg
Binary file added nonholonomic_data/images/92.jpg
Binary file added nonholonomic_data/images/93.jpg
Binary file added nonholonomic_data/images/94.jpg
Binary file added nonholonomic_data/images/95.jpg
Binary file added nonholonomic_data/images/96.jpg
Binary file added nonholonomic_data/images/97.jpg
Binary file added nonholonomic_data/images/98.jpg
Binary file added nonholonomic_data/images/99.jpg
Binary file modified nonholonomic_data/paths/0.png
Binary file added nonholonomic_data/paths/0notree.png
Binary file added nonholonomic_data/paths/1.png
Binary file added nonholonomic_data/paths/10.png
Binary file added nonholonomic_data/paths/100.png
Binary file added nonholonomic_data/paths/100notree.png
Binary file added nonholonomic_data/paths/101.png
Binary file added nonholonomic_data/paths/101notree.png
Binary file added nonholonomic_data/paths/102.png
Binary file added nonholonomic_data/paths/102notree.png
Binary file added nonholonomic_data/paths/103.png
Binary file added nonholonomic_data/paths/103notree.png
Binary file added nonholonomic_data/paths/104.png
Binary file added nonholonomic_data/paths/104notree.png
Binary file added nonholonomic_data/paths/105.png
Binary file added nonholonomic_data/paths/105notree.png
Binary file added nonholonomic_data/paths/106.png
Binary file added nonholonomic_data/paths/106notree.png
Binary file added nonholonomic_data/paths/107.png
Binary file added nonholonomic_data/paths/107notree.png
Binary file added nonholonomic_data/paths/108.png
Binary file added nonholonomic_data/paths/108notree.png
Binary file added nonholonomic_data/paths/109.png
Binary file added nonholonomic_data/paths/109notree.png
Binary file added nonholonomic_data/paths/10notree.png
Binary file added nonholonomic_data/paths/11.png
Binary file added nonholonomic_data/paths/110.png
Binary file added nonholonomic_data/paths/110notree.png
Binary file added nonholonomic_data/paths/111.png
Binary file added nonholonomic_data/paths/111notree.png
Binary file added nonholonomic_data/paths/112.png
Binary file added nonholonomic_data/paths/112notree.png
Binary file added nonholonomic_data/paths/113.png
Binary file added nonholonomic_data/paths/113notree.png
Binary file added nonholonomic_data/paths/114.png
Binary file added nonholonomic_data/paths/114notree.png
Binary file added nonholonomic_data/paths/115.png
Binary file added nonholonomic_data/paths/115notree.png
Binary file added nonholonomic_data/paths/116.png
Binary file added nonholonomic_data/paths/116notree.png
Binary file added nonholonomic_data/paths/117.png
Binary file added nonholonomic_data/paths/117notree.png
Binary file added nonholonomic_data/paths/118.png
Binary file added nonholonomic_data/paths/118notree.png
Binary file added nonholonomic_data/paths/119.png
Binary file added nonholonomic_data/paths/119notree.png
Binary file added nonholonomic_data/paths/11notree.png
Binary file added nonholonomic_data/paths/12.png
Binary file added nonholonomic_data/paths/120.png
Binary file added nonholonomic_data/paths/120notree.png
Binary file added nonholonomic_data/paths/121.png
Binary file added nonholonomic_data/paths/121notree.png
Binary file added nonholonomic_data/paths/122.png
Binary file added nonholonomic_data/paths/122notree.png
Binary file added nonholonomic_data/paths/123.png
Binary file added nonholonomic_data/paths/123notree.png
Binary file added nonholonomic_data/paths/124.png
Binary file added nonholonomic_data/paths/124notree.png
Binary file added nonholonomic_data/paths/125.png
Binary file added nonholonomic_data/paths/125notree.png
Binary file added nonholonomic_data/paths/126.png
Binary file added nonholonomic_data/paths/126notree.png
Binary file added nonholonomic_data/paths/127.png
Binary file added nonholonomic_data/paths/127notree.png
Binary file added nonholonomic_data/paths/128.png
Binary file added nonholonomic_data/paths/128notree.png
Binary file added nonholonomic_data/paths/129.png
Binary file added nonholonomic_data/paths/129notree.png
Binary file added nonholonomic_data/paths/12notree.png
Binary file added nonholonomic_data/paths/13.png
Binary file added nonholonomic_data/paths/130.png
Binary file added nonholonomic_data/paths/130notree.png
Binary file added nonholonomic_data/paths/131.png
Binary file added nonholonomic_data/paths/131notree.png
Binary file added nonholonomic_data/paths/132.png
Binary file added nonholonomic_data/paths/132notree.png
Binary file added nonholonomic_data/paths/133.png
Binary file added nonholonomic_data/paths/133notree.png
Binary file added nonholonomic_data/paths/134.png
Binary file added nonholonomic_data/paths/134notree.png
Binary file added nonholonomic_data/paths/135.png
Binary file added nonholonomic_data/paths/135notree.png
Binary file added nonholonomic_data/paths/136.png
Binary file added nonholonomic_data/paths/136notree.png
Binary file added nonholonomic_data/paths/137.png
Binary file added nonholonomic_data/paths/137notree.png
Binary file added nonholonomic_data/paths/138.png
Binary file added nonholonomic_data/paths/138notree.png
Binary file added nonholonomic_data/paths/139.png
Binary file added nonholonomic_data/paths/139notree.png
Binary file added nonholonomic_data/paths/13notree.png
Binary file added nonholonomic_data/paths/14.png
Binary file added nonholonomic_data/paths/140.png
Binary file added nonholonomic_data/paths/140notree.png
Binary file added nonholonomic_data/paths/141.png
Binary file added nonholonomic_data/paths/141notree.png
Binary file added nonholonomic_data/paths/142.png
Loading

0 comments on commit 4993fe4

Please sign in to comment.