Skip to content

Commit 8d15651

Browse files
author
Roberts Kalnins
committed
Add level 2 auton
1 parent 4e5d0cb commit 8d15651

File tree

12 files changed

+252
-92
lines changed

12 files changed

+252
-92
lines changed

‎PathWeaver/Paths/hab2_to_cargo_l.path‎

Lines changed: 4 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,4 @@
1+
X,Y,Tangent X,Tangent Y,Fixed Theta,Name
2+
8.0,113.57352749818757,120.0,0.0,true,
3+
129.129,123.5,56.818493129737874,30.048688717374006,false,
4+
150.191,135.75,128.631711463858,1.18010744462255,false,

‎PathWeaver/Paths/hab2_to_cargo_r.path‎

Lines changed: 4 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,4 @@
1+
X,Y,Tangent X,Tangent Y,Fixed Theta,Name
2+
8.0,213.574,120.0,0.0,true,
3+
129.0,200.147,51.077382204704634,-25.55802715072346,true,
4+
150.0,184.5,128.631711463858,-1.18010744462255,false,

‎PathWeaver/Paths/loading_to_cargo_side_r.path‎

Lines changed: 4 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -1,6 +1,6 @@
11
X,Y,Tangent X,Tangent Y,Fixed Theta,Name
22
5.379,305.004,97.94891790367163,-2.3602148892450963,true,
3-
151.532,232.658,24.782256337073534,-4.7204297784902,true,
4-
189.116,234.838,42.48386800641174,1.1801074446225641,true,
5-
228.581,243.738,43.663975451034304,5.900537223112735,true,
6-
263.5,233.757,7.080644667735413,-30.962,true,
3+
151.532,233.658,24.782256337073534,-4.7204297784902,true,
4+
189.116,236.0,39.71566344171717,7.871372501873282,true,
5+
226.0,247.0,43.663975451034304,5.900537223112735,true,
6+
263.5,235.757,7.080644667735413,-30.962,true,

‎src/main/deploy/paths/hab2_to_cargo_l.pf1.csv‎

Lines changed: 55 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,55 @@
1+
dt,x,y,position,velocity,acceleration,jerk,heading
2+
0.040000,8.000000,113.573527,0.030952,1.547619,38.690476,967.261905,0.000393
3+
0.040000,8.032819,113.573525,0.154762,4.642857,77.380952,967.261905,6.283044
4+
0.040000,8.311390,113.573319,0.433333,9.285714,116.071429,967.261905,6.281851
5+
0.040000,8.806627,113.572138,0.928571,15.476190,154.761905,967.261905,6.279757
6+
0.040000,9.549474,113.568445,1.671429,21.666667,154.761905,0.000000,6.276682
7+
0.040000,10.539914,113.560022,2.661905,27.857143,154.761905,0.000000,6.272704
8+
0.040000,11.777906,113.544067,3.900000,34.047619,154.761905,0.000000,6.267929
9+
0.040000,13.263377,113.517321,5.385714,40.238095,154.761905,-0.000000,6.262487
10+
0.040000,14.996221,113.476227,7.119048,46.428571,154.761905,0.000000,6.256533
11+
0.040000,16.976288,113.417122,9.100000,52.619048,154.761905,0.000000,6.250247
12+
0.040000,19.203395,113.336459,11.328571,58.809524,154.761905,0.000000,6.243833
13+
0.040000,21.677338,113.231052,13.804762,65.000000,154.761905,0.000000,6.237518
14+
0.040000,24.397909,113.098356,16.528571,71.190476,154.761905,0.000000,6.231550
15+
0.040000,27.364937,112.936763,19.500000,77.380952,154.761905,-0.000000,6.226203
16+
0.040000,30.578320,112.745933,22.719048,83.571429,154.761905,0.000000,6.221770
17+
0.040000,34.038075,112.527149,26.185714,89.761905,154.761905,-0.000000,6.218567
18+
0.040000,37.744374,112.283707,29.900000,95.952381,154.761905,0.000000,6.216935
19+
0.040000,41.697582,112.021336,33.861905,102.142857,154.761905,-0.000000,6.217244
20+
0.040000,45.898265,111.748674,38.071429,108.333333,154.761905,0.000000,6.219889
21+
0.040000,50.347163,111.477787,42.528571,114.523810,154.761905,-0.000000,6.225304
22+
0.040000,55.045102,111.224759,47.233333,120.714286,154.761905,0.000000,6.233957
23+
0.040000,59.961876,111.011487,52.154762,125.357143,116.071429,-967.261905,6.246275
24+
0.040000,65.035863,110.863855,57.230952,128.452381,77.380952,-967.261905,6.262525
25+
0.040000,70.204519,110.807881,62.400000,130.000000,38.690476,-967.261905,6.282823
26+
0.040000,75.404050,110.867444,67.600000,130.000000,0.000000,-967.261905,0.023921
27+
0.040000,80.600185,111.063357,72.800000,130.000000,0.000000,0.000000,0.052100
28+
0.040000,85.788014,111.415660,78.000000,130.000000,0.000000,0.000000,0.084152
29+
0.040000,90.960835,111.943885,83.200000,130.000000,0.000000,0.000000,0.119994
30+
0.040000,96.094716,112.664082,88.384486,129.224304,-19.392402,-484.810039,0.159335
31+
0.040000,101.133949,113.581851,93.506992,126.900989,-58.082878,-967.261905,0.201481
32+
0.040000,106.008150,114.688346,98.505613,123.030055,-96.773354,-967.261905,0.245398
33+
0.040000,110.649457,115.960267,103.318444,117.611501,-135.463830,-967.261905,0.289876
34+
0.040000,115.009011,117.365005,107.899094,111.421025,-154.761905,-482.451866,0.333772
35+
0.040000,119.071604,118.870869,112.232126,105.230549,-154.761905,-0.000000,0.376283
36+
0.040000,122.839723,120.448706,116.317538,99.040073,-154.761905,0.000000,0.416870
37+
0.040000,126.318275,122.069379,120.155332,92.849597,-154.761905,-0.000000,0.455128
38+
0.040000,129.490919,123.696431,123.745506,86.659121,-154.761905,0.000000,0.507887
39+
0.040000,132.282588,125.530083,127.088061,80.468644,-154.761905,-0.000000,0.642602
40+
0.040000,134.691383,127.472554,130.182998,74.278168,-154.761905,0.000000,0.704985
41+
0.040000,136.845716,129.334274,133.030315,68.087692,-154.761905,-0.000000,0.712568
42+
0.040000,138.835942,131.006627,135.630013,61.897216,-154.761905,0.000000,0.678441
43+
0.040000,140.710607,132.426443,137.982092,55.706740,-154.761905,0.000000,0.612184
44+
0.040000,142.481759,133.561713,140.086552,49.516263,-154.761905,0.000000,0.523138
45+
0.040000,144.132925,134.409402,141.943393,43.325787,-154.761905,0.000000,0.422221
46+
0.040000,145.631142,134.994830,143.552615,37.135311,-154.761905,0.000000,0.321062
47+
0.040000,146.940937,135.365097,144.914218,30.944835,-154.761905,0.000000,0.229351
48+
0.040000,148.034363,135.576699,146.028202,24.754359,-154.761905,0.000000,0.152973
49+
0.040000,148.894004,135.683405,146.894567,18.563882,-154.761905,0.000000,0.094206
50+
0.040000,149.511031,135.728893,147.513313,12.373406,-154.761905,-0.000000,0.053125
51+
0.040000,149.897344,135.744552,147.899953,6.958626,-135.369503,484.810039,0.027972
52+
0.040000,150.098298,135.748876,148.100955,3.091465,-96.679027,967.261905,0.015077
53+
0.040000,150.175559,135.749851,148.178223,0.771923,-57.988551,967.261905,0.010155
54+
0.040000,150.191000,135.750000,148.193661,0.000000,-19.298075,967.261905,0.009174
55+
0.040000,150.191000,135.750000,148.193661,0.000000,0.000000,482.451866,0.009174

‎src/main/deploy/paths/hab2_to_cargo_r.pf1.csv‎

Lines changed: 55 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,55 @@
1+
dt,x,y,position,velocity,acceleration,jerk,heading
2+
0.040000,8.000000,213.574000,0.030952,1.547619,38.690476,967.261905,6.282968
3+
0.040000,8.032272,213.574001,0.154762,4.642857,77.380952,967.261905,0.000076
4+
0.040000,8.310843,213.574114,0.433333,9.285714,116.071429,967.261905,0.000732
5+
0.040000,8.806081,213.574761,0.928571,15.476190,154.761905,967.261905,0.001877
6+
0.040000,9.548935,213.576780,1.671429,21.666667,154.761905,0.000000,0.003548
7+
0.040000,10.539400,213.581362,2.661905,27.857143,154.761905,0.000000,0.005687
8+
0.040000,11.777465,213.589985,3.900000,34.047619,154.761905,0.000000,0.008218
9+
0.040000,13.263110,213.604324,5.385714,40.238095,154.761905,-0.000000,0.011047
10+
0.040000,14.996306,213.626128,7.119048,46.428571,154.761905,0.000000,0.014061
11+
0.040000,16.977015,213.657086,9.100000,52.619048,154.761905,0.000000,0.017130
12+
0.040000,19.205198,213.698667,11.328571,58.809524,154.761905,0.000000,0.020104
13+
0.040000,21.680815,213.751933,13.804762,65.000000,154.761905,0.000000,0.022818
14+
0.040000,24.403838,213.817339,16.528571,71.190476,154.761905,0.000000,0.025087
15+
0.040000,27.374265,213.894505,19.500000,77.380952,154.761905,-0.000000,0.026709
16+
0.040000,30.592124,213.981965,22.719048,83.571429,154.761905,0.000000,0.027463
17+
0.040000,34.057491,214.076897,26.185714,89.761905,154.761905,-0.000000,0.027111
18+
0.040000,37.770485,214.174821,29.900000,95.952381,154.761905,0.000000,0.025392
19+
0.040000,41.731262,214.269265,33.861905,102.142857,154.761905,-0.000000,0.022025
20+
0.040000,45.939979,214.351410,38.071429,108.333333,154.761905,0.000000,0.016706
21+
0.040000,50.396731,214.409682,42.528571,114.523810,154.761905,-0.000000,0.009104
22+
0.040000,55.101431,214.429323,47.233333,120.714286,154.761905,0.000000,6.282049
23+
0.040000,60.022685,214.392354,52.154762,125.357143,116.071429,-967.261905,6.268876
24+
0.040000,65.097568,214.279629,57.230952,128.452381,77.380952,-967.261905,6.252624
25+
0.040000,70.262400,214.072917,62.400000,130.000000,38.690476,-967.261905,6.233269
26+
0.040000,75.452669,213.756712,67.600000,130.000000,0.000000,-967.261905,6.210926
27+
0.040000,80.633920,213.317168,72.800000,130.000000,0.000000,0.000000,6.185704
28+
0.040000,85.801586,212.739723,78.000000,130.000000,0.000000,0.000000,6.157636
29+
0.040000,90.949962,212.010286,83.200000,130.000000,0.000000,0.000000,6.126787
30+
0.040000,96.069028,211.116125,88.396816,129.840798,-3.980041,-99.501030,6.093296
31+
0.040000,101.117524,210.052995,93.556311,128.133978,-42.670517,-967.261905,6.057580
32+
0.040000,106.027579,208.830402,98.616582,124.879538,-81.360994,-967.261905,6.020383
33+
0.040000,110.733513,207.469192,103.515722,120.077479,-120.051470,-967.261905,5.982579
34+
0.040000,115.176107,206.000674,108.195012,113.887003,-154.761905,-867.760875,5.945097
35+
0.040000,119.329277,204.455132,112.626682,107.696527,-154.761905,-0.000000,5.908624
36+
0.040000,123.195673,202.856550,116.810734,101.506051,-154.761905,0.000000,5.873562
37+
0.040000,126.779685,201.228999,120.747166,95.315574,-154.761905,-0.000000,5.840230
38+
0.040000,130.040133,199.565113,124.435980,89.125098,-154.761905,0.000000,5.728293
39+
0.040000,132.742221,197.444093,127.877174,82.934622,-154.761905,-0.000000,5.523067
40+
0.040000,134.923510,195.113470,131.070750,76.744146,-154.761905,0.000000,5.419945
41+
0.040000,136.796201,192.839459,134.016706,70.553670,-154.761905,-0.000000,5.392995
42+
0.040000,138.515631,190.760026,136.715043,64.363193,-154.761905,0.000000,5.422319
43+
0.040000,140.173128,188.955596,139.165761,58.172717,-154.761905,0.000000,5.496350
44+
0.040000,141.805384,187.477563,141.368861,51.982241,-154.761905,0.000000,5.605173
45+
0.040000,143.400871,186.349318,143.324341,45.791765,-154.761905,0.000000,5.735009
46+
0.040000,144.912412,185.557031,145.032202,39.601289,-154.761905,0.000000,5.868039
47+
0.040000,146.280681,185.049520,146.492444,33.410812,-154.761905,0.000000,5.988232
48+
0.040000,147.456488,184.755003,147.705067,27.220336,-154.761905,0.000000,6.086670
49+
0.040000,148.409125,184.602407,148.670071,21.029860,-154.761905,-0.000000,6.161338
50+
0.040000,149.123164,184.534106,149.387456,14.839384,-154.761905,0.000000,6.213834
51+
0.040000,149.595434,184.509176,149.860405,8.808109,-150.781864,99.501030,6.246838
52+
0.040000,149.857983,184.501971,150.123057,4.324454,-112.091387,967.261905,6.264588
53+
0.040000,149.972230,184.500280,150.237314,1.388417,-73.400911,967.261905,6.272178
54+
0.040000,150.000000,184.500000,150.265082,0.000000,-34.710435,967.261905,6.274011
55+
0.040000,150.000000,184.500000,150.265082,0.000000,0.000000,867.760875,6.274011

0 commit comments

Comments
 (0)