diff --git a/src/boards/Main/Configs/ADAConfig.h b/src/boards/Main/Configs/ADAConfig.h index 0fc32e89b5d1f997b93ad39f361dd0fb6adf4393..1f5b58aceb01be5316e7ffcaa1610063d2a6c884 100644 --- a/src/boards/Main/Configs/ADAConfig.h +++ b/src/boards/Main/Configs/ADAConfig.h @@ -40,7 +40,7 @@ namespace ADA constexpr Hertz UPDATE_RATE = 50_hz; constexpr float UPDATE_RATE_SECONDS = 0.02; // [s] -constexpr unsigned int SHADOW_MODE_TIMEOUT = 9000; // [ms] +constexpr unsigned int SHADOW_MODE_TIMEOUT = 13000; // [ms] constexpr float APOGEE_VERTICAL_SPEED_TARGET = 2.5; // [m/s] constexpr unsigned int APOGEE_N_SAMPLES = 5; diff --git a/src/boards/Main/Configs/FMMConfig.h b/src/boards/Main/Configs/FMMConfig.h index a6b0d4b99448b191c0e1d764dd1adc754bad41b6..04ce8d7498190d5a1d8eb976a1fdd98241bd41e6 100644 --- a/src/boards/Main/Configs/FMMConfig.h +++ b/src/boards/Main/Configs/FMMConfig.h @@ -36,7 +36,7 @@ constexpr unsigned int MISSION_TIMEOUT = 15 * 60 * 1000; constexpr unsigned int ENGINE_SHUTDOWN_TIMEOUT = 6000; -constexpr unsigned int APOGEE_TIMEOUT = 35 * 1000; +constexpr unsigned int APOGEE_TIMEOUT = 28 * 1000; constexpr unsigned int CUT_DURATION = 500; // [ms] diff --git a/src/boards/Main/Configs/MEAConfig.h b/src/boards/Main/Configs/MEAConfig.h index 994d403f110ddcafdd62efdc54205100a477a30f..cd615a54235d4d86621d21dc11a0505edeb1f9e0 100644 --- a/src/boards/Main/Configs/MEAConfig.h +++ b/src/boards/Main/Configs/MEAConfig.h @@ -47,13 +47,13 @@ constexpr float SHUTDOWN_APOGEE_TARGET = 800; // agl [m] #ifndef EUROC #warning "MISSION NOT DEFINED: Using EUROC" #endif -constexpr unsigned int SHADOW_MODE_TIMEOUT = 3000; // [ms] -constexpr float DEFAULT_INITIAL_ROCKET_MASS = 33.69f; // [kg] +constexpr unsigned int SHADOW_MODE_TIMEOUT = 2600; // [ms] +constexpr float DEFAULT_INITIAL_ROCKET_MASS = 33.87f; // [kg] constexpr float SHUTDOWN_APOGEE_TARGET = 3200; // agl [m] #endif constexpr float CD_CORRECTION_FACTOR = - 2.69f; // Completely random number (for now... i hope) + 1.0f; // Completely random number (for now... i hope) constexpr unsigned int SHUTDOWN_N_SAMPLES = 5; @@ -61,7 +61,7 @@ constexpr float SENSOR_NOISE_VARIANCE = 0.36f; constexpr float MODEL_NOISE_VARIANCE = 1.0f; // Pressure threshold after which the kalman is updated -constexpr float CC_PRESSURE_THRESHOLD = 1.f; // [bar] +constexpr float CC_PRESSURE_THRESHOLD = 1.0f; // [bar] constexpr Boardcore::Aeroutils::AerodynamicCoeff AERO_COEFF = { .n000 = 0.476899999999981f, diff --git a/src/boards/Main/Configs/NASConfig.h b/src/boards/Main/Configs/NASConfig.h index c947586ea4abfa305fdffefd6070e702cda7402b..82e5ab80f0a68a74fdbb3d59b28afc6494911aee 100644 --- a/src/boards/Main/Configs/NASConfig.h +++ b/src/boards/Main/Configs/NASConfig.h @@ -49,8 +49,8 @@ static const Boardcore::NASConfig CONFIG = { .SIGMA_W = 0.0019, .SIGMA_ACC = 0.202, .SIGMA_MAG = 0.0047, - .SIGMA_GPS = {0.0447f, 0.0447f, 0.1f / 30.0f, 0.1f / 30.0f}, - .SIGMA_BAR = 4.5097, + .SIGMA_GPS = {0.0447f, 0.0447f, 1.0f / 30.0f, 1.0f / 30.0f}, + .SIGMA_BAR = 400.0f, .SIGMA_POS = 2.0, .SIGMA_VEL = 1.0, .SIGMA_PITOT = 1e-3, diff --git a/src/boards/Main/Data/ABKTrajectorySet.cpp b/src/boards/Main/Data/ABKTrajectorySet.cpp index 0c992a59e59717d3dfc879849043bcda837e6a95..c8ebef400f5d14926143611d5cfa43a7c32a5e6d 100644 --- a/src/boards/Main/Data/ABKTrajectorySet.cpp +++ b/src/boards/Main/Data/ABKTrajectorySet.cpp @@ -495,6674 +495,6676 @@ TrajectorySet Main::Data::ABK::OPEN_TRAJECTORY_SET(t_open, 2); #ifndef EUROC #warning "MISSION NOT DEFINED: Using EUROC" #endif -// ============================================= -// WARNING: GEMINI ROCCARASO TRAJECTORIES -// REMOVE THESE!!! -// ============================================= +//['Heights ', 'Vz_closed_m26 ', 'Vz_closed_m26_4 ', 'Vz_closed_m26_8 ', +//'Vz_closed_m27_2 ', 'Vz_closed_m27_6 ', 'Vz_closed_m28 ', 'Vz_closed_m28_4 ', +//'Vz_closed_m28_8 ', 'Vz_closed_m29_2 ', 'Vz_closed_m29_6 ', 'Vz_closed_m30 ', +//'Vz_open_m26 ', 'Vz_open_m26_4 ', 'Vz_open_m26_8 ', 'Vz_open_m27_2 ', +//'Vz_open_m27_6 ', 'Vz_open_m28 ', 'Vz_open_m28_4 ', 'Vz_open_m28_8 ', +//'Vz_open_m29_2 ', 'Vz_open_m29_6 ', 'Vz_open_m30 '] TrajectoryPoint t0_closed[] = { - TrajectoryPoint(0, 291.697688278318), - TrajectoryPoint(10, 290.984535447996), - TrajectoryPoint(20, 290.272554676878), - TrajectoryPoint(30, 289.561766863639), - TrajectoryPoint(40, 288.852030395801), - TrajectoryPoint(50, 288.143059351263), - TrajectoryPoint(60, 287.435031702346), - TrajectoryPoint(70, 286.728110939376), - TrajectoryPoint(80, 286.021892458837), - TrajectoryPoint(90, 285.316377182964), - TrajectoryPoint(100, 284.612028614926), - TrajectoryPoint(110, 283.908322286167), - TrajectoryPoint(120, 283.205255534554), - TrajectoryPoint(130, 282.50308711451), - TrajectoryPoint(140, 281.801667911645), - TrajectoryPoint(150, 281.1008305958), - TrajectoryPoint(160, 280.400637653825), - TrajectoryPoint(170, 279.701294671578), - TrajectoryPoint(180, 279.002478787265), - TrajectoryPoint(190, 278.304185227024), - TrajectoryPoint(200, 277.606610031429), - TrajectoryPoint(210, 276.909620330855), - TrajectoryPoint(220, 276.213100610647), - TrajectoryPoint(230, 275.517059820918), - TrajectoryPoint(240, 274.82171272541), - TrajectoryPoint(250, 274.126785845519), - TrajectoryPoint(260, 273.43227319665), - TrajectoryPoint(270, 272.738247390128), - TrajectoryPoint(280, 272.044742814953), - TrajectoryPoint(290, 271.351605000273), - TrajectoryPoint(300, 270.658827282562), - TrajectoryPoint(310, 269.966503330181), - TrajectoryPoint(320, 269.274581563642), - TrajectoryPoint(330, 268.582974629793), - TrajectoryPoint(340, 267.891675380714), - TrajectoryPoint(350, 267.200770381043), - TrajectoryPoint(360, 266.510185961775), - TrajectoryPoint(370, 265.819866035091), - TrajectoryPoint(380, 265.129803108316), - TrajectoryPoint(390, 264.440060197535), - TrajectoryPoint(400, 263.750580678499), - TrajectoryPoint(410, 263.061316875416), - TrajectoryPoint(420, 262.372261048453), - TrajectoryPoint(430, 261.683445809333), - TrajectoryPoint(440, 260.994850482844), - TrajectoryPoint(450, 260.306423575181), - TrajectoryPoint(460, 259.618157164805), - TrajectoryPoint(470, 258.93005453962), - TrajectoryPoint(480, 258.242133161705), - TrajectoryPoint(490, 257.554334259916), - TrajectoryPoint(500, 256.866649771936), - TrajectoryPoint(510, 256.179071425476), - TrajectoryPoint(520, 255.491612941993), - TrajectoryPoint(530, 254.80424221825), - TrajectoryPoint(540, 254.116941049339), - TrajectoryPoint(550, 253.429701072041), - TrajectoryPoint(560, 252.742514410224), - TrajectoryPoint(570, 252.055379875809), - TrajectoryPoint(580, 251.368271078778), - TrajectoryPoint(590, 250.681179566394), - TrajectoryPoint(600, 249.99409673583), - TrajectoryPoint(610, 249.307013259786), - TrajectoryPoint(620, 248.619912378961), - TrajectoryPoint(630, 247.932785721418), - TrajectoryPoint(640, 247.245624600031), - TrajectoryPoint(650, 246.558420198845), - TrajectoryPoint(660, 245.871163580697), - TrajectoryPoint(670, 245.183824700715), - TrajectoryPoint(680, 244.496407515798), - TrajectoryPoint(690, 243.808904442685), - TrajectoryPoint(700, 243.121306454657), - TrajectoryPoint(710, 242.433604414687), - TrajectoryPoint(720, 241.745776514132), - TrajectoryPoint(730, 241.057801409348), - TrajectoryPoint(740, 240.369689078822), - TrajectoryPoint(750, 239.681430271073), - TrajectoryPoint(760, 238.993015629897), - TrajectoryPoint(770, 238.30443569757), - TrajectoryPoint(780, 237.61566492373), - TrajectoryPoint(790, 236.926679238592), - TrajectoryPoint(800, 236.237495318523), - TrajectoryPoint(810, 235.548103559551), - TrajectoryPoint(820, 234.858494256803), - TrajectoryPoint(830, 234.16865760621), - TrajectoryPoint(840, 233.478583705918), - TrajectoryPoint(850, 232.788224228347), - TrajectoryPoint(860, 232.097591757854), - TrajectoryPoint(870, 231.406688953627), - TrajectoryPoint(880, 230.715505725166), - TrajectoryPoint(890, 230.024031880883), - TrajectoryPoint(900, 229.332257128576), - TrajectoryPoint(910, 228.640171075695), - TrajectoryPoint(920, 227.94775068442), - TrajectoryPoint(930, 227.254954930989), - TrajectoryPoint(940, 226.561814303897), - TrajectoryPoint(950, 225.868318174168), - TrajectoryPoint(960, 225.174455806958), - TrajectoryPoint(970, 224.480216361252), - TrajectoryPoint(980, 223.785588889414), - TrajectoryPoint(990, 223.090562336636), - TrajectoryPoint(1000, 222.395125540258), - TrajectoryPoint(1010, 221.699255543157), - TrajectoryPoint(1020, 221.002910978018), - TrajectoryPoint(1030, 220.306121420704), - TrajectoryPoint(1040, 219.60887541045), - TrajectoryPoint(1050, 218.911161371448), - TrajectoryPoint(1060, 218.212967611875), - TrajectoryPoint(1070, 217.514282322845), - TrajectoryPoint(1080, 216.8150935773), - TrajectoryPoint(1090, 216.115389328827), - TrajectoryPoint(1100, 215.415157410421), - TrajectoryPoint(1110, 214.714385533196), - TrajectoryPoint(1120, 214.013061285041), - TrajectoryPoint(1130, 213.311172129224), - TrajectoryPoint(1140, 212.608673742036), - TrajectoryPoint(1150, 211.905576887698), - TrajectoryPoint(1160, 211.201877731975), - TrajectoryPoint(1170, 210.497563350611), - TrajectoryPoint(1180, 209.792620686413), - TrajectoryPoint(1190, 209.087036547734), - TrajectoryPoint(1200, 208.380797606912), - TrajectoryPoint(1210, 207.673890398689), - TrajectoryPoint(1220, 206.966301318579), - TrajectoryPoint(1230, 206.258016621218), - TrajectoryPoint(1240, 205.549022418667), - TrajectoryPoint(1250, 204.839304678699), - TrajectoryPoint(1260, 204.128849223041), - TrajectoryPoint(1270, 203.417641725602), - TrajectoryPoint(1280, 202.705667710654), - TrajectoryPoint(1290, 201.992912551), - TrajectoryPoint(1300, 201.279361466101), - TrajectoryPoint(1310, 200.564999520181), - TrajectoryPoint(1320, 199.849811620298), - TrajectoryPoint(1330, 199.133782514392), - TrajectoryPoint(1340, 198.416896789296), - TrajectoryPoint(1350, 197.699138868718), - TrajectoryPoint(1360, 196.980493011203), - TrajectoryPoint(1370, 196.260943308046), - TrajectoryPoint(1380, 195.540473681187), - TrajectoryPoint(1390, 194.819067881072), - TrajectoryPoint(1400, 194.096709484473), - TrajectoryPoint(1410, 193.373381892281), - TrajectoryPoint(1420, 192.649068327263), - TrajectoryPoint(1430, 191.923751831781), - TrajectoryPoint(1440, 191.197415265473), - TrajectoryPoint(1450, 190.470041302905), - TrajectoryPoint(1460, 189.741612431169), - TrajectoryPoint(1470, 189.012110947453), - TrajectoryPoint(1480, 188.281518956566), - TrajectoryPoint(1490, 187.549818368419), - TrajectoryPoint(1500, 186.816952567424), - TrajectoryPoint(1510, 186.082905678569), - TrajectoryPoint(1520, 185.347689154617), - TrajectoryPoint(1530, 184.611283957458), - TrajectoryPoint(1540, 183.873670839394), - TrajectoryPoint(1550, 183.134830340299), - TrajectoryPoint(1560, 182.394742784713), - TrajectoryPoint(1570, 181.653388278888), - TrajectoryPoint(1580, 180.910746707778), - TrajectoryPoint(1590, 180.166797731971), - TrajectoryPoint(1600, 179.421520784558), - TrajectoryPoint(1610, 178.674808817941), - TrajectoryPoint(1620, 177.926676784425), - TrajectoryPoint(1630, 177.177146378547), - TrajectoryPoint(1640, 176.426195929864), - TrajectoryPoint(1650, 175.67380352185), - TrajectoryPoint(1660, 174.919946988324), - TrajectoryPoint(1670, 174.164603909805), - TrajectoryPoint(1680, 173.407715382908), - TrajectoryPoint(1690, 172.649146178947), - TrajectoryPoint(1700, 171.889013057377), - TrajectoryPoint(1710, 171.127292370435), - TrajectoryPoint(1720, 170.363960195215), - TrajectoryPoint(1730, 169.598992329481), - TrajectoryPoint(1740, 168.832310429993), - TrajectoryPoint(1750, 168.063764499078), - TrajectoryPoint(1760, 167.293498806744), - TrajectoryPoint(1770, 166.521487795767), - TrajectoryPoint(1780, 165.747705604384), - TrajectoryPoint(1790, 164.972080733082), - TrajectoryPoint(1800, 164.194399148115), - TrajectoryPoint(1810, 163.414856083536), - TrajectoryPoint(1820, 162.633424199322), - TrajectoryPoint(1830, 161.850075822372), - TrajectoryPoint(1840, 161.064556645122), - TrajectoryPoint(1850, 160.276961344482), - TrajectoryPoint(1860, 159.487352451706), - TrajectoryPoint(1870, 158.695700675387), - TrajectoryPoint(1880, 157.901720616709), - TrajectoryPoint(1890, 157.105519268063), - TrajectoryPoint(1900, 156.307171866083), - TrajectoryPoint(1910, 155.506626385401), - TrajectoryPoint(1920, 154.703483224839), - TrajectoryPoint(1930, 153.89808575136), - TrajectoryPoint(1940, 153.090401455257), - TrajectoryPoint(1950, 152.280087885851), - TrajectoryPoint(1960, 151.467267063182), - TrajectoryPoint(1970, 150.652044175097), - TrajectoryPoint(1980, 149.834109418323), - TrajectoryPoint(1990, 149.013471914356), - TrajectoryPoint(2000, 148.190311224522), - TrajectoryPoint(2010, 147.364252189324), - TrajectoryPoint(2020, 146.535383279066), - TrajectoryPoint(2030, 145.703863786175), - TrajectoryPoint(2040, 144.869143927633), - TrajectoryPoint(2050, 144.031606027675), - TrajectoryPoint(2060, 143.191114848679), - TrajectoryPoint(2070, 142.347330408586), - TrajectoryPoint(2080, 141.500661472084), - TrajectoryPoint(2090, 140.650526550284), - TrajectoryPoint(2100, 139.797269614436), - TrajectoryPoint(2110, 138.940659933022), - TrajectoryPoint(2120, 138.08056305132), - TrajectoryPoint(2130, 137.217170605551), - TrajectoryPoint(2140, 136.349970986925), - TrajectoryPoint(2150, 135.479471796961), - TrajectoryPoint(2160, 134.604895213864), - TrajectoryPoint(2170, 133.726945074672), - TrajectoryPoint(2180, 132.844708576594), - TrajectoryPoint(2190, 131.958955479211), - TrajectoryPoint(2200, 131.068753317653), - TrajectoryPoint(2210, 130.174816309537), - TrajectoryPoint(2220, 129.27633929721), - TrajectoryPoint(2230, 128.373820743973), - TrajectoryPoint(2240, 127.466742075516), - TrajectoryPoint(2250, 126.555223090573), - TrajectoryPoint(2260, 125.639200846806), - TrajectoryPoint(2270, 124.71823997185), - TrajectoryPoint(2280, 123.792752260635), - TrajectoryPoint(2290, 122.862047991453), - TrajectoryPoint(2300, 121.926390385521), - TrajectoryPoint(2310, 120.985781216501), - TrajectoryPoint(2320, 120.039447022012), - TrajectoryPoint(2330, 119.087894481187), - TrajectoryPoint(2340, 118.130967276745), - TrajectoryPoint(2350, 117.167913449536), - TrajectoryPoint(2360, 116.199153768707), - TrajectoryPoint(2370, 115.224530490338), - TrajectoryPoint(2380, 114.243642807481), - TrajectoryPoint(2390, 113.256236854829), - TrajectoryPoint(2400, 112.262428217485), - TrajectoryPoint(2410, 111.262017430573), - TrajectoryPoint(2420, 110.254797311192), - TrajectoryPoint(2430, 109.240210388553), - TrajectoryPoint(2440, 108.218359657945), - TrajectoryPoint(2450, 107.18905886819), - TrajectoryPoint(2460, 106.152068475589), - TrajectoryPoint(2470, 105.107139357046), - TrajectoryPoint(2480, 104.054012347058), - TrajectoryPoint(2490, 102.992417746795), - TrajectoryPoint(2500, 101.922074803322), - TrajectoryPoint(2510, 100.842691156895), - TrajectoryPoint(2520, 99.753962254038), - TrajectoryPoint(2530, 98.6555707239711), - TrajectoryPoint(2540, 97.5471857157151), - TrajectoryPoint(2550, 96.4284621929983), - TrajectoryPoint(2560, 95.2990401838284), - TrajectoryPoint(2570, 94.1585439813332), - TrajectoryPoint(2580, 93.0065812921652), - TrajectoryPoint(2590, 91.8427423284479), - TrajectoryPoint(2600, 90.6665988388753), - TrajectoryPoint(2610, 89.4774390540253), - TrajectoryPoint(2620, 88.2746396649513), - TrajectoryPoint(2630, 87.0580281855391), - TrajectoryPoint(2640, 85.8270846882579), - TrajectoryPoint(2650, 84.5804379182145), - TrajectoryPoint(2660, 83.3180612390695), - TrajectoryPoint(2670, 82.0392338060996), - TrajectoryPoint(2680, 80.7424991054066), - TrajectoryPoint(2690, 79.4279821236853), - TrajectoryPoint(2700, 78.0935956269846), - TrajectoryPoint(2710, 76.7393940987897), - TrajectoryPoint(2720, 75.3636329858332), - TrajectoryPoint(2730, 73.9651817263447), - TrajectoryPoint(2740, 72.5431290280362), - TrajectoryPoint(2750, 71.0958831964234), - TrajectoryPoint(2760, 69.6212360147459), - TrajectoryPoint(2770, 68.1180465393934), - TrajectoryPoint(2780, 66.5843147037006), - TrajectoryPoint(2790, 65.0178549168622), - TrajectoryPoint(2800, 63.4162742978174), - TrajectoryPoint(2810, 61.7767195677176), - TrajectoryPoint(2820, 60.095624802691), - TrajectoryPoint(2830, 58.3702755230403), - TrajectoryPoint(2840, 56.5962574251198), - TrajectoryPoint(2850, 54.7686724086359), - TrajectoryPoint(2860, 52.8819145270167), - TrajectoryPoint(2870, 50.9298307741777), - TrajectoryPoint(2880, 48.9042896236109), - TrajectoryPoint(2890, 46.7957762132094), - TrajectoryPoint(2900, 44.5930868834589), - TrajectoryPoint(2910, 42.2799660800708), - TrajectoryPoint(2920, 39.8388300333339), - TrajectoryPoint(2930, 37.2438952999428), - TrajectoryPoint(2940, 34.4609033921338), - TrajectoryPoint(2950, 31.4390325302813), - TrajectoryPoint(2960, 28.1028168888058), - TrajectoryPoint(2970, 24.3209267802065), - TrajectoryPoint(2980, 19.8437772488535), - TrajectoryPoint(2990, 14.0194488542204), + TrajectoryPoint(0, 306.603538096386), + TrajectoryPoint(10, 305.768505733462), + TrajectoryPoint(20, 304.937667323281), + TrajectoryPoint(30, 304.109312139867), + TrajectoryPoint(40, 303.282835536058), + TrajectoryPoint(50, 302.45971239723), + TrajectoryPoint(60, 301.638705427401), + TrajectoryPoint(70, 300.819438919743), + TrajectoryPoint(80, 300.00326723704), + TrajectoryPoint(90, 299.188975881593), + TrajectoryPoint(100, 298.376293703289), + TrajectoryPoint(110, 297.566395330707), + TrajectoryPoint(120, 296.758240736162), + TrajectoryPoint(130, 295.951571229698), + TrajectoryPoint(140, 295.147342278942), + TrajectoryPoint(150, 294.344794678536), + TrajectoryPoint(160, 293.543615373182), + TrajectoryPoint(170, 292.744516565817), + TrajectoryPoint(180, 291.94709093476), + TrajectoryPoint(190, 291.150924018958), + TrajectoryPoint(200, 290.356472483662), + TrajectoryPoint(210, 289.563724515597), + TrajectoryPoint(220, 288.772132688172), + TrajectoryPoint(230, 287.981894950135), + TrajectoryPoint(240, 287.19341734818), + TrajectoryPoint(250, 286.40600002545), + TrajectoryPoint(260, 285.61964141661), + TrajectoryPoint(270, 284.835005053623), + TrajectoryPoint(280, 284.051394906493), + TrajectoryPoint(290, 283.268752815939), + TrajectoryPoint(300, 282.48742516336), + TrajectoryPoint(310, 281.707284957766), + TrajectoryPoint(320, 280.928028431234), + TrajectoryPoint(330, 280.149706595462), + TrajectoryPoint(340, 279.372726310223), + TrajectoryPoint(350, 278.596551143767), + TrajectoryPoint(360, 277.821175092321), + TrajectoryPoint(370, 277.04685443443), + TrajectoryPoint(380, 276.273480552463), + TrajectoryPoint(390, 275.500832352316), + TrajectoryPoint(400, 274.728902257339), + TrajectoryPoint(410, 273.958044994855), + TrajectoryPoint(420, 273.187871323288), + TrajectoryPoint(430, 272.41834736678), + TrajectoryPoint(440, 271.649534383534), + TrajectoryPoint(450, 270.881601031591), + TrajectoryPoint(460, 270.114253598279), + TrajectoryPoint(470, 269.347483712316), + TrajectoryPoint(480, 268.581383678863), + TrajectoryPoint(490, 267.815999862809), + TrajectoryPoint(500, 267.051134139247), + TrajectoryPoint(510, 266.28677763825), + TrajectoryPoint(520, 265.523010864309), + TrajectoryPoint(530, 264.759855068636), + TrajectoryPoint(540, 263.997153018311), + TrajectoryPoint(550, 263.234895561799), + TrajectoryPoint(560, 262.473125038457), + TrajectoryPoint(570, 261.711899449048), + TrajectoryPoint(580, 260.951066546964), + TrajectoryPoint(590, 260.190617035183), + TrajectoryPoint(600, 259.430541636839), + TrajectoryPoint(610, 258.670969325324), + TrajectoryPoint(620, 257.911731643952), + TrajectoryPoint(630, 257.152819227589), + TrajectoryPoint(640, 256.39422240339), + TrajectoryPoint(650, 255.635990197723), + TrajectoryPoint(660, 254.878091620194), + TrajectoryPoint(670, 254.120462871294), + TrajectoryPoint(680, 253.363094297013), + TrajectoryPoint(690, 252.605976015234), + TrajectoryPoint(700, 251.849163325516), + TrajectoryPoint(710, 251.092579596848), + TrajectoryPoint(720, 250.336202896863), + TrajectoryPoint(730, 249.580023382922), + TrajectoryPoint(740, 248.824031033816), + TrajectoryPoint(750, 248.068260569029), + TrajectoryPoint(760, 247.312651284009), + TrajectoryPoint(770, 246.557187887592), + TrajectoryPoint(780, 245.80186037723), + TrajectoryPoint(790, 245.04665860069), + TrajectoryPoint(800, 244.29158969972), + TrajectoryPoint(810, 243.536629052742), + TrajectoryPoint(820, 242.781754352523), + TrajectoryPoint(830, 242.02695542015), + TrajectoryPoint(840, 241.272221941902), + TrajectoryPoint(850, 240.517543476554), + TrajectoryPoint(860, 239.762915733077), + TrajectoryPoint(870, 239.008315410906), + TrajectoryPoint(880, 238.253731378498), + TrajectoryPoint(890, 237.499153107778), + TrajectoryPoint(900, 236.744569945948), + TrajectoryPoint(910, 235.989971119235), + TrajectoryPoint(920, 235.235339556376), + TrajectoryPoint(930, 234.480662913245), + TrajectoryPoint(940, 233.72593237615), + TrajectoryPoint(950, 232.971137011172), + TrajectoryPoint(960, 232.21626575932), + TrajectoryPoint(970, 231.46130743807), + TrajectoryPoint(980, 230.706250742444), + TrajectoryPoint(990, 229.951070219621), + TrajectoryPoint(1000, 229.195757041172), + TrajectoryPoint(1010, 228.440307126637), + TrajectoryPoint(1020, 227.684708926154), + TrajectoryPoint(1030, 226.928950758824), + TrajectoryPoint(1040, 226.173020812614), + TrajectoryPoint(1050, 225.416907143991), + TrajectoryPoint(1060, 224.660597677338), + TrajectoryPoint(1070, 223.904071144381), + TrajectoryPoint(1080, 223.147301493374), + TrajectoryPoint(1090, 222.390296768172), + TrajectoryPoint(1100, 221.633044555963), + TrajectoryPoint(1110, 220.875532301284), + TrajectoryPoint(1120, 220.117747304932), + TrajectoryPoint(1130, 219.359676722746), + TrajectoryPoint(1140, 218.601307564275), + TrajectoryPoint(1150, 217.842626691346), + TrajectoryPoint(1160, 217.083620816547), + TrajectoryPoint(1170, 216.324276501625), + TrajectoryPoint(1180, 215.564572044532), + TrajectoryPoint(1190, 214.804478475182), + TrajectoryPoint(1200, 214.044004799993), + TrajectoryPoint(1210, 213.283137131702), + TrajectoryPoint(1220, 212.521861421432), + TrajectoryPoint(1230, 211.760163457011), + TrajectoryPoint(1240, 210.998028861268), + TrajectoryPoint(1250, 210.235443090272), + TrajectoryPoint(1260, 209.472391431554), + TrajectoryPoint(1270, 208.708859002287), + TrajectoryPoint(1280, 207.944830747449), + TrajectoryPoint(1290, 207.180291437958), + TrajectoryPoint(1300, 206.415225668786), + TrajectoryPoint(1310, 205.649617857056), + TrajectoryPoint(1320, 204.883452240121), + TrajectoryPoint(1330, 204.116712873621), + TrajectoryPoint(1340, 203.349383629532), + TrajectoryPoint(1350, 202.581448194193), + TrajectoryPoint(1360, 201.81289006632), + TrajectoryPoint(1370, 201.043692555004), + TrajectoryPoint(1380, 200.27383877769), + TrajectoryPoint(1390, 199.503311658143), + TrajectoryPoint(1400, 198.732093924393), + TrajectoryPoint(1410, 197.960168106664), + TrajectoryPoint(1420, 197.18751653528), + TrajectoryPoint(1430, 196.41412133855), + TrajectoryPoint(1440, 195.639964440634), + TrajectoryPoint(1450, 194.86502755938), + TrajectoryPoint(1460, 194.089292204134), + TrajectoryPoint(1470, 193.312739673533), + TrajectoryPoint(1480, 192.535351053249), + TrajectoryPoint(1490, 191.757107213723), + TrajectoryPoint(1500, 190.977988807846), + TrajectoryPoint(1510, 190.197976268619), + TrajectoryPoint(1520, 189.417049806766), + TrajectoryPoint(1530, 188.635189408311), + TrajectoryPoint(1540, 187.852374832111), + TrajectoryPoint(1550, 187.068585607344), + TrajectoryPoint(1560, 186.283801030957), + TrajectoryPoint(1570, 185.498000165049), + TrajectoryPoint(1580, 184.711148529582), + TrajectoryPoint(1590, 183.923172746084), + TrajectoryPoint(1600, 183.134110268391), + TrajectoryPoint(1610, 182.343939013501), + TrajectoryPoint(1620, 181.552636648232), + TrajectoryPoint(1630, 180.760180586215), + TrajectoryPoint(1640, 179.966547984823), + TrajectoryPoint(1650, 179.171715742019), + TrajectoryPoint(1660, 178.375660493147), + TrajectoryPoint(1670, 177.578358607635), + TrajectoryPoint(1680, 176.779702868234), + TrajectoryPoint(1690, 175.979695890928), + TrajectoryPoint(1700, 175.178361630405), + TrajectoryPoint(1710, 174.375675161418), + TrajectoryPoint(1720, 173.571611272996), + TrajectoryPoint(1730, 172.766144464583), + TrajectoryPoint(1740, 171.95924894208), + TrajectoryPoint(1750, 171.150755281752), + TrajectoryPoint(1760, 170.340730526474), + TrajectoryPoint(1770, 169.529188210183), + TrajectoryPoint(1780, 168.716101109173), + TrajectoryPoint(1790, 167.901441682174), + TrajectoryPoint(1800, 167.085132551243), + TrajectoryPoint(1810, 166.267007960958), + TrajectoryPoint(1820, 165.447215590876), + TrajectoryPoint(1830, 164.625726352174), + TrajectoryPoint(1840, 163.802510810727), + TrajectoryPoint(1850, 162.977413672671), + TrajectoryPoint(1860, 162.150369016005), + TrajectoryPoint(1870, 161.321495447076), + TrajectoryPoint(1880, 160.490761847485), + TrajectoryPoint(1890, 159.658058361193), + TrajectoryPoint(1900, 158.823178813082), + TrajectoryPoint(1910, 157.98633026541), + TrajectoryPoint(1920, 157.147479787227), + TrajectoryPoint(1930, 156.306427523666), + TrajectoryPoint(1940, 155.463092319296), + TrajectoryPoint(1950, 154.617639370155), + TrajectoryPoint(1960, 153.770033788122), + TrajectoryPoint(1970, 152.91982704572), + TrajectoryPoint(1980, 152.067374338526), + TrajectoryPoint(1990, 151.212645789145), + TrajectoryPoint(2000, 150.35524058864), + TrajectoryPoint(2010, 149.495369413737), + TrajectoryPoint(2020, 148.633092963046), + TrajectoryPoint(2030, 147.767961702436), + TrajectoryPoint(2040, 146.900230541214), + TrajectoryPoint(2050, 146.029951428021), + TrajectoryPoint(2060, 145.156536760044), + TrajectoryPoint(2070, 144.280479753853), + TrajectoryPoint(2080, 143.401507994019), + TrajectoryPoint(2090, 142.519424218278), + TrajectoryPoint(2100, 141.634549478752), + TrajectoryPoint(2110, 140.746253149708), + TrajectoryPoint(2120, 139.854988487094), + TrajectoryPoint(2130, 138.960402140938), + TrajectoryPoint(2140, 138.062479825096), + TrajectoryPoint(2150, 137.161279290983), + TrajectoryPoint(2160, 136.25641999104), + TrajectoryPoint(2170, 135.348263735117), + TrajectoryPoint(2180, 134.436175886452), + TrajectoryPoint(2190, 133.520704055364), + TrajectoryPoint(2200, 132.601083178003), + TrajectoryPoint(2210, 131.677916562063), + TrajectoryPoint(2220, 130.750444526715), + TrajectoryPoint(2230, 129.819183436246), + TrajectoryPoint(2240, 128.883527673846), + TrajectoryPoint(2250, 127.943750721575), + TrajectoryPoint(2260, 126.999563371787), + TrajectoryPoint(2270, 126.050826153454), + TrajectoryPoint(2280, 125.097743147151), + TrajectoryPoint(2290, 124.139576811717), + TrajectoryPoint(2300, 123.176867421404), + TrajectoryPoint(2310, 122.209126581864), + TrajectoryPoint(2320, 121.236214144692), + TrajectoryPoint(2330, 120.258329453858), + TrajectoryPoint(2340, 119.274898312285), + TrajectoryPoint(2350, 118.285964412858), + TrajectoryPoint(2360, 117.291585042826), + TrajectoryPoint(2370, 116.291345919379), + TrajectoryPoint(2380, 115.284990960486), + TrajectoryPoint(2390, 114.272668253155), + TrajectoryPoint(2400, 113.254185418545), + TrajectoryPoint(2410, 112.229094936626), + TrajectoryPoint(2420, 111.197235983754), + TrajectoryPoint(2430, 110.158618097328), + TrajectoryPoint(2440, 109.113018737779), + TrajectoryPoint(2450, 108.060206467224), + TrajectoryPoint(2460, 106.999940531819), + TrajectoryPoint(2470, 105.931710389053), + TrajectoryPoint(2480, 104.8555402798), + TrajectoryPoint(2490, 103.771173115263), + TrajectoryPoint(2500, 102.67832904986), + TrajectoryPoint(2510, 101.576716587537), + TrajectoryPoint(2520, 100.466031996438), + TrajectoryPoint(2530, 99.3459586867462), + TrajectoryPoint(2540, 98.2161665490744), + TrajectoryPoint(2550, 97.076311250512), + TrajectoryPoint(2560, 95.926033485212), + TrajectoryPoint(2570, 94.7649581761222), + TrajectoryPoint(2580, 93.5926936241699), + TrajectoryPoint(2590, 92.4085885526906), + TrajectoryPoint(2600, 91.2122286432315), + TrajectoryPoint(2610, 90.0033071241473), + TrajectoryPoint(2620, 88.7813501596466), + TrajectoryPoint(2630, 87.5458616994635), + TrajectoryPoint(2640, 86.2955277015047), + TrajectoryPoint(2650, 85.0304416724909), + TrajectoryPoint(2660, 83.7500660901069), + TrajectoryPoint(2670, 82.4526376231376), + TrajectoryPoint(2680, 81.138506002907), + TrajectoryPoint(2690, 79.8060316280253), + TrajectoryPoint(2700, 78.4548544559544), + TrajectoryPoint(2710, 77.0833491215566), + TrajectoryPoint(2720, 75.6912631159369), + TrajectoryPoint(2730, 74.2763147628683), + TrajectoryPoint(2740, 72.8379622070132), + TrajectoryPoint(2750, 71.3747847238537), + TrajectoryPoint(2760, 69.8850796672856), + TrajectoryPoint(2770, 68.3667436252194), + TrajectoryPoint(2780, 66.8180914803195), + TrajectoryPoint(2790, 65.2370678792598), + TrajectoryPoint(2800, 63.6211983508568), + TrajectoryPoint(2810, 61.967306071852), + TrajectoryPoint(2820, 60.2727624445349), + TrajectoryPoint(2830, 58.5343327445673), + TrajectoryPoint(2840, 56.7470975638771), + TrajectoryPoint(2850, 54.9072093065608), + TrajectoryPoint(2860, 53.0080691336017), + TrajectoryPoint(2870, 51.0440390860303), + TrajectoryPoint(2880, 49.0069949240363), + TrajectoryPoint(2890, 46.8874284549086), + TrajectoryPoint(2900, 44.6741420541467), + TrajectoryPoint(2910, 42.3505537876965), + TrajectoryPoint(2920, 39.8994760374335), + TrajectoryPoint(2930, 37.2951382986628), + TrajectoryPoint(2940, 34.5030375772815), + TrajectoryPoint(2950, 31.4726820422002), + TrajectoryPoint(2960, 28.1286236704261), + TrajectoryPoint(2970, 24.3392226136914), + TrajectoryPoint(2980, 19.8552497352213), + TrajectoryPoint(2990, 14.0247510000792), TrajectoryPoint(3000, 0), }; TrajectoryPoint t1_closed[] = { - TrajectoryPoint(0, 290.829077875845), - TrajectoryPoint(10, 290.122172054902), - TrajectoryPoint(20, 289.417015425694), - TrajectoryPoint(30, 288.712681652409), - TrajectoryPoint(40, 288.009090411237), - TrajectoryPoint(50, 287.306575566213), - TrajectoryPoint(60, 286.604955600667), - TrajectoryPoint(70, 285.904016310454), - TrajectoryPoint(80, 285.203904889002), - TrajectoryPoint(90, 284.504762210305), - TrajectoryPoint(100, 283.806241375245), - TrajectoryPoint(110, 283.108339356948), - TrajectoryPoint(120, 282.411426891841), - TrajectoryPoint(130, 281.715105784861), - TrajectoryPoint(140, 281.019347001664), - TrajectoryPoint(150, 280.324320518395), - TrajectoryPoint(160, 279.629993971235), - TrajectoryPoint(170, 278.936176071407), - TrajectoryPoint(180, 278.242861849887), - TrajectoryPoint(190, 277.550330696212), - TrajectoryPoint(200, 276.858263577897), - TrajectoryPoint(210, 276.166648858561), - TrajectoryPoint(220, 275.475577471328), - TrajectoryPoint(230, 274.785082243284), - TrajectoryPoint(240, 274.094990631664), - TrajectoryPoint(250, 273.405296556451), - TrajectoryPoint(260, 272.716137305278), - TrajectoryPoint(270, 272.027402462398), - TrajectoryPoint(280, 271.339018608207), - TrajectoryPoint(290, 270.650979032165), - TrajectoryPoint(300, 269.963428352593), - TrajectoryPoint(310, 269.276199688281), - TrajectoryPoint(320, 268.58927089732), - TrajectoryPoint(330, 267.902638402271), - TrajectoryPoint(340, 267.216418064091), - TrajectoryPoint(350, 266.530455149956), - TrajectoryPoint(360, 265.844742552838), - TrajectoryPoint(370, 265.159274959654), - TrajectoryPoint(380, 264.474140252046), - TrajectoryPoint(390, 263.789215233555), - TrajectoryPoint(400, 263.104492503099), - TrajectoryPoint(410, 262.419964350752), - TrajectoryPoint(420, 261.735687838805), - TrajectoryPoint(430, 261.051584197904), - TrajectoryPoint(440, 260.367636256453), - TrajectoryPoint(450, 259.683836135295), - TrajectoryPoint(460, 259.000206047323), - TrajectoryPoint(470, 258.316717367152), - TrajectoryPoint(480, 257.633339113222), - TrajectoryPoint(490, 256.950063274559), - TrajectoryPoint(500, 256.266886049725), - TrajectoryPoint(510, 255.583814805828), - TrajectoryPoint(520, 254.900809880192), - TrajectoryPoint(530, 254.217863149985), - TrajectoryPoint(540, 253.534966317164), - TrajectoryPoint(550, 252.852115469077), - TrajectoryPoint(560, 252.169295073575), - TrajectoryPoint(570, 251.486489660126), - TrajectoryPoint(580, 250.803690845035), - TrajectoryPoint(590, 250.120890099958), - TrajectoryPoint(600, 249.438073589924), - TrajectoryPoint(610, 248.755227958891), - TrajectoryPoint(620, 248.072346441901), - TrajectoryPoint(630, 247.389420428771), - TrajectoryPoint(640, 246.706441184727), - TrajectoryPoint(650, 246.023389640157), - TrajectoryPoint(660, 245.340249714397), - TrajectoryPoint(670, 244.657023333154), - TrajectoryPoint(680, 243.973701668469), - TrajectoryPoint(690, 243.290275780156), - TrajectoryPoint(700, 242.606736620884), - TrajectoryPoint(710, 241.923040328153), - TrajectoryPoint(720, 241.23920538233), - TrajectoryPoint(730, 240.555224440028), - TrajectoryPoint(740, 239.871088341122), - TrajectoryPoint(750, 239.186787823495), - TrajectoryPoint(760, 238.502312831033), - TrajectoryPoint(770, 237.817608922812), - TrajectoryPoint(780, 237.132708127409), - TrajectoryPoint(790, 236.447601039962), - TrajectoryPoint(800, 235.762278155135), - TrajectoryPoint(810, 235.076729869037), - TrajectoryPoint(820, 234.39094648083), - TrajectoryPoint(830, 233.704891884481), - TrajectoryPoint(840, 233.018554126146), - TrajectoryPoint(850, 232.331948690626), - TrajectoryPoint(860, 231.645065695013), - TrajectoryPoint(870, 230.957895156788), - TrajectoryPoint(880, 230.270426994446), - TrajectoryPoint(890, 229.582651027917), - TrajectoryPoint(900, 228.894548232979), - TrajectoryPoint(910, 228.206068791782), - TrajectoryPoint(920, 227.517248524449), - TrajectoryPoint(930, 226.828077023166), - TrajectoryPoint(940, 226.138543776481), - TrajectoryPoint(950, 225.448638169104), - TrajectoryPoint(960, 224.758349481575), - TrajectoryPoint(970, 224.0676668898), - TrajectoryPoint(980, 223.376579464479), - TrajectoryPoint(990, 222.685050692273), - TrajectoryPoint(1000, 221.993064690274), - TrajectoryPoint(1010, 221.300639720334), - TrajectoryPoint(1020, 220.607764565613), - TrajectoryPoint(1030, 219.914427897154), - TrajectoryPoint(1040, 219.220618272985), - TrajectoryPoint(1050, 218.526324137143), - TrajectoryPoint(1060, 217.831533818629), - TrajectoryPoint(1070, 217.136235530293), - TrajectoryPoint(1080, 216.440417367657), - TrajectoryPoint(1090, 215.744067307687), - TrajectoryPoint(1100, 215.0471732075), - TrajectoryPoint(1110, 214.349681234015), - TrajectoryPoint(1120, 213.651617827089), - TrajectoryPoint(1130, 212.952973951545), - TrajectoryPoint(1140, 212.25373709601), - TrajectoryPoint(1150, 211.553894621211), - TrajectoryPoint(1160, 210.853433758546), - TrajectoryPoint(1170, 210.152341608619), - TrajectoryPoint(1180, 209.450605139728), - TrajectoryPoint(1190, 208.748211186327), - TrajectoryPoint(1200, 208.045146447444), - TrajectoryPoint(1210, 207.341397485074), - TrajectoryPoint(1220, 206.63695072253), - TrajectoryPoint(1230, 205.931792442771), - TrajectoryPoint(1240, 205.225908786697), - TrajectoryPoint(1250, 204.519285751413), - TrajectoryPoint(1260, 203.811909188463), - TrajectoryPoint(1270, 203.103764802039), - TrajectoryPoint(1280, 202.39483814716), - TrajectoryPoint(1290, 201.685114627816), - TrajectoryPoint(1300, 200.974579495099), - TrajectoryPoint(1310, 200.263217845284), - TrajectoryPoint(1320, 199.551014617905), - TrajectoryPoint(1330, 198.83795459378), - TrajectoryPoint(1340, 198.124022393023), - TrajectoryPoint(1350, 197.409202473016), - TrajectoryPoint(1360, 196.693479126357), - TrajectoryPoint(1370, 195.976836478773), - TrajectoryPoint(1380, 195.259258487002), - TrajectoryPoint(1390, 194.540728936648), - TrajectoryPoint(1400, 193.821231439988), - TrajectoryPoint(1410, 193.100749433768), - TrajectoryPoint(1420, 192.379266176939), - TrajectoryPoint(1430, 191.656764748376), - TrajectoryPoint(1440, 190.933228044551), - TrajectoryPoint(1450, 190.20863877717), - TrajectoryPoint(1460, 189.482979470771), - TrajectoryPoint(1470, 188.756232460279), - TrajectoryPoint(1480, 188.028379888526), - TrajectoryPoint(1490, 187.299403703721), - TrajectoryPoint(1500, 186.569285656882), - TrajectoryPoint(1510, 185.838007299214), - TrajectoryPoint(1520, 185.105507192333), - TrajectoryPoint(1530, 184.371765601887), - TrajectoryPoint(1540, 183.636801220906), - TrajectoryPoint(1550, 182.900594630179), - TrajectoryPoint(1560, 182.163126195348), - TrajectoryPoint(1570, 181.424376063945), - TrajectoryPoint(1580, 180.684324162368), - TrajectoryPoint(1590, 179.942950192808), - TrajectoryPoint(1600, 179.200233630109), - TrajectoryPoint(1610, 178.456153718572), - TrajectoryPoint(1620, 177.710613893524), - TrajectoryPoint(1630, 176.963598576561), - TrajectoryPoint(1640, 176.215148726596), - TrajectoryPoint(1650, 175.465242470346), - TrajectoryPoint(1660, 174.713857684942), - TrajectoryPoint(1670, 173.96097199428), - TrajectoryPoint(1680, 173.206562765285), - TrajectoryPoint(1690, 172.4505311038), - TrajectoryPoint(1700, 171.692810521247), - TrajectoryPoint(1710, 170.933488157364), - TrajectoryPoint(1720, 170.172540133522), - TrajectoryPoint(1730, 169.409942291753), - TrajectoryPoint(1740, 168.64567019047), - TrajectoryPoint(1750, 167.879554206843), - TrajectoryPoint(1760, 167.111614131452), - TrajectoryPoint(1770, 166.34191476266), - TrajectoryPoint(1780, 165.570430283399), - TrajectoryPoint(1790, 164.797134567163), - TrajectoryPoint(1800, 164.021816777897), - TrajectoryPoint(1810, 163.244527411786), - TrajectoryPoint(1820, 162.465335453913), - TrajectoryPoint(1830, 161.684213275933), - TrajectoryPoint(1840, 160.901044112436), - TrajectoryPoint(1850, 160.115645042362), - TrajectoryPoint(1860, 159.328218769358), - TrajectoryPoint(1870, 158.53873604667), - TrajectoryPoint(1880, 157.747046321975), - TrajectoryPoint(1890, 156.952984241906), - TrajectoryPoint(1900, 156.15676266115), - TrajectoryPoint(1910, 155.358350584961), - TrajectoryPoint(1920, 154.557416650126), - TrajectoryPoint(1930, 153.754102012342), - TrajectoryPoint(1940, 152.948487268968), - TrajectoryPoint(1950, 152.140359660956), - TrajectoryPoint(1960, 151.329578949268), - TrajectoryPoint(1970, 150.516383010107), - TrajectoryPoint(1980, 149.700589632649), - TrajectoryPoint(1990, 148.881949787186), - TrajectoryPoint(2000, 148.060773715051), - TrajectoryPoint(2010, 147.23681120013), - TrajectoryPoint(2020, 146.409897777274), - TrajectoryPoint(2030, 145.580320852129), - TrajectoryPoint(2040, 144.747652426745), - TrajectoryPoint(2050, 143.912028131551), - TrajectoryPoint(2060, 143.073559183707), - TrajectoryPoint(2070, 142.231659479903), - TrajectoryPoint(2080, 141.386862559265), - TrajectoryPoint(2090, 140.538704393667), - TrajectoryPoint(2100, 139.687290783155), - TrajectoryPoint(2110, 138.832628253849), - TrajectoryPoint(2120, 137.974346110366), - TrajectoryPoint(2130, 137.112871033484), - TrajectoryPoint(2140, 136.247457672887), - TrajectoryPoint(2150, 135.378777012577), - TrajectoryPoint(2160, 134.506027212234), - TrajectoryPoint(2170, 133.629822593518), - TrajectoryPoint(2180, 132.74942754111), - TrajectoryPoint(2190, 131.865407817577), - TrajectoryPoint(2200, 130.977000888017), - TrajectoryPoint(2210, 130.084860666808), - TrajectoryPoint(2220, 129.188057115323), - TrajectoryPoint(2230, 128.287304916148), - TrajectoryPoint(2240, 127.381871800353), - TrajectoryPoint(2250, 126.472088647913), - TrajectoryPoint(2260, 125.557684168049), - TrajectoryPoint(2270, 124.638428526806), - TrajectoryPoint(2280, 123.714631056739), - TrajectoryPoint(2290, 122.785501210383), - TrajectoryPoint(2300, 121.851503075104), - TrajectoryPoint(2310, 120.912440830451), - TrajectoryPoint(2320, 119.967735287543), - TrajectoryPoint(2330, 119.017796100875), - TrajectoryPoint(2340, 118.062388321257), - TrajectoryPoint(2350, 117.100901468559), - TrajectoryPoint(2360, 116.133708726001), - TrajectoryPoint(2370, 115.160636824536), - TrajectoryPoint(2380, 114.181194958593), - TrajectoryPoint(2390, 113.195309277643), - TrajectoryPoint(2400, 112.203005205245), - TrajectoryPoint(2410, 111.204083201297), - TrajectoryPoint(2420, 110.198295295584), - TrajectoryPoint(2430, 109.185121788222), - TrajectoryPoint(2440, 108.164712722323), - TrajectoryPoint(2450, 107.136837632749), - TrajectoryPoint(2460, 106.101256915076), - TrajectoryPoint(2470, 105.057721388591), - TrajectoryPoint(2480, 104.005971833185), - TrajectoryPoint(2490, 102.945738498333), - TrajectoryPoint(2500, 101.876740582235), - TrajectoryPoint(2510, 100.798685679019), - TrajectoryPoint(2520, 99.7112691917454), - TrajectoryPoint(2530, 98.6141737087591), - TrajectoryPoint(2540, 97.5070683407233), - TrajectoryPoint(2550, 96.3896080154607), - TrajectoryPoint(2560, 95.2614327274642), - TrajectoryPoint(2570, 94.1221667386778), - TrajectoryPoint(2580, 92.9714177268462), - TrajectoryPoint(2590, 91.8087758774081), - TrajectoryPoint(2600, 90.6338129145457), - TrajectoryPoint(2610, 89.4458787073954), - TrajectoryPoint(2620, 88.2442247651321), - TrajectoryPoint(2630, 87.0287420336022), - TrajectoryPoint(2640, 85.7989105704131), - TrajectoryPoint(2650, 84.5534152660321), - TrajectoryPoint(2660, 83.2921150807374), - TrajectoryPoint(2670, 82.014401350699), - TrajectoryPoint(2680, 80.7187073523509), - TrajectoryPoint(2690, 79.4052657110939), - TrajectoryPoint(2700, 78.0718839085126), - TrajectoryPoint(2710, 76.7187188147948), - TrajectoryPoint(2720, 75.3439262036785), - TrajectoryPoint(2730, 73.9464719823418), - TrajectoryPoint(2740, 72.5253960116352), - TrajectoryPoint(2750, 71.0790628106865), - TrajectoryPoint(2760, 69.605352224911), - TrajectoryPoint(2770, 68.1030785439597), - TrajectoryPoint(2780, 66.5702415163878), - TrajectoryPoint(2790, 65.0046553770575), - TrajectoryPoint(2800, 63.4039270807116), - TrajectoryPoint(2810, 61.7652383944638), - TrajectoryPoint(2820, 60.0849510939485), - TrajectoryPoint(2830, 58.3603874267216), - TrajectoryPoint(2840, 56.5871637456788), - TrajectoryPoint(2850, 54.7603182114602), - TrajectoryPoint(2860, 52.8743051150524), - TrajectoryPoint(2870, 50.9229401999799), - TrajectoryPoint(2880, 48.8980914998915), - TrajectoryPoint(2890, 46.7902437443092), - TrajectoryPoint(2900, 44.5881928976516), - TrajectoryPoint(2910, 42.2757031657274), - TrajectoryPoint(2920, 39.8351667536236), - TrajectoryPoint(2930, 37.2407994157408), - TrajectoryPoint(2940, 34.4583574305346), - TrajectoryPoint(2950, 31.4369990092808), - TrajectoryPoint(2960, 28.101257203988), - TrajectoryPoint(2970, 24.3198210242276), - TrajectoryPoint(2980, 19.8430839205536), - TrajectoryPoint(2990, 14.019128463856), + TrajectoryPoint(0, 305.403968186833), + TrajectoryPoint(10, 304.581576679633), + TrajectoryPoint(20, 303.761136416585), + TrajectoryPoint(30, 302.942994082006), + TrajectoryPoint(40, 302.127968384364), + TrajectoryPoint(50, 301.314624578058), + TrajectoryPoint(60, 300.503448651674), + TrajectoryPoint(70, 299.695032528678), + TrajectoryPoint(80, 298.888174537767), + TrajectoryPoint(90, 298.083285690558), + TrajectoryPoint(100, 297.280914141219), + TrajectoryPoint(110, 296.479983048595), + TrajectoryPoint(120, 295.680776108168), + TrajectoryPoint(130, 294.883931043683), + TrajectoryPoint(140, 294.088415117653), + TrajectoryPoint(150, 293.294349456664), + TrajectoryPoint(160, 292.502555702974), + TrajectoryPoint(170, 291.711986187563), + TrajectoryPoint(180, 290.922645155959), + TrajectoryPoint(190, 290.135399114061), + TrajectoryPoint(200, 289.349346345444), + TrajectoryPoint(210, 288.564421172332), + TrajectoryPoint(220, 287.781196463467), + TrajectoryPoint(230, 286.999266299721), + TrajectoryPoint(240, 286.218369505369), + TrajectoryPoint(250, 285.438794353685), + TrajectoryPoint(260, 284.660624899825), + TrajectoryPoint(270, 283.883400879259), + TrajectoryPoint(280, 283.107139396789), + TrajectoryPoint(290, 282.332398004673), + TrajectoryPoint(300, 281.558520004984), + TrajectoryPoint(310, 280.785500951448), + TrajectoryPoint(320, 280.01364853279), + TrajectoryPoint(330, 279.242815896955), + TrajectoryPoint(340, 278.47276514311), + TrajectoryPoint(350, 277.703517550187), + TrajectoryPoint(360, 276.935453203186), + TrajectoryPoint(370, 276.1680989069), + TrajectoryPoint(380, 275.401447933884), + TrajectoryPoint(390, 274.63566442709), + TrajectoryPoint(400, 273.870755597288), + TrajectoryPoint(410, 273.106482982722), + TrajectoryPoint(420, 272.342838709161), + TrajectoryPoint(430, 271.580047356515), + TrajectoryPoint(440, 270.817925312298), + TrajectoryPoint(450, 270.05636904278), + TrajectoryPoint(460, 269.295369959278), + TrajectoryPoint(470, 268.535156203733), + TrajectoryPoint(480, 267.775480633393), + TrajectoryPoint(490, 267.016303926207), + TrajectoryPoint(500, 266.257617073579), + TrajectoryPoint(510, 265.499614579316), + TrajectoryPoint(520, 264.742070895729), + TrajectoryPoint(530, 263.984962619872), + TrajectoryPoint(540, 263.228280516812), + TrajectoryPoint(550, 262.472163522262), + TrajectoryPoint(560, 261.716460091284), + TrajectoryPoint(570, 260.961131858762), + TrajectoryPoint(580, 260.206169483201), + TrajectoryPoint(590, 259.451646387457), + TrajectoryPoint(600, 258.697511783859), + TrajectoryPoint(610, 257.943695118475), + TrajectoryPoint(620, 257.190187009401), + TrajectoryPoint(630, 256.436994975112), + TrajectoryPoint(640, 255.684175333625), + TrajectoryPoint(650, 254.931618970678), + TrajectoryPoint(660, 254.179316491538), + TrajectoryPoint(670, 253.427258261951), + TrajectoryPoint(680, 252.675473394565), + TrajectoryPoint(690, 251.923940743777), + TrajectoryPoint(700, 251.172609530897), + TrajectoryPoint(710, 250.421470142706), + TrajectoryPoint(720, 249.670512780101), + TrajectoryPoint(730, 248.919757414667), + TrajectoryPoint(740, 248.169175021903), + TrajectoryPoint(750, 247.418733825737), + TrajectoryPoint(760, 246.668424037443), + TrajectoryPoint(770, 245.918235714503), + TrajectoryPoint(780, 245.168169391196), + TrajectoryPoint(790, 244.418215099481), + TrajectoryPoint(800, 243.66834294947), + TrajectoryPoint(810, 242.918542971368), + TrajectoryPoint(820, 242.168805058941), + TrajectoryPoint(830, 241.419118977381), + TrajectoryPoint(840, 240.669479239352), + TrajectoryPoint(850, 239.919865629166), + TrajectoryPoint(860, 239.170265627571), + TrajectoryPoint(870, 238.420668919337), + TrajectoryPoint(880, 237.671065065199), + TrajectoryPoint(890, 236.921443506018), + TrajectoryPoint(900, 236.171787425829), + TrajectoryPoint(910, 235.422084039558), + TrajectoryPoint(920, 234.672325273141), + TrajectoryPoint(930, 233.922500418388), + TrajectoryPoint(940, 233.172598644336), + TrajectoryPoint(950, 232.422608999077), + TrajectoryPoint(960, 231.672520411104), + TrajectoryPoint(970, 230.922304159114), + TrajectoryPoint(980, 230.171957369825), + TrajectoryPoint(990, 229.421473903466), + TrajectoryPoint(1000, 228.670842458191), + TrajectoryPoint(1010, 227.920051604687), + TrajectoryPoint(1020, 227.169089786259), + TrajectoryPoint(1030, 226.417945318631), + TrajectoryPoint(1040, 225.666606389508), + TrajectoryPoint(1050, 224.915037743256), + TrajectoryPoint(1060, 224.163239993865), + TrajectoryPoint(1070, 223.411209225895), + TrajectoryPoint(1080, 222.658933306377), + TrajectoryPoint(1090, 221.906399964108), + TrajectoryPoint(1100, 221.153596788652), + TrajectoryPoint(1110, 220.400511229207), + TrajectoryPoint(1120, 219.647130593357), + TrajectoryPoint(1130, 218.893442045702), + TrajectoryPoint(1140, 218.139432606409), + TrajectoryPoint(1150, 217.385073503648), + TrajectoryPoint(1160, 216.63034866581), + TrajectoryPoint(1170, 215.875262396753), + TrajectoryPoint(1180, 215.11980129404), + TrajectoryPoint(1190, 214.363951800138), + TrajectoryPoint(1200, 213.607700200825), + TrajectoryPoint(1210, 212.85103262356), + TrajectoryPoint(1220, 212.09393503579), + TrajectoryPoint(1230, 211.336393243231), + TrajectoryPoint(1240, 210.578392888103), + TrajectoryPoint(1250, 209.819919447337), + TrajectoryPoint(1260, 209.060958230753), + TrajectoryPoint(1270, 208.301494379217), + TrajectoryPoint(1280, 207.541512862765), + TrajectoryPoint(1290, 206.780998478723), + TrajectoryPoint(1300, 206.019935849794), + TrajectoryPoint(1310, 205.258309422135), + TrajectoryPoint(1320, 204.496103463418), + TrajectoryPoint(1330, 203.733302060871), + TrajectoryPoint(1340, 202.969889119311), + TrajectoryPoint(1350, 202.205848359156), + TrajectoryPoint(1360, 201.441163314423), + TrajectoryPoint(1370, 200.675817330712), + TrajectoryPoint(1380, 199.909793563173), + TrajectoryPoint(1390, 199.143074974455), + TrajectoryPoint(1400, 198.37564433264), + TrajectoryPoint(1410, 197.607484209151), + TrajectoryPoint(1420, 196.83857697665), + TrajectoryPoint(1430, 196.068904806902), + TrajectoryPoint(1440, 195.298449668627), + TrajectoryPoint(1450, 194.527193325319), + TrajectoryPoint(1460, 193.755117333042), + TrajectoryPoint(1470, 192.982203038195), + TrajectoryPoint(1480, 192.20843157525), + TrajectoryPoint(1490, 191.433783864454), + TrajectoryPoint(1500, 190.658240609497), + TrajectoryPoint(1510, 189.881782295149), + TrajectoryPoint(1520, 189.104389184849), + TrajectoryPoint(1530, 188.326041318262), + TrajectoryPoint(1540, 187.546718508787), + TrajectoryPoint(1550, 186.766400341022), + TrajectoryPoint(1560, 185.985066168183), + TrajectoryPoint(1570, 185.202695109474), + TrajectoryPoint(1580, 184.419266047396), + TrajectoryPoint(1590, 183.634757625016), + TrajectoryPoint(1600, 182.849128030464), + TrajectoryPoint(1610, 182.062303472391), + TrajectoryPoint(1620, 181.274327430929), + TrajectoryPoint(1630, 180.485177383132), + TrajectoryPoint(1640, 179.694830550388), + TrajectoryPoint(1650, 178.903263895252), + TrajectoryPoint(1660, 178.110454118201), + TrajectoryPoint(1670, 177.316377654314), + TrajectoryPoint(1680, 176.521010669877), + TrajectoryPoint(1690, 175.724263891668), + TrajectoryPoint(1700, 174.926093209432), + TrajectoryPoint(1710, 174.126550480556), + TrajectoryPoint(1720, 173.325610563398), + TrajectoryPoint(1730, 172.523248027045), + TrajectoryPoint(1740, 171.719437147329), + TrajectoryPoint(1750, 170.914151902741), + TrajectoryPoint(1760, 170.107186067922), + TrajectoryPoint(1770, 169.298667321345), + TrajectoryPoint(1780, 168.488584399946), + TrajectoryPoint(1790, 167.67690983466), + TrajectoryPoint(1800, 166.863615834288), + TrajectoryPoint(1810, 166.048544749098), + TrajectoryPoint(1820, 165.231676766241), + TrajectoryPoint(1830, 164.413092851627), + TrajectoryPoint(1840, 163.592763644637), + TrajectoryPoint(1850, 162.770659433923), + TrajectoryPoint(1860, 161.9464917377), + TrajectoryPoint(1870, 161.12044472446), + TrajectoryPoint(1880, 160.292518956399), + TrajectoryPoint(1890, 159.462683011726), + TrajectoryPoint(1900, 158.630648129846), + TrajectoryPoint(1910, 157.796548206442), + TrajectoryPoint(1920, 156.960427900257), + TrajectoryPoint(1930, 156.122240476775), + TrajectoryPoint(1940, 155.281595104699), + TrajectoryPoint(1950, 154.438813737489), + TrajectoryPoint(1960, 153.593861560646), + TrajectoryPoint(1970, 152.746438917312), + TrajectoryPoint(1980, 151.896599649548), + TrajectoryPoint(1990, 151.044466566853), + TrajectoryPoint(2000, 150.18978618549), + TrajectoryPoint(2010, 149.332470777916), + TrajectoryPoint(2020, 148.472732326945), + TrajectoryPoint(2030, 147.610266205406), + TrajectoryPoint(2040, 146.745033627655), + TrajectoryPoint(2050, 145.877242136387), + TrajectoryPoint(2060, 145.006426015128), + TrajectoryPoint(2070, 144.132810910139), + TrajectoryPoint(2080, 143.25640566241), + TrajectoryPoint(2090, 142.376724840643), + TrajectoryPoint(2100, 141.494235830988), + TrajectoryPoint(2110, 140.608445512865), + TrajectoryPoint(2120, 139.719527947732), + TrajectoryPoint(2130, 138.827408421704), + TrajectoryPoint(2140, 137.931794758649), + TrajectoryPoint(2150, 137.033021608815), + TrajectoryPoint(2160, 136.130432710308), + TrajectoryPoint(2170, 135.224641178948), + TrajectoryPoint(2180, 134.314808688179), + TrajectoryPoint(2190, 133.40162417822), + TrajectoryPoint(2200, 132.48425837505), + TrajectoryPoint(2210, 131.563371327805), + TrajectoryPoint(2220, 130.638084477035), + TrajectoryPoint(2230, 129.70909115905), + TrajectoryPoint(2240, 128.775554806531), + TrajectoryPoint(2250, 127.838005381501), + TrajectoryPoint(2260, 126.895900210469), + TrajectoryPoint(2270, 125.949350179873), + TrajectoryPoint(2280, 124.998312331005), + TrajectoryPoint(2290, 124.042292767725), + TrajectoryPoint(2300, 123.081710473286), + TrajectoryPoint(2310, 122.1159571816), + TrajectoryPoint(2320, 121.145131231294), + TrajectoryPoint(2330, 120.169313067938), + TrajectoryPoint(2340, 119.18781228282), + TrajectoryPoint(2350, 118.200904158946), + TrajectoryPoint(2360, 117.208530362102), + TrajectoryPoint(2370, 116.21016483312), + TrajectoryPoint(2380, 115.205774596764), + TrajectoryPoint(2390, 114.195396202233), + TrajectoryPoint(2400, 113.178837161236), + TrajectoryPoint(2410, 112.155543558444), + TrajectoryPoint(2420, 111.125567422517), + TrajectoryPoint(2430, 110.088811671619), + TrajectoryPoint(2440, 109.045053675727), + TrajectoryPoint(2450, 107.994061911874), + TrajectoryPoint(2460, 106.935508380714), + TrajectoryPoint(2470, 105.869046017543), + TrajectoryPoint(2480, 104.794634375933), + TrajectoryPoint(2490, 103.712004640545), + TrajectoryPoint(2500, 102.620876901073), + TrajectoryPoint(2510, 101.52095960111), + TrajectoryPoint(2520, 100.411948952653), + TrajectoryPoint(2530, 99.29352831381), + TrajectoryPoint(2540, 98.1653675270496), + TrajectoryPoint(2550, 97.027122215126), + TrajectoryPoint(2560, 95.8784330315476), + TrajectoryPoint(2570, 94.7189248621988), + TrajectoryPoint(2580, 93.5482059744221), + TrajectoryPoint(2590, 92.3657045908552), + TrajectoryPoint(2600, 91.1708452069898), + TrajectoryPoint(2610, 89.9634025823569), + TrajectoryPoint(2620, 88.7429028629317), + TrajectoryPoint(2630, 87.5088499832026), + TrajectoryPoint(2640, 86.2600011644767), + TrajectoryPoint(2650, 84.9963048390703), + TrajectoryPoint(2660, 83.7172972049136), + TrajectoryPoint(2670, 82.4212812238729), + TrajectoryPoint(2680, 81.1084712861158), + TrajectoryPoint(2690, 79.7773601103479), + TrajectoryPoint(2700, 78.4274580969371), + TrajectoryPoint(2710, 77.0572659674235), + TrajectoryPoint(2720, 75.6664675619107), + TrajectoryPoint(2730, 74.2527226188677), + TrajectoryPoint(2740, 72.8156066217882), + TrajectoryPoint(2750, 71.3536393938848), + TrajectoryPoint(2760, 69.8651180280093), + TrajectoryPoint(2770, 68.3478877988411), + TrajectoryPoint(2780, 66.800367129019), + TrajectoryPoint(2790, 65.2204478978201), + TrajectoryPoint(2800, 63.6057011765181), + TrajectoryPoint(2810, 61.9528564109668), + TrajectoryPoint(2820, 60.2593324958471), + TrajectoryPoint(2830, 58.52189455115), + TrajectoryPoint(2840, 56.7356612981212), + TrajectoryPoint(2850, 54.8967058800154), + TrajectoryPoint(2860, 52.9985044094041), + TrajectoryPoint(2870, 51.0353800600489), + TrajectoryPoint(2880, 48.9992080420685), + TrajectoryPoint(2890, 46.8804796579768), + TrajectoryPoint(2900, 44.6679968243362), + TrajectoryPoint(2910, 42.3452022788805), + TrajectoryPoint(2920, 39.8948784486615), + TrajectoryPoint(2930, 37.2912538311726), + TrajectoryPoint(2940, 34.4998439063973), + TrajectoryPoint(2950, 31.4701318537055), + TrajectoryPoint(2960, 28.1266682613903), + TrajectoryPoint(2970, 24.3378366964697), + TrajectoryPoint(2980, 19.8543810300786), + TrajectoryPoint(2990, 14.0243497478722), TrajectoryPoint(3000, 0), }; TrajectoryPoint t2_closed[] = { - TrajectoryPoint(0, 289.990532647539), - TrajectoryPoint(10, 289.290629334632), - TrajectoryPoint(20, 288.591524150995), - TrajectoryPoint(30, 287.893139205481), - TrajectoryPoint(40, 287.195935188177), - TrajectoryPoint(50, 286.499447145895), - TrajectoryPoint(60, 285.80361876589), - TrajectoryPoint(70, 285.108716919421), - TrajectoryPoint(80, 284.414616111409), - TrajectoryPoint(90, 283.72111733734), - TrajectoryPoint(100, 283.028305908279), - TrajectoryPoint(110, 282.336376766393), - TrajectoryPoint(120, 281.644994825122), - TrajectoryPoint(130, 280.95415627984), - TrajectoryPoint(140, 280.264118377312), - TrajectoryPoint(150, 279.574653525184), - TrajectoryPoint(160, 278.885679483621), - TrajectoryPoint(170, 278.197269942942), - TrajectoryPoint(180, 277.509534392015), - TrajectoryPoint(190, 276.822239615796), - TrajectoryPoint(200, 276.135380289327), - TrajectoryPoint(210, 275.449113629437), - TrajectoryPoint(220, 274.763323659928), - TrajectoryPoint(230, 274.077921314087), - TrajectoryPoint(240, 273.392900446543), - TrajectoryPoint(250, 272.708449809811), - TrajectoryPoint(260, 272.024342074227), - TrajectoryPoint(270, 271.340570164451), - TrajectoryPoint(280, 270.657164681517), - TrajectoryPoint(290, 269.974198011273), - TrajectoryPoint(300, 269.291523580107), - TrajectoryPoint(310, 268.609134666897), - TrajectoryPoint(320, 267.927069649664), - TrajectoryPoint(330, 267.245349080588), - TrajectoryPoint(340, 266.563872345745), - TrajectoryPoint(350, 265.882632346677), - TrajectoryPoint(360, 265.201657131346), - TrajectoryPoint(370, 264.520957818512), - TrajectoryPoint(380, 263.840455322292), - TrajectoryPoint(390, 263.160142268207), - TrajectoryPoint(400, 262.480027897729), - TrajectoryPoint(410, 261.800136004061), - TrajectoryPoint(420, 261.120395239726), - TrajectoryPoint(430, 260.440798023814), - TrajectoryPoint(440, 259.761336527479), - TrajectoryPoint(450, 259.082045843505), - TrajectoryPoint(460, 258.402864059875), - TrajectoryPoint(470, 257.723781206795), - TrajectoryPoint(480, 257.04478933079), - TrajectoryPoint(490, 256.365893858026), - TrajectoryPoint(500, 255.687076890643), - TrajectoryPoint(510, 255.008315364283), - TrajectoryPoint(520, 254.329601218851), - TrajectoryPoint(530, 253.650926225461), - TrajectoryPoint(540, 252.972286353988), - TrajectoryPoint(550, 252.293660416161), - TrajectoryPoint(560, 251.615039235209), - TrajectoryPoint(570, 250.936414499555), - TrajectoryPoint(580, 250.257777392541), - TrajectoryPoint(590, 249.579107520317), - TrajectoryPoint(600, 248.900400574317), - TrajectoryPoint(610, 248.221648151675), - TrajectoryPoint(620, 247.54284172103), - TrajectoryPoint(630, 246.863972630215), - TrajectoryPoint(640, 246.185007937019), - TrajectoryPoint(650, 245.505954714799), - TrajectoryPoint(660, 244.826806064946), - TrajectoryPoint(670, 244.147553243614), - TrajectoryPoint(680, 243.468187397823), - TrajectoryPoint(690, 242.788682034575), - TrajectoryPoint(700, 242.109022336875), - TrajectoryPoint(710, 241.429217331709), - TrajectoryPoint(720, 240.749258053238), - TrajectoryPoint(730, 240.069135432812), - TrajectoryPoint(740, 239.388840302282), - TrajectoryPoint(750, 238.708334729357), - TrajectoryPoint(760, 238.027616389498), - TrajectoryPoint(770, 237.346693489852), - TrajectoryPoint(780, 236.665556721415), - TrajectoryPoint(790, 235.984196676983), - TrajectoryPoint(800, 235.302603852965), - TrajectoryPoint(810, 234.620758226245), - TrajectoryPoint(820, 233.938615799731), - TrajectoryPoint(830, 233.256208509574), - TrajectoryPoint(840, 232.573526676086), - TrajectoryPoint(850, 231.890560521205), - TrajectoryPoint(860, 231.207300169286), - TrajectoryPoint(870, 230.523735647671), - TrajectoryPoint(880, 229.839856776478), - TrajectoryPoint(890, 229.155595480256), - TrajectoryPoint(900, 228.470997524063), - TrajectoryPoint(910, 227.786052715702), - TrajectoryPoint(920, 227.10075076137), - TrajectoryPoint(930, 226.415081265576), - TrajectoryPoint(940, 225.729033730923), - TrajectoryPoint(950, 225.04259755775), - TrajectoryPoint(960, 224.355762043657), - TrajectoryPoint(970, 223.668483317803), - TrajectoryPoint(980, 222.980758770208), - TrajectoryPoint(990, 222.292601340314), - TrajectoryPoint(1000, 221.604000048377), - TrajectoryPoint(1010, 220.914943805308), - TrajectoryPoint(1020, 220.225421411858), - TrajectoryPoint(1030, 219.535421557711), - TrajectoryPoint(1040, 218.844932820517), - TrajectoryPoint(1050, 218.15394366484), - TrajectoryPoint(1060, 217.462442441048), - TrajectoryPoint(1070, 216.770417384147), - TrajectoryPoint(1080, 216.077821062503), - TrajectoryPoint(1090, 215.384664298062), - TrajectoryPoint(1100, 214.690948191719), - TrajectoryPoint(1110, 213.996660628405), - TrajectoryPoint(1120, 213.301789369925), - TrajectoryPoint(1130, 212.606322053624), - TrajectoryPoint(1140, 211.910246191012), - TrajectoryPoint(1150, 211.213549166341), - TrajectoryPoint(1160, 210.516218235156), - TrajectoryPoint(1170, 209.818240522791), - TrajectoryPoint(1180, 209.119603022842), - TrajectoryPoint(1190, 208.420292595602), - TrajectoryPoint(1200, 207.720295966463), - TrajectoryPoint(1210, 207.019599724287), - TrajectoryPoint(1220, 206.318190319742), - TrajectoryPoint(1230, 205.616054063619), - TrajectoryPoint(1240, 204.913177125106), - TrajectoryPoint(1250, 204.209545530044), - TrajectoryPoint(1260, 203.505145159153), - TrajectoryPoint(1270, 202.799961746222), - TrajectoryPoint(1280, 202.093980876282), - TrajectoryPoint(1290, 201.387187983746), - TrajectoryPoint(1300, 200.679568350519), - TrajectoryPoint(1310, 199.971107104085), - TrajectoryPoint(1320, 199.261789215561), - TrajectoryPoint(1330, 198.551599497726), - TrajectoryPoint(1340, 197.840522603016), - TrajectoryPoint(1350, 197.128543021498), - TrajectoryPoint(1360, 196.415645078801), - TrajectoryPoint(1370, 195.701812934028), - TrajectoryPoint(1380, 194.987030577632), - TrajectoryPoint(1390, 194.271281829256), - TrajectoryPoint(1400, 193.554550335542), - TrajectoryPoint(1410, 192.836819567913), - TrajectoryPoint(1420, 192.118072820307), - TrajectoryPoint(1430, 191.398293206884), - TrajectoryPoint(1440, 190.677463659694), - TrajectoryPoint(1450, 189.955566926305), - TrajectoryPoint(1460, 189.232585567395), - TrajectoryPoint(1470, 188.508501954297), - TrajectoryPoint(1480, 187.783298266512), - TrajectoryPoint(1490, 187.056956489174), - TrajectoryPoint(1500, 186.329458410464), - TrajectoryPoint(1510, 185.600785618995), - TrajectoryPoint(1520, 184.870919501133), - TrajectoryPoint(1530, 184.139841238284), - TrajectoryPoint(1540, 183.407455774352), - TrajectoryPoint(1550, 182.673796287573), - TrajectoryPoint(1560, 181.938860700964), - TrajectoryPoint(1570, 181.202629201723), - TrajectoryPoint(1580, 180.46508175607), - TrajectoryPoint(1590, 179.726198106159), - TrajectoryPoint(1600, 178.985957766931), - TrajectoryPoint(1610, 178.244340022909), - TrajectoryPoint(1620, 177.50132392493), - TrajectoryPoint(1630, 176.756810850301), - TrajectoryPoint(1640, 176.010779537374), - TrajectoryPoint(1650, 175.26327789023), - TrajectoryPoint(1660, 174.514283827528), - TrajectoryPoint(1670, 173.763775014745), - TrajectoryPoint(1680, 173.011728860433), - TrajectoryPoint(1690, 172.258122512408), - TrajectoryPoint(1700, 171.502802299328), - TrajectoryPoint(1710, 170.745799826362), - TrajectoryPoint(1720, 169.987158029808), - TrajectoryPoint(1730, 169.226852794084), - TrajectoryPoint(1740, 168.464859719965), - TrajectoryPoint(1750, 167.701148737858), - TrajectoryPoint(1760, 166.935458415675), - TrajectoryPoint(1770, 166.167995325343), - TrajectoryPoint(1780, 165.398733692557), - TrajectoryPoint(1790, 164.627647433495), - TrajectoryPoint(1800, 163.854662367914), - TrajectoryPoint(1810, 163.079553375224), - TrajectoryPoint(1820, 162.302528510133), - TrajectoryPoint(1830, 161.523560187086), - TrajectoryPoint(1840, 160.742620481751), - TrajectoryPoint(1850, 159.959392392691), - TrajectoryPoint(1860, 159.174077919573), - TrajectoryPoint(1870, 158.386693913255), - TrajectoryPoint(1880, 157.597210803919), - TrajectoryPoint(1890, 156.805229841621), - TrajectoryPoint(1900, 156.011065255406), - TrajectoryPoint(1910, 155.214697246271), - TrajectoryPoint(1920, 154.415922921581), - TrajectoryPoint(1930, 153.614623793633), - TrajectoryPoint(1940, 152.811011747412), - TrajectoryPoint(1950, 152.005000931991), - TrajectoryPoint(1960, 151.196194495543), - TrajectoryPoint(1970, 150.384960134497), - TrajectoryPoint(1980, 149.57124041917), - TrajectoryPoint(1990, 148.754533875081), - TrajectoryPoint(2000, 147.935278523036), - TrajectoryPoint(2010, 147.113346278167), - TrajectoryPoint(2020, 146.288325452034), - TrajectoryPoint(2030, 145.460628658026), - TrajectoryPoint(2040, 144.629946895004), - TrajectoryPoint(2050, 143.796174767656), - TrajectoryPoint(2060, 142.959592799733), - TrajectoryPoint(2070, 142.119588813678), - TrajectoryPoint(2080, 141.276603912625), - TrajectoryPoint(2090, 140.430360174269), - TrajectoryPoint(2100, 139.580730880441), - TrajectoryPoint(2110, 138.727954136291), - TrajectoryPoint(2120, 137.871428705336), - TrajectoryPoint(2130, 137.011737812166), - TrajectoryPoint(2140, 136.148126450635), - TrajectoryPoint(2150, 135.281162988202), - TrajectoryPoint(2160, 134.410225809084), - TrajectoryPoint(2170, 133.535711065008), - TrajectoryPoint(2180, 132.65709956286), - TrajectoryPoint(2190, 131.774742497623), - TrajectoryPoint(2200, 130.888089926654), - TrajectoryPoint(2210, 129.997586473053), - TrajectoryPoint(2220, 129.102506764339), - TrajectoryPoint(2230, 128.203465468637), - TrajectoryPoint(2240, 127.299625668779), - TrajectoryPoint(2250, 126.391523900619), - TrajectoryPoint(2260, 125.478685893337), - TrajectoryPoint(2270, 124.561082042761), - TrajectoryPoint(2280, 123.638888122458), - TrajectoryPoint(2290, 122.711316602962), - TrajectoryPoint(2300, 121.778925986366), - TrajectoryPoint(2310, 120.841361773559), - TrajectoryPoint(2320, 119.898233943148), - TrajectoryPoint(2330, 118.949857663134), - TrajectoryPoint(2340, 117.995906426099), - TrajectoryPoint(2350, 117.035952554308), - TrajectoryPoint(2360, 116.07027781758), - TrajectoryPoint(2370, 115.098708862294), - TrajectoryPoint(2380, 114.120667320821), - TrajectoryPoint(2390, 113.136254502301), - TrajectoryPoint(2400, 112.145408092451), - TrajectoryPoint(2410, 111.147928478732), - TrajectoryPoint(2420, 110.143485075267), - TrajectoryPoint(2430, 109.131723764081), - TrajectoryPoint(2440, 108.112711507268), - TrajectoryPoint(2450, 107.086217777984), - TrajectoryPoint(2460, 106.052002913153), - TrajectoryPoint(2470, 105.009817676376), - TrajectoryPoint(2480, 103.95940279472), - TrajectoryPoint(2490, 102.900488467612), - TrajectoryPoint(2500, 101.832793845895), - TrajectoryPoint(2510, 100.756026478954), - TrajectoryPoint(2520, 99.6698817276448), - TrajectoryPoint(2530, 98.5740421405746), - TrajectoryPoint(2540, 97.4681767910725), - TrajectoryPoint(2550, 96.3519405719673), - TrajectoryPoint(2560, 95.2249734450403), - TrajectoryPoint(2570, 94.0868996417504), - TrajectoryPoint(2580, 92.937326811532), - TrajectoryPoint(2590, 91.7758451136384), - TrajectoryPoint(2600, 90.6020262481441), - TrajectoryPoint(2610, 89.4152799633214), - TrajectoryPoint(2620, 88.2147361589403), - TrajectoryPoint(2630, 87.000347402234), - TrajectoryPoint(2640, 85.7715937359367), - TrajectoryPoint(2650, 84.527214583509), - TrajectoryPoint(2660, 83.2669577874919), - TrajectoryPoint(2670, 81.9903236346375), - TrajectoryPoint(2680, 80.6956383732317), - TrajectoryPoint(2690, 79.3832391537127), - TrajectoryPoint(2700, 78.0508312241006), - TrajectoryPoint(2710, 76.6986708698004), - TrajectoryPoint(2720, 75.3248170873549), - TrajectoryPoint(2730, 73.9283294471792), - TrajectoryPoint(2740, 72.5082003818366), - TrajectoryPoint(2750, 71.0627519044716), - TrajectoryPoint(2760, 69.5899493514023), - TrajectoryPoint(2770, 68.088563550995), - TrajectoryPoint(2780, 66.5565940725129), - TrajectoryPoint(2790, 64.9918549815491), - TrajectoryPoint(2800, 63.3919530733085), - TrajectoryPoint(2810, 61.7541041282596), - TrajectoryPoint(2820, 60.0745997507789), - TrajectoryPoint(2830, 58.3507978337962), - TrajectoryPoint(2840, 56.5783444803655), - TrajectoryPoint(2850, 54.7522159954608), - TrajectoryPoint(2860, 52.8669251254865), - TrajectoryPoint(2870, 50.9162572872799), - TrajectoryPoint(2880, 48.8920800877321), - TrajectoryPoint(2890, 46.7848778599192), - TrajectoryPoint(2900, 44.5834462029579), - TrajectoryPoint(2910, 42.2715684944862), - TrajectoryPoint(2920, 39.8316136279946), - TrajectoryPoint(2930, 37.2377965794946), - TrajectoryPoint(2940, 34.4558879526583), - TrajectoryPoint(2950, 31.4350265460602), - TrajectoryPoint(2960, 28.0997443226259), - TrajectoryPoint(2970, 24.318748429892), - TrajectoryPoint(2980, 19.8424113696207), - TrajectoryPoint(2990, 14.018817664886), + TrajectoryPoint(0, 304.252888930256), + TrajectoryPoint(10, 303.43946036641), + TrajectoryPoint(20, 302.629633424716), + TrajectoryPoint(30, 301.822036948388), + TrajectoryPoint(40, 301.016088965388), + TrajectoryPoint(50, 300.212903924993), + TrajectoryPoint(60, 299.411697729647), + TrajectoryPoint(70, 298.612017176307), + TrajectoryPoint(80, 297.814830765184), + TrajectoryPoint(90, 297.019468578506), + TrajectoryPoint(100, 296.225515571972), + TrajectoryPoint(110, 295.433753735374), + TrajectoryPoint(120, 294.643734469219), + TrajectoryPoint(130, 293.85501445492), + TrajectoryPoint(140, 293.068163508326), + TrajectoryPoint(150, 292.283027370016), + TrajectoryPoint(160, 291.499087058236), + TrajectoryPoint(170, 290.716686144546), + TrajectoryPoint(180, 289.936011020233), + TrajectoryPoint(190, 289.156434647927), + TrajectoryPoint(200, 288.378069274036), + TrajectoryPoint(210, 287.601467381886), + TrajectoryPoint(220, 286.825873282779), + TrajectoryPoint(230, 286.051285882072), + TrajectoryPoint(240, 285.278284558341), + TrajectoryPoint(250, 284.506322020924), + TrajectoryPoint(260, 283.735279868164), + TrajectoryPoint(270, 282.965445999813), + TrajectoryPoint(280, 282.196792391611), + TrajectoryPoint(290, 281.428978637817), + TrajectoryPoint(300, 280.66202083937), + TrajectoryPoint(310, 279.896378976007), + TrajectoryPoint(320, 279.131501812254), + TrajectoryPoint(330, 278.367383803524), + TrajectoryPoint(340, 277.604250962633), + TrajectoryPoint(350, 276.842041216511), + TrajectoryPoint(360, 276.080520163744), + TrajectoryPoint(370, 275.319680684002), + TrajectoryPoint(380, 274.559853503918), + TrajectoryPoint(390, 273.800685346365), + TrajectoryPoint(400, 273.042132953315), + TrajectoryPoint(410, 272.284253520263), + TrajectoryPoint(420, 271.527212226796), + TrajectoryPoint(430, 270.770725188665), + TrajectoryPoint(440, 270.014784422447), + TrajectoryPoint(450, 269.259484082775), + TrajectoryPoint(460, 268.504856480171), + TrajectoryPoint(470, 267.75071768638), + TrajectoryPoint(480, 266.997059192573), + TrajectoryPoint(490, 266.243969452804), + TrajectoryPoint(500, 265.491444400216), + TrajectoryPoint(510, 264.739345912453), + TrajectoryPoint(520, 263.987665171705), + TrajectoryPoint(530, 263.236458464202), + TrajectoryPoint(540, 262.485747194806), + TrajectoryPoint(550, 261.735403301872), + TrajectoryPoint(560, 260.985417797274), + TrajectoryPoint(570, 260.235801054543), + TrajectoryPoint(580, 259.486634604445), + TrajectoryPoint(590, 258.737779152611), + TrajectoryPoint(600, 257.989225622361), + TrajectoryPoint(610, 257.240964633177), + TrajectoryPoint(620, 256.493061564985), + TrajectoryPoint(630, 255.745445388386), + TrajectoryPoint(640, 254.998077211004), + TrajectoryPoint(650, 254.250947655733), + TrajectoryPoint(660, 253.504056054443), + TrajectoryPoint(670, 252.757444543123), + TrajectoryPoint(680, 252.011029283585), + TrajectoryPoint(690, 251.264800898426), + TrajectoryPoint(700, 250.518749815911), + TrajectoryPoint(710, 249.772878907337), + TrajectoryPoint(720, 249.02719603936), + TrajectoryPoint(730, 248.281650077134), + TrajectoryPoint(740, 247.536231448673), + TrajectoryPoint(750, 246.790930423168), + TrajectoryPoint(760, 246.045739576037), + TrajectoryPoint(770, 245.300666722662), + TrajectoryPoint(780, 244.555672593338), + TrajectoryPoint(790, 243.810747427472), + TrajectoryPoint(800, 243.065881325637), + TrajectoryPoint(810, 242.321064258059), + TrajectoryPoint(820, 241.576289388368), + TrajectoryPoint(830, 240.831540240368), + TrajectoryPoint(840, 240.086802382803), + TrajectoryPoint(850, 239.342065710424), + TrajectoryPoint(860, 238.597319994049), + TrajectoryPoint(870, 237.852554885168), + TrajectoryPoint(880, 237.107754661403), + TrajectoryPoint(890, 236.362904715394), + TrajectoryPoint(900, 235.61799823051), + TrajectoryPoint(910, 234.873024719142), + TrajectoryPoint(920, 234.127973572754), + TrajectoryPoint(930, 233.38283406402), + TrajectoryPoint(940, 232.637595348464), + TrajectoryPoint(950, 231.892227427106), + TrajectoryPoint(960, 231.146729652325), + TrajectoryPoint(970, 230.40109553587), + TrajectoryPoint(980, 229.655314016642), + TrajectoryPoint(990, 228.909373909308), + TrajectoryPoint(1000, 228.163263904587), + TrajectoryPoint(1010, 227.416972569231), + TrajectoryPoint(1020, 226.670487259695), + TrajectoryPoint(1030, 225.923765307057), + TrajectoryPoint(1040, 225.17682432719), + TrajectoryPoint(1050, 224.42965259124), + TrajectoryPoint(1060, 223.682238237009), + TrajectoryPoint(1070, 222.934569268235), + TrajectoryPoint(1080, 222.186633553707), + TrajectoryPoint(1090, 221.438418826231), + TrajectoryPoint(1100, 220.689912681464), + TrajectoryPoint(1110, 219.941102576628), + TrajectoryPoint(1120, 219.191963044751), + TrajectoryPoint(1130, 218.442470751254), + TrajectoryPoint(1140, 217.692635020356), + TrajectoryPoint(1150, 216.942442912646), + TrajectoryPoint(1160, 216.191881339829), + TrajectoryPoint(1170, 215.440937063248), + TrajectoryPoint(1180, 214.689596692343), + TrajectoryPoint(1190, 213.937846683053), + TrajectoryPoint(1200, 213.185673336164), + TrajectoryPoint(1210, 212.433062795618), + TrajectoryPoint(1220, 211.680001046775), + TrajectoryPoint(1230, 210.926473914647), + TrajectoryPoint(1240, 210.1724670621), + TrajectoryPoint(1250, 209.417965988028), + TrajectoryPoint(1260, 208.662956025503), + TrajectoryPoint(1270, 207.907422339905), + TrajectoryPoint(1280, 207.151339689713), + TrajectoryPoint(1290, 206.39469329224), + TrajectoryPoint(1300, 205.637479050704), + TrajectoryPoint(1310, 204.879681594873), + TrajectoryPoint(1320, 204.121285376913), + TrajectoryPoint(1330, 203.362274669522), + TrajectoryPoint(1340, 202.602633564031), + TrajectoryPoint(1350, 201.842345968495), + TrajectoryPoint(1360, 201.081395605762), + TrajectoryPoint(1370, 200.319766011517), + TrajectoryPoint(1380, 199.557440532315), + TrajectoryPoint(1390, 198.794402323582), + TrajectoryPoint(1400, 198.030634347606), + TrajectoryPoint(1410, 197.266119371496), + TrajectoryPoint(1420, 196.500839965122), + TrajectoryPoint(1430, 195.734778499032), + TrajectoryPoint(1440, 194.96791714234), + TrajectoryPoint(1450, 194.200237860585), + TrajectoryPoint(1460, 193.431722413566), + TrajectoryPoint(1470, 192.662352353145), + TrajectoryPoint(1480, 191.89207763019), + TrajectoryPoint(1490, 191.120904704971), + TrajectoryPoint(1500, 190.348816024771), + TrajectoryPoint(1510, 189.575792124713), + TrajectoryPoint(1520, 188.801813319468), + TrajectoryPoint(1530, 188.026859700786), + TrajectoryPoint(1540, 187.250911134983), + TrajectoryPoint(1550, 186.473947260388), + TrajectoryPoint(1560, 185.695947484734), + TrajectoryPoint(1570, 184.916890982502), + TrajectoryPoint(1580, 184.136756692216), + TrajectoryPoint(1590, 183.355523313678), + TrajectoryPoint(1600, 182.573169305146), + TrajectoryPoint(1610, 181.78967288046), + TrajectoryPoint(1620, 181.004954469286), + TrajectoryPoint(1630, 180.218999636016), + TrajectoryPoint(1640, 179.431828518014), + TrajectoryPoint(1650, 178.643418140031), + TrajectoryPoint(1660, 177.85374526524), + TrajectoryPoint(1670, 177.062786391884), + TrajectoryPoint(1680, 176.27051774986), + TrajectoryPoint(1690, 175.476915297214), + TrajectoryPoint(1700, 174.681894757513), + TrajectoryPoint(1710, 173.885390867532), + TrajectoryPoint(1720, 173.087470749333), + TrajectoryPoint(1730, 172.288109038835), + TrajectoryPoint(1740, 171.487280078955), + TrajectoryPoint(1750, 170.684957915505), + TrajectoryPoint(1760, 169.881091808081), + TrajectoryPoint(1770, 169.075496090552), + TrajectoryPoint(1780, 168.26831752249), + TrajectoryPoint(1790, 167.459528703986), + TrajectoryPoint(1800, 166.649101913078), + TrajectoryPoint(1810, 165.837009100915), + TrajectoryPoint(1820, 165.022993927286), + TrajectoryPoint(1830, 164.207219089408), + TrajectoryPoint(1840, 163.389680667563), + TrajectoryPoint(1850, 162.570349020656), + TrajectoryPoint(1860, 161.749087672077), + TrajectoryPoint(1870, 160.925773808529), + TrajectoryPoint(1880, 160.100563153002), + TrajectoryPoint(1890, 159.273424354345), + TrajectoryPoint(1900, 158.444218948035), + TrajectoryPoint(1910, 157.61277705297), + TrajectoryPoint(1920, 156.779296998211), + TrajectoryPoint(1930, 155.943745589885), + TrajectoryPoint(1940, 155.105838700279), + TrajectoryPoint(1950, 154.265641093799), + TrajectoryPoint(1960, 153.423255164225), + TrajectoryPoint(1970, 152.578527600077), + TrajectoryPoint(1980, 151.731216032491), + TrajectoryPoint(1990, 150.881593331512), + TrajectoryPoint(2000, 150.029550689068), + TrajectoryPoint(2010, 149.17470737237), + TrajectoryPoint(2020, 148.317423889765), + TrajectoryPoint(2030, 147.457537793759), + TrajectoryPoint(2040, 146.594722165259), + TrajectoryPoint(2050, 145.729330696666), + TrajectoryPoint(2060, 144.86103659752), + TrajectoryPoint(2070, 143.989783780055), + TrajectoryPoint(2080, 143.115812345552), + TrajectoryPoint(2090, 142.238507068539), + TrajectoryPoint(2100, 141.358326173067), + TrajectoryPoint(2110, 140.474962014959), + TrajectoryPoint(2120, 139.588315295419), + TrajectoryPoint(2130, 138.698584024033), + TrajectoryPoint(2140, 137.805204117469), + TrajectoryPoint(2150, 136.908726671063), + TrajectoryPoint(2160, 136.008389038852), + TrajectoryPoint(2170, 135.104778200883), + TrajectoryPoint(2180, 134.197236931549), + TrajectoryPoint(2190, 133.286196524714), + TrajectoryPoint(2200, 132.371083495042), + TrajectoryPoint(2210, 131.452304152151), + TrajectoryPoint(2220, 130.529231479316), + TrajectoryPoint(2230, 129.602389887002), + TrajectoryPoint(2240, 128.670948765082), + TrajectoryPoint(2250, 127.735556235959), + TrajectoryPoint(2260, 126.795466289538), + TrajectoryPoint(2270, 125.851034160702), + TrajectoryPoint(2280, 124.901975804818), + TrajectoryPoint(2290, 123.948035076422), + TrajectoryPoint(2300, 122.989512575698), + TrajectoryPoint(2310, 122.025683163012), + TrajectoryPoint(2320, 121.056877754398), + TrajectoryPoint(2330, 120.083056689408), + TrajectoryPoint(2340, 119.103428698681), + TrajectoryPoint(2350, 118.118482415275), + TrajectoryPoint(2360, 117.128050914554), + TrajectoryPoint(2370, 116.131499240371), + TrajectoryPoint(2380, 115.129011814869), + TrajectoryPoint(2390, 114.120516487876), + TrajectoryPoint(2400, 113.105820666166), + TrajectoryPoint(2410, 112.084266830389), + TrajectoryPoint(2420, 111.056114305483), + TrajectoryPoint(2430, 110.021162161107), + TrajectoryPoint(2440, 108.979187680297), + TrajectoryPoint(2450, 107.92995925823), + TrajectoryPoint(2460, 106.873052635126), + TrajectoryPoint(2470, 105.808313912287), + TrajectoryPoint(2480, 104.73560562881), + TrajectoryPoint(2490, 103.654658902521), + TrajectoryPoint(2500, 102.56519376058), + TrajectoryPoint(2510, 101.466918588196), + TrajectoryPoint(2520, 100.359529542981), + TrajectoryPoint(2530, 99.242709932525), + TrajectoryPoint(2540, 98.1161295525209), + TrajectoryPoint(2550, 96.9794439825693), + TrajectoryPoint(2560, 95.8322938365379), + TrajectoryPoint(2570, 94.6743039640811), + TrajectoryPoint(2580, 93.5050825996255), + TrajectoryPoint(2590, 92.3241352481732), + TrajectoryPoint(2600, 91.130729711421), + TrajectoryPoint(2610, 89.9247200086928), + TrajectoryPoint(2620, 88.7056322676864), + TrajectoryPoint(2630, 87.4729704074673), + TrajectoryPoint(2640, 86.225560901593), + TrajectoryPoint(2650, 84.9632112019553), + TrajectoryPoint(2660, 83.6855291448815), + TrajectoryPoint(2670, 82.390882101734), + TrajectoryPoint(2680, 81.0793529678237), + TrajectoryPoint(2690, 79.7495630100116), + TrajectoryPoint(2700, 78.4008967749515), + TrajectoryPoint(2710, 77.0319774584058), + TrajectoryPoint(2720, 75.6424270690559), + TrajectoryPoint(2730, 74.2298484577766), + TrajectoryPoint(2740, 72.7939310566816), + TrajectoryPoint(2750, 71.3331369512548), + TrajectoryPoint(2760, 69.8457629814841), + TrajectoryPoint(2770, 68.329604604216), + TrajectoryPoint(2780, 66.7831807684602), + TrajectoryPoint(2790, 65.2043321195956), + TrajectoryPoint(2800, 63.5906682499055), + TrajectoryPoint(2810, 61.9388446810233), + TrajectoryPoint(2820, 60.2463093467703), + TrajectoryPoint(2830, 58.5098329032436), + TrajectoryPoint(2840, 56.7245710780884), + TrajectoryPoint(2850, 54.8865200862684), + TrajectoryPoint(2860, 52.9892287825201), + TrajectoryPoint(2870, 51.0269826177715), + TrajectoryPoint(2880, 48.9916562684975), + TrajectoryPoint(2890, 46.8737405471414), + TrajectoryPoint(2900, 44.6620369243402), + TrajectoryPoint(2910, 42.3400120759941), + TrajectoryPoint(2920, 39.8904193624166), + TrajectoryPoint(2930, 37.2874863130597), + TrajectoryPoint(2940, 34.4967463303249), + TrajectoryPoint(2950, 31.4676583484225), + TrajectoryPoint(2960, 28.1247716081359), + TrajectoryPoint(2970, 24.3364923913138), + TrajectoryPoint(2980, 19.853538383309), + TrajectoryPoint(2990, 14.023960516384), TrajectoryPoint(3000, 0), }; TrajectoryPoint t3_closed[] = { - TrajectoryPoint(0, 289.182107830101), - TrajectoryPoint(10, 288.487638116439), - TrajectoryPoint(20, 287.794369522951), - TrajectoryPoint(30, 287.102211933116), - TrajectoryPoint(40, 286.410695187298), - TrajectoryPoint(50, 285.719817704691), - TrajectoryPoint(60, 285.029943027159), - TrajectoryPoint(70, 284.340728032277), - TrajectoryPoint(80, 283.65209586107), - TrajectoryPoint(90, 282.964224486183), - TrajectoryPoint(100, 282.277101384937), - TrajectoryPoint(110, 281.590507383385), - TrajectoryPoint(120, 280.904450122347), - TrajectoryPoint(130, 280.219221744867), - TrajectoryPoint(140, 279.534471301906), - TrajectoryPoint(150, 278.850194443121), - TrajectoryPoint(160, 278.166533743119), - TrajectoryPoint(170, 277.483443750756), - TrajectoryPoint(180, 276.800778293557), - TrajectoryPoint(190, 276.118531957525), - TrajectoryPoint(200, 275.436914717286), - TrajectoryPoint(210, 274.755690398112), - TrajectoryPoint(220, 274.074838303812), - TrajectoryPoint(230, 273.394405066399), - TrajectoryPoint(240, 272.714461114381), - TrajectoryPoint(250, 272.034844647825), - TrajectoryPoint(260, 271.355549436037), - TrajectoryPoint(270, 270.676648132464), - TrajectoryPoint(280, 269.998117180636), - TrajectoryPoint(290, 269.31986469574), - TrajectoryPoint(300, 268.641883957194), - TrajectoryPoint(310, 267.964246231187), - TrajectoryPoint(320, 267.286895934092), - TrajectoryPoint(330, 266.609776440362), - TrajectoryPoint(340, 265.932880673336), - TrajectoryPoint(350, 265.256262317718), - TrajectoryPoint(360, 264.579872075959), - TrajectoryPoint(370, 263.903666326736), - TrajectoryPoint(380, 263.227637732365), - TrajectoryPoint(390, 262.551815422004), - TrajectoryPoint(400, 261.876175277844), - TrajectoryPoint(410, 261.200674608831), - TrajectoryPoint(420, 260.525305881423), - TrajectoryPoint(430, 259.850074355068), - TrajectoryPoint(440, 259.174983876365), - TrajectoryPoint(450, 258.499989049415), - TrajectoryPoint(460, 257.825082186983), - TrajectoryPoint(470, 257.150255398236), - TrajectoryPoint(480, 256.475518987411), - TrajectoryPoint(490, 255.800839060547), - TrajectoryPoint(500, 255.126204212873), - TrajectoryPoint(510, 254.451606451008), - TrajectoryPoint(520, 253.777039039285), - TrajectoryPoint(530, 253.102490277219), - TrajectoryPoint(540, 252.427944642911), - TrajectoryPoint(550, 251.753394045062), - TrajectoryPoint(560, 251.078830246711), - TrajectoryPoint(570, 250.404239549638), - TrajectoryPoint(580, 249.729606329369), - TrajectoryPoint(590, 249.054926860967), - TrajectoryPoint(600, 248.380192818114), - TrajectoryPoint(610, 247.705395749725), - TrajectoryPoint(620, 247.030517745045), - TrajectoryPoint(630, 246.355538213215), - TrajectoryPoint(640, 245.680463309527), - TrajectoryPoint(650, 245.005284486521), - TrajectoryPoint(660, 244.329993085172), - TrajectoryPoint(670, 243.654580340112), - TrajectoryPoint(680, 242.97899931081), - TrajectoryPoint(690, 242.303272242708), - TrajectoryPoint(700, 241.627391969393), - TrajectoryPoint(710, 240.951349614003), - TrajectoryPoint(720, 240.275136199286), - TrajectoryPoint(730, 239.598735259265), - TrajectoryPoint(740, 238.922102531394), - TrajectoryPoint(750, 238.245267141656), - TrajectoryPoint(760, 237.568219974598), - TrajectoryPoint(770, 236.89095181662), - TrajectoryPoint(780, 236.213453358014), - TrajectoryPoint(790, 235.535715194701), - TrajectoryPoint(800, 234.857681583719), - TrajectoryPoint(810, 234.179376911183), - TrajectoryPoint(820, 233.500800847528), - TrajectoryPoint(830, 232.821943814915), - TrajectoryPoint(840, 232.142796139083), - TrajectoryPoint(850, 231.463348050087), - TrajectoryPoint(860, 230.783589682829), - TrajectoryPoint(870, 230.103465159568), - TrajectoryPoint(880, 229.422995047235), - TrajectoryPoint(890, 228.742182562763), - TrajectoryPoint(900, 228.061017624598), - TrajectoryPoint(910, 227.379490051459), - TrajectoryPoint(920, 226.697589562234), - TrajectoryPoint(930, 226.015305775741), - TrajectoryPoint(940, 225.332628210357), - TrajectoryPoint(950, 224.64951167313), - TrajectoryPoint(960, 223.965954940055), - TrajectoryPoint(970, 223.281971459366), - TrajectoryPoint(980, 222.597550481904), - TrajectoryPoint(990, 221.912681151786), - TrajectoryPoint(1000, 221.227352505668), - TrajectoryPoint(1010, 220.541553471925), - TrajectoryPoint(1020, 219.855272869754), - TrajectoryPoint(1030, 219.168499408195), - TrajectoryPoint(1040, 218.481221685092), - TrajectoryPoint(1050, 217.793413282696), - TrajectoryPoint(1060, 217.105040699245), - TrajectoryPoint(1070, 216.416129220919), - TrajectoryPoint(1080, 215.726667113262), - TrajectoryPoint(1090, 215.036642523188), - TrajectoryPoint(1100, 214.346043477744), - TrajectoryPoint(1110, 213.654857882841), - TrajectoryPoint(1120, 212.963073521924), - TrajectoryPoint(1130, 212.270678054611), - TrajectoryPoint(1140, 211.577659015282), - TrajectoryPoint(1150, 210.884003811634), - TrajectoryPoint(1160, 210.189699723196), - TrajectoryPoint(1170, 209.494733899818), - TrajectoryPoint(1180, 208.799093360109), - TrajectoryPoint(1190, 208.102764989864), - TrajectoryPoint(1200, 207.405735540444), - TrajectoryPoint(1210, 206.707991627129), - TrajectoryPoint(1220, 206.009519727452), - TrajectoryPoint(1230, 205.310303799033), - TrajectoryPoint(1240, 204.610315296992), - TrajectoryPoint(1250, 203.909559678483), - TrajectoryPoint(1260, 203.208022969636), - TrajectoryPoint(1270, 202.505691050197), - TrajectoryPoint(1280, 201.802549651752), - TrajectoryPoint(1290, 201.098584355917), - TrajectoryPoint(1300, 200.393780592496), - TrajectoryPoint(1310, 199.688123637622), - TrajectoryPoint(1320, 198.981598611851), - TrajectoryPoint(1330, 198.274190478238), - TrajectoryPoint(1340, 197.56588404038), - TrajectoryPoint(1350, 196.856663940426), - TrajectoryPoint(1360, 196.146514657056), - TrajectoryPoint(1370, 195.435420503433), - TrajectoryPoint(1380, 194.723365625114), - TrajectoryPoint(1390, 194.010308695131), - TrajectoryPoint(1400, 193.296252909082), - TrajectoryPoint(1410, 192.581183606465), - TrajectoryPoint(1420, 191.865084115041), - TrajectoryPoint(1430, 191.147937583066), - TrajectoryPoint(1440, 190.429726976956), - TrajectoryPoint(1450, 189.710435078906), - TrajectoryPoint(1460, 188.990044484474), - TrajectoryPoint(1470, 188.268537600125), - TrajectoryPoint(1480, 187.545896640728), - TrajectoryPoint(1490, 186.822103627015), - TrajectoryPoint(1500, 186.097140382996), - TrajectoryPoint(1510, 185.370988533322), - TrajectoryPoint(1520, 184.643629500611), - TrajectoryPoint(1530, 183.915044502719), - TrajectoryPoint(1540, 183.185214549962), - TrajectoryPoint(1550, 182.454087620405), - TrajectoryPoint(1560, 181.721602774448), - TrajectoryPoint(1570, 180.987808302819), - TrajectoryPoint(1580, 180.252684210011), - TrajectoryPoint(1590, 179.516210276581), - TrajectoryPoint(1600, 178.778366055993), - TrajectoryPoint(1610, 178.039130871408), - TrajectoryPoint(1620, 177.298483812401), - TrajectoryPoint(1630, 176.556403731627), - TrajectoryPoint(1640, 175.812777108933), - TrajectoryPoint(1650, 175.067602452673), - TrajectoryPoint(1660, 174.320921985024), - TrajectoryPoint(1670, 173.572713411345), - TrajectoryPoint(1680, 172.822954180107), - TrajectoryPoint(1690, 172.071621479073), - TrajectoryPoint(1700, 171.318692231397), - TrajectoryPoint(1710, 170.563943004238), - TrajectoryPoint(1720, 169.807533251097), - TrajectoryPoint(1730, 169.049446917602), - TrajectoryPoint(1740, 168.289659645109), - TrajectoryPoint(1750, 167.528146786912), - TrajectoryPoint(1760, 166.764765718723), - TrajectoryPoint(1770, 165.999467153305), - TrajectoryPoint(1780, 165.232357085834), - TrajectoryPoint(1790, 164.463409473346), - TrajectoryPoint(1800, 163.692597958339), - TrajectoryPoint(1810, 162.919685838993), - TrajectoryPoint(1820, 162.14475871462), - TrajectoryPoint(1830, 161.36787535874), - TrajectoryPoint(1840, 160.589007887833), - TrajectoryPoint(1850, 159.807969061943), - TrajectoryPoint(1860, 159.024698948165), - TrajectoryPoint(1870, 158.239346675455), - TrajectoryPoint(1880, 157.451882714642), - TrajectoryPoint(1890, 156.662035140382), - TrajectoryPoint(1900, 155.86986200023), - TrajectoryPoint(1910, 155.075472960758), - TrajectoryPoint(1920, 154.278790922891), - TrajectoryPoint(1930, 153.479443181285), - TrajectoryPoint(1940, 152.67777015486), - TrajectoryPoint(1950, 151.873739038617), - TrajectoryPoint(1960, 151.066915305604), - TrajectoryPoint(1970, 150.257580255098), - TrajectoryPoint(1980, 149.445770622936), - TrajectoryPoint(1990, 148.631035081752), - TrajectoryPoint(2000, 147.813639581047), - TrajectoryPoint(2010, 146.993647022485), - TrajectoryPoint(2020, 146.170486289793), - TrajectoryPoint(2030, 145.344610145469), - TrajectoryPoint(2040, 144.515853279567), - TrajectoryPoint(2050, 143.683874788175), - TrajectoryPoint(2060, 142.849074531548), - TrajectoryPoint(2070, 142.010953079031), - TrajectoryPoint(2080, 141.169723033753), - TrajectoryPoint(2090, 140.325334283944), - TrajectoryPoint(2100, 139.477433081159), - TrajectoryPoint(2110, 138.626464065991), - TrajectoryPoint(2120, 137.771659590004), - TrajectoryPoint(2130, 136.913658444504), - TrajectoryPoint(2140, 136.051831558164), - TrajectoryPoint(2150, 135.186531341384), - TrajectoryPoint(2160, 134.317350631723), - TrajectoryPoint(2170, 133.444472731043), - TrajectoryPoint(2180, 132.567589563416), - TrajectoryPoint(2190, 131.686843041269), - TrajectoryPoint(2200, 130.801890554278), - TrajectoryPoint(2210, 129.912971447264), - TrajectoryPoint(2220, 129.019563468995), - TrajectoryPoint(2230, 128.122154035541), - TrajectoryPoint(2240, 127.219883914503), - TrajectoryPoint(2250, 126.313411598424), - TrajectoryPoint(2260, 125.402091170407), - TrajectoryPoint(2270, 124.48608813533), - TrajectoryPoint(2280, 123.565385958573), - TrajectoryPoint(2290, 122.639386555774), - TrajectoryPoint(2300, 121.708553902917), - TrajectoryPoint(2310, 120.77244110872), - TrajectoryPoint(2320, 119.83084240012), - TrajectoryPoint(2330, 118.883980904618), - TrajectoryPoint(2340, 117.931440972961), - TrajectoryPoint(2350, 116.972972927859), - TrajectoryPoint(2360, 116.008769517596), - TrajectoryPoint(2370, 115.0386573072), - TrajectoryPoint(2380, 114.061972709715), - TrajectoryPoint(2390, 113.07898752469), - TrajectoryPoint(2400, 112.089554031402), - TrajectoryPoint(2410, 111.093472547498), - TrajectoryPoint(2420, 110.090332102255), - TrajectoryPoint(2430, 109.079939701269), - TrajectoryPoint(2440, 108.062281456774), - TrajectoryPoint(2450, 107.037126782327), - TrajectoryPoint(2460, 106.004235958171), - TrajectoryPoint(2470, 104.963359694045), - TrajectoryPoint(2480, 103.914238665882), - TrajectoryPoint(2490, 102.856603024624), - TrajectoryPoint(2500, 101.790171875195), - TrajectoryPoint(2510, 100.714618329294), - TrajectoryPoint(2520, 99.6296978451342), - TrajectoryPoint(2530, 98.5351188831332), - TrajectoryPoint(2540, 97.4304557412904), - TrajectoryPoint(2550, 96.3154063227267), - TrajectoryPoint(2560, 95.1896105572851), - TrajectoryPoint(2570, 94.0526926466147), - TrajectoryPoint(2580, 92.9042602124198), - TrajectoryPoint(2590, 91.7439033882566), - TrajectoryPoint(2600, 90.5711938504912), - TrajectoryPoint(2610, 89.3855995405474), - TrajectoryPoint(2620, 88.1861321721964), - TrajectoryPoint(2630, 86.9728041990342), - TrajectoryPoint(2640, 85.7450956489303), - TrajectoryPoint(2650, 84.5017989338394), - TrajectoryPoint(2660, 83.2425539259075), - TrajectoryPoint(2670, 81.9669667685812), - TrajectoryPoint(2680, 80.6732597287169), - TrajectoryPoint(2690, 79.3618642701204), - TrajectoryPoint(2700, 78.0304080190454), - TrajectoryPoint(2710, 76.6792221405925), - TrajectoryPoint(2720, 75.3062788564618), - TrajectoryPoint(2730, 73.9107287146203), - TrajectoryPoint(2740, 72.4915180773333), - TrajectoryPoint(2750, 71.0469276770162), - TrajectoryPoint(2760, 69.575005880163), - TrajectoryPoint(2770, 68.0744813032637), - TrajectoryPoint(2780, 66.5433533415323), - TrajectoryPoint(2790, 64.9794358961371), - TrajectoryPoint(2800, 63.3803356072063), - TrajectoryPoint(2810, 61.7433012808369), - TrajectoryPoint(2820, 60.0645563868848), - TrajectoryPoint(2830, 58.3414934287796), - TrajectoryPoint(2840, 56.5697873929039), - TrajectoryPoint(2850, 54.7443545298248), - TrajectoryPoint(2860, 52.8597643370541), - TrajectoryPoint(2870, 50.9097727881416), - TrajectoryPoint(2880, 48.8862470757287), - TrajectoryPoint(2890, 46.7796711478539), - TrajectoryPoint(2900, 44.5788402486425), - TrajectoryPoint(2910, 42.2675563651644), - TrajectoryPoint(2920, 39.8281657616084), - TrajectoryPoint(2930, 37.2348826584473), - TrajectoryPoint(2940, 34.4534915630279), - TrajectoryPoint(2950, 31.4331124313534), - TrajectoryPoint(2960, 28.0982761691317), - TrajectoryPoint(2970, 24.3177075274654), - TrajectoryPoint(2980, 19.8417586758741), - TrajectoryPoint(2990, 14.0185160329622), + TrajectoryPoint(0, 303.143063663282), + TrajectoryPoint(10, 302.340998443195), + TrajectoryPoint(20, 301.540577329818), + TrajectoryPoint(30, 300.741931460062), + TrajectoryPoint(40, 299.946215876113), + TrajectoryPoint(50, 299.151976308944), + TrajectoryPoint(60, 298.359361267239), + TrajectoryPoint(70, 297.569409023728), + TrajectoryPoint(80, 296.780822661406), + TrajectoryPoint(90, 295.99366121654), + TrajectoryPoint(100, 295.208981854303), + TrajectoryPoint(110, 294.4255638416), + TrajectoryPoint(120, 293.643414962312), + TrajectoryPoint(130, 292.863481992471), + TrajectoryPoint(140, 292.084787193474), + TrajectoryPoint(150, 291.307259756925), + TrajectoryPoint(160, 290.531586053716), + TrajectoryPoint(170, 289.757205560381), + TrajectoryPoint(180, 288.983896982225), + TrajectoryPoint(190, 288.212086560343), + TrajectoryPoint(200, 287.441644469155), + TrajectoryPoint(210, 286.672184902097), + TrajectoryPoint(220, 285.903880249427), + TrajectoryPoint(230, 285.137030693331), + TrajectoryPoint(240, 284.371080015468), + TrajectoryPoint(250, 283.606025096247), + TrajectoryPoint(260, 282.84238202624), + TrajectoryPoint(270, 282.079627086168), + TrajectoryPoint(280, 281.317688907857), + TrajectoryPoint(290, 280.556798117459), + TrajectoryPoint(300, 279.796950214619), + TrajectoryPoint(310, 279.037845327638), + TrajectoryPoint(320, 278.279477436798), + TrajectoryPoint(330, 277.522244825851), + TrajectoryPoint(340, 276.765711525513), + TrajectoryPoint(350, 276.009846120327), + TrajectoryPoint(360, 275.25477046574), + TrajectoryPoint(370, 274.500566694125), + TrajectoryPoint(380, 273.746966256539), + TrajectoryPoint(390, 272.99396175079), + TrajectoryPoint(400, 272.241745741708), + TrajectoryPoint(410, 271.490190083187), + TrajectoryPoint(420, 270.739169997788), + TrajectoryPoint(430, 269.988677331235), + TrajectoryPoint(440, 269.238918132828), + TrajectoryPoint(450, 268.489681653856), + TrajectoryPoint(460, 267.740916188283), + TrajectoryPoint(470, 266.992613123313), + TrajectoryPoint(480, 266.244954201973), + TrajectoryPoint(490, 265.497732164465), + TrajectoryPoint(500, 264.75091975514), + TrajectoryPoint(510, 264.004508098958), + TrajectoryPoint(520, 263.258631981501), + TrajectoryPoint(530, 262.51314133657), + TrajectoryPoint(540, 261.768001945765), + TrajectoryPoint(550, 261.023204796452), + TrajectoryPoint(560, 260.278826981905), + TrajectoryPoint(570, 259.534803865042), + TrajectoryPoint(580, 258.791076387172), + TrajectoryPoint(590, 258.047635470228), + TrajectoryPoint(600, 257.304499293602), + TrajectoryPoint(610, 256.561696588304), + TrajectoryPoint(620, 255.819136359132), + TrajectoryPoint(630, 255.076809496631), + TrajectoryPoint(640, 254.334706653247), + TrajectoryPoint(650, 253.59286679667), + TrajectoryPoint(660, 252.851243238948), + TrajectoryPoint(670, 252.10980197641), + TrajectoryPoint(680, 251.368533670984), + TrajectoryPoint(690, 250.627428800493), + TrajectoryPoint(700, 249.886516058481), + TrajectoryPoint(710, 249.145743462706), + TrajectoryPoint(720, 248.405094494811), + TrajectoryPoint(730, 247.664559638567), + TrajectoryPoint(740, 246.924129226545), + TrajectoryPoint(750, 246.183810737275), + TrajectoryPoint(760, 245.443575030744), + TrajectoryPoint(770, 244.703405434363), + TrajectoryPoint(780, 243.963292255598), + TrajectoryPoint(790, 243.223225669055), + TrajectoryPoint(800, 242.483197325378), + TrajectoryPoint(810, 241.743195168354), + TrajectoryPoint(820, 241.003202317373), + TrajectoryPoint(830, 240.263208874966), + TrajectoryPoint(840, 239.523204819229), + TrajectoryPoint(850, 238.783180008901), + TrajectoryPoint(860, 238.043120671428), + TrajectoryPoint(870, 237.303008960725), + TrajectoryPoint(880, 236.562839853956), + TrajectoryPoint(890, 235.822603079523), + TrajectoryPoint(900, 235.082288246277), + TrajectoryPoint(910, 234.341884845988), + TrajectoryPoint(920, 233.601382255301), + TrajectoryPoint(930, 232.860751220738), + TrajectoryPoint(940, 232.119989524432), + TrajectoryPoint(950, 231.379092075776), + TrajectoryPoint(960, 230.638048047648), + TrajectoryPoint(970, 229.896846491579), + TrajectoryPoint(980, 229.155476338255), + TrajectoryPoint(990, 228.413926397698), + TrajectoryPoint(1000, 227.672178208594), + TrajectoryPoint(1010, 226.930199968496), + TrajectoryPoint(1020, 226.188004893281), + TrajectoryPoint(1030, 225.44558151243), + TrajectoryPoint(1040, 224.702918225875), + TrajectoryPoint(1050, 223.960003303416), + TrajectoryPoint(1060, 223.216824883953), + TrajectoryPoint(1070, 222.473370974564), + TrajectoryPoint(1080, 221.729629449436), + TrajectoryPoint(1090, 220.985587265507), + TrajectoryPoint(1100, 220.241196168771), + TrajectoryPoint(1110, 219.496478978885), + TrajectoryPoint(1120, 218.751423198792), + TrajectoryPoint(1130, 218.006016188409), + TrajectoryPoint(1140, 217.26024516329), + TrajectoryPoint(1150, 216.514097193206), + TrajectoryPoint(1160, 215.767559200649), + TrajectoryPoint(1170, 215.020617959288), + TrajectoryPoint(1180, 214.273260092351), + TrajectoryPoint(1190, 213.525472070974), + TrajectoryPoint(1200, 212.777240212494), + TrajectoryPoint(1210, 212.028550678718), + TrajectoryPoint(1220, 211.279389474147), + TrajectoryPoint(1230, 210.529730011613), + TrajectoryPoint(1240, 209.779555122058), + TrajectoryPoint(1250, 209.028866412376), + TrajectoryPoint(1260, 208.277649392355), + TrajectoryPoint(1270, 207.525889404544), + TrajectoryPoint(1280, 206.773571622466), + TrajectoryPoint(1290, 206.020681048807), + TrajectoryPoint(1300, 205.267202513592), + TrajectoryPoint(1310, 204.513120672327), + TrajectoryPoint(1320, 203.758420004131), + TrajectoryPoint(1330, 203.003084809841), + TrajectoryPoint(1340, 202.247099210108), + TrajectoryPoint(1350, 201.49044714346), + TrajectoryPoint(1360, 200.733112364358), + TrajectoryPoint(1370, 199.975078441228), + TrajectoryPoint(1380, 199.216328754471), + TrajectoryPoint(1390, 198.456846494456), + TrajectoryPoint(1400, 197.696614659487), + TrajectoryPoint(1410, 196.935616053753), + TrajectoryPoint(1420, 196.173833285249), + TrajectoryPoint(1430, 195.411248763677), + TrajectoryPoint(1440, 194.647844698314), + TrajectoryPoint(1450, 193.88360309586), + TrajectoryPoint(1460, 193.118505758251), + TrajectoryPoint(1470, 192.352534280442), + TrajectoryPoint(1480, 191.585670048161), + TrajectoryPoint(1490, 190.817894235624), + TrajectoryPoint(1500, 190.049187803214), + TrajectoryPoint(1510, 189.279522102802), + TrajectoryPoint(1520, 188.508844400435), + TrajectoryPoint(1530, 187.737172550953), + TrajectoryPoint(1540, 186.964486471995), + TrajectoryPoint(1550, 186.190765853959), + TrajectoryPoint(1560, 185.415990157379), + TrajectoryPoint(1570, 184.64013861024), + TrajectoryPoint(1580, 183.863190205257), + TrajectoryPoint(1590, 183.085123697078), + TrajectoryPoint(1600, 182.305917599449), + TrajectoryPoint(1610, 181.525550182307), + TrajectoryPoint(1620, 180.743999468816), + TrajectoryPoint(1630, 179.961230919991), + TrajectoryPoint(1640, 179.177130849341), + TrajectoryPoint(1650, 178.391772785785), + TrajectoryPoint(1660, 177.605133552851), + TrajectoryPoint(1670, 176.817189709572), + TrajectoryPoint(1680, 176.027917547039), + TrajectoryPoint(1690, 175.237293084878), + TrajectoryPoint(1700, 174.445292067631), + TrajectoryPoint(1710, 173.651821679357), + TrajectoryPoint(1720, 172.856822272075), + TrajectoryPoint(1730, 172.060362987413), + TrajectoryPoint(1740, 171.262418232675), + TrajectoryPoint(1750, 170.462962118264), + TrajectoryPoint(1760, 169.66196845345), + TrajectoryPoint(1770, 168.859329645663), + TrajectoryPoint(1780, 168.054960464926), + TrajectoryPoint(1790, 167.248963101132), + TrajectoryPoint(1800, 166.441309898651), + TrajectoryPoint(1810, 165.631972875005), + TrajectoryPoint(1820, 164.820846012056), + TrajectoryPoint(1830, 164.007788679094), + TrajectoryPoint(1840, 163.192950131871), + TrajectoryPoint(1850, 162.37630079652), + TrajectoryPoint(1860, 161.557810742753), + TrajectoryPoint(1870, 160.737184567085), + TrajectoryPoint(1880, 159.914600797971), + TrajectoryPoint(1890, 159.090071566945), + TrajectoryPoint(1900, 158.263565206364), + TrajectoryPoint(1910, 157.43473637547), + TrajectoryPoint(1920, 156.603810999884), + TrajectoryPoint(1930, 155.770797201018), + TrajectoryPoint(1940, 154.935555586666), + TrajectoryPoint(1950, 154.097858160057), + TrajectoryPoint(1960, 153.257955525318), + TrajectoryPoint(1970, 152.41581256339), + TrajectoryPoint(1980, 151.570972709353), + TrajectoryPoint(1990, 150.723779403918), + TrajectoryPoint(2000, 149.874221466731), + TrajectoryPoint(2010, 149.021840617795), + TrajectoryPoint(2020, 148.166933065277), + TrajectoryPoint(2030, 147.309530241844), + TrajectoryPoint(2040, 146.449069470704), + TrajectoryPoint(2050, 145.586000914804), + TrajectoryPoint(2060, 144.720149599783), + TrajectoryPoint(2070, 143.851183273848), + TrajectoryPoint(2080, 142.979482193113), + TrajectoryPoint(2090, 142.104563389324), + TrajectoryPoint(2100, 141.226616707277), + TrajectoryPoint(2110, 140.345602591401), + TrajectoryPoint(2120, 139.461154110849), + TrajectoryPoint(2130, 138.57370877302), + TrajectoryPoint(2140, 137.682518731216), + TrajectoryPoint(2150, 136.788188009887), + TrajectoryPoint(2160, 135.890106925276), + TrajectoryPoint(2170, 134.988607306383), + TrajectoryPoint(2180, 134.083285553692), + TrajectoryPoint(2190, 133.174321039683), + TrajectoryPoint(2200, 132.261390332967), + TrajectoryPoint(2210, 131.344651739444), + TrajectoryPoint(2220, 130.423724055638), + TrajectoryPoint(2230, 129.498888254398), + TrajectoryPoint(2240, 128.569554667929), + TrajectoryPoint(2250, 127.636251697339), + TrajectoryPoint(2260, 126.698113193173), + TrajectoryPoint(2270, 125.755732909088), + TrajectoryPoint(2280, 124.808591488161), + TrajectoryPoint(2290, 123.856664821073), + TrajectoryPoint(2300, 122.900137946003), + TrajectoryPoint(2310, 121.938171749256), + TrajectoryPoint(2320, 120.97132400538), + TrajectoryPoint(2330, 119.999332112368), + TrajectoryPoint(2340, 119.021623795425), + TrajectoryPoint(2350, 118.038578388909), + TrajectoryPoint(2360, 117.050028847635), + TrajectoryPoint(2370, 116.055234096891), + TrajectoryPoint(2380, 115.054590444456), + TrajectoryPoint(2390, 114.047919781986), + TrajectoryPoint(2400, 113.034941620708), + TrajectoryPoint(2410, 112.015160911613), + TrajectoryPoint(2420, 110.988775535422), + TrajectoryPoint(2430, 109.955571179886), + TrajectoryPoint(2440, 108.915325044388), + TrajectoryPoint(2450, 107.867805445285), + TrajectoryPoint(2460, 106.812494405415), + TrajectoryPoint(2470, 105.749426105805), + TrajectoryPoint(2480, 104.678368617509), + TrajectoryPoint(2490, 103.599052993797), + TrajectoryPoint(2500, 102.511199201365), + TrajectoryPoint(2510, 101.414515568899), + TrajectoryPoint(2520, 100.308698201294), + TrajectoryPoint(2530, 99.1934303571026), + TrajectoryPoint(2540, 98.0683817865416), + TrajectoryPoint(2550, 96.9332080271858), + TrajectoryPoint(2560, 95.7875496542242), + TrajectoryPoint(2570, 94.6310314818831), + TrajectoryPoint(2580, 93.4632617123211), + TrajectoryPoint(2590, 92.2838210053548), + TrajectoryPoint(2600, 91.0918247801797), + TrajectoryPoint(2610, 89.887204135945), + TrajectoryPoint(2620, 88.6694851820519), + TrajectoryPoint(2630, 87.438171821999), + TrajectoryPoint(2640, 86.1921578530078), + TrajectoryPoint(2650, 84.9311136724844), + TrajectoryPoint(2660, 83.6547167588042), + TrajectoryPoint(2670, 82.3613970873302), + TrajectoryPoint(2680, 81.0511097453294), + TrajectoryPoint(2690, 79.722600932918), + TrajectoryPoint(2700, 78.3751328916335), + TrajectoryPoint(2710, 77.0074478304476), + TrajectoryPoint(2720, 75.6190793244725), + TrajectoryPoint(2730, 74.2076599994086), + TrajectoryPoint(2740, 72.7729049525317), + TrajectoryPoint(2750, 71.3132485192696), + TrajectoryPoint(2760, 69.8269613324207), + TrajectoryPoint(2770, 68.3118683486426), + TrajectoryPoint(2780, 66.7665082723314), + TrajectoryPoint(2790, 65.1886979450672), + TrajectoryPoint(2800, 63.5760467665334), + TrajectoryPoint(2810, 61.9252512716002), + TrajectoryPoint(2820, 60.2336747908334), + TrajectoryPoint(2830, 58.4981309577407), + TrajectoryPoint(2840, 56.713811432215), + TrajectoryPoint(2850, 54.8766377322569), + TrajectoryPoint(2860, 52.9802293414048), + TrajectoryPoint(2870, 51.0188350824853), + TrajectoryPoint(2880, 48.9843291140278), + TrajectoryPoint(2890, 46.8672017724728), + TrajectoryPoint(2900, 44.6562540949963), + TrajectoryPoint(2910, 42.3349759942612), + TrajectoryPoint(2920, 39.8860926130468), + TrajectoryPoint(2930, 37.283830541217), + TrajectoryPoint(2940, 34.4937405762601), + TrajectoryPoint(2950, 31.4652581188478), + TrajectoryPoint(2960, 28.1229311016481), + TrajectoryPoint(2970, 24.335187851849), + TrajectoryPoint(2980, 19.8527206397389), + TrajectoryPoint(2990, 14.0235827734113), TrajectoryPoint(3000, 0), }; TrajectoryPoint t4_closed[] = { - TrajectoryPoint(0, 288.400431198465), - TrajectoryPoint(10, 287.711921016228), - TrajectoryPoint(20, 287.024564629671), - TrajectoryPoint(30, 286.337866313319), - TrajectoryPoint(40, 285.65181294685), - TrajectoryPoint(50, 284.966768428709), - TrajectoryPoint(60, 284.282290678797), - TrajectoryPoint(70, 283.598377146192), - TrajectoryPoint(80, 282.915280133241), - TrajectoryPoint(90, 282.232818502879), - TrajectoryPoint(100, 281.550868454993), - TrajectoryPoint(110, 280.869510195808), - TrajectoryPoint(120, 280.188872452093), - TrajectoryPoint(130, 279.50869613773), - TrajectoryPoint(140, 278.828976782997), - TrajectoryPoint(150, 278.149911832688), - TrajectoryPoint(160, 277.47133057719), - TrajectoryPoint(170, 276.793158194143), - TrajectoryPoint(180, 276.11542941738), - TrajectoryPoint(190, 275.438274708529), - TrajectoryPoint(200, 274.761483007308), - TrajectoryPoint(210, 274.085048710897), - TrajectoryPoint(220, 273.409061175978), - TrajectoryPoint(230, 272.733493015012), - TrajectoryPoint(240, 272.058238351673), - TrajectoryPoint(250, 271.38329094514), - TrajectoryPoint(260, 270.708756326526), - TrajectoryPoint(270, 270.034534437161), - TrajectoryPoint(280, 269.360577790603), - TrajectoryPoint(290, 268.686879681535), - TrajectoryPoint(300, 268.013536529709), - TrajectoryPoint(310, 267.340433023407), - TrajectoryPoint(320, 266.66754782805), - TrajectoryPoint(330, 265.994873900041), - TrajectoryPoint(340, 265.322484013229), - TrajectoryPoint(350, 264.650282362245), - TrajectoryPoint(360, 263.978253406401), - TrajectoryPoint(370, 263.30638985346), - TrajectoryPoint(380, 262.634735152878), - TrajectoryPoint(390, 261.96322912017), - TrajectoryPoint(400, 261.291851422255), - TrajectoryPoint(410, 260.620594579627), - TrajectoryPoint(420, 259.949474410455), - TrajectoryPoint(430, 259.278466969676), - TrajectoryPoint(440, 258.607544660365), - TrajectoryPoint(450, 257.936699855327), - TrajectoryPoint(460, 257.265928649302), - TrajectoryPoint(470, 256.595230918324), - TrajectoryPoint(480, 255.924576148272), - TrajectoryPoint(490, 255.253956587112), - TrajectoryPoint(500, 254.583364311473), - TrajectoryPoint(510, 253.912792037851), - TrajectoryPoint(520, 253.242223924358), - TrajectoryPoint(530, 252.571649626302), - TrajectoryPoint(540, 251.901061124742), - TrajectoryPoint(550, 251.230450259334), - TrajectoryPoint(560, 250.559796205452), - TrajectoryPoint(570, 249.889092990303), - TrajectoryPoint(580, 249.218334819605), - TrajectoryPoint(590, 248.54751344508), - TrajectoryPoint(600, 247.876620497016), - TrajectoryPoint(610, 247.205625469229), - TrajectoryPoint(620, 246.534528863012), - TrajectoryPoint(630, 245.863328766793), - TrajectoryPoint(640, 245.192016715646), - TrajectoryPoint(650, 244.520584135817), - TrajectoryPoint(660, 243.849006570674), - TrajectoryPoint(670, 243.177263154125), - TrajectoryPoint(680, 242.505367764573), - TrajectoryPoint(690, 241.833311715744), - TrajectoryPoint(700, 241.161086219717), - TrajectoryPoint(710, 240.488682390396), - TrajectoryPoint(720, 239.816058586825), - TrajectoryPoint(730, 239.143217628455), - TrajectoryPoint(740, 238.470167128845), - TrajectoryPoint(750, 237.796898065338), - TrajectoryPoint(760, 237.123401319153), - TrajectoryPoint(770, 236.44966767735), - TrajectoryPoint(780, 235.775664645354), - TrajectoryPoint(790, 235.101370558986), - TrajectoryPoint(800, 234.426808353039), - TrajectoryPoint(810, 233.751968646039), - TrajectoryPoint(820, 233.076841961013), - TrajectoryPoint(830, 232.401418726393), - TrajectoryPoint(840, 231.725689276717), - TrajectoryPoint(850, 231.049614962792), - TrajectoryPoint(860, 230.373181617153), - TrajectoryPoint(870, 229.696410463845), - TrajectoryPoint(880, 229.019291628508), - TrajectoryPoint(890, 228.341815138819), - TrajectoryPoint(900, 227.66397092451), - TrajectoryPoint(910, 226.985748817252), - TrajectoryPoint(920, 226.307138550401), - TrajectoryPoint(930, 225.62809946443), - TrajectoryPoint(940, 224.948620192505), - TrajectoryPoint(950, 224.268720345345), - TrajectoryPoint(960, 223.588389398183), - TrajectoryPoint(970, 222.90761672199), - TrajectoryPoint(980, 222.226391582827), - TrajectoryPoint(990, 221.544703141109), - TrajectoryPoint(1000, 220.862540450785), - TrajectoryPoint(1010, 220.179892458441), - TrajectoryPoint(1020, 219.496748002327), - TrajectoryPoint(1030, 218.813060371453), - TrajectoryPoint(1040, 218.128834552168), - TrajectoryPoint(1050, 217.444078261782), - TrajectoryPoint(1060, 216.758780017229), - TrajectoryPoint(1070, 216.072928219891), - TrajectoryPoint(1080, 215.386511154428), - TrajectoryPoint(1090, 214.699516987561), - TrajectoryPoint(1100, 214.011933766801), - TrajectoryPoint(1110, 213.323749419139), - TrajectoryPoint(1120, 212.634951749688), - TrajectoryPoint(1130, 211.945528440289), - TrajectoryPoint(1140, 211.255467048075), - TrajectoryPoint(1150, 210.564755004007), - TrajectoryPoint(1160, 209.873379611363), - TrajectoryPoint(1170, 209.181328044208), - TrajectoryPoint(1180, 208.488577492694), - TrajectoryPoint(1190, 207.795104219395), - TrajectoryPoint(1200, 207.100917295221), - TrajectoryPoint(1210, 206.406003476037), - TrajectoryPoint(1220, 205.710349380257), - TrajectoryPoint(1230, 205.013941487196), - TrajectoryPoint(1240, 204.316766135399), - TrajectoryPoint(1250, 203.618809520941), - TrajectoryPoint(1260, 202.920057695692), - TrajectoryPoint(1270, 202.220496565557), - TrajectoryPoint(1280, 201.520111888687), - TrajectoryPoint(1290, 200.81888927366), - TrajectoryPoint(1300, 200.116814177633), - TrajectoryPoint(1310, 199.413871904466), - TrajectoryPoint(1320, 198.710047602816), - TrajectoryPoint(1330, 198.005326264198), - TrajectoryPoint(1340, 197.299692721025), - TrajectoryPoint(1350, 196.593131644607), - TrajectoryPoint(1360, 195.885627543123), - TrajectoryPoint(1370, 195.177164759563), - TrajectoryPoint(1380, 194.467727469639), - TrajectoryPoint(1390, 193.757299679654), - TrajectoryPoint(1400, 193.045865224347), - TrajectoryPoint(1410, 192.333407764698), - TrajectoryPoint(1420, 191.6199107857), - TrajectoryPoint(1430, 190.905322780246), - TrajectoryPoint(1440, 190.189647107171), - TrajectoryPoint(1450, 189.472876527352), - TrajectoryPoint(1460, 188.754993670017), - TrajectoryPoint(1470, 188.035980975529), - TrajectoryPoint(1480, 187.315820692875), - TrajectoryPoint(1490, 186.59449487712), - TrajectoryPoint(1500, 185.871985386811), - TrajectoryPoint(1510, 185.148273881338), - TrajectoryPoint(1520, 184.423341818247), - TrajectoryPoint(1530, 183.697170450505), - TrajectoryPoint(1540, 182.969740823718), - TrajectoryPoint(1550, 182.241033773288), - TrajectoryPoint(1560, 181.511029901333), - TrajectoryPoint(1570, 180.779594730267), - TrajectoryPoint(1580, 180.046816739329), - TrajectoryPoint(1590, 179.312675745994), - TrajectoryPoint(1600, 178.577151340754), - TrajectoryPoint(1610, 177.840222883898), - TrajectoryPoint(1620, 177.101869502225), - TrajectoryPoint(1630, 176.362070085694), - TrajectoryPoint(1640, 175.620803284013), - TrajectoryPoint(1650, 174.877927579264), - TrajectoryPoint(1660, 174.13348723214), - TrajectoryPoint(1670, 173.387505887092), - TrajectoryPoint(1680, 172.639961030897), - TrajectoryPoint(1690, 171.89082988964), - TrajectoryPoint(1700, 171.140089424815), - TrajectoryPoint(1710, 170.387650638499), - TrajectoryPoint(1720, 169.633402250696), - TrajectoryPoint(1730, 168.877464597034), - TrajectoryPoint(1740, 168.119813357763), - TrajectoryPoint(1750, 167.36042392504), - TrajectoryPoint(1760, 166.599271398437), - TrajectoryPoint(1770, 165.836083865085), - TrajectoryPoint(1780, 165.071057442012), - TrajectoryPoint(1790, 164.30418100186), - TrajectoryPoint(1800, 163.535428226177), - TrajectoryPoint(1810, 162.764691737369), - TrajectoryPoint(1820, 161.991796265612), - TrajectoryPoint(1830, 161.216932229542), - TrajectoryPoint(1840, 160.44007178471), - TrajectoryPoint(1850, 159.661154930748), - TrajectoryPoint(1860, 158.879864904239), - TrajectoryPoint(1870, 158.096480527657), - TrajectoryPoint(1880, 157.310972310723), - TrajectoryPoint(1890, 156.523192595656), - TrajectoryPoint(1900, 155.732948427036), - TrajectoryPoint(1910, 154.940476310972), - TrajectoryPoint(1920, 154.145744978267), - TrajectoryPoint(1930, 153.348364840947), - TrajectoryPoint(1940, 152.548570137481), - TrajectoryPoint(1950, 151.746405439504), - TrajectoryPoint(1960, 150.941554975928), - TrajectoryPoint(1970, 150.134059878806), - TrajectoryPoint(1980, 149.324078400722), - TrajectoryPoint(1990, 148.511275730857), - TrajectoryPoint(2000, 147.695682053642), - TrajectoryPoint(2010, 146.877479624742), - TrajectoryPoint(2020, 146.056211137843), - TrajectoryPoint(2030, 145.232098933755), - TrajectoryPoint(2040, 144.405208023058), - TrajectoryPoint(2050, 143.574967360873), - TrajectoryPoint(2060, 142.741893413172), - TrajectoryPoint(2070, 141.905596904374), - TrajectoryPoint(2080, 141.066067208368), - TrajectoryPoint(2090, 140.223476723442), - TrajectoryPoint(2100, 139.377249997122), - TrajectoryPoint(2110, 138.527944110655), - TrajectoryPoint(2120, 137.67489661382), - TrajectoryPoint(2130, 136.81853288239), - TrajectoryPoint(2140, 135.95843599383), - TrajectoryPoint(2150, 135.094747569336), - TrajectoryPoint(2160, 134.22726973848), - TrajectoryPoint(2170, 133.355978103545), - TrajectoryPoint(2180, 132.480770572025), - TrajectoryPoint(2190, 131.601584886375), - TrajectoryPoint(2200, 130.718280681949), - TrajectoryPoint(2210, 129.830897081207), - TrajectoryPoint(2220, 128.939109933057), - TrajectoryPoint(2230, 128.043210776131), - TrajectoryPoint(2240, 127.142533944956), - TrajectoryPoint(2250, 126.237641512498), - TrajectoryPoint(2260, 125.327792021431), - TrajectoryPoint(2270, 124.413341145268), - TrajectoryPoint(2280, 123.494084919109), - TrajectoryPoint(2290, 122.569609890261), - TrajectoryPoint(2300, 121.6402878983), - TrajectoryPoint(2310, 120.705582049405), - TrajectoryPoint(2320, 119.76546607844), - TrajectoryPoint(2330, 118.820073430179), - TrajectoryPoint(2340, 117.868901639836), - TrajectoryPoint(2350, 116.911874406278), - TrajectoryPoint(2360, 115.949097760183), - TrajectoryPoint(2370, 114.980359684919), - TrajectoryPoint(2380, 114.005029137626), - TrajectoryPoint(2390, 113.023428406018), - TrajectoryPoint(2400, 112.035365109698), - TrajectoryPoint(2410, 111.040639498985), - TrajectoryPoint(2420, 110.03876236273), - TrajectoryPoint(2430, 109.029697543662), - TrajectoryPoint(2440, 108.013352449616), - TrajectoryPoint(2450, 106.98949643655), - TrajectoryPoint(2460, 105.957889729889), - TrajectoryPoint(2470, 104.918282987238), - TrajectoryPoint(2480, 103.870416835007), - TrajectoryPoint(2490, 102.814021377134), - TrajectoryPoint(2500, 101.74877062261), - TrajectoryPoint(2510, 100.674404702738), - TrajectoryPoint(2520, 99.5906811754193), - TrajectoryPoint(2530, 98.4972858586535), - TrajectoryPoint(2540, 97.3938531451154), - TrajectoryPoint(2550, 96.2799549001043), - TrajectoryPoint(2560, 95.1552953515873), - TrajectoryPoint(2570, 94.019498672057), - TrajectoryPoint(2580, 92.8721724560516), - TrajectoryPoint(2590, 91.7129068119073), - TrajectoryPoint(2600, 90.5412733926751), - TrajectoryPoint(2610, 89.3567967164087), - TrajectoryPoint(2620, 88.1583735932861), - TrajectoryPoint(2630, 86.9460746997048), - TrajectoryPoint(2640, 85.7193800486954), - TrajectoryPoint(2650, 84.4771335603578), - TrajectoryPoint(2660, 83.2188701530575), - TrajectoryPoint(2670, 81.9442988619684), - TrajectoryPoint(2680, 80.6515408918803), - TrajectoryPoint(2690, 79.3410791988585), - TrajectoryPoint(2700, 78.0105864796306), - TrajectoryPoint(2710, 76.6603461600492), - TrajectoryPoint(2720, 75.2882863068892), - TrajectoryPoint(2730, 73.893645873302), - TrajectoryPoint(2740, 72.4753264520392), - TrajectoryPoint(2750, 71.0315686679998), - TrajectoryPoint(2760, 69.5605015614551), - TrajectoryPoint(2770, 68.0608127335285), - TrajectoryPoint(2780, 66.5305014103984), - TrajectoryPoint(2790, 64.9673813334451), - TrajectoryPoint(2800, 63.3690589919956), - TrajectoryPoint(2810, 61.7328152723726), - TrajectoryPoint(2820, 60.0548074594194), - TrajectoryPoint(2830, 58.3324616765179), - TrajectoryPoint(2840, 56.5614809638394), - TrajectoryPoint(2850, 54.7367232413618), - TrajectoryPoint(2860, 52.8528131267647), - TrajectoryPoint(2870, 50.9034779957129), - TrajectoryPoint(2880, 48.8805846385624), - TrajectoryPoint(2890, 46.7746166292359), - TrajectoryPoint(2900, 44.5743688667463), - TrajectoryPoint(2910, 42.2636614095763), - TrajectoryPoint(2920, 39.824818545402), - TrajectoryPoint(2930, 37.2320537610135), - TrajectoryPoint(2940, 34.4511650642228), - TrajectoryPoint(2950, 31.4312541138461), - TrajectoryPoint(2960, 28.0968507888569), - TrajectoryPoint(2970, 24.3166969327988), - TrajectoryPoint(2980, 19.8411249726781), - TrajectoryPoint(2990, 14.0182231684044), + TrajectoryPoint(0, 302.076419759108), + TrajectoryPoint(10, 301.282336477058), + TrajectoryPoint(20, 300.491121109858), + TrajectoryPoint(30, 299.702170717293), + TrajectoryPoint(40, 298.914665487845), + TrajectoryPoint(50, 298.129223644152), + TrajectoryPoint(60, 297.345853927624), + TrajectoryPoint(70, 296.563820490689), + TrajectoryPoint(80, 295.783602323619), + TrajectoryPoint(90, 295.00533815445), + TrajectoryPoint(100, 294.228307119065), + TrajectoryPoint(110, 293.452819718114), + TrajectoryPoint(120, 292.679224126974), + TrajectoryPoint(130, 291.906764298408), + TrajectoryPoint(140, 291.135564676896), + TrajectoryPoint(150, 290.366235613441), + TrajectoryPoint(160, 289.597950630174), + TrajectoryPoint(170, 288.830710980609), + TrajectoryPoint(180, 288.065207021853), + TrajectoryPoint(190, 287.300732256125), + TrajectoryPoint(200, 286.537215063426), + TrajectoryPoint(210, 285.775072312501), + TrajectoryPoint(220, 285.014072019631), + TrajectoryPoint(230, 284.253947184692), + TrajectoryPoint(240, 283.494855065458), + TrajectoryPoint(250, 282.737019765228), + TrajectoryPoint(260, 281.979983109053), + TrajectoryPoint(270, 281.223740637355), + TrajectoryPoint(280, 280.468703639159), + TrajectoryPoint(290, 279.714474489984), + TrajectoryPoint(300, 278.960967187913), + TrajectoryPoint(310, 278.208322272214), + TrajectoryPoint(320, 277.456641258269), + TrajectoryPoint(330, 276.705614479093), + TrajectoryPoint(340, 275.955235386603), + TrajectoryPoint(350, 275.205764771881), + TrajectoryPoint(360, 274.45698276563), + TrajectoryPoint(370, 273.708785099439), + TrajectoryPoint(380, 272.961181640015), + TrajectoryPoint(390, 272.214425718729), + TrajectoryPoint(400, 271.468194811764), + TrajectoryPoint(410, 270.722481402175), + TrajectoryPoint(420, 269.977345005864), + TrajectoryPoint(430, 269.232881205453), + TrajectoryPoint(440, 268.488879332984), + TrajectoryPoint(450, 267.745331301343), + TrajectoryPoint(460, 267.002302542902), + TrajectoryPoint(470, 266.259829357971), + TrajectoryPoint(480, 265.517757929603), + TrajectoryPoint(490, 264.776079820701), + TrajectoryPoint(500, 264.034838789808), + TrajectoryPoint(510, 263.294075840271), + TrajectoryPoint(520, 262.553657291377), + TrajectoryPoint(530, 261.81357450036), + TrajectoryPoint(540, 261.073834682011), + TrajectoryPoint(550, 260.334520377147), + TrajectoryPoint(560, 259.595495732297), + TrajectoryPoint(570, 258.856751987392), + TrajectoryPoint(580, 258.118280077911), + TrajectoryPoint(590, 257.380144334293), + TrajectoryPoint(600, 256.642270843228), + TrajectoryPoint(610, 255.904625792646), + TrajectoryPoint(620, 255.167200100097), + TrajectoryPoint(630, 254.429999352348), + TrajectoryPoint(640, 253.69304823738), + TrajectoryPoint(650, 252.956275170492), + TrajectoryPoint(660, 252.219671054657), + TrajectoryPoint(670, 251.48322659904), + TrajectoryPoint(680, 250.746951343062), + TrajectoryPoint(690, 250.010835063108), + TrajectoryPoint(700, 249.274839038593), + TrajectoryPoint(710, 248.538953971673), + TrajectoryPoint(720, 247.803170407221), + TrajectoryPoint(730, 247.067487042621), + TrajectoryPoint(740, 246.331894818822), + TrajectoryPoint(750, 245.596366175884), + TrajectoryPoint(760, 244.860891629051), + TrajectoryPoint(770, 244.125461557425), + TrajectoryPoint(780, 243.390066212587), + TrajectoryPoint(790, 242.65469774577), + TrajectoryPoint(800, 241.919337249188), + TrajectoryPoint(810, 241.183974688883), + TrajectoryPoint(820, 240.448600248096), + TrajectoryPoint(830, 239.713203990093), + TrajectoryPoint(840, 238.977774918537), + TrajectoryPoint(850, 238.242290594339), + TrajectoryPoint(860, 237.506748293902), + TrajectoryPoint(870, 236.771137957671), + TrajectoryPoint(880, 236.035449407421), + TrajectoryPoint(890, 235.299672349097), + TrajectoryPoint(900, 234.563796375107), + TrajectoryPoint(910, 233.827794991186), + TrajectoryPoint(920, 233.091660631903), + TrajectoryPoint(930, 232.355391342524), + TrajectoryPoint(940, 231.618976523643), + TrajectoryPoint(950, 230.882405457039), + TrajectoryPoint(960, 230.145667306405), + TrajectoryPoint(970, 229.408751117752), + TrajectoryPoint(980, 228.671635701729), + TrajectoryPoint(990, 227.934294166951), + TrajectoryPoint(1000, 227.19673816758), + TrajectoryPoint(1010, 226.458956483501), + TrajectoryPoint(1020, 225.720937768584), + TrajectoryPoint(1030, 224.982670550241), + TrajectoryPoint(1040, 224.244143228798), + TrajectoryPoint(1050, 223.505344076689), + TrajectoryPoint(1060, 222.766261237503), + TrajectoryPoint(1070, 222.026863688119), + TrajectoryPoint(1080, 221.287137674446), + TrajectoryPoint(1090, 220.547090217814), + TrajectoryPoint(1100, 219.806709106491), + TrajectoryPoint(1110, 219.065981989997), + TrajectoryPoint(1120, 218.324896377835), + TrajectoryPoint(1130, 217.583439638138), + TrajectoryPoint(1140, 216.841598996232), + TrajectoryPoint(1150, 216.099361533141), + TrajectoryPoint(1160, 215.356714184023), + TrajectoryPoint(1170, 214.613643736552), + TrajectoryPoint(1180, 213.870136829261), + TrajectoryPoint(1190, 213.126170717301), + TrajectoryPoint(1200, 212.381717538548), + TrajectoryPoint(1210, 211.636787259112), + TrajectoryPoint(1220, 210.891366055542), + TrajectoryPoint(1230, 210.145439945339), + TrajectoryPoint(1240, 209.398994785252), + TrajectoryPoint(1250, 208.652016269547), + TrajectoryPoint(1260, 207.904489928243), + TrajectoryPoint(1270, 207.15640112533), + TrajectoryPoint(1280, 206.407735056959), + TrajectoryPoint(1290, 205.658476749612), + TrajectoryPoint(1300, 204.908611058253), + TrajectoryPoint(1310, 204.158122664457), + TrajectoryPoint(1320, 203.406996074525), + TrajectoryPoint(1330, 202.655215617572), + TrajectoryPoint(1340, 201.902765443604), + TrajectoryPoint(1350, 201.149629521576), + TrajectoryPoint(1360, 200.395791637429), + TrajectoryPoint(1370, 199.641235392104), + TrajectoryPoint(1380, 198.885944199545), + TrajectoryPoint(1390, 198.129901284676), + TrajectoryPoint(1400, 197.373089681352), + TrajectoryPoint(1410, 196.615492230299), + TrajectoryPoint(1420, 195.857091577015), + TrajectoryPoint(1430, 195.097870169659), + TrajectoryPoint(1440, 194.337810256905), + TrajectoryPoint(1450, 193.576893885771), + TrajectoryPoint(1460, 192.815102899419), + TrajectoryPoint(1470, 192.052418934917), + TrajectoryPoint(1480, 191.28882342098), + TrajectoryPoint(1490, 190.524297575662), + TrajectoryPoint(1500, 189.758822404022), + TrajectoryPoint(1510, 188.992378695747), + TrajectoryPoint(1520, 188.224947022734), + TrajectoryPoint(1530, 187.456507736631), + TrajectoryPoint(1540, 186.687007097776), + TrajectoryPoint(1550, 185.916424062951), + TrajectoryPoint(1560, 185.144767454131), + TrajectoryPoint(1570, 184.372016551082), + TrajectoryPoint(1580, 183.598150398927), + TrajectoryPoint(1590, 182.823147805338), + TrajectoryPoint(1600, 182.04698733767), + TrajectoryPoint(1610, 181.269647320034), + TrajectoryPoint(1620, 180.491105830314), + TrajectoryPoint(1630, 179.711340697107), + TrajectoryPoint(1640, 178.930329496607), + TrajectoryPoint(1650, 178.147947136677), + TrajectoryPoint(1660, 177.364243257019), + TrajectoryPoint(1670, 176.579216819201), + TrajectoryPoint(1680, 175.792844173203), + TrajectoryPoint(1690, 175.005101397885), + TrajectoryPoint(1700, 174.215964297355), + TrajectoryPoint(1710, 173.425408397248), + TrajectoryPoint(1720, 172.633318293357), + TrajectoryPoint(1730, 171.839667760365), + TrajectoryPoint(1740, 171.044514186522), + TrajectoryPoint(1750, 170.247831744235), + TrajectoryPoint(1760, 169.449594304936), + TrajectoryPoint(1770, 168.649775434732), + TrajectoryPoint(1780, 167.848194078533), + TrajectoryPoint(1790, 167.044898394487), + TrajectoryPoint(1800, 166.239929641765), + TrajectoryPoint(1810, 165.433259901502), + TrajectoryPoint(1820, 164.624860923029), + TrajectoryPoint(1830, 163.814504615403), + TrajectoryPoint(1840, 163.002279377408), + TrajectoryPoint(1850, 162.188226412389), + TrajectoryPoint(1860, 161.372315854339), + TrajectoryPoint(1870, 160.554397107095), + TrajectoryPoint(1880, 159.734356207082), + TrajectoryPoint(1890, 158.912353140556), + TrajectoryPoint(1900, 158.088356304321), + TrajectoryPoint(1910, 157.262162876543), + TrajectoryPoint(1920, 156.433710681681), + TrajectoryPoint(1930, 155.603153597557), + TrajectoryPoint(1940, 154.770458146832), + TrajectoryPoint(1950, 153.935217717632), + TrajectoryPoint(1960, 153.097719365726), + TrajectoryPoint(1970, 152.25796446136), + TrajectoryPoint(1980, 151.415634184284), + TrajectoryPoint(1990, 150.570793129015), + TrajectoryPoint(2000, 149.723571394655), + TrajectoryPoint(2010, 148.873646457975), + TrajectoryPoint(2020, 148.021039539323), + TrajectoryPoint(2030, 147.165921480811), + TrajectoryPoint(2040, 146.307862644019), + TrajectoryPoint(2050, 145.447043535177), + TrajectoryPoint(2060, 144.583559416925), + TrajectoryPoint(2070, 143.716807364778), + TrajectoryPoint(2080, 142.847304983319), + TrajectoryPoint(2090, 141.974698885068), + TrajectoryPoint(2100, 141.098915997998), + TrajectoryPoint(2110, 140.220179312071), + TrajectoryPoint(2120, 139.337859881156), + TrajectoryPoint(2130, 138.452528310586), + TrajectoryPoint(2140, 137.563560888472), + TrajectoryPoint(2150, 136.671309468751), + TrajectoryPoint(2160, 135.775415337803), + TrajectoryPoint(2170, 134.87596072313), + TrajectoryPoint(2180, 133.972790080309), + TrajectoryPoint(2190, 133.065836444909), + TrajectoryPoint(2200, 132.155020849643), + TrajectoryPoint(2210, 131.240259183704), + TrajectoryPoint(2220, 130.321410479502), + TrajectoryPoint(2230, 129.398517831588), + TrajectoryPoint(2240, 128.471226978858), + TrajectoryPoint(2250, 127.539865640516), + TrajectoryPoint(2260, 126.603701453196), + TrajectoryPoint(2270, 125.663309988986), + TrajectoryPoint(2280, 124.718025858879), + TrajectoryPoint(2290, 123.76805145046), + TrajectoryPoint(2300, 122.813350576483), + TrajectoryPoint(2310, 121.853298152063), + TrajectoryPoint(2320, 120.888348077339), + TrajectoryPoint(2330, 119.91812865462), + TrajectoryPoint(2340, 118.942281245863), + TrajectoryPoint(2350, 117.96107854333), + TrajectoryPoint(2360, 116.974257564548), + TrajectoryPoint(2370, 115.981261262861), + TrajectoryPoint(2380, 114.982405044875), + TrajectoryPoint(2390, 113.977503313372), + TrajectoryPoint(2400, 112.966176968259), + TrajectoryPoint(2410, 111.948128182834), + TrajectoryPoint(2420, 110.923456070084), + TrajectoryPoint(2430, 109.891946232427), + TrajectoryPoint(2440, 108.853375788698), + TrajectoryPoint(2450, 107.807447480798), + TrajectoryPoint(2460, 106.753748557927), + TrajectoryPoint(2470, 105.692299887575), + TrajectoryPoint(2480, 104.622843023794), + TrajectoryPoint(2490, 103.545108957455), + TrajectoryPoint(2500, 102.458817596743), + TrajectoryPoint(2510, 101.363677215584), + TrajectoryPoint(2520, 100.259383867739), + TrajectoryPoint(2530, 99.145620764131), + TrajectoryPoint(2540, 98.022057610739), + TrajectoryPoint(2550, 96.8883499041892), + TrajectoryPoint(2560, 95.7441381819142), + TrajectoryPoint(2570, 94.5890472234842), + TrajectoryPoint(2580, 93.4226851994185), + TrajectoryPoint(2590, 92.2446427634535), + TrajectoryPoint(2600, 91.0540764463066), + TrajectoryPoint(2610, 89.8508029793147), + TrajectoryPoint(2620, 88.6344115717177), + TrajectoryPoint(2630, 87.4044061113322), + TrajectoryPoint(2640, 86.1597458686576), + TrajectoryPoint(2650, 84.8999679533911), + TrajectoryPoint(2660, 83.6248175705883), + TrajectoryPoint(2670, 82.332785568018), + TrajectoryPoint(2680, 81.0237027607831), + TrajectoryPoint(2690, 79.6964368159266), + TrajectoryPoint(2700, 78.3501310720769), + TrajectoryPoint(2710, 76.9836434336008), + TrajectoryPoint(2720, 75.596394789743), + TrajectoryPoint(2730, 74.1861268698245), + TrajectoryPoint(2740, 72.7524995539877), + TrajectoryPoint(2750, 71.2939469249545), + TrajectoryPoint(2760, 69.8086912187827), + TrajectoryPoint(2770, 68.2946548536581), + TrajectoryPoint(2780, 66.7503269355503), + TrajectoryPoint(2790, 65.1735241053439), + TrajectoryPoint(2800, 63.561855575424), + TrajectoryPoint(2810, 61.9120577258536), + TrajectoryPoint(2820, 60.2214116919876), + TrajectoryPoint(2830, 58.4867728612634), + TrajectoryPoint(2840, 56.7033677976602), + TrajectoryPoint(2850, 54.8670454580777), + TrajectoryPoint(2860, 52.9714939320771), + TrajectoryPoint(2870, 51.0109264622454), + TrajectoryPoint(2880, 48.9772167041765), + TrajectoryPoint(2890, 46.8608545317755), + TrajectoryPoint(2900, 44.6506405607068), + TrajectoryPoint(2910, 42.330087269351), + TrajectoryPoint(2920, 39.8818923955105), + TrajectoryPoint(2930, 37.2802816166748), + TrajectoryPoint(2940, 34.4908226210146), + TrajectoryPoint(2950, 31.4629279564184), + TrajectoryPoint(2960, 28.1211442851284), + TrajectoryPoint(2970, 24.3339213393453), + TrajectoryPoint(2980, 19.8519267114811), + TrajectoryPoint(2990, 14.0232160177106), TrajectoryPoint(3000, 0), }; TrajectoryPoint t5_closed[] = { - TrajectoryPoint(0, 287.645068077735), - TrajectoryPoint(10, 286.962205130311), - TrajectoryPoint(20, 286.280179676493), - TrajectoryPoint(30, 285.598860517744), - TrajectoryPoint(40, 284.918429532041), - TrajectoryPoint(50, 284.238547504384), - TrajectoryPoint(60, 283.559211689187), - TrajectoryPoint(70, 282.880732817141), - TrajectoryPoint(80, 282.202794897937), - TrajectoryPoint(90, 281.525351622756), - TrajectoryPoint(100, 280.848541071326), - TrajectoryPoint(110, 280.172359709641), - TrajectoryPoint(120, 279.496623828556), - TrajectoryPoint(130, 278.821328872096), - TrajectoryPoint(140, 278.146715039818), - TrajectoryPoint(150, 277.472512081307), - TrajectoryPoint(160, 276.798702896296), - TrajectoryPoint(170, 276.125366203722), - TrajectoryPoint(180, 275.452531494382), - TrajectoryPoint(190, 274.780045558337), - TrajectoryPoint(200, 274.107902768587), - TrajectoryPoint(210, 273.436225799665), - TrajectoryPoint(220, 272.764909414153), - TrajectoryPoint(230, 272.093893075098), - TrajectoryPoint(240, 271.423170548129), - TrajectoryPoint(250, 270.752872388411), - TrajectoryPoint(260, 270.082838729061), - TrajectoryPoint(270, 269.41305761704), - TrajectoryPoint(280, 268.743535533207), - TrajectoryPoint(290, 268.074347999303), - TrajectoryPoint(300, 267.405373454689), - TrajectoryPoint(310, 266.736605246243), - TrajectoryPoint(320, 266.068049577673), - TrajectoryPoint(330, 265.399753173828), - TrajectoryPoint(340, 264.731625122843), - TrajectoryPoint(350, 264.06365847463), - TrajectoryPoint(360, 263.395849868737), - TrajectoryPoint(370, 262.728240782365), - TrajectoryPoint(380, 262.060756558422), - TrajectoryPoint(390, 261.393390020641), - TrajectoryPoint(400, 260.726133749202), - TrajectoryPoint(410, 260.059010182716), - TrajectoryPoint(420, 259.391976029199), - TrajectoryPoint(430, 258.725016965189), - TrajectoryPoint(440, 258.058125427881), - TrajectoryPoint(450, 257.391301739614), - TrajectoryPoint(460, 256.724531778613), - TrajectoryPoint(470, 256.0577953091), - TrajectoryPoint(480, 255.391084646739), - TrajectoryPoint(490, 254.724391940888), - TrajectoryPoint(500, 254.057706940469), - TrajectoryPoint(510, 253.391014925052), - TrajectoryPoint(520, 252.724307867906), - TrajectoryPoint(530, 252.0575778245), - TrajectoryPoint(540, 251.390814826726), - TrajectoryPoint(550, 250.723994890922), - TrajectoryPoint(560, 250.057119779301), - TrajectoryPoint(570, 249.390181448748), - TrajectoryPoint(580, 248.723171730173), - TrajectoryPoint(590, 248.056079187464), - TrajectoryPoint(600, 247.388869047185), - TrajectoryPoint(610, 246.721556001355), - TrajectoryPoint(620, 246.054131779844), - TrajectoryPoint(630, 245.386588000762), - TrajectoryPoint(640, 244.718916175861), - TrajectoryPoint(650, 244.051073881721), - TrajectoryPoint(660, 243.383072751928), - TrajectoryPoint(670, 242.714912529256), - TrajectoryPoint(680, 242.046584614037), - TrajectoryPoint(690, 241.378080307108), - TrajectoryPoint(700, 240.709385427713), - TrajectoryPoint(710, 240.040449230509), - TrajectoryPoint(720, 239.371305855379), - TrajectoryPoint(730, 238.701946468383), - TrajectoryPoint(740, 238.032362139138), - TrajectoryPoint(750, 237.362543843013), - TrajectoryPoint(760, 236.692482463019), - TrajectoryPoint(770, 236.022113617346), - TrajectoryPoint(780, 235.351476653399), - TrajectoryPoint(790, 234.680565756963), - TrajectoryPoint(800, 234.009371644625), - TrajectoryPoint(810, 233.337884939232), - TrajectoryPoint(820, 232.666096170764), - TrajectoryPoint(830, 231.993988417772), - TrajectoryPoint(840, 231.321503974306), - TrajectoryPoint(850, 230.648686359201), - TrajectoryPoint(860, 229.975525900583), - TrajectoryPoint(870, 229.302012830173), - TrajectoryPoint(880, 228.628137283441), - TrajectoryPoint(890, 227.95388929962), - TrajectoryPoint(900, 227.279258821564), - TrajectoryPoint(910, 226.604215383972), - TrajectoryPoint(920, 225.928726336818), - TrajectoryPoint(930, 225.25282291406), - TrajectoryPoint(940, 224.576494809445), - TrajectoryPoint(950, 223.899731614758), - TrajectoryPoint(960, 223.22252281927), - TrajectoryPoint(970, 222.544857809092), - TrajectoryPoint(980, 221.866725866438), - TrajectoryPoint(990, 221.188116168805), - TrajectoryPoint(1000, 220.509017788083), - TrajectoryPoint(1010, 219.829370965822), - TrajectoryPoint(1020, 219.149204865238), - TrajectoryPoint(1030, 218.468516679728), - TrajectoryPoint(1040, 217.787295170526), - TrajectoryPoint(1050, 217.10552898627), - TrajectoryPoint(1060, 216.423206661892), - TrajectoryPoint(1070, 215.740316617464), - TrajectoryPoint(1080, 215.056847156983), - TrajectoryPoint(1090, 214.372786467116), - TrajectoryPoint(1100, 213.688122615898), - TrajectoryPoint(1110, 213.002843551388), - TrajectoryPoint(1120, 212.316937100288), - TrajectoryPoint(1130, 211.630390966522), - TrajectoryPoint(1140, 210.943188669665), - TrajectoryPoint(1150, 210.255287974639), - TrajectoryPoint(1160, 209.566711388752), - TrajectoryPoint(1170, 208.877446223105), - TrajectoryPoint(1180, 208.187479658105), - TrajectoryPoint(1190, 207.496798741929), - TrajectoryPoint(1200, 206.805390388963), - TrajectoryPoint(1210, 206.113241378201), - TrajectoryPoint(1220, 205.42033835162), - TrajectoryPoint(1230, 204.726667812527), - TrajectoryPoint(1240, 204.032216123872), - TrajectoryPoint(1250, 203.336969506533), - TrajectoryPoint(1260, 202.640914037577), - TrajectoryPoint(1270, 201.944035648488), - TrajectoryPoint(1280, 201.246320123365), - TrajectoryPoint(1290, 200.5477530971), - TrajectoryPoint(1300, 199.848320053519), - TrajectoryPoint(1310, 199.148006323497), - TrajectoryPoint(1320, 198.446797083045), - TrajectoryPoint(1330, 197.744677351369), - TrajectoryPoint(1340, 197.041631988893), - TrajectoryPoint(1350, 196.337645695257), - TrajectoryPoint(1360, 195.632703007283), - TrajectoryPoint(1370, 194.92678829691), - TrajectoryPoint(1380, 194.219885769091), - TrajectoryPoint(1390, 193.511979459665), - TrajectoryPoint(1400, 192.80305323319), - TrajectoryPoint(1410, 192.093090780743), - TrajectoryPoint(1420, 191.382075617684), - TrajectoryPoint(1430, 190.669991081381), - TrajectoryPoint(1440, 189.956820328903), - TrajectoryPoint(1450, 189.242546334669), - TrajectoryPoint(1460, 188.527092475612), - TrajectoryPoint(1470, 187.810495305715), - TrajectoryPoint(1480, 187.092737497607), - TrajectoryPoint(1490, 186.373801139469), - TrajectoryPoint(1500, 185.653668123152), - TrajectoryPoint(1510, 184.932320141534), - TrajectoryPoint(1520, 184.209738685825), - TrajectoryPoint(1530, 183.485905042824), - TrajectoryPoint(1540, 182.760800292131), - TrajectoryPoint(1550, 182.034405303298), - TrajectoryPoint(1560, 181.306700732938), - TrajectoryPoint(1570, 180.577667021772), - TrajectoryPoint(1580, 179.847183515782), - TrajectoryPoint(1590, 179.115302276004), - TrajectoryPoint(1600, 178.382024949056), - TrajectoryPoint(1610, 177.647330930922), - TrajectoryPoint(1620, 176.911199384181), - TrajectoryPoint(1630, 176.173609234648), - TrajectoryPoint(1640, 175.434539167953), - TrajectoryPoint(1650, 174.693967626053), - TrajectoryPoint(1660, 173.951711763561), - TrajectoryPoint(1670, 173.207888040727), - TrajectoryPoint(1680, 172.46248839248), - TrajectoryPoint(1690, 171.715490081693), - TrajectoryPoint(1700, 170.966870106656), - TrajectoryPoint(1710, 170.216605197079), - TrajectoryPoint(1720, 169.46451729046), - TrajectoryPoint(1730, 168.710661360815), - TrajectoryPoint(1740, 167.95507963025), - TrajectoryPoint(1750, 167.197747528185), - TrajectoryPoint(1760, 166.438640191411), - TrajectoryPoint(1770, 165.677613836988), - TrajectoryPoint(1780, 164.914606290587), - TrajectoryPoint(1790, 164.149736679401), - TrajectoryPoint(1800, 163.382978722402), - TrajectoryPoint(1810, 162.614305818787), - TrajectoryPoint(1820, 161.843425105075), - TrajectoryPoint(1830, 161.070517782534), - TrajectoryPoint(1840, 160.29560217459), - TrajectoryPoint(1850, 159.518650129482), - TrajectoryPoint(1860, 158.73937179666), - TrajectoryPoint(1870, 157.957894430793), - TrajectoryPoint(1880, 157.174281483588), - TrajectoryPoint(1890, 156.388503129619), - TrajectoryPoint(1900, 155.600132266168), - TrajectoryPoint(1910, 154.80951789124), - TrajectoryPoint(1920, 154.016632695386), - TrajectoryPoint(1930, 153.22120508215), - TrajectoryPoint(1940, 152.423230802707), - TrajectoryPoint(1950, 151.622875024949), - TrajectoryPoint(1960, 150.819938204493), - TrajectoryPoint(1970, 150.01422643591), - TrajectoryPoint(1980, 149.206016883473), - TrajectoryPoint(1990, 148.39508871791), - TrajectoryPoint(2000, 147.581241503595), - TrajectoryPoint(2010, 146.764774235666), - TrajectoryPoint(2020, 145.94534089845), - TrajectoryPoint(2030, 145.122938527948), - TrajectoryPoint(2040, 144.297787439618), - TrajectoryPoint(2050, 143.46930120438), - TrajectoryPoint(2060, 142.637900702192), - TrajectoryPoint(2070, 141.803374139476), - TrajectoryPoint(2080, 140.965492781696), - TrajectoryPoint(2090, 140.124626254003), - TrajectoryPoint(2100, 139.280042978536), - TrajectoryPoint(2110, 138.432349435245), - TrajectoryPoint(2120, 137.581006048985), - TrajectoryPoint(2130, 136.726229787813), - TrajectoryPoint(2140, 135.867810868594), - TrajectoryPoint(2150, 135.005685130171), - TrajectoryPoint(2160, 134.139858995665), - TrajectoryPoint(2170, 133.270105353598), - TrajectoryPoint(2180, 132.396523126834), - TrajectoryPoint(2190, 131.518850833749), - TrajectoryPoint(2200, 130.63714543608), - TrajectoryPoint(2210, 129.751250722126), - TrajectoryPoint(2220, 128.861035787662), - TrajectoryPoint(2230, 127.96660110763), - TrajectoryPoint(2240, 127.067469812509), - TrajectoryPoint(2250, 126.164109917979), - TrajectoryPoint(2260, 125.255686836633), - TrajectoryPoint(2270, 124.342741643179), - TrajectoryPoint(2280, 123.424887648915), - TrajectoryPoint(2290, 122.501891389149), - TrajectoryPoint(2300, 121.574034873178), - TrajectoryPoint(2310, 120.640693507332), - TrajectoryPoint(2320, 119.702015964978), - TrajectoryPoint(2330, 118.758048281497), - TrajectoryPoint(2340, 117.808203416895), - TrajectoryPoint(2350, 116.852573991573), - TrajectoryPoint(2360, 115.891181538506), - TrajectoryPoint(2370, 114.92373303021), - TrajectoryPoint(2380, 113.949759432374), - TrajectoryPoint(2390, 112.969501901223), - TrajectoryPoint(2400, 111.9827679883), - TrajectoryPoint(2410, 110.989357878944), - TrajectoryPoint(2420, 109.988706183813), - TrajectoryPoint(2430, 108.980929459917), - TrajectoryPoint(2440, 107.965858474578), - TrajectoryPoint(2450, 106.943262528051), - TrajectoryPoint(2460, 105.912901792707), - TrajectoryPoint(2470, 104.874526875667), - TrajectoryPoint(2480, 103.827878355339), - TrajectoryPoint(2490, 102.772677167077), - TrajectoryPoint(2500, 101.708557360755), - TrajectoryPoint(2510, 100.635367250582), - TrajectoryPoint(2520, 99.552805230541), - TrajectoryPoint(2530, 98.4605570804311), - TrajectoryPoint(2540, 97.3582953162009), - TrajectoryPoint(2550, 96.2455388771763), - TrajectoryPoint(2560, 95.1219819583308), - TrajectoryPoint(2570, 93.987273383584), - TrajectoryPoint(2580, 92.8410207208554), - TrajectoryPoint(2590, 91.6828140537279), - TrajectoryPoint(2600, 90.512225012325), - TrajectoryPoint(2610, 89.3288057385688), - TrajectoryPoint(2620, 88.1314234939478), - TrajectoryPoint(2630, 86.9201233757825), - TrajectoryPoint(2640, 85.6944127842922), - TrajectoryPoint(2650, 84.4531857280538), - TrajectoryPoint(2660, 83.19587506461), - TrajectoryPoint(2670, 81.922289877814), - TrajectoryPoint(2680, 80.6304531093402), - TrajectoryPoint(2690, 79.320897779959), - TrajectoryPoint(2700, 77.9913404068083), - TrajectoryPoint(2710, 76.6420179970206), - TrajectoryPoint(2720, 75.2708156965392), - TrajectoryPoint(2730, 73.8770583983956), - TrajectoryPoint(2740, 72.4596041725589), - TrajectoryPoint(2750, 71.0166546604778), - TrajectoryPoint(2760, 69.546417318339), - TrajectoryPoint(2770, 68.0475398784428), - TrajectoryPoint(2780, 66.5180214027292), - TrajectoryPoint(2790, 64.9556754772321), - TrajectoryPoint(2800, 63.3581084445769), - TrajectoryPoint(2810, 61.7226323658535), - TrajectoryPoint(2820, 60.0453402080718), - TrajectoryPoint(2830, 58.3236907658563), - TrajectoryPoint(2840, 56.5534143388102), - TrajectoryPoint(2850, 54.7293121670692), - TrajectoryPoint(2860, 52.846062426764), - TrajectoryPoint(2870, 50.8973647052268), - TrajectoryPoint(2880, 48.8750854019792), - TrajectoryPoint(2890, 46.7697077272905), - TrajectoryPoint(2900, 44.5700262445342), - TrajectoryPoint(2910, 42.2598785685748), - TrajectoryPoint(2920, 39.8215676355347), - TrajectoryPoint(2930, 37.2293062194413), - TrajectoryPoint(2940, 34.4489054426478), - TrajectoryPoint(2950, 31.4294491888299), - TrajectoryPoint(2960, 28.0954663394126), - TrajectoryPoint(2970, 24.3157153411942), - TrajectoryPoint(2980, 19.8405094431073), - TrajectoryPoint(2990, 14.0179386944373), + TrajectoryPoint(0, 301.046286812416), + TrajectoryPoint(10, 300.262080167516), + TrajectoryPoint(20, 299.479632456864), + TrajectoryPoint(30, 298.69863993793), + TrajectoryPoint(40, 297.920072960059), + TrajectoryPoint(50, 297.143073369851), + TrajectoryPoint(60, 296.36738021579), + TrajectoryPoint(70, 295.593824959882), + TrajectoryPoint(80, 294.821771625572), + TrajectoryPoint(90, 294.050923153679), + TrajectoryPoint(100, 293.281908321352), + TrajectoryPoint(110, 292.51437751091), + TrajectoryPoint(120, 291.747955770666), + TrajectoryPoint(130, 290.983057206608), + TrajectoryPoint(140, 290.219658812596), + TrajectoryPoint(150, 289.457279351584), + TrajectoryPoint(160, 288.696114421105), + TrajectoryPoint(170, 287.936489055806), + TrajectoryPoint(180, 287.177797942716), + TrajectoryPoint(190, 286.420039874811), + TrajectoryPoint(200, 285.663836979323), + TrajectoryPoint(210, 284.90850806802), + TrajectoryPoint(220, 284.154031639775), + TrajectoryPoint(230, 283.400757099651), + TrajectoryPoint(240, 282.648489517102), + TrajectoryPoint(250, 281.896999040174), + TrajectoryPoint(260, 281.146381235501), + TrajectoryPoint(270, 280.396897076321), + TrajectoryPoint(280, 279.648119477549), + TrajectoryPoint(290, 278.900043110584), + TrajectoryPoint(300, 278.152953091813), + TrajectoryPoint(310, 277.406635798875), + TrajectoryPoint(320, 276.66095339662), + TrajectoryPoint(330, 275.915940768298), + TrajectoryPoint(340, 275.171849774252), + TrajectoryPoint(350, 274.428331553245), + TrajectoryPoint(360, 273.685379263676), + TrajectoryPoint(370, 272.943116211066), + TrajectoryPoint(380, 272.201548820738), + TrajectoryPoint(390, 271.460489111542), + TrajectoryPoint(400, 270.719929431672), + TrajectoryPoint(410, 269.980022548625), + TrajectoryPoint(420, 269.240660439356), + TrajectoryPoint(430, 268.50174377852), + TrajectoryPoint(440, 267.763264401827), + TrajectoryPoint(450, 267.025365040149), + TrajectoryPoint(460, 266.287912636399), + TrajectoryPoint(470, 265.550846332841), + TrajectoryPoint(480, 264.814157655309), + TrajectoryPoint(490, 264.077955017661), + TrajectoryPoint(500, 263.342137242261), + TrajectoryPoint(510, 262.6066489899), + TrajectoryPoint(520, 261.871481608635), + TrajectoryPoint(530, 261.13669692773), + TrajectoryPoint(540, 260.40225692673), + TrajectoryPoint(550, 259.668092437142), + TrajectoryPoint(560, 258.934194709273), + TrajectoryPoint(570, 258.200576326036), + TrajectoryPoint(580, 257.467273234811), + TrajectoryPoint(590, 256.73419394488), + TrajectoryPoint(600, 256.001329650624), + TrajectoryPoint(610, 255.268671306466), + TrajectoryPoint(620, 254.536255635831), + TrajectoryPoint(630, 253.80403652568), + TrajectoryPoint(640, 253.071982662804), + TrajectoryPoint(650, 252.34008499506), + TrajectoryPoint(660, 251.608334285473), + TrajectoryPoint(670, 250.876759097087), + TrajectoryPoint(680, 250.145303822258), + TrajectoryPoint(690, 249.413956655286), + TrajectoryPoint(700, 248.68270835716), + TrajectoryPoint(710, 247.951549538284), + TrajectoryPoint(720, 247.220488315995), + TrajectoryPoint(730, 246.48949038575), + TrajectoryPoint(740, 245.758544525721), + TrajectoryPoint(750, 245.027641320438), + TrajectoryPoint(760, 244.296771223538), + TrajectoryPoint(770, 243.565925811792), + TrajectoryPoint(780, 242.835089258695), + TrajectoryPoint(790, 242.104249447784), + TrajectoryPoint(800, 241.373396766021), + TrajectoryPoint(810, 240.642521479156), + TrajectoryPoint(820, 239.911613737004), + TrajectoryPoint(830, 239.180652452415), + TrajectoryPoint(840, 238.449630482949), + TrajectoryPoint(850, 237.718540359914), + TrajectoryPoint(860, 236.987372114153), + TrajectoryPoint(870, 236.256115661446), + TrajectoryPoint(880, 235.524760805174), + TrajectoryPoint(890, 234.79328577606), + TrajectoryPoint(900, 234.061673980628), + TrajectoryPoint(910, 233.329928290561), + TrajectoryPoint(920, 232.598038328436), + TrajectoryPoint(930, 231.865993600168), + TrajectoryPoint(940, 231.133783495997), + TrajectoryPoint(950, 230.401397291126), + TrajectoryPoint(960, 229.668814120077), + TrajectoryPoint(970, 228.936006121261), + TrajectoryPoint(980, 228.202986190168), + TrajectoryPoint(990, 227.469743349616), + TrajectoryPoint(1000, 226.736266499661), + TrajectoryPoint(1010, 226.002544417317), + TrajectoryPoint(1020, 225.268565756076), + TrajectoryPoint(1030, 224.534319045237), + TrajectoryPoint(1040, 223.799792689076), + TrajectoryPoint(1050, 223.064942270238), + TrajectoryPoint(1060, 222.329779570178), + TrajectoryPoint(1070, 221.594300162182), + TrajectoryPoint(1080, 220.858492110694), + TrajectoryPoint(1090, 220.122343345502), + TrajectoryPoint(1100, 219.385841660546), + TrajectoryPoint(1110, 218.648974712638), + TrajectoryPoint(1120, 217.911730020097), + TrajectoryPoint(1130, 217.174094961308), + TrajectoryPoint(1140, 216.436056773213), + TrajectoryPoint(1150, 215.697602549745), + TrajectoryPoint(1160, 214.958699229347), + TrajectoryPoint(1170, 214.219337345967), + TrajectoryPoint(1180, 213.479519906004), + TrajectoryPoint(1190, 212.739233565684), + TrajectoryPoint(1200, 211.998464828402), + TrajectoryPoint(1210, 211.257200043086), + TrajectoryPoint(1220, 210.515425402525), + TrajectoryPoint(1230, 209.773126941666), + TrajectoryPoint(1240, 209.030290535881), + TrajectoryPoint(1250, 208.286901899205), + TrajectoryPoint(1260, 207.542946582554), + TrajectoryPoint(1270, 206.798409971917), + TrajectoryPoint(1280, 206.053277286532), + TrajectoryPoint(1290, 205.307533577034), + TrajectoryPoint(1300, 204.561163723594), + TrajectoryPoint(1310, 203.814152434032), + TrajectoryPoint(1320, 203.066484241916), + TrajectoryPoint(1330, 202.318143504642), + TrajectoryPoint(1340, 201.569114401494), + TrajectoryPoint(1350, 200.819380931695), + TrajectoryPoint(1360, 200.068926912423), + TrajectoryPoint(1370, 199.317735976825), + TrajectoryPoint(1380, 198.565791571998), + TrajectoryPoint(1390, 197.813076956957), + TrajectoryPoint(1400, 197.059575200578), + TrajectoryPoint(1410, 196.305269179516), + TrajectoryPoint(1420, 195.550141576102), + TrajectoryPoint(1430, 194.794174876212), + TrajectoryPoint(1440, 194.03735136711), + TrajectoryPoint(1450, 193.279653135261), + TrajectoryPoint(1460, 192.521062064114), + TrajectoryPoint(1470, 191.761559831856), + TrajectoryPoint(1480, 191.001127909126), + TrajectoryPoint(1490, 190.239747556697), + TrajectoryPoint(1500, 189.477399823124), + TrajectoryPoint(1510, 188.714065542347), + TrajectoryPoint(1520, 187.949725331258), + TrajectoryPoint(1530, 187.184359587217), + TrajectoryPoint(1540, 186.417948485534), + TrajectoryPoint(1550, 185.650471976898), + TrajectoryPoint(1560, 184.88187861089), + TrajectoryPoint(1570, 184.112129000046), + TrajectoryPoint(1580, 183.34124639332), + TrajectoryPoint(1590, 182.569209649638), + TrajectoryPoint(1600, 181.795997388152), + TrajectoryPoint(1610, 181.021587985295), + TrajectoryPoint(1620, 180.245959571771), + TrajectoryPoint(1630, 179.469090029481), + TrajectoryPoint(1640, 178.69095698838), + TrajectoryPoint(1650, 177.911537823266), + TrajectoryPoint(1660, 177.130721450679), + TrajectoryPoint(1670, 176.348519420651), + TrajectoryPoint(1680, 175.564953921634), + TrajectoryPoint(1690, 174.78000108949), + TrajectoryPoint(1700, 173.993636785627), + TrajectoryPoint(1710, 173.205836593253), + TrajectoryPoint(1720, 172.416575813557), + TrajectoryPoint(1730, 171.625701957779), + TrajectoryPoint(1740, 170.833250937829), + TrajectoryPoint(1750, 170.039254155045), + TrajectoryPoint(1760, 169.243685540546), + TrajectoryPoint(1770, 168.446518720246), + TrajectoryPoint(1780, 167.647718507553), + TrajectoryPoint(1790, 166.847038963335), + TrajectoryPoint(1800, 166.0446697243), + TrajectoryPoint(1810, 165.240582932584), + TrajectoryPoint(1820, 164.434750398512), + TrajectoryPoint(1830, 163.627087817392), + TrajectoryPoint(1840, 162.81739339743), + TrajectoryPoint(1850, 162.005854903876), + TrajectoryPoint(1860, 161.192442532302), + TrajectoryPoint(1870, 160.377126115935), + TrajectoryPoint(1880, 159.559570303576), + TrajectoryPoint(1890, 158.740013913809), + TrajectoryPoint(1900, 157.918447694284), + TrajectoryPoint(1910, 157.094809105881), + TrajectoryPoint(1920, 156.268752413795), + TrajectoryPoint(1930, 155.440574939431), + TrajectoryPoint(1940, 154.610243266852), + TrajectoryPoint(1950, 153.777487405143), + TrajectoryPoint(1960, 152.942318019908), + TrajectoryPoint(1970, 152.104876419741), + TrajectoryPoint(1980, 151.264979099679), + TrajectoryPoint(1990, 150.422416751879), + TrajectoryPoint(2000, 149.577458232888), + TrajectoryPoint(2010, 148.729914273668), + TrajectoryPoint(2020, 147.879536203048), + TrajectoryPoint(2030, 147.026631671186), + TrajectoryPoint(2040, 146.170901538785), + TrajectoryPoint(2050, 145.312261830418), + TrajectoryPoint(2060, 144.450958604086), + TrajectoryPoint(2070, 143.586466114138), + TrajectoryPoint(2080, 142.719094106221), + TrajectoryPoint(2090, 141.84873029301), + TrajectoryPoint(2100, 140.975044050039), + TrajectoryPoint(2110, 140.098442581311), + TrajectoryPoint(2120, 139.218259112723), + TrajectoryPoint(2130, 138.334975848682), + TrajectoryPoint(2140, 137.448163483409), + TrajectoryPoint(2150, 136.557927060748), + TrajectoryPoint(2160, 135.664153444167), + TrajectoryPoint(2170, 134.766680678071), + TrajectoryPoint(2180, 133.865595838171), + TrajectoryPoint(2190, 132.960591067111), + TrajectoryPoint(2200, 132.051826416184), + TrajectoryPoint(2210, 131.138980797191), + TrajectoryPoint(2220, 130.222148051613), + TrajectoryPoint(2230, 129.301138802103), + TrajectoryPoint(2240, 128.375828813473), + TrajectoryPoint(2250, 127.446318395335), + TrajectoryPoint(2260, 126.512099885559), + TrajectoryPoint(2270, 125.573637066366), + TrajectoryPoint(2280, 124.630153318949), + TrajectoryPoint(2290, 123.682072159155), + TrajectoryPoint(2300, 122.729139603677), + TrajectoryPoint(2310, 121.770944980433), + TrajectoryPoint(2320, 120.80783528776), + TrajectoryPoint(2330, 119.839334225838), + TrajectoryPoint(2340, 118.865291610168), + TrajectoryPoint(2350, 117.885876062069), + TrajectoryPoint(2360, 116.900723833298), + TrajectoryPoint(2370, 115.909478992998), + TrajectoryPoint(2380, 114.912356408327), + TrajectoryPoint(2390, 113.909170383811), + TrajectoryPoint(2400, 112.899445694456), + TrajectoryPoint(2410, 111.883076787586), + TrajectoryPoint(2420, 110.860066475865), + TrajectoryPoint(2430, 109.830200279539), + TrajectoryPoint(2440, 108.793255239814), + TrajectoryPoint(2450, 107.748844436883), + TrajectoryPoint(2460, 106.696734973942), + TrajectoryPoint(2470, 105.636857417336), + TrajectoryPoint(2480, 104.56895325691), + TrajectoryPoint(2490, 103.492753423174), + TrajectoryPoint(2500, 102.407977767654), + TrajectoryPoint(2510, 101.314334511189), + TrajectoryPoint(2520, 100.21151965791), + TrajectoryPoint(2530, 99.0992163724483), + TrajectoryPoint(2540, 97.9770943177261), + TrajectoryPoint(2550, 96.8448089504524), + TrajectoryPoint(2560, 95.7020007711877), + TrajectoryPoint(2570, 94.5482945255915), + TrajectoryPoint(2580, 93.3832983531531), + TrajectoryPoint(2590, 92.2066028793857), + TrajectoryPoint(2600, 91.0174339027686), + TrajectoryPoint(2610, 89.8154675963609), + TrajectoryPoint(2620, 88.6003643291124), + TrajectoryPoint(2630, 87.3716279730696), + TrajectoryPoint(2640, 86.1282814957334), + TrajectoryPoint(2650, 84.8697323350286), + TrajectoryPoint(2660, 83.5957915840682), + TrajectoryPoint(2670, 82.305009301416), + TrajectoryPoint(2680, 80.9970954229587), + TrajectoryPoint(2690, 79.6710357569924), + TrajectoryPoint(2700, 78.325858002893), + TrajectoryPoint(2710, 76.9605325781083), + TrajectoryPoint(2720, 75.5743707904661), + TrajectoryPoint(2730, 74.1652204626847), + TrajectoryPoint(2740, 72.7326877783678), + TrajectoryPoint(2750, 71.275206575244), + TrajectoryPoint(2760, 69.790952041776), + TrajectoryPoint(2770, 68.2779413451112), + TrajectoryPoint(2780, 66.7346153711384), + TrajectoryPoint(2790, 65.1587905656572), + TrajectoryPoint(2800, 63.5480759588373), + TrajectoryPoint(2810, 61.8992466569256), + TrajectoryPoint(2820, 60.2095039070813), + TrajectoryPoint(2830, 58.4757436785196), + TrajectoryPoint(2840, 56.6932264545545), + TrajectoryPoint(2850, 54.8577306767368), + TrajectoryPoint(2860, 52.9630111033634), + TrajectoryPoint(2870, 51.0032464004032), + TrajectoryPoint(2880, 48.970309734878), + TrajectoryPoint(2890, 46.8546905310586), + TrajectoryPoint(2900, 44.6451889945588), + TrajectoryPoint(2910, 42.3253395270656), + TrajectoryPoint(2920, 39.8778132393924), + TrajectoryPoint(2930, 37.2768349226986), + TrajectoryPoint(2940, 34.4879886730512), + TrajectoryPoint(2950, 31.4606648372028), + TrajectoryPoint(2960, 28.1194088430525), + TrajectoryPoint(2970, 24.3326912149813), + TrajectoryPoint(2980, 19.8511555731044), + TrajectoryPoint(2990, 14.022859776783), TrajectoryPoint(3000, 0), }; TrajectoryPoint t6_closed[] = { - TrajectoryPoint(0, 286.914805317672), - TrajectoryPoint(10, 286.236902974706), - TrajectoryPoint(20, 285.560162939834), - TrajectoryPoint(30, 284.884210042744), - TrajectoryPoint(40, 284.208788843333), - TrajectoryPoint(50, 283.533915417412), - TrajectoryPoint(60, 282.859888206836), - TrajectoryPoint(70, 282.186342646755), - TrajectoryPoint(80, 281.513275361756), - TrajectoryPoint(90, 280.840869547869), - TrajectoryPoint(100, 280.169016519694), - TrajectoryPoint(110, 279.49759356929), - TrajectoryPoint(120, 278.826629706472), - TrajectoryPoint(130, 278.156296544326), - TrajectoryPoint(140, 277.486347445279), - TrajectoryPoint(150, 276.8167775692), - TrajectoryPoint(160, 276.147699848122), - TrajectoryPoint(170, 275.479063571649), - TrajectoryPoint(180, 274.810762358349), - TrajectoryPoint(190, 274.14279057589), - TrajectoryPoint(200, 273.47529612968), - TrajectoryPoint(210, 272.808113150259), - TrajectoryPoint(220, 272.141217284644), - TrajectoryPoint(230, 271.474624506282), - TrajectoryPoint(240, 270.808417127517), - TrajectoryPoint(250, 270.14245634132), - TrajectoryPoint(260, 269.476735915803), - TrajectoryPoint(270, 268.811283804856), - TrajectoryPoint(280, 268.146124234358), - TrajectoryPoint(290, 267.481166136238), - TrajectoryPoint(300, 266.816402896338), - TrajectoryPoint(310, 266.15185718636), - TrajectoryPoint(320, 265.487535410947), - TrajectoryPoint(330, 264.823371130067), - TrajectoryPoint(340, 264.159357443263), - TrajectoryPoint(350, 263.495503556897), - TrajectoryPoint(360, 262.831819227989), - TrajectoryPoint(370, 262.168249526081), - TrajectoryPoint(380, 261.504787331837), - TrajectoryPoint(390, 260.841427770469), - TrajectoryPoint(400, 260.178189234804), - TrajectoryPoint(410, 259.515023496369), - TrajectoryPoint(420, 258.851923262196), - TrajectoryPoint(430, 258.188881037529), - TrajectoryPoint(440, 257.525898672682), - TrajectoryPoint(450, 256.862953907957), - TrajectoryPoint(460, 256.20003360898), - TrajectoryPoint(470, 255.537130161908), - TrajectoryPoint(480, 254.874235538139), - TrajectoryPoint(490, 254.21133541338), - TrajectoryPoint(500, 253.548419547377), - TrajectoryPoint(510, 252.885480215848), - TrajectoryPoint(520, 252.222509550343), - TrajectoryPoint(530, 251.559491897477), - TrajectoryPoint(540, 250.896410543287), - TrajectoryPoint(550, 250.233266095005), - TrajectoryPoint(560, 249.570050586632), - TrajectoryPoint(570, 248.906755929144), - TrajectoryPoint(580, 248.243360191519), - TrajectoryPoint(590, 247.579845928393), - TrajectoryPoint(600, 246.916221403899), - TrajectoryPoint(610, 246.252478428827), - TrajectoryPoint(620, 245.588608704626), - TrajectoryPoint(630, 244.924597299995), - TrajectoryPoint(640, 244.260403121697), - TrajectoryPoint(650, 243.596051541959), - TrajectoryPoint(660, 242.931534148769), - TrajectoryPoint(670, 242.266842428939), - TrajectoryPoint(680, 241.60196777175), - TrajectoryPoint(690, 240.936874187598), - TrajectoryPoint(700, 240.271551608894), - TrajectoryPoint(710, 239.606015679217), - TrajectoryPoint(720, 238.940257654473), - TrajectoryPoint(730, 238.274268695939), - TrajectoryPoint(740, 237.608039872387), - TrajectoryPoint(750, 236.941537147562), - TrajectoryPoint(760, 236.274739935903), - TrajectoryPoint(770, 235.607672446967), - TrajectoryPoint(780, 234.940325587566), - TrajectoryPoint(790, 234.272690171371), - TrajectoryPoint(800, 233.604756919973), - TrajectoryPoint(810, 232.93651646371), - TrajectoryPoint(820, 232.267914564727), - TrajectoryPoint(830, 231.598965730603), - TrajectoryPoint(840, 230.929678946613), - TrajectoryPoint(850, 230.260044643951), - TrajectoryPoint(860, 229.590053159058), - TrajectoryPoint(870, 228.919694733762), - TrajectoryPoint(880, 228.248959515272), - TrajectoryPoint(890, 227.577832685076), - TrajectoryPoint(900, 226.906249585546), - TrajectoryPoint(910, 226.234258327656), - TrajectoryPoint(920, 225.561848818101), - TrajectoryPoint(930, 224.889010863751), - TrajectoryPoint(940, 224.215734171201), - TrajectoryPoint(950, 223.542008346217), - TrajectoryPoint(960, 222.867822893085), - TrajectoryPoint(970, 222.193167213885), - TrajectoryPoint(980, 221.518030607672), - TrajectoryPoint(990, 220.842347295988), - TrajectoryPoint(1000, 220.166156741913), - TrajectoryPoint(1010, 219.489452444678), - TrajectoryPoint(1020, 218.812223403018), - TrajectoryPoint(1030, 218.134458505901), - TrajectoryPoint(1040, 217.456146531482), - TrajectoryPoint(1050, 216.777276146008), - TrajectoryPoint(1060, 216.097835902671), - TrajectoryPoint(1070, 215.417814240403), - TrajectoryPoint(1080, 214.737199482634), - TrajectoryPoint(1090, 214.055979836004), - TrajectoryPoint(1100, 213.37414338903), - TrajectoryPoint(1110, 212.691666599875), - TrajectoryPoint(1120, 212.008517344608), - TrajectoryPoint(1130, 211.324716022633), - TrajectoryPoint(1140, 210.640250347823), - TrajectoryPoint(1150, 209.955107908266), - TrajectoryPoint(1160, 209.269276164814), - TrajectoryPoint(1170, 208.582742449591), - TrajectoryPoint(1180, 207.895493964482), - TrajectoryPoint(1190, 207.207517779582), - TrajectoryPoint(1200, 206.518800831614), - TrajectoryPoint(1210, 205.829329922323), - TrajectoryPoint(1220, 205.139091716833), - TrajectoryPoint(1230, 204.448072741985), - TrajectoryPoint(1240, 203.75625938464), - TrajectoryPoint(1250, 203.063637889953), - TrajectoryPoint(1260, 202.370194359624), - TrajectoryPoint(1270, 201.675914750119), - TrajectoryPoint(1280, 200.980784870864), - TrajectoryPoint(1290, 200.284790382407), - TrajectoryPoint(1300, 199.587916794558), - TrajectoryPoint(1310, 198.890149464494), - TrajectoryPoint(1320, 198.191473594843), - TrajectoryPoint(1330, 197.491874231731), - TrajectoryPoint(1340, 196.791336262803), - TrajectoryPoint(1350, 196.089844415215), - TrajectoryPoint(1360, 195.38738325359), - TrajectoryPoint(1370, 194.683937177948), - TrajectoryPoint(1380, 193.9794904216), - TrajectoryPoint(1390, 193.274027049011), - TrajectoryPoint(1400, 192.567530953627), - TrajectoryPoint(1410, 191.859985855669), - TrajectoryPoint(1420, 191.151375299892), - TrajectoryPoint(1430, 190.4416826533), - TrajectoryPoint(1440, 189.730891102839), - TrajectoryPoint(1450, 189.018983653031), - TrajectoryPoint(1460, 188.305943123588), - TrajectoryPoint(1470, 187.59175214697), - TrajectoryPoint(1480, 186.876333937809), - TrajectoryPoint(1490, 186.159712888558), - TrajectoryPoint(1500, 185.441882635579), - TrajectoryPoint(1510, 184.722824904041), - TrajectoryPoint(1520, 184.002521217607), - TrajectoryPoint(1530, 183.280952895687), - TrajectoryPoint(1540, 182.558101050634), - TrajectoryPoint(1550, 181.833946584902), - TrajectoryPoint(1560, 181.108470188136), - TrajectoryPoint(1570, 180.381652334217), - TrajectoryPoint(1580, 179.653473278254), - TrajectoryPoint(1590, 178.923814964305), - TrajectoryPoint(1600, 178.192715327339), - TrajectoryPoint(1610, 177.460186785632), - TrajectoryPoint(1620, 176.72620853617), - TrajectoryPoint(1630, 175.990759539246), - TrajectoryPoint(1640, 175.253818515026), - TrajectoryPoint(1650, 174.515363940055), - TrajectoryPoint(1660, 173.775343630487), - TrajectoryPoint(1670, 173.033611120216), - TrajectoryPoint(1680, 172.290290687958), - TrajectoryPoint(1690, 171.545359631917), - TrajectoryPoint(1700, 170.798794985717), - TrajectoryPoint(1710, 170.050573514399), - TrajectoryPoint(1720, 169.300645275722), - TrajectoryPoint(1730, 168.548807182271), - TrajectoryPoint(1740, 167.795231482643), - TrajectoryPoint(1750, 167.039893642019), - TrajectoryPoint(1760, 166.282768832897), - TrajectoryPoint(1770, 165.52383193051), - TrajectoryPoint(1780, 164.762788641066), - TrajectoryPoint(1790, 163.999864456367), - TrajectoryPoint(1800, 163.235040317509), - TrajectoryPoint(1810, 162.468289659485), - TrajectoryPoint(1820, 161.699441908338), - TrajectoryPoint(1830, 160.928431549823), - TrajectoryPoint(1840, 160.155401425857), - TrajectoryPoint(1850, 159.380323420431), - TrajectoryPoint(1860, 158.603027642284), - TrajectoryPoint(1870, 157.823399175132), - TrajectoryPoint(1880, 157.041623776734), - TrajectoryPoint(1890, 156.257671657196), - TrajectoryPoint(1900, 155.471232551976), - TrajectoryPoint(1910, 154.682419426835), - TrajectoryPoint(1920, 153.891324261923), - TrajectoryPoint(1930, 153.097791004735), - TrajectoryPoint(1940, 152.301581879404), - TrajectoryPoint(1950, 151.502980133226), - TrajectoryPoint(1960, 150.70189997761), - TrajectoryPoint(1970, 149.897917480305), - TrajectoryPoint(1980, 149.091426173304), - TrajectoryPoint(1990, 148.282316736548), - TrajectoryPoint(2000, 147.4701631312), - TrajectoryPoint(2010, 146.655378543097), - TrajectoryPoint(2020, 145.837725793591), - TrajectoryPoint(2030, 145.016981596303), - TrajectoryPoint(2040, 144.193477848436), - TrajectoryPoint(2050, 143.366733890421), - TrajectoryPoint(2060, 142.536956356811), - TrajectoryPoint(2070, 141.704147182096), - TrajectoryPoint(2080, 140.867864497212), - TrajectoryPoint(2090, 140.028585967836), - TrajectoryPoint(2100, 139.18568147652), - TrajectoryPoint(2110, 138.339551777773), - TrajectoryPoint(2120, 137.489861976331), - TrajectoryPoint(2130, 136.636625488319), - TrajectoryPoint(2140, 135.779834814848), - TrajectoryPoint(2150, 134.919224863046), - TrajectoryPoint(2160, 134.055001508926), - TrajectoryPoint(2170, 133.186739753902), - TrajectoryPoint(2180, 132.314734728343), - TrajectoryPoint(2190, 131.438530511481), - TrajectoryPoint(2200, 130.558376633597), - TrajectoryPoint(2210, 129.673926275328), - TrajectoryPoint(2220, 128.785237087734), - TrajectoryPoint(2230, 127.892223134406), - TrajectoryPoint(2240, 126.994591731729), - TrajectoryPoint(2250, 126.092682146911), - TrajectoryPoint(2260, 125.185679911972), - TrajectoryPoint(2270, 124.274195977326), - TrajectoryPoint(2280, 123.35770244723), - TrajectoryPoint(2290, 122.436141364042), - TrajectoryPoint(2300, 121.50970713276), - TrajectoryPoint(2310, 120.577689679439), - TrajectoryPoint(2320, 119.640408210082), - TrajectoryPoint(2330, 118.697823543189), - TrajectoryPoint(2340, 117.749266221815), - TrajectoryPoint(2350, 116.794993495322), - TrajectoryPoint(2360, 115.834944538596), - TrajectoryPoint(2370, 114.868747393219), - TrajectoryPoint(2380, 113.896090888978), - TrajectoryPoint(2390, 112.917137119608), - TrajectoryPoint(2400, 111.931693570957), - TrajectoryPoint(2410, 110.939538519951), - TrajectoryPoint(2420, 109.940097920041), - TrajectoryPoint(2430, 108.933571538425), - TrajectoryPoint(2440, 107.919737333781), - TrajectoryPoint(2450, 106.898364552455), - TrajectoryPoint(2460, 105.869213315446), - TrajectoryPoint(2470, 104.832034180949), - TrajectoryPoint(2480, 103.786567680823), - TrajectoryPoint(2490, 102.732468262517), - TrajectoryPoint(2500, 101.669503762144), - TrajectoryPoint(2510, 100.597455128765), - TrajectoryPoint(2520, 99.5160207170817), - TrajectoryPoint(2530, 98.4248862697143), - TrajectoryPoint(2540, 97.3237242674834), - TrajectoryPoint(2550, 96.2121135562458), - TrajectoryPoint(2560, 95.0896271465131), - TrajectoryPoint(2570, 93.9559749960346), - TrajectoryPoint(2580, 92.8107646466441), - TrajectoryPoint(2590, 91.6535861576271), - TrajectoryPoint(2600, 90.4840111365609), - TrajectoryPoint(2610, 89.3015917045376), - TrajectoryPoint(2620, 88.1052470654749), - TrajectoryPoint(2630, 86.8949167371822), - TrajectoryPoint(2640, 85.670161663317), - TrajectoryPoint(2650, 84.4299245787049), - TrajectoryPoint(2660, 83.1735390559704), - TrajectoryPoint(2670, 81.9008809296054), - TrajectoryPoint(2680, 80.6099692743149), - TrajectoryPoint(2690, 79.301294095063), - TrajectoryPoint(2700, 77.972645100712), - TrajectoryPoint(2710, 76.6242141465072), - TrajectoryPoint(2720, 75.2538446408375), - TrajectoryPoint(2730, 73.8609450525468), - TrajectoryPoint(2740, 72.4443311244359), - TrajectoryPoint(2750, 71.0021665921202), - TrajectoryPoint(2760, 69.5327351629805), - TrajectoryPoint(2770, 68.0346457998035), - TrajectoryPoint(2780, 66.5058974048844), - TrajectoryPoint(2790, 64.9443034131675), - TrajectoryPoint(2800, 63.3474700245106), - TrajectoryPoint(2810, 61.7127396070419), - TrajectoryPoint(2820, 60.0361425993504), - TrajectoryPoint(2830, 58.3151695581118), - TrajectoryPoint(2840, 56.5455772812289), - TrajectoryPoint(2850, 54.7221119107376), - TrajectoryPoint(2860, 52.8395036848696), - TrajectoryPoint(2870, 50.8914251783219), - TrajectoryPoint(2880, 48.8697424107491), - TrajectoryPoint(2890, 46.7649382387952), - TrajectoryPoint(2900, 44.5658068992822), - TrajectoryPoint(2910, 42.2562030701249), - TrajectoryPoint(2920, 39.8184089345789), - TrajectoryPoint(2930, 37.2266365739458), - TrajectoryPoint(2940, 34.4467098555064), - TrajectoryPoint(2950, 31.42769538782), - TrajectoryPoint(2960, 28.0941210827197), - TrajectoryPoint(2970, 24.3147615217758), - TrajectoryPoint(2980, 19.8399113164253), - TrajectoryPoint(2990, 14.0176622555655), + TrajectoryPoint(0, 300.054138980575), + TrajectoryPoint(10, 299.277537130573), + TrajectoryPoint(20, 298.502974701747), + TrajectoryPoint(30, 297.730876432213), + TrajectoryPoint(40, 296.96004414759), + TrajectoryPoint(50, 296.190542063082), + TrajectoryPoint(60, 295.423334889304), + TrajectoryPoint(70, 294.657297260047), + TrajectoryPoint(80, 293.892436367811), + TrajectoryPoint(90, 293.129647145986), + TrajectoryPoint(100, 292.367993044347), + TrajectoryPoint(110, 291.60742156157), + TrajectoryPoint(120, 290.84858974004), + TrajectoryPoint(130, 290.090940419007), + TrajectoryPoint(140, 289.334285191049), + TrajectoryPoint(150, 288.579043179942), + TrajectoryPoint(160, 287.825049477132), + TrajectoryPoint(170, 287.071966715884), + TrajectoryPoint(180, 286.319981731366), + TrajectoryPoint(190, 285.569321485073), + TrajectoryPoint(200, 284.819494144318), + TrajectoryPoint(210, 284.070496818128), + TrajectoryPoint(220, 283.322839908449), + TrajectoryPoint(230, 282.5759752745), + TrajectoryPoint(240, 281.829866713564), + TrajectoryPoint(250, 281.084762344722), + TrajectoryPoint(260, 280.340589825289), + TrajectoryPoint(270, 279.597104149539), + TrajectoryPoint(280, 278.854313257363), + TrajectoryPoint(290, 278.11258235233), + TrajectoryPoint(300, 277.371473427971), + TrajectoryPoint(310, 276.630980609525), + TrajectoryPoint(320, 275.891255859241), + TrajectoryPoint(330, 275.152295443386), + TrajectoryPoint(340, 274.413890150485), + TrajectoryPoint(350, 273.67603297063), + TrajectoryPoint(360, 272.938942066445), + TrajectoryPoint(370, 272.202416002444), + TrajectoryPoint(380, 271.466380852838), + TrajectoryPoint(390, 270.730831062764), + TrajectoryPoint(400, 269.995990229392), + TrajectoryPoint(410, 269.261586553533), + TrajectoryPoint(420, 268.527612423928), + TrajectoryPoint(430, 267.794084774176), + TrajectoryPoint(440, 267.061134572808), + TrajectoryPoint(450, 266.328563408339), + TrajectoryPoint(460, 265.596363266701), + TrajectoryPoint(470, 264.86454395632), + TrajectoryPoint(480, 264.133211832706), + TrajectoryPoint(490, 263.402203193982), + TrajectoryPoint(500, 262.671509775807), + TrajectoryPoint(510, 261.941122933223), + TrajectoryPoint(520, 261.211148759852), + TrajectoryPoint(530, 260.481450339423), + TrajectoryPoint(540, 259.752013849853), + TrajectoryPoint(550, 259.022830564337), + TrajectoryPoint(560, 258.293950544564), + TrajectoryPoint(570, 257.565325545137), + TrajectoryPoint(580, 256.83691143718), + TrajectoryPoint(590, 256.10869944923), + TrajectoryPoint(600, 255.380690174038), + TrajectoryPoint(610, 254.652915226072), + TrajectoryPoint(620, 253.92530208719), + TrajectoryPoint(630, 253.197841952487), + TrajectoryPoint(640, 252.470525821276), + TrajectoryPoint(650, 251.74336189616), + TrajectoryPoint(660, 251.016339462768), + TrajectoryPoint(670, 250.289422559578), + TrajectoryPoint(680, 249.562602168512), + TrajectoryPoint(690, 248.835869113784), + TrajectoryPoint(700, 248.109222759718), + TrajectoryPoint(710, 247.382649444772), + TrajectoryPoint(720, 246.656126441338), + TrajectoryPoint(730, 245.92964454116), + TrajectoryPoint(740, 245.203194400929), + TrajectoryPoint(750, 244.476766887873), + TrajectoryPoint(760, 243.750349883108), + TrajectoryPoint(770, 243.023928679487), + TrajectoryPoint(780, 242.297493867005), + TrajectoryPoint(790, 241.571035912565), + TrajectoryPoint(800, 240.844545165798), + TrajectoryPoint(810, 240.118005675033), + TrajectoryPoint(820, 239.391401439735), + TrajectoryPoint(830, 238.664729161807), + TrajectoryPoint(840, 237.937979077926), + TrajectoryPoint(850, 237.211141309978), + TrajectoryPoint(860, 236.484205868105), + TrajectoryPoint(870, 235.757157590191), + TrajectoryPoint(880, 235.029967343719), + TrajectoryPoint(890, 234.302644432664), + TrajectoryPoint(900, 233.575178696394), + TrajectoryPoint(910, 232.847559859374), + TrajectoryPoint(920, 232.119777532438), + TrajectoryPoint(930, 231.39182121368), + TrajectoryPoint(940, 230.663673344505), + TrajectoryPoint(950, 229.935299349191), + TrajectoryPoint(960, 229.206716100236), + TrajectoryPoint(970, 228.477912856376), + TrajectoryPoint(980, 227.748878756557), + TrajectoryPoint(990, 227.019602819826), + TrajectoryPoint(1000, 226.290073945015), + TrajectoryPoint(1010, 225.560280910218), + TrajectoryPoint(1020, 224.83021231363), + TrajectoryPoint(1030, 224.099815028404), + TrajectoryPoint(1040, 223.36911738155), + TrajectoryPoint(1050, 222.638107834715), + TrajectoryPoint(1060, 221.906774719771), + TrajectoryPoint(1070, 221.175106237824), + TrajectoryPoint(1080, 220.443090458125), + TrajectoryPoint(1090, 219.710715316866), + TrajectoryPoint(1100, 218.977968615888), + TrajectoryPoint(1110, 218.244838021312), + TrajectoryPoint(1120, 217.51131106209), + TrajectoryPoint(1130, 216.777357327297), + TrajectoryPoint(1140, 216.04296040226), + TrajectoryPoint(1150, 215.308128652652), + TrajectoryPoint(1160, 214.57284919365), + TrajectoryPoint(1170, 213.837108993576), + TrajectoryPoint(1180, 213.100894872342), + TrajectoryPoint(1190, 212.364193499855), + TrajectoryPoint(1200, 211.626991394377), + TrajectoryPoint(1210, 210.889274920855), + TrajectoryPoint(1220, 210.151030289218), + TrajectoryPoint(1230, 209.412243552643), + TrajectoryPoint(1240, 208.672900605799), + TrajectoryPoint(1250, 207.93298718307), + TrajectoryPoint(1260, 207.192488856745), + TrajectoryPoint(1270, 206.4513910352), + TrajectoryPoint(1280, 205.709678961055), + TrajectoryPoint(1290, 204.967337709312), + TrajectoryPoint(1300, 204.224352185474), + TrajectoryPoint(1310, 203.480707123656), + TrajectoryPoint(1320, 202.736387084664), + TrajectoryPoint(1330, 201.99137645407), + TrajectoryPoint(1340, 201.24565944026), + TrajectoryPoint(1350, 200.499220072471), + TrajectoryPoint(1360, 199.752042198803), + TrajectoryPoint(1370, 199.004109484217), + TrajectoryPoint(1380, 198.25540540851), + TrajectoryPoint(1390, 197.505913264267), + TrajectoryPoint(1400, 196.755616154796), + TrajectoryPoint(1410, 196.004496992035), + TrajectoryPoint(1420, 195.252538494434), + TrajectoryPoint(1430, 194.499723184815), + TrajectoryPoint(1440, 193.746033388198), + TrajectoryPoint(1450, 192.991451229603), + TrajectoryPoint(1460, 192.235958631819), + TrajectoryPoint(1470, 191.479537313141), + TrajectoryPoint(1480, 190.722168785069), + TrajectoryPoint(1490, 189.963834349981), + TrajectoryPoint(1500, 189.204515098753), + TrajectoryPoint(1510, 188.444191908356), + TrajectoryPoint(1520, 187.682845439396), + TrajectoryPoint(1530, 186.920456133624), + TrajectoryPoint(1540, 186.157004211389), + TrajectoryPoint(1550, 185.392469669052), + TrajectoryPoint(1560, 184.626832276346), + TrajectoryPoint(1570, 183.860071573689), + TrajectoryPoint(1580, 183.092110731573), + TrajectoryPoint(1590, 182.322946362439), + TrajectoryPoint(1600, 181.552589440904), + TrajectoryPoint(1610, 180.781018393935), + TrajectoryPoint(1620, 180.008211403233), + TrajectoryPoint(1630, 179.23414640214), + TrajectoryPoint(1640, 178.458801072473), + TrajectoryPoint(1650, 177.682152841299), + TrajectoryPoint(1660, 176.904178877625), + TrajectoryPoint(1670, 176.12477003003), + TrajectoryPoint(1680, 175.343923618663), + TrajectoryPoint(1690, 174.561673264966), + TrajectoryPoint(1700, 173.777994885483), + TrajectoryPoint(1710, 172.992864118816), + TrajectoryPoint(1720, 172.206256321772), + TrajectoryPoint(1730, 171.41814656543), + TrajectoryPoint(1740, 170.628330387598), + TrajectoryPoint(1750, 169.836935347303), + TrajectoryPoint(1760, 169.043952221806), + TrajectoryPoint(1770, 168.24935469446), + TrajectoryPoint(1780, 167.453116139017), + TrajectoryPoint(1790, 166.655106788324), + TrajectoryPoint(1800, 165.855256071072), + TrajectoryPoint(1810, 165.053671807038), + TrajectoryPoint(1820, 164.250325865061), + TrajectoryPoint(1830, 163.445189777017), + TrajectoryPoint(1840, 162.638033531443), + TrajectoryPoint(1850, 161.828931404661), + TrajectoryPoint(1860, 161.017939674882), + TrajectoryPoint(1870, 160.205028234244), + TrajectoryPoint(1880, 159.389999389711), + TrajectoryPoint(1890, 158.57281386429), + TrajectoryPoint(1900, 157.753603000045), + TrajectoryPoint(1910, 156.932334923572), + TrajectoryPoint(1920, 156.108707008072), + TrajectoryPoint(1930, 155.282835596228), + TrajectoryPoint(1940, 154.45479469616), + TrajectoryPoint(1950, 153.62444862157), + TrajectoryPoint(1960, 152.791536356697), + TrajectoryPoint(1970, 151.95633674903), + TrajectoryPoint(1980, 151.118799193252), + TrajectoryPoint(1990, 150.278445392894), + TrajectoryPoint(2000, 149.43568045671), + TrajectoryPoint(2010, 148.590445892304), + TrajectoryPoint(2020, 147.742228180186), + TrajectoryPoint(2030, 146.891469205662), + TrajectoryPoint(2040, 146.037997823109), + TrajectoryPoint(2050, 145.181470679475), + TrajectoryPoint(2060, 144.322265379703), + TrajectoryPoint(2070, 143.459980782146), + TrajectoryPoint(2080, 142.594673948393), + TrajectoryPoint(2090, 141.72648514874), + TrajectoryPoint(2100, 140.854831468063), + TrajectoryPoint(2110, 139.980248191344), + TrajectoryPoint(2120, 139.102188522011), + TrajectoryPoint(2130, 138.220891090023), + TrajectoryPoint(2140, 137.336169237466), + TrajectoryPoint(2150, 136.447886437283), + TrajectoryPoint(2160, 135.556169863568), + TrajectoryPoint(2170, 134.660618664478), + TrajectoryPoint(2180, 133.761557236769), + TrajectoryPoint(2190, 132.858442134375), + TrajectoryPoint(2200, 131.951667124761), + TrajectoryPoint(2210, 131.040679435627), + TrajectoryPoint(2220, 130.12580243918), + TrajectoryPoint(2230, 129.206619542107), + TrajectoryPoint(2240, 128.283231306437), + TrajectoryPoint(2250, 127.35551582606), + TrajectoryPoint(2260, 126.42318498494), + TrajectoryPoint(2270, 125.486583912934), + TrajectoryPoint(2280, 124.544855615853), + TrajectoryPoint(2290, 123.598611322026), + TrajectoryPoint(2300, 122.647393793192), + TrajectoryPoint(2310, 121.691001701027), + TrajectoryPoint(2320, 120.729677651641), + TrajectoryPoint(2330, 119.762843277812), + TrajectoryPoint(2340, 118.790551834029), + TrajectoryPoint(2350, 117.812870359169), + TrajectoryPoint(2360, 116.829336810641), + TrajectoryPoint(2370, 115.839791471148), + TrajectoryPoint(2380, 114.84435110636), + TrajectoryPoint(2390, 113.842829926315), + TrajectoryPoint(2400, 112.834658980274), + TrajectoryPoint(2410, 111.819920213438), + TrajectoryPoint(2420, 110.798522520373), + TrajectoryPoint(2430, 109.770251342123), + TrajectoryPoint(2440, 108.734883645022), + TrajectoryPoint(2450, 107.691945125133), + TrajectoryPoint(2460, 106.641378185975), + TrajectoryPoint(2470, 105.583025372006), + TrajectoryPoint(2480, 104.516628110978), + TrajectoryPoint(2490, 103.441917274967), + TrajectoryPoint(2500, 102.358612660598), + TrajectoryPoint(2510, 101.266422437212), + TrajectoryPoint(2520, 100.165042560736), + TrajectoryPoint(2530, 99.0541561507873), + TrajectoryPoint(2540, 97.9334328283609), + TrajectoryPoint(2550, 96.802528011234), + TrajectoryPoint(2560, 95.6610821639456), + TrajectoryPoint(2570, 94.5087199989633), + TrajectoryPoint(2580, 93.3450496253384), + TrajectoryPoint(2590, 92.1696616408304), + TrajectoryPoint(2600, 90.981849274584), + TrajectoryPoint(2610, 89.7811518677087), + TrajectoryPoint(2620, 88.5672990625475), + TrajectoryPoint(2630, 87.3397947153142), + TrajectoryPoint(2640, 86.0977237845128), + TrajectoryPoint(2650, 84.8403675091878), + TrajectoryPoint(2660, 83.5676011046634), + TrajectoryPoint(2670, 82.2780322450081), + TrajectoryPoint(2680, 80.9712532443926), + TrajectoryPoint(2690, 79.6463648599436), + TrajectoryPoint(2700, 78.302282284221), + TrajectoryPoint(2710, 76.9380853937431), + TrajectoryPoint(2720, 75.5529788939205), + TrajectoryPoint(2730, 74.1449138125288), + TrajectoryPoint(2740, 72.713444095796), + TrajectoryPoint(2750, 71.2570033438141), + TrajectoryPoint(2760, 69.7737209912369), + TrajectoryPoint(2770, 68.2617063526781), + TrajectoryPoint(2780, 66.7193534159484), + TrajectoryPoint(2790, 65.1444784371373), + TrajectoryPoint(2800, 63.5346902690749), + TrajectoryPoint(2810, 61.8868016715207), + TrajectoryPoint(2820, 60.1979362149777), + TrajectoryPoint(2830, 58.4650293267969), + TrajectoryPoint(2840, 56.6833744658788), + TrajectoryPoint(2850, 54.8486815190548), + TrajectoryPoint(2860, 52.9547700568221), + TrajectoryPoint(2870, 50.9957851303638), + TrajectoryPoint(2880, 48.9635994318818), + TrajectoryPoint(2890, 46.8487019483797), + TrajectoryPoint(2900, 44.6398924864203), + TrajectoryPoint(2910, 42.3207267556131), + TrajectoryPoint(2920, 39.8738499851332), + TrajectoryPoint(2930, 37.2734861047521), + TrajectoryPoint(2940, 34.4852351560461), + TrajectoryPoint(2950, 31.4584659088083), + TrajectoryPoint(2960, 28.1177225911586), + TrajectoryPoint(2970, 24.3314959327713), + TrajectoryPoint(2980, 19.8504062572133), + TrajectoryPoint(2990, 14.0225136048364), TrajectoryPoint(3000, 0), }; TrajectoryPoint t7_closed[] = { - TrajectoryPoint(0, 286.207536847051), - TrajectoryPoint(10, 285.535077414886), - TrajectoryPoint(20, 284.863437411843), - TrajectoryPoint(30, 284.192348384917), - TrajectoryPoint(40, 283.521838698171), - TrajectoryPoint(50, 282.852094250836), - TrajectoryPoint(60, 282.182815728898), - TrajectoryPoint(70, 281.513999670143), - TrajectoryPoint(80, 280.845863306509), - TrajectoryPoint(90, 280.178216402721), - TrajectoryPoint(100, 279.510984706648), - TrajectoryPoint(110, 278.844232814604), - TrajectoryPoint(120, 278.178048720745), - TrajectoryPoint(130, 277.512234691857), - TrajectoryPoint(140, 276.846785866913), - TrajectoryPoint(150, 276.181840948142), - TrajectoryPoint(160, 275.517287020983), - TrajectoryPoint(170, 274.853054954324), - TrajectoryPoint(180, 274.189148746781), - TrajectoryPoint(190, 273.525705734919), - TrajectoryPoint(200, 272.862543105237), - TrajectoryPoint(210, 272.199655156462), - TrajectoryPoint(220, 271.537079223044), - TrajectoryPoint(230, 270.874846244708), - TrajectoryPoint(240, 270.212848126684), - TrajectoryPoint(250, 269.551078671541), - TrajectoryPoint(260, 268.889581885578), - TrajectoryPoint(270, 268.228342295024), - TrajectoryPoint(280, 267.567293127746), - TrajectoryPoint(290, 266.906427816928), - TrajectoryPoint(300, 266.245781008459), - TrajectoryPoint(310, 265.585328430802), - TrajectoryPoint(320, 264.925022945688), - TrajectoryPoint(330, 264.2648577087), - TrajectoryPoint(340, 263.604850764564), - TrajectoryPoint(350, 262.94498818147), - TrajectoryPoint(360, 262.2852304342), - TrajectoryPoint(370, 261.625570465259), - TrajectoryPoint(380, 260.966009817216), - TrajectoryPoint(390, 260.30654862979), - TrajectoryPoint(400, 259.647151024477), - TrajectoryPoint(410, 258.987809774023), - TrajectoryPoint(420, 258.328517454817), - TrajectoryPoint(430, 257.66927530953), - TrajectoryPoint(440, 257.010057634902), - TrajectoryPoint(450, 256.35085582331), - TrajectoryPoint(460, 255.691662333739), - TrajectoryPoint(470, 255.032467437014), - TrajectoryPoint(480, 254.373255928457), - TrajectoryPoint(490, 253.71402059337), - TrajectoryPoint(500, 253.054753781532), - TrajectoryPoint(510, 252.395447701914), - TrajectoryPoint(520, 251.736079910209), - TrajectoryPoint(530, 251.076643495073), - TrajectoryPoint(540, 250.417136468119), - TrajectoryPoint(550, 249.757550941413), - TrajectoryPoint(560, 249.097878906633), - TrajectoryPoint(570, 248.438087341157), - TrajectoryPoint(580, 247.778177597475), - TrajectoryPoint(590, 247.118150626477), - TrajectoryPoint(600, 246.457998320241), - TrajectoryPoint(610, 245.797712463687), - TrajectoryPoint(620, 245.137263245373), - TrajectoryPoint(630, 244.476636255167), - TrajectoryPoint(640, 243.815845437621), - TrajectoryPoint(650, 243.154882465053), - TrajectoryPoint(660, 242.493738910504), - TrajectoryPoint(670, 241.832406251286), - TrajectoryPoint(680, 241.170827012), - TrajectoryPoint(690, 240.509031356764), - TrajectoryPoint(700, 239.847016545368), - TrajectoryPoint(710, 239.184773923019), - TrajectoryPoint(720, 238.522294741972), - TrajectoryPoint(730, 237.859570163593), - TrajectoryPoint(740, 237.196538574956), - TrajectoryPoint(750, 236.53323204497), - TrajectoryPoint(760, 235.86965006035), - TrajectoryPoint(770, 235.205783622386), - TrajectoryPoint(780, 234.541623640825), - TrajectoryPoint(790, 233.877160934885), - TrajectoryPoint(800, 233.212371072885), - TrajectoryPoint(810, 232.547209145732), - TrajectoryPoint(820, 231.881714206485), - TrajectoryPoint(830, 231.215876881588), - TrajectoryPoint(840, 230.549687704021), - TrajectoryPoint(850, 229.883137113579), - TrajectoryPoint(860, 229.216215457004), - TrajectoryPoint(870, 228.548912987966), - TrajectoryPoint(880, 227.881170177789), - TrajectoryPoint(890, 227.213009628583), - TrajectoryPoint(900, 226.544437261333), - TrajectoryPoint(910, 225.875443092577), - TrajectoryPoint(920, 225.206017040653), - TrajectoryPoint(930, 224.53614892524), - TrajectoryPoint(940, 223.865828466811), - TrajectoryPoint(950, 223.195045285985), - TrajectoryPoint(960, 222.523788902802), - TrajectoryPoint(970, 221.851994318651), - TrajectoryPoint(980, 221.179697872664), - TrajectoryPoint(990, 220.506895974739), - TrajectoryPoint(1000, 219.833577854602), - TrajectoryPoint(1010, 219.15973263491), - TrajectoryPoint(1020, 218.485349330272), - TrajectoryPoint(1030, 217.810416846222), - TrajectoryPoint(1040, 217.134923978131), - TrajectoryPoint(1050, 216.458859410067), - TrajectoryPoint(1060, 215.782211713609), - TrajectoryPoint(1070, 215.104969346617), - TrajectoryPoint(1080, 214.427119075252), - TrajectoryPoint(1090, 213.748604677677), - TrajectoryPoint(1100, 213.069461242472), - TrajectoryPoint(1110, 212.389676870454), - TrajectoryPoint(1120, 211.709239541317), - TrajectoryPoint(1130, 211.02813711227), - TrajectoryPoint(1140, 210.346357316634), - TrajectoryPoint(1150, 209.663887762403), - TrajectoryPoint(1160, 208.980715930775), - TrajectoryPoint(1170, 208.29682917465), - TrajectoryPoint(1180, 207.612214717099), - TrajectoryPoint(1190, 206.926859649795), - TrajectoryPoint(1200, 206.24075093143), - TrajectoryPoint(1210, 205.553875386086), - TrajectoryPoint(1220, 204.86621970159), - TrajectoryPoint(1230, 204.177770427837), - TrajectoryPoint(1240, 203.488513975084), - TrajectoryPoint(1250, 202.798436612221), - TrajectoryPoint(1260, 202.107524465007), - TrajectoryPoint(1270, 201.415763514292), - TrajectoryPoint(1280, 200.723139594193), - TrajectoryPoint(1290, 200.02963839026), - TrajectoryPoint(1300, 199.335245437603), - TrajectoryPoint(1310, 198.639946118996), - TrajectoryPoint(1320, 197.94372566295), - TrajectoryPoint(1330, 197.246569141756), - TrajectoryPoint(1340, 196.548461469503), - TrajectoryPoint(1350, 195.849387400059), - TrajectoryPoint(1360, 195.149331525026), - TrajectoryPoint(1370, 194.448278271663), - TrajectoryPoint(1380, 193.746211900774), - TrajectoryPoint(1390, 193.043116504565), - TrajectoryPoint(1400, 192.338976004467), - TrajectoryPoint(1410, 191.633774148922), - TrajectoryPoint(1420, 190.927494511136), - TrajectoryPoint(1430, 190.220120486794), - TrajectoryPoint(1440, 189.511635291736), - TrajectoryPoint(1450, 188.802021959599), - TrajectoryPoint(1460, 188.09126333941), - TrajectoryPoint(1470, 187.379342093148), - TrajectoryPoint(1480, 186.666240693258), - TrajectoryPoint(1490, 185.951938744363), - TrajectoryPoint(1500, 185.236340898261), - TrajectoryPoint(1510, 184.519503476129), - TrajectoryPoint(1520, 183.801408032926), - TrajectoryPoint(1530, 183.0820359195), - TrajectoryPoint(1540, 182.361368279781), - TrajectoryPoint(1550, 181.639386047927), - TrajectoryPoint(1560, 180.916069945412), - TrajectoryPoint(1570, 180.191400478062), - TrajectoryPoint(1580, 179.46535793304), - TrajectoryPoint(1590, 178.737922375765), - TrajectoryPoint(1600, 178.008966793815), - TrajectoryPoint(1610, 177.278537893074), - TrajectoryPoint(1620, 176.546647509496), - TrajectoryPoint(1630, 175.813274636538), - TrajectoryPoint(1640, 175.078398027584), - TrajectoryPoint(1650, 174.341996192443), - TrajectoryPoint(1660, 173.604047393776), - TrajectoryPoint(1670, 172.864440884697), - TrajectoryPoint(1680, 172.123136661147), - TrajectoryPoint(1690, 171.380210248617), - TrajectoryPoint(1700, 170.635638714677), - TrajectoryPoint(1710, 169.889398858312), - TrajectoryPoint(1720, 169.141467205827), - TrajectoryPoint(1730, 168.391685430626), - TrajectoryPoint(1740, 167.640055148469), - TrajectoryPoint(1750, 166.886651344555), - TrajectoryPoint(1760, 166.131449225666), - TrajectoryPoint(1770, 165.374423701256), - TrajectoryPoint(1780, 164.615402005244), - TrajectoryPoint(1790, 163.854364609601), - TrajectoryPoint(1800, 163.091416033914), - TrajectoryPoint(1810, 162.326529747521), - TrajectoryPoint(1820, 161.559655161383), - TrajectoryPoint(1830, 160.790484703573), - TrajectoryPoint(1840, 160.019283377664), - TrajectoryPoint(1850, 159.246023101928), - TrajectoryPoint(1860, 158.470651596697), - TrajectoryPoint(1870, 157.692816524291), - TrajectoryPoint(1880, 156.912823542905), - TrajectoryPoint(1890, 156.130642896707), - TrajectoryPoint(1900, 155.346078805411), - TrajectoryPoint(1910, 154.559012969409), - TrajectoryPoint(1920, 153.769654241633), - TrajectoryPoint(1930, 152.977959719172), - TrajectoryPoint(1940, 152.183462950703), - TrajectoryPoint(1950, 151.386562801754), - TrajectoryPoint(1960, 150.587226180988), - TrajectoryPoint(1970, 149.784979958864), - TrajectoryPoint(1980, 148.980155614003), - TrajectoryPoint(1990, 148.172777074918), - TrajectoryPoint(2000, 147.362301079301), - TrajectoryPoint(2010, 146.549149029904), - TrajectoryPoint(2020, 145.733224693201), - TrajectoryPoint(2030, 144.914089310072), - TrajectoryPoint(2040, 144.092183894461), - TrajectoryPoint(2050, 143.267131206262), - TrajectoryPoint(2060, 142.438928409549), - TrajectoryPoint(2070, 141.607786362709), - TrajectoryPoint(2080, 140.773054892413), - TrajectoryPoint(2090, 139.935317247214), - TrajectoryPoint(2100, 139.094042460563), - TrajectoryPoint(2110, 138.249430259597), - TrajectoryPoint(2120, 137.401345724098), - TrajectoryPoint(2130, 136.549603426327), - TrajectoryPoint(2140, 135.694393446138), - TrajectoryPoint(2150, 134.835254458212), - TrajectoryPoint(2160, 133.972587103533), - TrajectoryPoint(2170, 133.105773169177), - TrajectoryPoint(2180, 132.235299339883), - TrajectoryPoint(2190, 131.360519885334), - TrajectoryPoint(2200, 130.481872302199), - TrajectoryPoint(2210, 129.598823734166), - TrajectoryPoint(2220, 128.711615851671), - TrajectoryPoint(2230, 127.819980803974), - TrajectoryPoint(2240, 126.923805638098), - TrajectoryPoint(2250, 126.023252162767), - TrajectoryPoint(2260, 125.117681026501), - TrajectoryPoint(2270, 124.207615860236), - TrajectoryPoint(2280, 123.292442863301), - TrajectoryPoint(2290, 122.372275260105), - TrajectoryPoint(2300, 121.447222000453), - TrajectoryPoint(2310, 120.516489670244), - TrajectoryPoint(2320, 119.580563758719), - TrajectoryPoint(2330, 118.639321982649), - TrajectoryPoint(2340, 117.692014548037), - TrajectoryPoint(2350, 116.739059195442), - TrajectoryPoint(2360, 115.780314804533), - TrajectoryPoint(2370, 114.815332489566), - TrajectoryPoint(2380, 113.843954951181), - TrajectoryPoint(2390, 112.866267214492), - TrajectoryPoint(2400, 111.882076701886), - TrajectoryPoint(2410, 110.891088942265), - TrajectoryPoint(2420, 109.892875666616), - TrajectoryPoint(2430, 108.887563508315), - TrajectoryPoint(2440, 107.874930371337), - TrajectoryPoint(2450, 106.854745449833), - TrajectoryPoint(2460, 105.826768815018), - TrajectoryPoint(2470, 104.790750977653), - TrajectoryPoint(2480, 103.746432424429), - TrajectoryPoint(2490, 102.693402849876), - TrajectoryPoint(2500, 101.631560389923), - TrajectoryPoint(2510, 100.560620381365), - TrajectoryPoint(2520, 99.4802811406893), - TrajectoryPoint(2530, 98.3902283743204), - TrajectoryPoint(2540, 97.2901345288442), - TrajectoryPoint(2550, 96.1796367753489), - TrajectoryPoint(2560, 95.058190136743), - TrajectoryPoint(2570, 93.9255640929727), - TrajectoryPoint(2580, 92.7813661603038), - TrajectoryPoint(2590, 91.6251863741699), - TrajectoryPoint(2600, 90.4565963199775), - TrajectoryPoint(2610, 89.275148098296), - TrajectoryPoint(2620, 88.0798114688228), - TrajectoryPoint(2630, 86.8704231881022), - TrajectoryPoint(2640, 85.6465963135072), - TrajectoryPoint(2650, 84.407320998294), - TrajectoryPoint(2660, 83.1518341951938), - TrajectoryPoint(2670, 81.8800608690652), - TrajectoryPoint(2680, 80.5900638104315), - TrajectoryPoint(2690, 79.282243688495), - TrajectoryPoint(2700, 77.9544772549455), - TrajectoryPoint(2710, 76.6069124291296), - TrajectoryPoint(2720, 75.2373520170843), - TrajectoryPoint(2730, 73.8452857951918), - TrajectoryPoint(2740, 72.4294883263256), - TrajectoryPoint(2750, 70.9880864739511), - TrajectoryPoint(2760, 69.5194381200289), - TrajectoryPoint(2770, 68.0221145124561), - TrajectoryPoint(2780, 66.4941143982843), - TrajectoryPoint(2790, 64.9332510654512), - TrajectoryPoint(2800, 63.3371305748235), - TrajectoryPoint(2810, 61.7031247695055), - TrajectoryPoint(2820, 60.0272032755617), - TrajectoryPoint(2830, 58.3068875398862), - TrajectoryPoint(2840, 56.5379601289491), - TrajectoryPoint(2850, 54.7151136032121), - TrajectoryPoint(2860, 52.8331288284302), - TrajectoryPoint(2870, 50.8856521103676), - TrajectoryPoint(2880, 48.864549099322), - TrajectoryPoint(2890, 46.7603023079308), - TrajectoryPoint(2900, 44.5617056551878), - TrajectoryPoint(2910, 42.2526304092233), - TrajectoryPoint(2920, 39.8153385742936), - TrajectoryPoint(2930, 37.2240415581766), - TrajectoryPoint(2940, 34.4445756188724), - TrajectoryPoint(2950, 31.4259905690461), - TrajectoryPoint(2960, 28.0928133777348), - TrajectoryPoint(2970, 24.3138343123499), - TrajectoryPoint(2980, 19.8393298648743), - TrajectoryPoint(2990, 14.0173935160974), + TrajectoryPoint(0, 299.095246817808), + TrajectoryPoint(10, 298.326818650565), + TrajectoryPoint(20, 297.560665459978), + TrajectoryPoint(30, 296.795806856905), + TrajectoryPoint(40, 296.032550680716), + TrajectoryPoint(50, 295.27119938732), + TrajectoryPoint(60, 294.51099116749), + TrajectoryPoint(70, 293.752147351742), + TrajectoryPoint(80, 292.995137222596), + TrajectoryPoint(90, 292.239180249372), + TrajectoryPoint(100, 291.484337068318), + TrajectoryPoint(110, 290.731295167948), + TrajectoryPoint(120, 289.979221493986), + TrajectoryPoint(130, 289.228117476469), + TrajectoryPoint(140, 288.478589036018), + TrajectoryPoint(150, 287.730059214453), + TrajectoryPoint(160, 286.982417452414), + TrajectoryPoint(170, 286.236024530001), + TrajectoryPoint(180, 285.49072513138), + TrajectoryPoint(190, 284.746237205866), + TrajectoryPoint(200, 284.002688506134), + TrajectoryPoint(210, 283.260329828663), + TrajectoryPoint(220, 282.518710761636), + TrajectoryPoint(230, 281.777827273593), + TrajectoryPoint(240, 281.03805506579), + TrajectoryPoint(250, 280.299041199199), + TrajectoryPoint(260, 279.560694985466), + TrajectoryPoint(270, 278.823146848026), + TrajectoryPoint(280, 278.086493896903), + TrajectoryPoint(290, 277.350444922959), + TrajectoryPoint(300, 276.614993838829), + TrajectoryPoint(310, 275.880390433621), + TrajectoryPoint(320, 275.146415919347), + TrajectoryPoint(330, 274.412979424685), + TrajectoryPoint(340, 273.680103074452), + TrajectoryPoint(350, 272.947995862854), + TrajectoryPoint(360, 272.216370449358), + TrajectoryPoint(370, 271.485219746641), + TrajectoryPoint(380, 270.754616837678), + TrajectoryPoint(390, 270.024612799547), + TrajectoryPoint(400, 269.295030640527), + TrajectoryPoint(410, 268.565862693335), + TrajectoryPoint(420, 267.837190795272), + TrajectoryPoint(430, 267.109002942919), + TrajectoryPoint(440, 266.381179636422), + TrajectoryPoint(450, 265.653712840534), + TrajectoryPoint(460, 264.926666421748), + TrajectoryPoint(470, 264.2000271323), + TrajectoryPoint(480, 263.473697580668), + TrajectoryPoint(490, 262.74766950539), + TrajectoryPoint(500, 262.02197433135), + TrajectoryPoint(510, 261.296633293524), + TrajectoryPoint(520, 260.571549553413), + TrajectoryPoint(530, 259.846714712804), + TrajectoryPoint(540, 259.12212309975), + TrajectoryPoint(550, 258.397845274305), + TrajectoryPoint(560, 257.673774453814), + TrajectoryPoint(570, 256.949902154063), + TrajectoryPoint(580, 256.226219646066), + TrajectoryPoint(590, 255.502752576244), + TrajectoryPoint(600, 254.779474816701), + TrajectoryPoint(610, 254.056347109367), + TrajectoryPoint(620, 253.33336069841), + TrajectoryPoint(630, 252.610506640133), + TrajectoryPoint(640, 251.887807531866), + TrajectoryPoint(650, 251.16521729093), + TrajectoryPoint(660, 250.442721451613), + TrajectoryPoint(670, 249.720311056808), + TrajectoryPoint(680, 248.997976997602), + TrajectoryPoint(690, 248.275724554634), + TrajectoryPoint(700, 247.5535224792), + TrajectoryPoint(710, 246.831360197616), + TrajectoryPoint(720, 246.109228571492), + TrajectoryPoint(730, 245.387118332019), + TrajectoryPoint(740, 244.665019379271), + TrajectoryPoint(750, 243.942916423737), + TrajectoryPoint(760, 243.220799350082), + TrajectoryPoint(770, 242.498658825773), + TrajectoryPoint(780, 241.776485399037), + TrajectoryPoint(790, 241.054269053746), + TrajectoryPoint(800, 240.331983632489), + TrajectoryPoint(810, 239.609630487501), + TrajectoryPoint(820, 238.887200058708), + TrajectoryPoint(830, 238.164682670993), + TrajectoryPoint(840, 237.442068537661), + TrajectoryPoint(850, 236.719347763334), + TrajectoryPoint(860, 235.996484719815), + TrajectoryPoint(870, 235.273487313095), + TrajectoryPoint(880, 234.550348700297), + TrajectoryPoint(890, 233.827058819392), + TrajectoryPoint(900, 233.103607496376), + TrajectoryPoint(910, 232.379984446437), + TrajectoryPoint(920, 231.65617830329), + TrajectoryPoint(930, 230.932142228903), + TrajectoryPoint(940, 230.207899711351), + TrajectoryPoint(950, 229.483440238754), + TrajectoryPoint(960, 228.758753182106), + TrajectoryPoint(970, 228.033827795369), + TrajectoryPoint(980, 227.308653215324), + TrajectoryPoint(990, 226.583218461217), + TrajectoryPoint(1000, 225.8575091315), + TrajectoryPoint(1010, 225.131477356562), + TrajectoryPoint(1020, 224.40514983452), + TrajectoryPoint(1030, 223.678515282502), + TrajectoryPoint(1040, 222.951562291449), + TrajectoryPoint(1050, 222.224279325234), + TrajectoryPoint(1060, 221.496654719672), + TrajectoryPoint(1070, 220.768676681408), + TrajectoryPoint(1080, 220.040333286714), + TrajectoryPoint(1090, 219.311612480185), + TrajectoryPoint(1100, 218.582498093788), + TrajectoryPoint(1110, 217.852944158746), + TrajectoryPoint(1120, 217.122975356109), + TrajectoryPoint(1130, 216.392579240212), + TrajectoryPoint(1140, 215.661743224233), + TrajectoryPoint(1150, 214.930454578743), + TrajectoryPoint(1160, 214.198700430195), + TrajectoryPoint(1170, 213.466467759371), + TrajectoryPoint(1180, 212.733743399782), + TrajectoryPoint(1190, 212.000514036034), + TrajectoryPoint(1200, 211.266766202161), + TrajectoryPoint(1210, 210.53248627992), + TrajectoryPoint(1220, 209.797660497066), + TrajectoryPoint(1230, 209.062274925599), + TrajectoryPoint(1240, 208.326315479985), + TrajectoryPoint(1250, 207.589767915363), + TrajectoryPoint(1260, 206.852617825721), + TrajectoryPoint(1270, 206.114850642065), + TrajectoryPoint(1280, 205.376437258993), + TrajectoryPoint(1290, 204.637374372368), + TrajectoryPoint(1300, 203.897651642886), + TrajectoryPoint(1310, 203.157253970572), + TrajectoryPoint(1320, 202.416166083132), + TrajectoryPoint(1330, 201.674372534086), + TrajectoryPoint(1340, 200.931857700879), + TrajectoryPoint(1350, 200.188605782972), + TrajectoryPoint(1360, 199.444600799908), + TrajectoryPoint(1370, 198.699826589359), + TrajectoryPoint(1380, 197.954266805148), + TrajectoryPoint(1390, 197.20790491525), + TrajectoryPoint(1400, 196.460724199766), + TrajectoryPoint(1410, 195.712707748871), + TrajectoryPoint(1420, 194.963838460737), + TrajectoryPoint(1430, 194.214099039427), + TrajectoryPoint(1440, 193.463447444109), + TrajectoryPoint(1450, 192.711884013413), + TrajectoryPoint(1460, 191.959393137928), + TrajectoryPoint(1470, 191.205956575049), + TrajectoryPoint(1480, 190.451555876082), + TrajectoryPoint(1490, 189.696172383893), + TrajectoryPoint(1500, 188.939787230526), + TrajectoryPoint(1510, 188.182381334773), + TrajectoryPoint(1520, 187.423935399704), + TrajectoryPoint(1530, 186.664429910157), + TrajectoryPoint(1540, 185.903845130175), + TrajectoryPoint(1550, 185.142161100405), + TrajectoryPoint(1560, 184.379357635436), + TrajectoryPoint(1570, 183.615414321094), + TrajectoryPoint(1580, 182.850310511679), + TrajectoryPoint(1590, 182.084016500443), + TrajectoryPoint(1600, 181.316426333053), + TrajectoryPoint(1610, 180.547605633782), + TrajectoryPoint(1620, 179.777532633572), + TrajectoryPoint(1630, 179.006185315418), + TrajectoryPoint(1640, 178.233541411183), + TrajectoryPoint(1650, 177.459578398347), + TrajectoryPoint(1660, 176.684273496683), + TrajectoryPoint(1670, 175.907603664862), + TrajectoryPoint(1680, 175.129449119366), + TrajectoryPoint(1690, 174.349817798426), + TrajectoryPoint(1700, 173.568742460882), + TrajectoryPoint(1710, 172.786198798646), + TrajectoryPoint(1720, 172.002162222041), + TrajectoryPoint(1730, 171.216607855852), + TrajectoryPoint(1740, 170.429471957324), + TrajectoryPoint(1750, 169.640598589625), + TrajectoryPoint(1760, 168.850121435734), + TrajectoryPoint(1770, 168.05801423419), + TrajectoryPoint(1780, 167.264250414006), + TrajectoryPoint(1790, 166.468803090048), + TrajectoryPoint(1800, 165.671430682837), + TrajectoryPoint(1810, 164.872272202538), + TrajectoryPoint(1820, 164.071336649146), + TrajectoryPoint(1830, 163.268595610659), + TrajectoryPoint(1840, 162.46395627211), + TrajectoryPoint(1850, 161.657215972043), + TrajectoryPoint(1860, 160.848570876313), + TrajectoryPoint(1870, 160.037990933547), + TrajectoryPoint(1880, 159.22541402544), + TrajectoryPoint(1890, 158.410527005239), + TrajectoryPoint(1900, 157.593599660891), + TrajectoryPoint(1910, 156.774600175447), + TrajectoryPoint(1920, 155.953358666255), + TrajectoryPoint(1930, 155.129723112839), + TrajectoryPoint(1940, 154.303903296048), + TrajectoryPoint(1950, 153.475865491831), + TrajectoryPoint(1960, 152.645171794873), + TrajectoryPoint(1970, 151.812146102439), + TrajectoryPoint(1980, 150.976783116826), + TrajectoryPoint(1990, 150.138686112053), + TrajectoryPoint(2000, 149.298048279267), + TrajectoryPoint(2010, 148.454947803395), + TrajectoryPoint(2020, 147.608931938887), + TrajectoryPoint(2030, 146.760253625046), + TrajectoryPoint(2040, 145.908974122188), + TrajectoryPoint(2050, 145.054495725735), + TrajectoryPoint(2060, 144.197325022721), + TrajectoryPoint(2070, 143.337183016015), + TrajectoryPoint(2080, 142.473879096107), + TrajectoryPoint(2090, 141.607738887879), + TrajectoryPoint(2100, 140.73811868892), + TrajectoryPoint(2110, 139.865492884128), + TrajectoryPoint(2120, 138.989494296546), + TrajectoryPoint(2130, 138.110123029943), + TrajectoryPoint(2140, 137.227429988463), + TrajectoryPoint(2150, 136.341042191246), + TrajectoryPoint(2160, 135.451321983405), + TrajectoryPoint(2170, 134.557634772449), + TrajectoryPoint(2180, 133.660537112141), + TrajectoryPoint(2190, 132.759255133451), + TrajectoryPoint(2200, 131.854411158993), + TrajectoryPoint(2210, 130.945225881763), + TrajectoryPoint(2220, 130.032247072331), + TrajectoryPoint(2230, 129.114836029696), + TrajectoryPoint(2240, 128.193313033379), + TrajectoryPoint(2250, 127.267339005557), + TrajectoryPoint(2260, 126.336840371612), + TrajectoryPoint(2270, 125.401950506709), + TrajectoryPoint(2280, 124.462021313858), + TrajectoryPoint(2290, 123.517559977514), + TrajectoryPoint(2300, 122.568006552917), + TrajectoryPoint(2310, 121.613364145076), + TrajectoryPoint(2320, 120.653773400035), + TrajectoryPoint(2330, 119.68855633444), + TrajectoryPoint(2340, 118.717964790002), + TrajectoryPoint(2350, 117.741966631797), + TrajectoryPoint(2360, 116.760003910931), + TrajectoryPoint(2370, 115.772108384922), + TrajectoryPoint(2380, 114.778301075369), + TrajectoryPoint(2390, 113.778396101369), + TrajectoryPoint(2400, 112.771733101963), + TrajectoryPoint(2410, 111.758576909189), + TrajectoryPoint(2420, 110.738744799963), + TrajectoryPoint(2430, 109.712022138938), + TrajectoryPoint(2440, 108.678185820178), + TrajectoryPoint(2450, 107.636676351258), + TrajectoryPoint(2460, 106.587607045257), + TrajectoryPoint(2470, 105.530734622868), + TrajectoryPoint(2480, 104.465800451752), + TrajectoryPoint(2490, 103.39253534738), + TrajectoryPoint(2500, 102.31065905314), + TrajectoryPoint(2510, 101.219879688388), + TrajectoryPoint(2520, 100.119893162209), + TrajectoryPoint(2530, 99.0103825504219), + TrajectoryPoint(2540, 97.8910174331728), + TrajectoryPoint(2550, 96.7614531902537), + TrajectoryPoint(2560, 95.6213302509999), + TrajectoryPoint(2570, 94.4702732953807), + TrajectoryPoint(2580, 93.307890402585), + TrajectoryPoint(2590, 92.1337721430789), + TrajectoryPoint(2600, 90.9472774103768), + TrajectoryPoint(2610, 89.747812296445), + TrajectoryPoint(2620, 88.5351739033227), + TrajectoryPoint(2630, 87.3088660713491), + TrajectoryPoint(2640, 86.0680341107186), + TrajectoryPoint(2650, 84.8118363987549), + TrajectoryPoint(2660, 83.5402105762021), + TrajectoryPoint(2670, 82.2518204002293), + TrajectoryPoint(2680, 80.9461436923589), + TrajectoryPoint(2690, 79.6223930924427), + TrajectoryPoint(2700, 78.2793742942999), + TrajectoryPoint(2710, 76.9162737010822), + TrajectoryPoint(2720, 75.5321922759335), + TrajectoryPoint(2730, 74.1251814788003), + TrajectoryPoint(2740, 72.6947444194972), + TrajectoryPoint(2750, 71.2393144675029), + TrajectoryPoint(2760, 69.7569765450602), + TrajectoryPoint(2770, 68.2459296178799), + TrajectoryPoint(2780, 66.7045220443653), + TrajectoryPoint(2790, 65.1305698960477), + TrajectoryPoint(2800, 63.5216818530973), + TrajectoryPoint(2810, 61.8747072999386), + TrajectoryPoint(2820, 60.18669425166), + TrajectoryPoint(2830, 58.4546165159843), + TrajectoryPoint(2840, 56.6737996224159), + TrajectoryPoint(2850, 54.8398867832196), + TrajectoryPoint(2860, 52.9467606008921), + TrajectoryPoint(2870, 50.9885334341568), + TrajectoryPoint(2880, 48.9570775135718), + TrajectoryPoint(2890, 46.842881400736), + TrajectoryPoint(2900, 44.6347445137228), + TrajectoryPoint(2910, 42.3162432802152), + TrajectoryPoint(2920, 39.8699977622612), + TrajectoryPoint(2930, 37.2702310521455), + TrajectoryPoint(2940, 34.4825586938339), + TrajectoryPoint(2950, 31.4563284783873), + TrajectoryPoint(2960, 28.1160834672774), + TrajectoryPoint(2970, 24.3303340330837), + TrajectoryPoint(2980, 19.849677850402), + TrajectoryPoint(2990, 14.0221770809277), TrajectoryPoint(3000, 0), }; TrajectoryPoint t8_closed[] = { - TrajectoryPoint(0, 285.523113265711), - TrajectoryPoint(10, 284.855479592315), - TrajectoryPoint(20, 284.188599955009), - TrajectoryPoint(30, 283.522319891926), - TrajectoryPoint(40, 282.856738052227), - TrajectoryPoint(50, 282.191606926307), - TrajectoryPoint(60, 281.526922993916), - TrajectoryPoint(70, 280.862927897498), - TrajectoryPoint(80, 280.199370408337), - TrajectoryPoint(90, 279.53621377455), - TrajectoryPoint(100, 278.873549246532), - TrajectoryPoint(110, 278.211400254819), - TrajectoryPoint(120, 277.54960782467), - TrajectoryPoint(130, 276.888167092974), - TrajectoryPoint(140, 276.22723524485), - TrajectoryPoint(150, 275.566652746908), - TrajectoryPoint(160, 274.906379396659), - TrajectoryPoint(170, 274.246440631504), - TrajectoryPoint(180, 273.586921896077), - TrajectoryPoint(190, 272.927671562415), - TrajectoryPoint(200, 272.268683957444), - TrajectoryPoint(210, 271.610012172191), - TrajectoryPoint(220, 270.951647780515), - TrajectoryPoint(230, 270.29350697632), - TrajectoryPoint(240, 269.63558360616), - TrajectoryPoint(250, 268.977933131465), - TrajectoryPoint(260, 268.320510263718), - TrajectoryPoint(270, 267.663267218803), - TrajectoryPoint(280, 267.006197484494), - TrajectoryPoint(290, 266.349343914107), - TrajectoryPoint(300, 265.692659694764), - TrajectoryPoint(310, 265.036112602816), - TrajectoryPoint(320, 264.37969585541), - TrajectoryPoint(330, 263.723433254483), - TrajectoryPoint(340, 263.06729386886), - TrajectoryPoint(350, 262.411249952544), - TrajectoryPoint(360, 261.755294514099), - TrajectoryPoint(370, 261.099432998246), - TrajectoryPoint(380, 260.443652786982), - TrajectoryPoint(390, 259.787927355261), - TrajectoryPoint(400, 259.13224954476), - TrajectoryPoint(410, 258.476613175241), - TrajectoryPoint(420, 257.821013728907), - TrajectoryPoint(430, 257.165429245428), - TrajectoryPoint(440, 256.50985242548), - TrajectoryPoint(450, 255.854275802825), - TrajectoryPoint(460, 255.198686644694), - TrajectoryPoint(470, 254.543071820487), - TrajectoryPoint(480, 253.887425475764), - TrajectoryPoint(490, 253.2317400358), - TrajectoryPoint(500, 252.576007788054), - TrajectoryPoint(510, 251.920198781337), - TrajectoryPoint(520, 251.264317636031), - TrajectoryPoint(530, 250.60835874226), - TrajectoryPoint(540, 249.952314290874), - TrajectoryPoint(550, 249.296176354702), - TrajectoryPoint(560, 248.639900564981), - TrajectoryPoint(570, 247.983507836944), - TrajectoryPoint(580, 247.326991286202), - TrajectoryPoint(590, 246.67034288633), - TrajectoryPoint(600, 246.013554505713), - TrajectoryPoint(610, 245.356581559388), - TrajectoryPoint(620, 244.699436329154), - TrajectoryPoint(630, 244.042121205665), - TrajectoryPoint(640, 243.384627945387), - TrajectoryPoint(650, 242.726948207252), - TrajectoryPoint(660, 242.069061291831), - TrajectoryPoint(670, 241.410925613854), - TrajectoryPoint(680, 240.752573795882), - TrajectoryPoint(690, 240.093997365522), - TrajectoryPoint(700, 239.435187756668), - TrajectoryPoint(710, 238.776136311819), - TrajectoryPoint(720, 238.116818638694), - TrajectoryPoint(730, 237.457193427333), - TrajectoryPoint(740, 236.797296735251), - TrajectoryPoint(750, 236.137119748541), - TrajectoryPoint(760, 235.476653562034), - TrajectoryPoint(770, 234.815889180508), - TrajectoryPoint(780, 234.154817519677), - TrajectoryPoint(790, 233.493381841834), - TrajectoryPoint(800, 232.831599648341), - TrajectoryPoint(810, 232.169480232087), - TrajectoryPoint(820, 231.5070143185), - TrajectoryPoint(830, 230.844192541051), - TrajectoryPoint(840, 230.181005441523), - TrajectoryPoint(850, 229.517443470133), - TrajectoryPoint(860, 228.853472035346), - TrajectoryPoint(870, 228.189063405612), - TrajectoryPoint(880, 227.524249386891), - TrajectoryPoint(890, 226.859020200281), - TrajectoryPoint(900, 226.193365970585), - TrajectoryPoint(910, 225.527276725961), - TrajectoryPoint(920, 224.860742397472), - TrajectoryPoint(930, 224.193752818536), - TrajectoryPoint(940, 223.526297724289), - TrajectoryPoint(950, 222.858319459937), - TrajectoryPoint(960, 222.189838287004), - TrajectoryPoint(970, 221.520859897277), - TrajectoryPoint(980, 220.851373745248), - TrajectoryPoint(990, 220.181369180901), - TrajectoryPoint(1000, 219.510835448812), - TrajectoryPoint(1010, 218.839761687189), - TrajectoryPoint(1020, 218.168136926844), - TrajectoryPoint(1030, 217.495950090128), - TrajectoryPoint(1040, 216.823189989797), - TrajectoryPoint(1050, 216.149845327839), - TrajectoryPoint(1060, 215.475877416546), - TrajectoryPoint(1070, 214.80127836353), - TrajectoryPoint(1080, 214.126061010631), - TrajectoryPoint(1090, 213.450213713862), - TrajectoryPoint(1100, 212.773724711259), - TrajectoryPoint(1110, 212.09658212156), - TrajectoryPoint(1120, 211.418773942857), - TrajectoryPoint(1130, 210.740288051206), - TrajectoryPoint(1140, 210.061112199208), - TrajectoryPoint(1150, 209.381234014553), - TrajectoryPoint(1160, 208.700640998534), - TrajectoryPoint(1170, 208.019320524532), - TrajectoryPoint(1180, 207.33725983647), - TrajectoryPoint(1190, 206.654446047238), - TrajectoryPoint(1200, 205.970866137089), - TrajectoryPoint(1210, 205.286506952009), - TrajectoryPoint(1220, 204.601355202063), - TrajectoryPoint(1230, 203.915397459701), - TrajectoryPoint(1240, 203.228620158054), - TrajectoryPoint(1250, 202.541009589193), - TrajectoryPoint(1260, 201.852551902359), - TrajectoryPoint(1270, 201.163233102175), - TrajectoryPoint(1280, 200.473039046825), - TrajectoryPoint(1290, 199.781955446206), - TrajectoryPoint(1300, 199.089967860053), - TrajectoryPoint(1310, 198.397061696035), - TrajectoryPoint(1320, 197.703222207824), - TrajectoryPoint(1330, 197.008434493137), - TrajectoryPoint(1340, 196.31268349174), - TrajectoryPoint(1350, 195.615953983432), - TrajectoryPoint(1360, 194.918230585992), - TrajectoryPoint(1370, 194.219497753096), - TrajectoryPoint(1380, 193.5197397722), - TrajectoryPoint(1390, 192.818940762392), - TrajectoryPoint(1400, 192.117084672212), - TrajectoryPoint(1410, 191.41415527743), - TrajectoryPoint(1420, 190.710136178793), - TrajectoryPoint(1430, 190.005010799738), - TrajectoryPoint(1440, 189.298762384061), - TrajectoryPoint(1450, 188.591373993548), - TrajectoryPoint(1460, 187.882828505574), - TrajectoryPoint(1470, 187.173108610646), - TrajectoryPoint(1480, 186.462196809922), - TrajectoryPoint(1490, 185.75007541267), - TrajectoryPoint(1500, 185.036726533696), - TrajectoryPoint(1510, 184.322087607605), - TrajectoryPoint(1520, 183.606133997179), - TrajectoryPoint(1530, 182.888892075563), - TrajectoryPoint(1540, 182.170343017133), - TrajectoryPoint(1550, 181.450467786611), - TrajectoryPoint(1560, 180.729247136151), - TrajectoryPoint(1570, 180.006661602364), - TrajectoryPoint(1580, 179.282691503298), - TrajectoryPoint(1590, 178.557316935352), - TrajectoryPoint(1600, 177.830517770135), - TrajectoryPoint(1610, 177.102146245149), - TrajectoryPoint(1620, 176.372281218417), - TrajectoryPoint(1630, 175.640922343904), - TrajectoryPoint(1640, 174.908048406959), - TrajectoryPoint(1650, 174.173637949395), - TrajectoryPoint(1660, 173.437669265913), - TrajectoryPoint(1670, 172.700120400445), - TrajectoryPoint(1680, 171.960808350156), - TrajectoryPoint(1690, 171.219826759187), - TrajectoryPoint(1700, 170.477188891358), - TrajectoryPoint(1710, 169.73287157828), - TrajectoryPoint(1720, 168.986851378867), - TrajectoryPoint(1730, 168.23909191192), - TrajectoryPoint(1740, 167.48934912901), - TrajectoryPoint(1750, 166.737821813749), - TrajectoryPoint(1760, 165.984485205846), - TrajectoryPoint(1770, 165.229314247626), - TrajectoryPoint(1780, 164.472255503174), - TrajectoryPoint(1790, 163.713048861259), - TrajectoryPoint(1800, 162.951920177622), - TrajectoryPoint(1810, 162.18884295457), - TrajectoryPoint(1820, 161.423790369185), - TrajectoryPoint(1830, 160.656499224743), - TrajectoryPoint(1840, 159.88707252106), - TrajectoryPoint(1850, 159.115576157201), - TrajectoryPoint(1860, 158.341981733516), - TrajectoryPoint(1870, 157.565978432388), - TrajectoryPoint(1880, 156.787715173247), - TrajectoryPoint(1890, 156.007253658688), - TrajectoryPoint(1900, 155.224510286424), - TrajectoryPoint(1910, 154.439140161109), - TrajectoryPoint(1920, 153.651466641418), - TrajectoryPoint(1930, 152.861458193193), - TrajectoryPoint(1940, 152.068722752288), - TrajectoryPoint(1950, 151.273474076715), - TrajectoryPoint(1960, 150.475778547396), - TrajectoryPoint(1970, 149.675269543101), - TrajectoryPoint(1980, 148.872063133736), - TrajectoryPoint(1990, 148.066292236779), - TrajectoryPoint(2000, 147.25751779753), - TrajectoryPoint(2010, 146.445950348983), - TrajectoryPoint(2020, 145.631694684321), - TrajectoryPoint(2030, 144.81413073952), - TrajectoryPoint(2040, 143.993776798312), - TrajectoryPoint(2050, 143.170366571422), - TrajectoryPoint(2060, 142.343692394227), - TrajectoryPoint(2070, 141.514102806064), - TrajectoryPoint(2080, 140.680943745961), - TrajectoryPoint(2090, 139.844701933015), - TrajectoryPoint(2100, 139.005009885509), - TrajectoryPoint(2110, 138.161870862199), - TrajectoryPoint(2120, 137.315345354401), - TrajectoryPoint(2130, 136.46505365521), - TrajectoryPoint(2140, 135.61137886277), - TrajectoryPoint(2150, 134.753667972044), - TrajectoryPoint(2160, 133.892511848776), - TrajectoryPoint(2170, 133.027103589809), - TrajectoryPoint(2180, 132.158116930458), - TrajectoryPoint(2190, 131.284720810643), - TrajectoryPoint(2200, 130.407536241305), - TrajectoryPoint(2210, 129.52584874985), - TrajectoryPoint(2220, 128.640079640029), - TrajectoryPoint(2230, 127.749783494374), - TrajectoryPoint(2240, 126.855022784092), - TrajectoryPoint(2250, 125.955786120814), - TrajectoryPoint(2260, 125.051605055493), - TrajectoryPoint(2270, 124.142917990285), - TrajectoryPoint(2280, 123.229027326204), - TrajectoryPoint(2290, 122.31021329417), - TrajectoryPoint(2300, 121.38644954933), - TrajectoryPoint(2310, 120.457017146129), - TrajectoryPoint(2320, 119.522408012795), - TrajectoryPoint(2330, 118.582418839063), - TrajectoryPoint(2340, 117.636377142724), - TrajectoryPoint(2350, 116.68470152192), - TrajectoryPoint(2360, 115.727224431874), - TrajectoryPoint(2370, 114.763421990318), - TrajectoryPoint(2380, 113.79328691982), - TrajectoryPoint(2390, 112.816829099011), - TrajectoryPoint(2400, 111.833855888938), - TrajectoryPoint(2410, 110.84400191246), - TrajectoryPoint(2420, 109.846980996819), - TrajectoryPoint(2430, 108.842848483946), - TrajectoryPoint(2440, 107.831382224854), - TrajectoryPoint(2450, 106.812351363113), - TrajectoryPoint(2460, 105.78551592168), - TrajectoryPoint(2470, 104.750626365291), - TrajectoryPoint(2480, 103.707364272066), - TrajectoryPoint(2490, 102.655432846983), - TrajectoryPoint(2500, 101.594680577135), - TrajectoryPoint(2510, 100.524817738453), - TrajectoryPoint(2520, 99.4455426102373), - TrajectoryPoint(2530, 98.3565408636541), - TrajectoryPoint(2540, 97.257484911913), - TrajectoryPoint(2550, 96.1480332193403), - TrajectoryPoint(2560, 95.0276324299234), - TrajectoryPoint(2570, 93.8960034612218), - TrajectoryPoint(2580, 92.7527893160912), - TrajectoryPoint(2590, 91.5975800065485), - TrajectoryPoint(2600, 90.4299470961985), - TrajectoryPoint(2610, 89.2494426653926), - TrajectoryPoint(2620, 88.0550856972589), - TrajectoryPoint(2630, 86.8466128949824), - TrajectoryPoint(2640, 85.6236880559177), - TrajectoryPoint(2650, 84.3853474955093), - TrajectoryPoint(2660, 83.1307341065176), - TrajectoryPoint(2670, 81.8598206815153), - TrajectoryPoint(2680, 80.5707125652386), - TrajectoryPoint(2690, 79.2637234655312), - TrajectoryPoint(2700, 77.9368148596952), - TrajectoryPoint(2710, 76.5900918989892), - TrajectoryPoint(2720, 75.2213178767821), - TrajectoryPoint(2730, 73.8300616994356), - TrajectoryPoint(2740, 72.4150578513234), - TrajectoryPoint(2750, 70.9743973158589), - TrajectoryPoint(2760, 69.5065101563758), - TrajectoryPoint(2770, 68.0099309182002), - TrajectoryPoint(2780, 66.4826581973602), - TrajectoryPoint(2790, 64.9225051387046), - TrajectoryPoint(2800, 63.327077667737), - TrajectoryPoint(2810, 61.6937495738048), - TrajectoryPoint(2820, 60.0185115080315), - TrajectoryPoint(2830, 58.2988347798023), - TrajectoryPoint(2840, 56.5305537545326), - TrajectoryPoint(2850, 54.7083088659519), - TrajectoryPoint(2860, 52.8269302311832), - TrajectoryPoint(2870, 50.880038600498), - TrajectoryPoint(2880, 48.8594992649163), - TrajectoryPoint(2890, 46.7557944022989), - TrajectoryPoint(2900, 44.5577176221904), - TrajectoryPoint(2910, 42.2491563294788), - TrajectoryPoint(2920, 39.8123528998214), - TrajectoryPoint(2930, 37.2215180858861), - TrajectoryPoint(2940, 34.4425001967444), - TrajectoryPoint(2950, 31.4243327087247), - TrajectoryPoint(2960, 28.0915416737693), - TrajectoryPoint(2970, 24.3129326146767), - TrajectoryPoint(2980, 19.8387644007151), - TrajectoryPoint(2990, 14.0171321587863), + TrajectoryPoint(0, 298.169168242893), + TrajectoryPoint(10, 297.408530938844), + TrajectoryPoint(20, 296.649461187083), + TrajectoryPoint(30, 295.892216229603), + TrajectoryPoint(40, 295.136542753202), + TrajectoryPoint(50, 294.381986076728), + TrajectoryPoint(60, 293.62899408337), + TrajectoryPoint(70, 292.877534301804), + TrajectoryPoint(80, 292.127102965775), + TrajectoryPoint(90, 291.377967648887), + TrajectoryPoint(100, 290.630358948495), + TrajectoryPoint(110, 289.883695268809), + TrajectoryPoint(120, 289.138058218358), + TrajectoryPoint(130, 288.393965596118), + TrajectoryPoint(140, 287.650739355503), + TrajectoryPoint(150, 286.908378776054), + TrajectoryPoint(160, 286.167389427112), + TrajectoryPoint(170, 285.427295489916), + TrajectoryPoint(180, 284.68799207897), + TrajectoryPoint(190, 283.949743573363), + TrajectoryPoint(200, 283.212499686421), + TrajectoryPoint(210, 282.475975801805), + TrajectoryPoint(220, 281.740211609126), + TrajectoryPoint(230, 281.005556375587), + TrajectoryPoint(240, 280.2715549364), + TrajectoryPoint(250, 279.53820250004), + TrajectoryPoint(260, 278.80573178734), + TrajectoryPoint(270, 278.074014405415), + TrajectoryPoint(280, 277.342883519511), + TrajectoryPoint(290, 276.612347970762), + TrajectoryPoint(300, 275.88269323434), + TrajectoryPoint(310, 275.153566298778), + TrajectoryPoint(320, 274.424960826038), + TrajectoryPoint(330, 273.696979277044), + TrajectoryPoint(340, 272.969653779033), + TrajectoryPoint(350, 272.242794506134), + TrajectoryPoint(360, 271.516394296132), + TrajectoryPoint(370, 270.790591511507), + TrajectoryPoint(380, 270.06529280511), + TrajectoryPoint(390, 269.340401231148), + TrajectoryPoint(400, 268.615909090071), + TrajectoryPoint(410, 267.891951693656), + TrajectoryPoint(420, 267.168398089156), + TrajectoryPoint(430, 266.445195070988), + TrajectoryPoint(440, 265.722334600778), + TrajectoryPoint(450, 264.999924741035), + TrajectoryPoint(460, 264.27785335636), + TrajectoryPoint(470, 263.556078489096), + TrajectoryPoint(480, 262.834591894496), + TrajectoryPoint(490, 262.113461887097), + TrajectoryPoint(500, 261.392626651189), + TrajectoryPoint(510, 260.672036181256), + TrajectoryPoint(520, 259.951682109371), + TrajectoryPoint(530, 259.231589891158), + TrajectoryPoint(540, 258.511759564337), + TrajectoryPoint(550, 257.792124350757), + TrajectoryPoint(560, 257.072675805976), + TrajectoryPoint(570, 256.353405250562), + TrajectoryPoint(580, 255.634357321016), + TrajectoryPoint(590, 254.915460879725), + TrajectoryPoint(600, 254.196703241518), + TrajectoryPoint(610, 253.478075705197), + TrajectoryPoint(620, 252.759579712326), + TrajectoryPoint(630, 252.041216365573), + TrajectoryPoint(640, 251.322945525822), + TrajectoryPoint(650, 250.604758460585), + TrajectoryPoint(660, 249.886646277401), + TrajectoryPoint(670, 249.168605980481), + TrajectoryPoint(680, 248.450626609215), + TrajectoryPoint(690, 247.732685938107), + TrajectoryPoint(700, 247.01477503646), + TrajectoryPoint(710, 246.29688483811), + TrajectoryPoint(720, 245.57900604823), + TrajectoryPoint(730, 244.861124572362), + TrajectoryPoint(740, 244.143228674885), + TrajectoryPoint(750, 243.425309224024), + TrajectoryPoint(760, 242.707356966125), + TrajectoryPoint(770, 241.989362531793), + TrajectoryPoint(780, 241.27130639629), + TrajectoryPoint(790, 240.553177141605), + TrajectoryPoint(800, 239.834971311285), + TrajectoryPoint(810, 239.116679430751), + TrajectoryPoint(820, 238.398291913503), + TrajectoryPoint(830, 237.679799064425), + TrajectoryPoint(840, 236.961175837509), + TrajectoryPoint(850, 236.24241002572), + TrajectoryPoint(860, 235.523504783011), + TrajectoryPoint(870, 234.804450256366), + TrajectoryPoint(880, 234.085236482049), + TrajectoryPoint(890, 233.365853387074), + TrajectoryPoint(900, 232.646290790306), + TrajectoryPoint(910, 231.926507598261), + TrajectoryPoint(920, 231.206513123493), + TrajectoryPoint(930, 230.486304845719), + TrajectoryPoint(940, 229.765872361613), + TrajectoryPoint(950, 229.045205153385), + TrajectoryPoint(960, 228.324292588821), + TrajectoryPoint(970, 227.603123921111), + TrajectoryPoint(980, 226.881685811767), + TrajectoryPoint(990, 226.159927725629), + TrajectoryPoint(1000, 225.437878566706), + TrajectoryPoint(1010, 224.71552729987), + TrajectoryPoint(1020, 223.992862767173), + TrajectoryPoint(1030, 223.26987368709), + TrajectoryPoint(1040, 222.546548653641), + TrajectoryPoint(1050, 221.822876135378), + TrajectoryPoint(1060, 221.098844474272), + TrajectoryPoint(1070, 220.374441884504), + TrajectoryPoint(1080, 219.649633229938), + TrajectoryPoint(1090, 218.924408831859), + TrajectoryPoint(1100, 218.198776758224), + TrajectoryPoint(1110, 217.472724847955), + TrajectoryPoint(1120, 216.746240802868), + TrajectoryPoint(1130, 216.019312186277), + TrajectoryPoint(1140, 215.291926421538), + TrajectoryPoint(1150, 214.564070790545), + TrajectoryPoint(1160, 213.835732432171), + TrajectoryPoint(1170, 213.106898340678), + TrajectoryPoint(1180, 212.377555364084), + TrajectoryPoint(1190, 211.647690202495), + TrajectoryPoint(1200, 210.917289406414), + TrajectoryPoint(1210, 210.186339375013), + TrajectoryPoint(1220, 209.454826354392), + TrajectoryPoint(1230, 208.722711139812), + TrajectoryPoint(1240, 207.990003529665), + TrajectoryPoint(1250, 207.256692113825), + TrajectoryPoint(1260, 206.522762645327), + TrajectoryPoint(1270, 205.78820071488), + TrajectoryPoint(1280, 205.052991749088), + TrajectoryPoint(1290, 204.317121008656), + TrajectoryPoint(1300, 203.580573586566), + TrajectoryPoint(1310, 202.843334406243), + TrajectoryPoint(1320, 202.105388219694), + TrajectoryPoint(1330, 201.366719605623), + TrajectoryPoint(1340, 200.627312967535), + TrajectoryPoint(1350, 199.887152531812), + TrajectoryPoint(1360, 199.146222345769), + TrajectoryPoint(1370, 198.404506275688), + TrajectoryPoint(1380, 197.661988004831), + TrajectoryPoint(1390, 196.918651031424), + TrajectoryPoint(1400, 196.174478666624), + TrajectoryPoint(1410, 195.429454032451), + TrajectoryPoint(1420, 194.683560059702), + TrajectoryPoint(1430, 193.936779485827), + TrajectoryPoint(1440, 193.189094852788), + TrajectoryPoint(1450, 192.440488504874), + TrajectoryPoint(1460, 191.690942586491), + TrajectoryPoint(1470, 190.940439039915), + TrajectoryPoint(1480, 190.18892178432), + TrajectoryPoint(1490, 189.436398585976), + TrajectoryPoint(1500, 188.682857443295), + TrajectoryPoint(1510, 187.928279315706), + TrajectoryPoint(1520, 187.172644947515), + TrajectoryPoint(1530, 186.415934865376), + TrajectoryPoint(1540, 185.658129375717), + TrajectoryPoint(1550, 184.899208562117), + TrajectoryPoint(1560, 184.139152282628), + TrajectoryPoint(1570, 183.377940167057), + TrajectoryPoint(1580, 182.61555161418), + TrajectoryPoint(1590, 181.851965788909), + TrajectoryPoint(1600, 181.0871616194), + TrajectoryPoint(1610, 180.321036154971), + TrajectoryPoint(1620, 179.553613681044), + TrajectoryPoint(1630, 178.784901127948), + TrajectoryPoint(1640, 178.014876275842), + TrajectoryPoint(1650, 177.243516650848), + TrajectoryPoint(1660, 176.470799521703), + TrajectoryPoint(1670, 175.696701896348), + TrajectoryPoint(1680, 174.921200518435), + TrajectoryPoint(1690, 174.144151977521), + TrajectoryPoint(1700, 173.365600550522), + TrajectoryPoint(1710, 172.585565395217), + TrajectoryPoint(1720, 171.804021973445), + TrajectoryPoint(1730, 171.020945461676), + TrajectoryPoint(1740, 170.236310746944), + TrajectoryPoint(1750, 169.449983177092), + TrajectoryPoint(1760, 168.661936067567), + TrajectoryPoint(1770, 167.872243788032), + TrajectoryPoint(1780, 167.080879820615), + TrajectoryPoint(1790, 166.287817333336), + TrajectoryPoint(1800, 165.492950478375), + TrajectoryPoint(1810, 164.696144495296), + TrajectoryPoint(1820, 163.897546558067), + TrajectoryPoint(1830, 163.097128308576), + TrajectoryPoint(1840, 162.294861046374), + TrajectoryPoint(1850, 161.49048251351), + TrajectoryPoint(1860, 160.68411337024), + TrajectoryPoint(1870, 159.875794747835), + TrajectoryPoint(1880, 159.065496280522), + TrajectoryPoint(1890, 158.252940377068), + TrajectoryPoint(1900, 157.43822793941), + TrajectoryPoint(1910, 156.621428927703), + TrajectoryPoint(1920, 155.802504018576), + TrajectoryPoint(1930, 154.981037263916), + TrajectoryPoint(1940, 154.157371960544), + TrajectoryPoint(1950, 153.331474438148), + TrajectoryPoint(1960, 152.503033403209), + TrajectoryPoint(1970, 151.672116591249), + TrajectoryPoint(1980, 150.83884840337), + TrajectoryPoint(1990, 150.002957053505), + TrajectoryPoint(2000, 149.164382811001), + TrajectoryPoint(2010, 148.323331992177), + TrajectoryPoint(2020, 147.479474479661), + TrajectoryPoint(2030, 146.632814820666), + TrajectoryPoint(2040, 145.783546934775), + TrajectoryPoint(2050, 144.931172607236), + TrajectoryPoint(2060, 144.075975987331), + TrajectoryPoint(2070, 143.217914107522), + TrajectoryPoint(2080, 142.356553606682), + TrajectoryPoint(2090, 141.492343279738), + TrajectoryPoint(2100, 140.624755279631), + TrajectoryPoint(2110, 139.754028918941), + TrajectoryPoint(2120, 138.880031419066), + TrajectoryPoint(2130, 138.00252929365), + TrajectoryPoint(2140, 137.121806040459), + TrajectoryPoint(2150, 136.237257219696), + TrajectoryPoint(2160, 135.349475334356), + TrajectoryPoint(2170, 134.457597076541), + TrajectoryPoint(2180, 133.562364152793), + TrajectoryPoint(2190, 132.662903221868), + TrajectoryPoint(2200, 131.75991803919), + TrajectoryPoint(2210, 130.852498281492), + TrajectoryPoint(2220, 129.941362591977), + TrajectoryPoint(2230, 129.025671304527), + TrajectoryPoint(2240, 128.105959482051), + TrajectoryPoint(2250, 127.18167577273), + TrajectoryPoint(2260, 126.252956285389), + TrajectoryPoint(2270, 125.319727451888), + TrajectoryPoint(2280, 124.381545310271), + TrajectoryPoint(2290, 123.43881535487), + TrajectoryPoint(2300, 122.49087734335), + TrajectoryPoint(2310, 121.537934057195), + TrajectoryPoint(2320, 120.580026539492), + TrajectoryPoint(2330, 119.61637956163), + TrajectoryPoint(2340, 118.647438857812), + TrajectoryPoint(2350, 117.673075450829), + TrajectoryPoint(2360, 116.69263779339), + TrajectoryPoint(2370, 115.706344536399), + TrajectoryPoint(2380, 114.714123237233), + TrajectoryPoint(2390, 113.715722424512), + TrajectoryPoint(2400, 112.710589071088), + TrajectoryPoint(2410, 111.69896993448), + TrajectoryPoint(2420, 110.680658398823), + TrajectoryPoint(2430, 109.655439755036), + TrajectoryPoint(2440, 108.623012476564), + TrajectoryPoint(2450, 107.582969052252), + TrajectoryPoint(2460, 106.535354417326), + TrajectoryPoint(2470, 105.479919940033), + TrajectoryPoint(2480, 104.416406929834), + TrajectoryPoint(2490, 103.344546147337), + TrajectoryPoint(2500, 102.264057284275), + TrajectoryPoint(2510, 101.174648411457), + TrajectoryPoint(2520, 100.076015392424), + TrajectoryPoint(2530, 98.967841260357), + TrajectoryPoint(2540, 97.8497955555871), + TrajectoryPoint(2550, 96.7215336208281), + TrajectoryPoint(2560, 95.5826958509986), + TrajectoryPoint(2570, 94.4329068942411), + TrajectoryPoint(2580, 93.2717748004408), + TrajectoryPoint(2590, 92.0988901132209), + TrajectoryPoint(2600, 90.9136756914645), + TrajectoryPoint(2610, 89.7154078243833), + TrajectoryPoint(2620, 88.5039493290423), + TrajectoryPoint(2630, 87.278804029885), + TrajectoryPoint(2640, 86.0391760127967), + TrajectoryPoint(2650, 84.7841040016675), + TrajectoryPoint(2660, 83.5135864314345), + TrajectoryPoint(2670, 82.2263416696317), + TrajectoryPoint(2680, 80.9217360523383), + TrajectoryPoint(2690, 79.5990911558509), + TrajectoryPoint(2700, 78.2571060653845), + TrajectoryPoint(2710, 76.8950708935594), + TrajectoryPoint(2720, 75.5119856087328), + TrajectoryPoint(2730, 74.1059994395712), + TrajectoryPoint(2740, 72.6765660052629), + TrajectoryPoint(2750, 71.2221184513856), + TrajectoryPoint(2760, 69.740698379555), + TrajectoryPoint(2770, 68.2305920097809), + TrajectoryPoint(2780, 66.6901032892101), + TrajectoryPoint(2790, 65.1170481097568), + TrajectoryPoint(2800, 63.5090349834268), + TrajectoryPoint(2810, 61.8629489319367), + TrajectoryPoint(2820, 60.1757644507384), + TrajectoryPoint(2830, 58.4444926935865), + TrajectoryPoint(2840, 56.6644903922812), + TrajectoryPoint(2850, 54.8313358885318), + TrajectoryPoint(2860, 52.9389731088485), + TrajectoryPoint(2870, 50.9814826044457), + TrajectoryPoint(2880, 48.9507361568704), + TrajectoryPoint(2890, 46.837221913699), + TrajectoryPoint(2900, 44.6297389146645), + TrajectoryPoint(2910, 42.3118837398159), + TrajectoryPoint(2920, 39.8662519694227), + TrajectoryPoint(2930, 37.2670658812005), + TrajectoryPoint(2940, 34.4799560965972), + TrajectoryPoint(2950, 31.4542500016361), + TrajectoryPoint(2960, 28.1144895229178), + TrajectoryPoint(2970, 24.3292041366927), + TrajectoryPoint(2980, 19.8489694895358), + TrajectoryPoint(2990, 14.0218498072543), TrajectoryPoint(3000, 0), }; TrajectoryPoint t9_closed[] = { - TrajectoryPoint(0, 284.860132271709), - TrajectoryPoint(10, 284.196954575389), - TrajectoryPoint(20, 283.534777036889), - TrajectoryPoint(30, 282.873243011805), - TrajectoryPoint(40, 282.212144989553), - TrajectoryPoint(50, 281.551479416948), - TrajectoryPoint(60, 280.891503985271), - TrajectoryPoint(70, 280.231924382733), - TrajectoryPoint(80, 279.572731784548), - TrajectoryPoint(90, 278.914036336609), - TrajectoryPoint(100, 278.255813506923), - TrajectoryPoint(110, 277.597934213897), - TrajectoryPoint(120, 276.940393608758), - TrajectoryPoint(130, 276.28336107756), - TrajectoryPoint(140, 275.626643954136), - TrajectoryPoint(150, 274.970223737409), - TrajectoryPoint(160, 274.314141418251), - TrajectoryPoint(170, 273.658443168417), - TrajectoryPoint(180, 273.003001790553), - TrajectoryPoint(190, 272.347811650729), - TrajectoryPoint(200, 271.69293681138), - TrajectoryPoint(210, 271.038339781219), - TrajectoryPoint(220, 270.383955506719), - TrajectoryPoint(230, 269.729777886714), - TrajectoryPoint(240, 269.075869958168), - TrajectoryPoint(250, 268.422165010115), - TrajectoryPoint(260, 267.768629714238), - TrajectoryPoint(270, 267.115257619198), - TrajectoryPoint(280, 266.462096652855), - TrajectoryPoint(290, 265.809084279181), - TrajectoryPoint(300, 265.156199485578), - TrajectoryPoint(310, 264.503435555533), - TrajectoryPoint(320, 263.850819531513), - TrajectoryPoint(330, 263.198309001446), - TrajectoryPoint(340, 262.545884979851), - TrajectoryPoint(350, 261.89354054497), - TrajectoryPoint(360, 261.241283035297), - TrajectoryPoint(370, 260.589091520446), - TrajectoryPoint(380, 259.936946376295), - TrajectoryPoint(390, 259.28484051619), - TrajectoryPoint(400, 258.632768650923), - TrajectoryPoint(410, 257.980720350232), - TrajectoryPoint(420, 257.328679124255), - TrajectoryPoint(430, 256.676637746542), - TrajectoryPoint(440, 256.024588827252), - TrajectoryPoint(450, 255.372515718959), - TrajectoryPoint(460, 254.720409509474), - TrajectoryPoint(470, 254.068264458153), - TrajectoryPoint(480, 253.416073066936), - TrajectoryPoint(490, 252.763825413684), - TrajectoryPoint(500, 252.111490530356), - TrajectoryPoint(510, 251.45907873107), - TrajectoryPoint(520, 250.80658240923), - TrajectoryPoint(530, 250.15399383501), - TrajectoryPoint(540, 249.501298073655), - TrajectoryPoint(550, 248.8484607203), - TrajectoryPoint(560, 248.195501137233), - TrajectoryPoint(570, 247.542411488323), - TrajectoryPoint(580, 246.889183828715), - TrajectoryPoint(590, 246.235809161444), - TrajectoryPoint(600, 245.582231345332), - TrajectoryPoint(610, 244.928485971925), - TrajectoryPoint(620, 244.274564981276), - TrajectoryPoint(630, 243.620460213729), - TrajectoryPoint(640, 242.966163413684), - TrajectoryPoint(650, 242.31163651172), - TrajectoryPoint(660, 241.656870199237), - TrajectoryPoint(670, 241.001882535127), - TrajectoryPoint(680, 240.34666513352), - TrajectoryPoint(690, 239.69120951633), - TrajectoryPoint(700, 239.035507115515), - TrajectoryPoint(710, 238.379510576256), - TrajectoryPoint(720, 237.723222254929), - TrajectoryPoint(730, 237.066657841556), - TrajectoryPoint(740, 236.409808613365), - TrajectoryPoint(750, 235.752665757752), - TrajectoryPoint(760, 235.095220373467), - TrajectoryPoint(770, 234.437453344742), - TrajectoryPoint(780, 233.779307397293), - TrajectoryPoint(790, 233.120829410333), - TrajectoryPoint(800, 232.462010298004), - TrajectoryPoint(810, 231.802840883498), - TrajectoryPoint(820, 231.143311899487), - TrajectoryPoint(830, 230.483413988376), - TrajectoryPoint(840, 229.823137702427), - TrajectoryPoint(850, 229.162409488717), - TrajectoryPoint(860, 228.501277556995), - TrajectoryPoint(870, 227.839737074187), - TrajectoryPoint(880, 227.177778366591), - TrajectoryPoint(890, 226.515391665711), - TrajectoryPoint(900, 225.852567107906), - TrajectoryPoint(910, 225.189294733942), - TrajectoryPoint(920, 224.52556448845), - TrajectoryPoint(930, 223.861332381098), - TrajectoryPoint(940, 223.196590127606), - TrajectoryPoint(950, 222.531358831378), - TrajectoryPoint(960, 221.865628165727), - TrajectoryPoint(970, 221.199387701887), - TrajectoryPoint(980, 220.532626908188), - TrajectoryPoint(990, 219.86533514917), - TrajectoryPoint(1000, 219.197501684629), - TrajectoryPoint(1010, 218.529115668609), - TrajectoryPoint(1020, 217.86016614834), - TrajectoryPoint(1030, 217.190642063122), - TrajectoryPoint(1040, 216.520487434659), - TrajectoryPoint(1050, 215.849726555463), - TrajectoryPoint(1060, 215.178357982363), - TrajectoryPoint(1070, 214.506370319467), - TrajectoryPoint(1080, 213.833752055933), - TrajectoryPoint(1090, 213.160491564705), - TrajectoryPoint(1100, 212.486577101214), - TrajectoryPoint(1110, 211.811996802043), - TrajectoryPoint(1120, 211.13673868355), - TrajectoryPoint(1130, 210.460790640468), - TrajectoryPoint(1140, 209.784140444462), - TrajectoryPoint(1150, 209.106775742663), - TrajectoryPoint(1160, 208.428684056169), - TrajectoryPoint(1170, 207.749852778514), - TrajectoryPoint(1180, 207.070269174113), - TrajectoryPoint(1190, 206.389920376677), - TrajectoryPoint(1200, 205.7087933876), - TrajectoryPoint(1210, 205.026875074322), - TrajectoryPoint(1220, 204.34415216866), - TrajectoryPoint(1230, 203.660611265117), - TrajectoryPoint(1240, 202.976238819165), - TrajectoryPoint(1250, 202.291019684537), - TrajectoryPoint(1260, 201.604934397644), - TrajectoryPoint(1270, 200.917978945247), - TrajectoryPoint(1280, 200.230139317258), - TrajectoryPoint(1290, 199.541401356063), - TrajectoryPoint(1300, 198.851750754696), - TrajectoryPoint(1310, 198.161173054968), - TrajectoryPoint(1320, 197.469651093697), - TrajectoryPoint(1330, 196.777161436794), - TrajectoryPoint(1340, 196.083696748141), - TrajectoryPoint(1350, 195.389241832702), - TrajectoryPoint(1360, 194.693781333652), - TrajectoryPoint(1370, 193.997299730282), - TrajectoryPoint(1380, 193.299781335887), - TrajectoryPoint(1390, 192.601210295605), - TrajectoryPoint(1400, 191.901570584236), - TrajectoryPoint(1410, 191.200846004012), - TrajectoryPoint(1420, 190.499020182346), - TrajectoryPoint(1430, 189.79607656953), - TrajectoryPoint(1440, 189.091998436406), - TrajectoryPoint(1450, 188.38676887199), - TrajectoryPoint(1460, 187.680370781063), - TrajectoryPoint(1470, 186.972786881714), - TrajectoryPoint(1480, 186.263999702848), - TrajectoryPoint(1490, 185.553991581642), - TrajectoryPoint(1500, 184.842744660964), - TrajectoryPoint(1510, 184.130240886744), - TrajectoryPoint(1520, 183.416449069571), - TrajectoryPoint(1530, 182.701274237962), - TrajectoryPoint(1540, 181.984781033213), - TrajectoryPoint(1550, 181.266950449524), - TrajectoryPoint(1560, 180.54776326863), - TrajectoryPoint(1570, 179.82720005682), - TrajectoryPoint(1580, 179.105241161914), - TrajectoryPoint(1590, 178.381866710166), - TrajectoryPoint(1600, 177.657056603121), - TrajectoryPoint(1610, 176.930787350821), - TrajectoryPoint(1620, 176.20288792369), - TrajectoryPoint(1630, 175.47348365584), - TrajectoryPoint(1640, 174.742553363391), - TrajectoryPoint(1650, 174.010075618963), - TrajectoryPoint(1660, 173.27602874809), - TrajectoryPoint(1670, 172.540390825568), - TrajectoryPoint(1680, 171.803100147764), - TrajectoryPoint(1690, 171.064006183184), - TrajectoryPoint(1700, 170.323245144399), - TrajectoryPoint(1710, 169.580793894391), - TrajectoryPoint(1720, 168.836629023431), - TrajectoryPoint(1730, 168.090726844893), - TrajectoryPoint(1740, 167.3429233275), - TrajectoryPoint(1750, 166.593217473833), - TrajectoryPoint(1760, 165.84169170131), - TrajectoryPoint(1770, 165.088320983845), - TrajectoryPoint(1780, 164.333079993209), - TrajectoryPoint(1790, 163.575739572046), - TrajectoryPoint(1800, 162.816377543151), - TrajectoryPoint(1810, 162.055056491904), - TrajectoryPoint(1820, 161.291749626964), - TrajectoryPoint(1830, 160.526307141909), - TrajectoryPoint(1840, 159.758603249157), - TrajectoryPoint(1850, 158.988819327081), - TrajectoryPoint(1860, 158.216927007504), - TrajectoryPoint(1870, 157.442726327146), - TrajectoryPoint(1880, 156.666142391393), - TrajectoryPoint(1890, 155.887349946125), - TrajectoryPoint(1900, 155.106318920254), - TrajectoryPoint(1910, 154.322651560624), - TrajectoryPoint(1920, 153.536614247997), - TrajectoryPoint(1930, 152.74823186829), - TrajectoryPoint(1940, 151.957218529703), - TrajectoryPoint(1950, 151.163573380709), - TrajectoryPoint(1960, 150.367471324249), - TrajectoryPoint(1970, 149.568650017007), - TrajectoryPoint(1980, 148.767014642972), - TrajectoryPoint(1990, 147.962804812621), - TrajectoryPoint(2000, 147.15568345995), - TrajectoryPoint(2010, 146.345654750718), - TrajectoryPoint(2020, 145.532927941512), - TrajectoryPoint(2030, 144.716982300626), - TrajectoryPoint(2040, 143.898135002593), - TrajectoryPoint(2050, 143.076320503308), - TrajectoryPoint(2060, 142.251130820992), - TrajectoryPoint(2070, 141.423015983168), - TrajectoryPoint(2080, 140.59141757117), - TrajectoryPoint(2090, 139.75662848236), - TrajectoryPoint(2100, 138.918474203177), - TrajectoryPoint(2110, 138.076765947777), - TrajectoryPoint(2120, 137.231755192692), - TrajectoryPoint(2130, 136.382872377543), - TrajectoryPoint(2140, 135.530689198789), - TrajectoryPoint(2150, 134.674365382645), - TrajectoryPoint(2160, 133.814641738985), - TrajectoryPoint(2170, 132.950634704476), - TrajectoryPoint(2180, 132.08307195848), - TrajectoryPoint(2190, 131.211040621662), - TrajectoryPoint(2200, 130.335277619677), - TrajectoryPoint(2210, 129.454912237195), - TrajectoryPoint(2220, 128.570541169391), - TrajectoryPoint(2230, 127.681545635994), - TrajectoryPoint(2240, 126.788159368973), - TrajectoryPoint(2250, 125.890201902086), - TrajectoryPoint(2260, 124.987371615836), - TrajectoryPoint(2270, 124.080023704841), - TrajectoryPoint(2280, 123.167378805519), - TrajectoryPoint(2290, 122.249880122997), - TrajectoryPoint(2300, 121.327340922214), - TrajectoryPoint(2310, 120.399200018403), - TrajectoryPoint(2320, 119.465870521575), - TrajectoryPoint(2330, 118.527072728175), - TrajectoryPoint(2340, 117.582286711512), - TrajectoryPoint(2350, 116.631854768689), - TrajectoryPoint(2360, 115.675609286581), - TrajectoryPoint(2370, 114.712953247704), - TrajectoryPoint(2380, 113.744025685441), - TrajectoryPoint(2390, 112.76876318555), - TrajectoryPoint(2400, 111.786973049757), - TrajectoryPoint(2410, 110.798220769624), - TrajectoryPoint(2420, 109.802358721198), - TrajectoryPoint(2430, 108.799372730605), - TrajectoryPoint(2440, 107.789040597536), - TrajectoryPoint(2450, 106.771131416532), - TrajectoryPoint(2460, 105.745405163731), - TrajectoryPoint(2470, 104.711612259198), - TrajectoryPoint(2480, 103.669371974665), - TrajectoryPoint(2490, 102.618512829381), - TrajectoryPoint(2500, 101.558820235446), - TrajectoryPoint(2510, 100.490004430682), - TrajectoryPoint(2520, 99.4117636581828), - TrajectoryPoint(2530, 98.3237835547576), - TrajectoryPoint(2540, 97.2257365010637), - TrajectoryPoint(2550, 96.1172809306365), - TrajectoryPoint(2560, 94.9979176500855), - TrajectoryPoint(2570, 93.8672579390628), - TrajectoryPoint(2580, 92.7250001491128), - TrajectoryPoint(2590, 91.570734269261), - TrajectoryPoint(2600, 90.4040318416731), - TrajectoryPoint(2610, 89.2244449267843), - TrajectoryPoint(2620, 88.0310404503353), - TrajectoryPoint(2630, 86.8234576653431), - TrajectoryPoint(2640, 85.6014097885444), - TrajectoryPoint(2650, 84.363978090251), - TrajectoryPoint(2660, 83.1102138634812), - TrajectoryPoint(2670, 81.8401364766352), - TrajectoryPoint(2680, 80.5518927124763), - TrajectoryPoint(2690, 79.2457115990299), - TrajectoryPoint(2700, 77.9196371128033), - TrajectoryPoint(2710, 76.573732759094), - TrajectoryPoint(2720, 75.2057233651619), - TrajectoryPoint(2730, 73.8152548757506), - TrajectoryPoint(2740, 72.4010227547454), - TrajectoryPoint(2750, 70.9610830582135), - TrajectoryPoint(2760, 69.4939361166712), - TrajectoryPoint(2770, 67.9980807451113), - TrajectoryPoint(2780, 66.4715153925865), - TrajectoryPoint(2790, 64.912053064619), - TrajectoryPoint(2800, 63.317299554836), - TrajectoryPoint(2810, 61.6846285279769), - TrajectoryPoint(2820, 60.0100571541484), - TrajectoryPoint(2830, 58.2910018887725), - TrajectoryPoint(2840, 56.5233495287609), - TrajectoryPoint(2850, 54.7016897775644), - TrajectoryPoint(2860, 52.820900682815), - TrajectoryPoint(2870, 50.8745781240896), - TrajectoryPoint(2880, 48.8545870427998), - TrajectoryPoint(2890, 46.7514092908934), - TrajectoryPoint(2900, 44.5538381765167), - TrajectoryPoint(2910, 42.2457768061917), - TrajectoryPoint(2920, 39.8094484551715), - TrajectoryPoint(2930, 37.2190632386811), - TrajectoryPoint(2940, 34.4404811909898), - TrajectoryPoint(2950, 31.4227198930438), - TrajectoryPoint(2960, 28.0903045043538), - TrajectoryPoint(2970, 24.3120553901285), - TrajectoryPoint(2980, 19.8382142735135), - TrajectoryPoint(2990, 14.0168778835745), + TrajectoryPoint(0, 297.274120311127), + TrajectoryPoint(10, 296.520161589322), + TrajectoryPoint(20, 295.76870798757), + TrajectoryPoint(30, 295.01854217357), + TrajectoryPoint(40, 294.269467198551), + TrajectoryPoint(50, 293.52211849079), + TrajectoryPoint(60, 292.776044893293), + TrajectoryPoint(70, 292.030975394156), + TrajectoryPoint(80, 291.287349475562), + TrajectoryPoint(90, 290.545015310423), + TrajectoryPoint(100, 289.803603355622), + TrajectoryPoint(110, 289.063354252202), + TrajectoryPoint(120, 288.32443337393), + TrajectoryPoint(130, 287.586357514458), + TrajectoryPoint(140, 286.84917128406), + TrajectoryPoint(150, 286.113361937263), + TrajectoryPoint(160, 285.378324915918), + TrajectoryPoint(170, 284.644057988645), + TrajectoryPoint(180, 283.910938808365), + TrajectoryPoint(190, 283.178665447705), + TrajectoryPoint(200, 282.447092985066), + TrajectoryPoint(210, 281.716369579261), + TrajectoryPoint(220, 280.98660483537), + TrajectoryPoint(230, 280.257475997615), + TrajectoryPoint(240, 279.528978060352), + TrajectoryPoint(250, 278.801428317233), + TrajectoryPoint(260, 278.074510313611), + TrajectoryPoint(270, 277.348161850819), + TrajectoryPoint(280, 276.622474922973), + TrajectoryPoint(290, 275.897551363063), + TrajectoryPoint(300, 275.17313968948), + TrajectoryPoint(310, 274.449233463701), + TrajectoryPoint(320, 273.726001667835), + TrajectoryPoint(330, 273.003328679683), + TrajectoryPoint(340, 272.281106861781), + TrajectoryPoint(350, 271.559329004188), + TrajectoryPoint(360, 270.838187052676), + TrajectoryPoint(370, 270.11746787576), + TrajectoryPoint(380, 269.397141605395), + TrajectoryPoint(390, 268.67721011718), + TrajectoryPoint(400, 267.957823455178), + TrajectoryPoint(410, 267.238781496487), + TrajectoryPoint(420, 266.520076681908), + TrajectoryPoint(430, 265.801712791853), + TrajectoryPoint(440, 265.083798078149), + TrajectoryPoint(450, 264.366175013322), + TrajectoryPoint(460, 263.648835755729), + TrajectoryPoint(470, 262.931772089221), + TrajectoryPoint(480, 262.215081766861), + TrajectoryPoint(490, 261.498635600691), + TrajectoryPoint(500, 260.78242217002), + TrajectoryPoint(510, 260.066433146388), + TrajectoryPoint(520, 259.350718590196), + TrajectoryPoint(530, 258.635221736296), + TrajectoryPoint(540, 257.919908595406), + TrajectoryPoint(550, 257.204770770011), + TrajectoryPoint(560, 256.489816208341), + TrajectoryPoint(570, 255.775053628202), + TrajectoryPoint(580, 255.060427537969), + TrajectoryPoint(590, 254.345929488845), + TrajectoryPoint(600, 253.631550838994), + TrajectoryPoint(610, 252.917304450456), + TrajectoryPoint(620, 252.203162676353), + TrajectoryPoint(630, 251.489103199566), + TrajectoryPoint(640, 250.775117350109), + TrajectoryPoint(650, 250.061196303242), + TrajectoryPoint(660, 249.347340987595), + TrajectoryPoint(670, 248.633527415998), + TrajectoryPoint(680, 247.919742921275), + TrajectoryPoint(690, 247.205978642784), + TrajectoryPoint(700, 246.492225588514), + TrajectoryPoint(710, 245.778472263794), + TrajectoryPoint(720, 245.064704370447), + TrajectoryPoint(730, 244.350913005266), + TrajectoryPoint(740, 243.637089113031), + TrajectoryPoint(750, 242.923223520059), + TrajectoryPoint(760, 242.209305398657), + TrajectoryPoint(770, 241.495308088301), + TrajectoryPoint(780, 240.781235077746), + TrajectoryPoint(790, 240.067077091183), + TrajectoryPoint(800, 239.352824739984), + TrajectoryPoint(810, 238.638468526468), + TrajectoryPoint(820, 237.923995701297), + TrajectoryPoint(830, 237.20937077263), + TrajectoryPoint(840, 236.494608328636), + TrajectoryPoint(850, 235.779698721396), + TrajectoryPoint(860, 235.064632193103), + TrajectoryPoint(870, 234.349398877861), + TrajectoryPoint(880, 233.633988803077), + TrajectoryPoint(890, 232.918372388259), + TrajectoryPoint(900, 232.202536368232), + TrajectoryPoint(910, 231.486489797047), + TrajectoryPoint(920, 230.770222491171), + TrajectoryPoint(930, 230.053724154858), + TrajectoryPoint(940, 229.336984380411), + TrajectoryPoint(950, 228.619992648191), + TrajectoryPoint(960, 227.902738326422), + TrajectoryPoint(970, 227.185167409318), + TrajectoryPoint(980, 226.467307864019), + TrajectoryPoint(990, 225.74915117572), + TrajectoryPoint(1000, 225.030686430029), + TrajectoryPoint(1010, 224.311902592254), + TrajectoryPoint(1020, 223.592788506642), + TrajectoryPoint(1030, 222.873332895481), + TrajectoryPoint(1040, 222.153524358091), + TrajectoryPoint(1050, 221.433351369704), + TrajectoryPoint(1060, 220.712765504099), + TrajectoryPoint(1070, 219.991782213631), + TrajectoryPoint(1080, 219.270398408075), + TrajectoryPoint(1090, 218.548602202068), + TrajectoryPoint(1100, 217.826381577042), + TrajectoryPoint(1110, 217.103724379894), + TrajectoryPoint(1120, 216.380618321582), + TrajectoryPoint(1130, 215.657050975679), + TrajectoryPoint(1140, 214.933009776866), + TrajectoryPoint(1150, 214.208482019384), + TrajectoryPoint(1160, 213.48345485544), + TrajectoryPoint(1170, 212.757915293585), + TrajectoryPoint(1180, 212.031850197053), + TrajectoryPoint(1190, 211.305222349158), + TrajectoryPoint(1200, 210.578033102204), + TrajectoryPoint(1210, 209.850278981752), + TrajectoryPoint(1220, 209.121946388117), + TrajectoryPoint(1230, 208.393021567126), + TrajectoryPoint(1240, 207.663490608418), + TrajectoryPoint(1250, 206.933339443717), + TrajectoryPoint(1260, 206.202553845087), + TrajectoryPoint(1270, 205.471119423164), + TrajectoryPoint(1280, 204.739021625363), + TrajectoryPoint(1290, 204.006245734067), + TrajectoryPoint(1300, 203.272776864798), + TrajectoryPoint(1310, 202.538599964365), + TrajectoryPoint(1320, 201.803699808991), + TrajectoryPoint(1330, 201.068061002424), + TrajectoryPoint(1340, 200.331667974026), + TrajectoryPoint(1350, 199.594504976836), + TrajectoryPoint(1360, 198.856556085623), + TrajectoryPoint(1370, 198.117805194901), + TrajectoryPoint(1380, 197.378236016938), + TrajectoryPoint(1390, 196.637832079726), + TrajectoryPoint(1400, 195.896576724938), + TrajectoryPoint(1410, 195.154453105847), + TrajectoryPoint(1420, 194.411444185233), + TrajectoryPoint(1430, 193.667532733242), + TrajectoryPoint(1440, 192.922701325233), + TrajectoryPoint(1450, 192.176932339583), + TrajectoryPoint(1460, 191.430207955464), + TrajectoryPoint(1470, 190.682510150579), + TrajectoryPoint(1480, 189.933820698873), + TrajectoryPoint(1490, 189.184121168197), + TrajectoryPoint(1500, 188.433387598805), + TrajectoryPoint(1510, 187.681551729846), + TrajectoryPoint(1520, 186.928643952112), + TrajectoryPoint(1530, 186.174644832836), + TrajectoryPoint(1540, 185.419534719552), + TrajectoryPoint(1550, 184.663293737457), + TrajectoryPoint(1560, 183.905901786721), + TrajectoryPoint(1570, 183.147338539744), + TrajectoryPoint(1580, 182.387583438361), + TrajectoryPoint(1590, 181.62661569099), + TrajectoryPoint(1600, 180.864414269719), + TrajectoryPoint(1610, 180.100957907334), + TrajectoryPoint(1620, 179.336162710585), + TrajectoryPoint(1630, 178.570005712293), + TrajectoryPoint(1640, 177.802521220667), + TrajectoryPoint(1650, 177.033686808769), + TrajectoryPoint(1660, 176.263479792578), + TrajectoryPoint(1670, 175.491877227557), + TrajectoryPoint(1680, 174.718855905141), + TrajectoryPoint(1690, 173.944392349153), + TrajectoryPoint(1700, 173.168306145238), + TrajectoryPoint(1710, 172.390704403493), + TrajectoryPoint(1720, 171.611579549591), + TrajectoryPoint(1730, 170.830906809761), + TrajectoryPoint(1740, 170.048661120932), + TrajectoryPoint(1750, 169.26481712656), + TrajectoryPoint(1760, 168.479153677736), + TrajectoryPoint(1770, 167.691804269894), + TrajectoryPoint(1780, 166.902768601203), + TrajectoryPoint(1790, 166.112019890791), + TrajectoryPoint(1800, 165.31953103895), + TrajectoryPoint(1810, 164.525062716497), + TrajectoryPoint(1820, 163.728732852298), + TrajectoryPoint(1830, 162.930568335951), + TrajectoryPoint(1840, 162.130540518716), + TrajectoryPoint(1850, 161.328517804348), + TrajectoryPoint(1860, 160.524357062725), + TrajectoryPoint(1870, 159.718232689744), + TrajectoryPoint(1880, 158.910114371539), + TrajectoryPoint(1890, 158.099853124355), + TrajectoryPoint(1900, 157.287290013356), + TrajectoryPoint(1910, 156.472626367483), + TrajectoryPoint(1920, 155.655830077698), + TrajectoryPoint(1930, 154.836589188399), + TrajectoryPoint(1940, 154.015014765294), + TrajectoryPoint(1950, 153.191194355711), + TrajectoryPoint(1960, 152.364941076686), + TrajectoryPoint(1970, 151.536070974992), + TrajectoryPoint(1980, 150.704835872841), + TrajectoryPoint(1990, 149.871086662457), + TrajectoryPoint(2000, 149.034515290142), + TrajectoryPoint(2010, 148.195453860432), + TrajectoryPoint(2020, 147.353692591943), + TrajectoryPoint(2030, 146.50899230415), + TrajectoryPoint(2040, 145.661670451723), + TrajectoryPoint(2050, 144.811346251878), + TrajectoryPoint(2060, 143.958065853556), + TrajectoryPoint(2070, 143.102024313253), + TrajectoryPoint(2080, 142.242550341307), + TrajectoryPoint(2090, 141.380213441398), + TrajectoryPoint(2100, 140.514599294566), + TrajectoryPoint(2110, 139.645716885988), + TrajectoryPoint(2120, 138.773663048644), + TrajectoryPoint(2130, 137.897975529305), + TrajectoryPoint(2140, 137.019160638828), + TrajectoryPoint(2150, 136.136402140204), + TrajectoryPoint(2160, 135.250393770768), + TrajectoryPoint(2170, 134.360381074941), + TrajectoryPoint(2180, 133.466891780054), + TrajectoryPoint(2190, 132.569266689489), + TrajectoryPoint(2200, 131.667996286218), + TrajectoryPoint(2210, 130.762381627354), + TrajectoryPoint(2220, 129.853016469659), + TrajectoryPoint(2230, 128.939014972831), + TrajectoryPoint(2240, 128.021062567888), + TrajectoryPoint(2250, 127.098420258596), + TrajectoryPoint(2260, 126.171429122048), + TrajectoryPoint(2270, 125.239813315524), + TrajectoryPoint(2280, 124.303328392275), + TrajectoryPoint(2290, 123.362280441023), + TrajectoryPoint(2300, 122.415911254386), + TrajectoryPoint(2310, 121.464618681994), + TrajectoryPoint(2320, 120.508284444374), + TrajectoryPoint(2330, 119.546224373221), + TrajectoryPoint(2340, 118.578887539781), + TrajectoryPoint(2350, 117.606112385699), + TrajectoryPoint(2360, 116.627155996178), + TrajectoryPoint(2370, 115.642419485388), + TrajectoryPoint(2380, 114.651739151679), + TrajectoryPoint(2390, 113.654776265382), + TrajectoryPoint(2400, 112.651152304623), + TrajectoryPoint(2410, 111.641026638663), + TrajectoryPoint(2420, 110.62419257651), + TrajectoryPoint(2430, 109.600435337859), + TrajectoryPoint(2440, 108.569371731363), + TrajectoryPoint(2450, 107.530758009122), + TrajectoryPoint(2460, 106.484556902992), + TrajectoryPoint(2470, 105.430519721523), + TrajectoryPoint(2480, 104.368387717781), + TrajectoryPoint(2490, 103.297891599157), + TrajectoryPoint(2500, 102.21875100724), + TrajectoryPoint(2510, 101.130673965661), + TrajectoryPoint(2520, 100.033356293653), + TrajectoryPoint(2530, 98.9264809828727), + TrajectoryPoint(2540, 97.8097175348248), + TrajectoryPoint(2550, 96.6827212560161), + TrajectoryPoint(2560, 95.5451325077068), + TrajectoryPoint(2570, 94.3965759068618), + TrajectoryPoint(2580, 93.236659474606), + TrajectoryPoint(2590, 92.0649737281617), + TrajectoryPoint(2600, 90.8810038567727), + TrajectoryPoint(2610, 89.6838996635499), + TrajectoryPoint(2620, 88.473588001564), + TrajectoryPoint(2630, 87.2495726793589), + TrajectoryPoint(2640, 86.0111150426589), + TrajectoryPoint(2650, 84.7571372477791), + TrajectoryPoint(2660, 83.4876969549058), + TrajectoryPoint(2670, 82.2015657258536), + TrajectoryPoint(2680, 80.8980013027669), + TrajectoryPoint(2690, 79.5764313658408), + TrajectoryPoint(2700, 78.2354511699044), + TrajectoryPoint(2710, 76.8744518292502), + TrajectoryPoint(2720, 75.4923349580459), + TrajectoryPoint(2730, 74.0873449940281), + TrajectoryPoint(2740, 72.6588873592058), + TrajectoryPoint(2750, 71.2053949816724), + TrajectoryPoint(2760, 69.7248672871839), + TrajectoryPoint(2770, 68.2156754476255), + TrajectoryPoint(2780, 66.6760801691506), + TrajectoryPoint(2790, 65.1038971687985), + TrajectoryPoint(2800, 63.4967347947298), + TrajectoryPoint(2810, 61.8515127578645), + TrajectoryPoint(2820, 60.1651339888478), + TrajectoryPoint(2830, 58.4346459942549), + TrajectoryPoint(2840, 56.6554358745973), + TrajectoryPoint(2850, 54.8230188329473), + TrajectoryPoint(2860, 52.9313984802107), + TrajectoryPoint(2870, 50.9746244096565), + TrajectoryPoint(2880, 48.9445679659378), + TrajectoryPoint(2890, 46.8317168935398), + TrajectoryPoint(2900, 44.6248698636102), + TrajectoryPoint(2910, 42.3076430656993), + TrajectoryPoint(2920, 39.86260825605), + TrajectoryPoint(2930, 37.2639869197955), + TrajectoryPoint(2940, 34.4774243481856), + TrajectoryPoint(2950, 31.4522280726933), + TrajectoryPoint(2960, 28.1129389155415), + TrajectoryPoint(2970, 24.3281049393204), + TrajectoryPoint(2980, 19.8482803583464), + TrajectoryPoint(2990, 14.0215314075888), TrajectoryPoint(3000, 0), }; TrajectoryPoint t10_closed[] = { - TrajectoryPoint(0, 284.217060865029), - TrajectoryPoint(10, 283.558695560262), - TrajectoryPoint(20, 282.901066213715), - TrajectoryPoint(30, 282.2438920452), - TrajectoryPoint(40, 281.5871507165), - TrajectoryPoint(50, 280.931064826739), - TrajectoryPoint(60, 280.275356468001), - TrajectoryPoint(70, 279.62002174664), - TrajectoryPoint(80, 278.965182967075), - TrajectoryPoint(90, 278.310782098687), - TrajectoryPoint(100, 277.656712203669), - TrajectoryPoint(110, 277.00297036531), - TrajectoryPoint(120, 276.349727053556), - TrajectoryPoint(130, 275.696773837399), - TrajectoryPoint(140, 275.044105740489), - TrajectoryPoint(150, 274.391774243689), - TrajectoryPoint(160, 273.739797150309), - TrajectoryPoint(170, 273.088065832102), - TrajectoryPoint(180, 272.436574703862), - TrajectoryPoint(190, 271.785394728316), - TrajectoryPoint(200, 271.134468161814), - TrajectoryPoint(210, 270.483743941939), - TrajectoryPoint(220, 269.83321602705), - TrajectoryPoint(230, 269.182951775553), - TrajectoryPoint(240, 268.532870144488), - TrajectoryPoint(250, 267.88294840627), - TrajectoryPoint(260, 267.233180175921), - TrajectoryPoint(270, 266.583615875424), - TrajectoryPoint(280, 265.934182915387), - TrajectoryPoint(290, 265.284868387449), - TrajectoryPoint(300, 264.635665645574), - TrajectoryPoint(310, 263.986602948067), - TrajectoryPoint(320, 263.337630898988), - TrajectoryPoint(330, 262.688736784896), - TrajectoryPoint(340, 262.039913756836), - TrajectoryPoint(350, 261.391169480478), - TrajectoryPoint(360, 260.74247824232), - TrajectoryPoint(370, 260.093825341646), - TrajectoryPoint(380, 259.445203765819), - TrajectoryPoint(390, 258.79660792686), - TrajectoryPoint(400, 258.14802421407), - TrajectoryPoint(410, 257.499440052208), - TrajectoryPoint(420, 256.850848289447), - TrajectoryPoint(430, 256.202241613688), - TrajectoryPoint(440, 255.553598892973), - TrajectoryPoint(450, 254.904916872003), - TrajectoryPoint(460, 254.256189042771), - TrajectoryPoint(470, 253.60740798483), - TrajectoryPoint(480, 252.958559143628), - TrajectoryPoint(490, 252.309617722723), - TrajectoryPoint(500, 251.660592879102), - TrajectoryPoint(510, 251.011477083801), - TrajectoryPoint(520, 250.362262686695), - TrajectoryPoint(530, 249.7129267839), - TrajectoryPoint(540, 249.063448120732), - TrajectoryPoint(550, 248.413841239794), - TrajectoryPoint(560, 247.764098384764), - TrajectoryPoint(570, 247.114211692327), - TrajectoryPoint(580, 246.464161165948), - TrajectoryPoint(590, 245.813910110824), - TrajectoryPoint(600, 245.16348601726), - TrajectoryPoint(610, 244.51288090731), - TrajectoryPoint(620, 243.86208670485), - TrajectoryPoint(630, 243.211095239261), - TrajectoryPoint(640, 242.559851903875), - TrajectoryPoint(650, 241.908378169887), - TrajectoryPoint(660, 241.256678187504), - TrajectoryPoint(670, 240.604743656787), - TrajectoryPoint(680, 239.95256618696), - TrajectoryPoint(690, 239.300137298627), - TrajectoryPoint(700, 238.647387836907), - TrajectoryPoint(710, 237.994361642452), - TrajectoryPoint(720, 237.341055048766), - TrajectoryPoint(730, 236.687459423309), - TrajectoryPoint(740, 236.033566045058), - TrajectoryPoint(750, 235.379366105661), - TrajectoryPoint(760, 234.724813395315), - TrajectoryPoint(770, 234.069902825872), - TrajectoryPoint(780, 233.414656510954), - TrajectoryPoint(790, 232.759065459875), - TrajectoryPoint(800, 232.10312059237), - TrajectoryPoint(810, 231.44681273902), - TrajectoryPoint(820, 230.790132641501), - TrajectoryPoint(830, 230.13304067002), - TrajectoryPoint(840, 229.475516977617), - TrajectoryPoint(850, 228.817591327444), - TrajectoryPoint(860, 228.159254242639), - TrajectoryPoint(870, 227.500496153216), - TrajectoryPoint(880, 226.841307395835), - TrajectoryPoint(890, 226.181678213455), - TrajectoryPoint(900, 225.521598754892), - TrajectoryPoint(910, 224.861044764806), - TrajectoryPoint(920, 224.199967444365), - TrajectoryPoint(930, 223.538409189616), - TrajectoryPoint(940, 222.876359887027), - TrajectoryPoint(950, 222.21380932328), - TrajectoryPoint(960, 221.550747184522), - TrajectoryPoint(970, 220.887163055561), - TrajectoryPoint(980, 220.223046418979), - TrajectoryPoint(990, 219.5583866542), - TrajectoryPoint(1000, 218.893173036488), - TrajectoryPoint(1010, 218.227394735901), - TrajectoryPoint(1020, 217.560986376641), - TrajectoryPoint(1030, 216.893988829051), - TrajectoryPoint(1040, 216.226394059999), - TrajectoryPoint(1050, 215.558190914844), - TrajectoryPoint(1060, 214.889368126915), - TrajectoryPoint(1070, 214.219914316298), - TrajectoryPoint(1080, 213.549817988594), - TrajectoryPoint(1090, 212.879067533634), - TrajectoryPoint(1100, 212.207651224154), - TrajectoryPoint(1110, 211.535557214442), - TrajectoryPoint(1120, 210.862773538947), - TrajectoryPoint(1130, 210.189288110859), - TrajectoryPoint(1140, 209.515088720655), - TrajectoryPoint(1150, 208.840163034618), - TrajectoryPoint(1160, 208.164498593327), - TrajectoryPoint(1170, 207.488082810117), - TrajectoryPoint(1180, 206.810902969514), - TrajectoryPoint(1190, 206.13292457024), - TrajectoryPoint(1200, 205.454153880327), - TrajectoryPoint(1210, 204.774582485683), - TrajectoryPoint(1220, 204.094197244072), - TrajectoryPoint(1230, 203.412984876468), - TrajectoryPoint(1240, 202.730931965383), - TrajectoryPoint(1250, 202.048024953167), - TrajectoryPoint(1260, 201.364250140279), - TrajectoryPoint(1270, 200.679593683532), - TrajectoryPoint(1280, 199.994041594307), - TrajectoryPoint(1290, 199.307579736745), - TrajectoryPoint(1300, 198.620193825903), - TrajectoryPoint(1310, 197.931869425885), - TrajectoryPoint(1320, 197.242591947943), - TrajectoryPoint(1330, 196.552346648553), - TrajectoryPoint(1340, 195.861118627451), - TrajectoryPoint(1350, 195.168892825646), - TrajectoryPoint(1360, 194.475654023398), - TrajectoryPoint(1370, 193.781386838169), - TrajectoryPoint(1380, 193.086060382431), - TrajectoryPoint(1390, 192.389651884636), - TrajectoryPoint(1400, 191.692163493074), - TrajectoryPoint(1410, 190.993579035609), - TrajectoryPoint(1420, 190.293882165467), - TrajectoryPoint(1430, 189.593056358935), - TrajectoryPoint(1440, 188.891084913025), - TrajectoryPoint(1450, 188.187950943096), - TrajectoryPoint(1460, 187.483637380433), - TrajectoryPoint(1470, 186.778126969793), - TrajectoryPoint(1480, 186.071402266903), - TrajectoryPoint(1490, 185.363445635912), - TrajectoryPoint(1500, 184.654239246804), - TrajectoryPoint(1510, 183.943765072763), - TrajectoryPoint(1520, 183.232004887492), - TrajectoryPoint(1530, 182.518940262478), - TrajectoryPoint(1540, 181.804451801445), - TrajectoryPoint(1550, 181.088606222286), - TrajectoryPoint(1560, 180.371393223427), - TrajectoryPoint(1570, 179.652793399783), - TrajectoryPoint(1580, 178.932787127878), - TrajectoryPoint(1590, 178.211354562753), - TrajectoryPoint(1600, 177.48847563481), - TrajectoryPoint(1610, 176.764130046598), - TrajectoryPoint(1620, 176.038258301008), - TrajectoryPoint(1630, 175.310751824504), - TrajectoryPoint(1640, 174.581708708596), - TrajectoryPoint(1650, 173.851107555573), - TrajectoryPoint(1660, 173.118926720661), - TrajectoryPoint(1670, 172.385144308363), - TrajectoryPoint(1680, 171.649738168726), - TrajectoryPoint(1690, 170.912556882719), - TrajectoryPoint(1700, 170.173618295166), - TrajectoryPoint(1710, 169.432979070706), - TrajectoryPoint(1720, 168.690615829777), - TrajectoryPoint(1730, 167.946504915895), - TrajectoryPoint(1740, 167.200598255468), - TrajectoryPoint(1750, 166.452661212771), - TrajectoryPoint(1760, 165.702893960156), - TrajectoryPoint(1770, 164.951271501907), - TrajectoryPoint(1780, 164.197768540106), - TrajectoryPoint(1790, 163.442269001612), - TrajectoryPoint(1800, 162.684622684623), - TrajectoryPoint(1810, 161.925007192098), - TrajectoryPoint(1820, 161.163395763042), - TrajectoryPoint(1830, 160.399749833423), - TrajectoryPoint(1840, 159.63371916964), - TrajectoryPoint(1850, 158.865598432802), - TrajectoryPoint(1860, 158.095359284961), - TrajectoryPoint(1870, 157.322910452589), - TrajectoryPoint(1880, 156.547957606193), - TrajectoryPoint(1890, 155.770786317144), - TrajectoryPoint(1900, 154.991366544342), - TrajectoryPoint(1910, 154.209406025209), - TrajectoryPoint(1920, 153.424958019643), - TrajectoryPoint(1930, 152.638155124884), - TrajectoryPoint(1940, 151.848815449002), - TrajectoryPoint(1950, 151.056727932878), - TrajectoryPoint(1960, 150.262173768664), - TrajectoryPoint(1970, 149.464992715667), - TrajectoryPoint(1980, 148.664883482326), - TrajectoryPoint(1990, 147.862190133666), - TrajectoryPoint(2000, 147.056675430956), - TrajectoryPoint(2010, 146.248141557878), - TrajectoryPoint(2020, 145.436900007296), - TrajectoryPoint(2030, 144.622527247612), - TrajectoryPoint(2040, 143.80514367317), - TrajectoryPoint(2050, 142.984880127093), - TrajectoryPoint(2060, 142.161132694795), - TrajectoryPoint(2070, 141.334450663163), - TrajectoryPoint(2080, 140.50436915139), - TrajectoryPoint(2090, 139.670991512361), - TrajectoryPoint(2100, 138.834331914379), - TrajectoryPoint(2110, 137.994013819464), - TrajectoryPoint(2120, 137.150475396111), - TrajectoryPoint(2130, 136.302961521506), - TrajectoryPoint(2140, 135.452153761484), - TrajectoryPoint(2150, 134.597252182141), - TrajectoryPoint(2160, 133.738867122969), - TrajectoryPoint(2170, 132.876275508058), - TrajectoryPoint(2180, 132.010030322447), - TrajectoryPoint(2190, 131.139391754783), - TrajectoryPoint(2200, 130.26499103446), - TrajectoryPoint(2210, 129.38593001286), - TrajectoryPoint(2220, 128.502917958065), - TrajectoryPoint(2230, 127.615186364543), - TrajectoryPoint(2240, 126.723136199075), - TrajectoryPoint(2250, 125.826421900187), - TrajectoryPoint(2260, 124.924904740617), - TrajectoryPoint(2270, 124.01885866196), - TrajectoryPoint(2280, 123.107424499922), - TrajectoryPoint(2290, 122.191204538836), - TrajectoryPoint(2300, 121.269855490042), - TrajectoryPoint(2310, 120.342970152429), - TrajectoryPoint(2320, 119.410884697565), - TrajectoryPoint(2330, 118.473244881224), - TrajectoryPoint(2340, 117.529679647516), - TrajectoryPoint(2350, 116.580456829175), - TrajectoryPoint(2360, 115.625408747032), - TrajectoryPoint(2370, 114.663867043354), - TrajectoryPoint(2380, 113.696113482846), - TrajectoryPoint(2390, 112.722013146543), - TrajectoryPoint(2400, 111.741373278759), - TrajectoryPoint(2410, 110.753691950393), - TrajectoryPoint(2420, 109.758956666518), - TrajectoryPoint(2430, 108.757085449398), - TrajectoryPoint(2440, 107.747856048974), - TrajectoryPoint(2450, 106.731037512227), - TrajectoryPoint(2460, 105.706389769855), - TrajectoryPoint(2470, 104.673663198538), - TrajectoryPoint(2480, 103.632416327513), - TrajectoryPoint(2490, 102.582599849262), - TrajectoryPoint(2500, 101.523937679523), - TrajectoryPoint(2510, 100.45614001903), - TrajectoryPoint(2520, 99.3789050756092), - TrajectoryPoint(2530, 98.291918452576), - TrajectoryPoint(2540, 97.1948524988287), - TrajectoryPoint(2550, 96.0873656178334), - TrajectoryPoint(2560, 94.9690114000573), - TrajectoryPoint(2570, 93.839294276825), - TrajectoryPoint(2580, 92.6979665407632), - TrajectoryPoint(2590, 91.5446181583213), - TrajectoryPoint(2600, 90.3788206505824), - TrajectoryPoint(2610, 89.200126058364), - TrajectoryPoint(2620, 88.0076480181356), - TrajectoryPoint(2630, 86.8009308364979), - TrajectoryPoint(2640, 85.5797358794279), - TrajectoryPoint(2650, 84.3431882112177), - TrajectoryPoint(2660, 83.0902498907466), - TrajectoryPoint(2670, 81.8209856585395), - TrajectoryPoint(2680, 80.5335826622994), - TrajectoryPoint(2690, 79.2281874436575), - TrajectoryPoint(2700, 77.9029243380736), - TrajectoryPoint(2710, 76.5578162836645), - TrajectoryPoint(2720, 75.1905506472505), - TrajectoryPoint(2730, 73.8008484018779), - TrajectoryPoint(2740, 72.3873670077783), - TrajectoryPoint(2750, 70.9481285090389), - TrajectoryPoint(2760, 69.4817016640765), - TrajectoryPoint(2770, 67.9865504917883), - TrajectoryPoint(2780, 66.4606732981375), - TrajectoryPoint(2790, 64.9018829529339), - TrajectoryPoint(2800, 63.3077851212815), - TrajectoryPoint(2810, 61.6757533464129), - TrajectoryPoint(2820, 60.0018306178938), - TrajectoryPoint(2830, 58.2833799834912), - TrajectoryPoint(2840, 56.5163392871054), - TrajectoryPoint(2850, 54.6952488430528), - TrajectoryPoint(2860, 52.8150333609928), - TrajectoryPoint(2870, 50.8692645074718), - TrajectoryPoint(2880, 48.8498068835772), - TrajectoryPoint(2890, 46.7471420238584), - TrajectoryPoint(2900, 44.5500629428049), - TrajectoryPoint(2910, 42.2424880308071), - TrajectoryPoint(2920, 39.8066219698814), - TrajectoryPoint(2930, 37.2166742547711), - TrajectoryPoint(2940, 34.4385163321078), - TrajectoryPoint(2950, 31.421150310798), - TrajectoryPoint(2960, 28.0891004816011), - TrajectoryPoint(2970, 24.3112016557051), - TrajectoryPoint(2980, 19.83767886765), - TrajectoryPoint(2990, 14.016630406453), + TrajectoryPoint(0, 296.40713122294), + TrajectoryPoint(10, 295.661244680948), + TrajectoryPoint(20, 294.916423913162), + TrajectoryPoint(30, 294.172668422467), + TrajectoryPoint(40, 293.430766962259), + TrajectoryPoint(50, 292.689922620245), + TrajectoryPoint(60, 291.950058459599), + TrajectoryPoint(70, 291.211755101243), + TrajectoryPoint(80, 290.474543760113), + TrajectoryPoint(90, 289.738232266117), + TrajectoryPoint(100, 289.003192494477), + TrajectoryPoint(110, 288.269296439633), + TrajectoryPoint(120, 287.536224494901), + TrajectoryPoint(130, 286.804144447861), + TrajectoryPoint(140, 286.073269512534), + TrajectoryPoint(150, 285.343147345838), + TrajectoryPoint(160, 284.613775373855), + TrajectoryPoint(170, 283.885623984423), + TrajectoryPoint(180, 283.158183142126), + TrajectoryPoint(190, 282.431424610043), + TrajectoryPoint(200, 281.705586156811), + TrajectoryPoint(210, 280.980577633037), + TrajectoryPoint(220, 280.256187626497), + TrajectoryPoint(230, 279.532441427699), + TrajectoryPoint(240, 278.809633941113), + TrajectoryPoint(250, 278.08738498552), + TrajectoryPoint(260, 277.365689139949), + TrajectoryPoint(270, 276.644707082345), + TrajectoryPoint(280, 275.924387558405), + TrajectoryPoint(290, 275.204564508338), + TrajectoryPoint(300, 274.485231424557), + TrajectoryPoint(310, 273.766611683332), + TrajectoryPoint(320, 273.048467513531), + TrajectoryPoint(330, 272.33075996821), + TrajectoryPoint(340, 271.613514768954), + TrajectoryPoint(350, 270.896868338548), + TrajectoryPoint(360, 270.180608238347), + TrajectoryPoint(370, 269.464727326777), + TrajectoryPoint(380, 268.749273017452), + TrajectoryPoint(390, 268.034293541331), + TrajectoryPoint(400, 267.319645820775), + TrajectoryPoint(410, 266.605322304046), + TrajectoryPoint(420, 265.891364384653), + TrajectoryPoint(430, 265.177795694563), + TrajectoryPoint(440, 264.464506411641), + TrajectoryPoint(450, 263.751488718968), + TrajectoryPoint(460, 263.038762408527), + TrajectoryPoint(470, 262.326364311364), + TrajectoryPoint(480, 261.614195389763), + TrajectoryPoint(490, 260.902247656316), + TrajectoryPoint(500, 260.190513470049), + TrajectoryPoint(510, 259.479059950988), + TrajectoryPoint(520, 258.767787318172), + TrajectoryPoint(530, 258.056687470778), + TrajectoryPoint(540, 257.345752064364), + TrajectoryPoint(550, 256.63500491011), + TrajectoryPoint(560, 255.924416693486), + TrajectoryPoint(570, 255.213954614685), + TrajectoryPoint(580, 254.503610282065), + TrajectoryPoint(590, 253.793375117173), + TrajectoryPoint(600, 253.083269470464), + TrajectoryPoint(610, 252.373245260295), + TrajectoryPoint(620, 251.663293593711), + TrajectoryPoint(630, 250.953405866374), + TrajectoryPoint(640, 250.243575331145), + TrajectoryPoint(650, 249.533797678032), + TrajectoryPoint(660, 248.824048577771), + TrajectoryPoint(670, 248.114319379083), + TrajectoryPoint(680, 247.404601293362), + TrajectoryPoint(690, 246.694885326542), + TrajectoryPoint(700, 245.985155491935), + TrajectoryPoint(710, 245.275402429999), + TrajectoryPoint(720, 244.565617285081), + TrajectoryPoint(730, 243.855791079657), + TrajectoryPoint(740, 243.145914720841), + TrajectoryPoint(750, 242.435967973021), + TrajectoryPoint(760, 241.725939121568), + TrajectoryPoint(770, 241.015826516226), + TrajectoryPoint(780, 240.305620964609), + TrajectoryPoint(790, 239.595313164297), + TrajectoryPoint(800, 238.884893706454), + TrajectoryPoint(810, 238.174332459271), + TrajectoryPoint(820, 237.463625269253), + TrajectoryPoint(830, 236.752773158768), + TrajectoryPoint(840, 236.041766572176), + TrajectoryPoint(850, 235.330595846486), + TrajectoryPoint(860, 234.619251213073), + TrajectoryPoint(870, 233.907717287203), + TrajectoryPoint(880, 233.195953083795), + TrajectoryPoint(890, 232.483981669159), + TrajectoryPoint(900, 231.771793074152), + TrajectoryPoint(910, 231.059377219352), + TrajectoryPoint(920, 230.346723915546), + TrajectoryPoint(930, 229.633822863953), + TrajectoryPoint(940, 228.920663656215), + TrajectoryPoint(950, 228.207200233642), + TrajectoryPoint(960, 227.493444420175), + TrajectoryPoint(970, 226.779396462938), + TrajectoryPoint(980, 226.065045683953), + TrajectoryPoint(990, 225.35038128799), + TrajectoryPoint(1000, 224.635392361934), + TrajectoryPoint(1010, 223.920067874022), + TrajectoryPoint(1020, 223.204396672937), + TrajectoryPoint(1030, 222.488367486799), + TrajectoryPoint(1040, 221.771924107119), + TrajectoryPoint(1050, 221.055096295821), + TrajectoryPoint(1060, 220.337875092901), + TrajectoryPoint(1070, 219.620248880188), + TrajectoryPoint(1080, 218.902205910054), + TrajectoryPoint(1090, 218.183734304148), + TrajectoryPoint(1100, 217.464822052069), + TrajectoryPoint(1110, 216.745457009968), + TrajectoryPoint(1120, 216.025626899103), + TrajectoryPoint(1130, 215.305319304338), + TrajectoryPoint(1140, 214.584521672599), + TrajectoryPoint(1150, 213.863221311292), + TrajectoryPoint(1160, 213.141371410505), + TrajectoryPoint(1170, 212.418989424738), + TrajectoryPoint(1180, 211.696066461626), + TrajectoryPoint(1190, 210.972589388018), + TrajectoryPoint(1200, 210.248544922167), + TrajectoryPoint(1210, 209.523919632084), + TrajectoryPoint(1220, 208.798699933872), + TrajectoryPoint(1230, 208.072872090038), + TrajectoryPoint(1240, 207.346422207771), + TrajectoryPoint(1250, 206.619336237205), + TrajectoryPoint(1260, 205.891599969655), + TrajectoryPoint(1270, 205.163199035839), + TrajectoryPoint(1280, 204.434118904072), + TrajectoryPoint(1290, 203.704344878445), + TrajectoryPoint(1300, 202.973862096984), + TrajectoryPoint(1310, 202.242655529788), + TrajectoryPoint(1320, 201.510709977151), + TrajectoryPoint(1330, 200.778010067656), + TrajectoryPoint(1340, 200.044540256261), + TrajectoryPoint(1350, 199.31028482235), + TrajectoryPoint(1360, 198.575227867776), + TrajectoryPoint(1370, 197.839353314872), + TrajectoryPoint(1380, 197.10264490444), + TrajectoryPoint(1390, 196.365086193724), + TrajectoryPoint(1400, 195.626660554344), + TrajectoryPoint(1410, 194.887351170218), + TrajectoryPoint(1420, 194.147141035444), + TrajectoryPoint(1430, 193.406012952161), + TrajectoryPoint(1440, 192.663949528374), + TrajectoryPoint(1450, 191.920933175754), + TrajectoryPoint(1460, 191.176946107399), + TrajectoryPoint(1470, 190.431970335561), + TrajectoryPoint(1480, 189.685987669338), + TrajectoryPoint(1490, 188.938979712329), + TrajectoryPoint(1500, 188.190927860248), + TrajectoryPoint(1510, 187.441813298494), + TrajectoryPoint(1520, 186.691616999685), + TrajectoryPoint(1530, 185.940252130242), + TrajectoryPoint(1540, 185.187757187874), + TrajectoryPoint(1550, 184.434116336425), + TrajectoryPoint(1560, 183.679309516871), + TrajectoryPoint(1570, 182.923316442871), + TrajectoryPoint(1580, 182.166116597946), + TrajectoryPoint(1590, 181.407689232617), + TrajectoryPoint(1600, 180.648013361477), + TrajectoryPoint(1610, 179.887067760198), + TrajectoryPoint(1620, 179.124830962488), + TrajectoryPoint(1630, 178.361227223415), + TrajectoryPoint(1640, 177.596207867877), + TrajectoryPoint(1650, 176.829823937258), + TrajectoryPoint(1660, 176.062052793124), + TrajectoryPoint(1670, 175.292871536788), + TrajectoryPoint(1680, 174.522257005778), + TrajectoryPoint(1690, 173.750185770235), + TrajectoryPoint(1700, 172.976611067951), + TrajectoryPoint(1710, 172.201370946712), + TrajectoryPoint(1720, 171.424593350107), + TrajectoryPoint(1730, 170.646253552287), + TrajectoryPoint(1740, 169.866326538231), + TrajectoryPoint(1750, 169.084786999549), + TrajectoryPoint(1760, 168.301545472951), + TrajectoryPoint(1770, 167.516470045202), + TrajectoryPoint(1780, 166.729694256432), + TrajectoryPoint(1790, 165.941191374928), + TrajectoryPoint(1800, 165.150934350151), + TrajectoryPoint(1810, 164.358813596118), + TrajectoryPoint(1820, 163.564685303837), + TrajectoryPoint(1830, 162.768708483743), + TrajectoryPoint(1840, 161.970854536789), + TrajectoryPoint(1850, 161.171094516017), + TrajectoryPoint(1860, 160.36910364613), + TrajectoryPoint(1870, 159.565109378389), + TrajectoryPoint(1880, 158.759107520225), + TrajectoryPoint(1890, 157.951067432681), + TrajectoryPoint(1900, 157.140599143406), + TrajectoryPoint(1910, 156.328008590919), + TrajectoryPoint(1920, 155.513271933191), + TrajectoryPoint(1930, 154.696200596333), + TrajectoryPoint(1940, 153.876656187503), + TrajectoryPoint(1950, 153.054852466978), + TrajectoryPoint(1960, 152.23072478147), + TrajectoryPoint(1970, 151.403841919208), + TrajectoryPoint(1980, 150.574580868554), + TrajectoryPoint(1990, 149.742905992407), + TrajectoryPoint(2000, 148.90828637736), + TrajectoryPoint(2010, 148.07115667973), + TrajectoryPoint(2020, 147.231432172638), + TrajectoryPoint(2030, 146.388634538047), + TrajectoryPoint(2040, 145.543202426191), + TrajectoryPoint(2050, 144.694870231337), + TrajectoryPoint(2060, 143.843450692898), + TrajectoryPoint(2070, 142.989258409916), + TrajectoryPoint(2080, 142.131730353385), + TrajectoryPoint(2090, 141.271212861031), + TrajectoryPoint(2100, 140.407516686097), + TrajectoryPoint(2110, 139.54042512822), + TrajectoryPoint(2120, 138.670259953257), + TrajectoryPoint(2130, 137.796334851537), + TrajectoryPoint(2140, 136.919269915773), + TrajectoryPoint(2150, 136.038354755667), + TrajectoryPoint(2160, 135.154068123087), + TrajectoryPoint(2170, 134.265869175192), + TrajectoryPoint(2180, 133.37407352872), + TrajectoryPoint(2190, 132.478232464748), + TrajectoryPoint(2200, 131.578627753023), + TrajectoryPoint(2210, 130.674767284874), + TrajectoryPoint(2220, 129.767039995101), + TrajectoryPoint(2230, 128.854762753442), + TrajectoryPoint(2240, 127.938520189724), + TrajectoryPoint(2250, 127.017472451613), + TrajectoryPoint(2260, 126.092161008138), + TrajectoryPoint(2270, 125.162112272147), + TrajectoryPoint(2280, 124.227276830422), + TrajectoryPoint(2290, 123.287858096711), + TrajectoryPoint(2300, 122.343018617102), + TrajectoryPoint(2310, 121.393330384879), + TrajectoryPoint(2320, 120.438493198883), + TrajectoryPoint(2330, 119.478007069447), + TrajectoryPoint(2340, 118.512229108026), + TrajectoryPoint(2350, 117.540924105128), + TrajectoryPoint(2360, 116.563480600645), + TrajectoryPoint(2370, 115.580257222119), + TrajectoryPoint(2380, 114.591074697309), + TrajectoryPoint(2390, 113.595509113119), + TrajectoryPoint(2400, 112.593352322244), + TrajectoryPoint(2410, 111.584678366133), + TrajectoryPoint(2420, 110.569280481225), + TrajectoryPoint(2430, 109.546943818366), + TrajectoryPoint(2440, 108.517205496962), + TrajectoryPoint(2450, 107.479981583259), + TrajectoryPoint(2460, 106.435154582247), + TrajectoryPoint(2470, 105.382475744637), + TrajectoryPoint(2480, 104.32168626881), + TrajectoryPoint(2490, 103.252516810512), + TrajectoryPoint(2500, 102.174686962621), + TrajectoryPoint(2510, 101.087904702899), + TrajectoryPoint(2520, 99.9918658074546), + TrajectoryPoint(2530, 98.8862532274817), + TrajectoryPoint(2540, 97.770736426607), + TrajectoryPoint(2550, 96.6449706759686), + TrajectoryPoint(2560, 95.5085963038994), + TrajectoryPoint(2570, 94.3612378968147), + TrajectoryPoint(2580, 93.2025034476081), + TrajectoryPoint(2590, 92.0319834475337), + TrajectoryPoint(2600, 90.8492238420761), + TrajectoryPoint(2610, 89.6532511414564), + TrajectoryPoint(2620, 88.4440546181981), + TrajectoryPoint(2630, 87.2211380649586), + TrajectoryPoint(2640, 85.9838186286225), + TrajectoryPoint(2650, 84.7309048674115), + TrajectoryPoint(2660, 83.4625121570217), + TrajectoryPoint(2670, 82.1774638912821), + TrajectoryPoint(2680, 80.8749119999983), + TrajectoryPoint(2690, 79.5543875427414), + TrajectoryPoint(2700, 78.2143846158978), + TrajectoryPoint(2710, 76.8543927314715), + TrajectoryPoint(2720, 75.473217688578), + TrajectoryPoint(2730, 74.0691966728954), + TrajectoryPoint(2740, 72.6416881530151), + TrajectoryPoint(2750, 71.1891248456865), + TrajectoryPoint(2760, 69.7094651009845), + TrajectoryPoint(2770, 68.201162829758), + TrajectoryPoint(2780, 66.6624366220048), + TrajectoryPoint(2790, 65.0911020244435), + TrajectoryPoint(2800, 63.4847672255429), + TrajectoryPoint(2810, 61.8403857145698), + TrajectoryPoint(2820, 60.1547907354665), + TrajectoryPoint(2830, 58.4250651934022), + TrajectoryPoint(2840, 56.6466257569166), + TrajectoryPoint(2850, 54.8149261540516), + TrajectoryPoint(2860, 52.9240281052663), + TrajectoryPoint(2870, 50.9679510619184), + TrajectoryPoint(2880, 48.9385659433982), + TrajectoryPoint(2890, 46.8263601016018), + TrajectoryPoint(2900, 44.6201318484734), + TrajectoryPoint(2910, 42.3035164618311), + TrajectoryPoint(2920, 39.859062505505), + TrajectoryPoint(2930, 37.2609906931531), + TrajectoryPoint(2940, 34.4749605944553), + TrajectoryPoint(2950, 31.4502604148486), + TrajectoryPoint(2960, 28.1114299014575), + TrajectoryPoint(2970, 24.3270352066112), + TrajectoryPoint(2980, 19.8476096842865), + TrajectoryPoint(2990, 14.0212215258321), TrajectoryPoint(3000, 0), }; TrajectoryPoint t0_open[] = { - TrajectoryPoint(0, 521.120565192786), - TrajectoryPoint(10, 518.991801421389), - TrajectoryPoint(20, 516.856699928473), - TrajectoryPoint(30, 514.721598435556), - TrajectoryPoint(40, 512.572518503631), - TrajectoryPoint(50, 510.418971229153), - TrajectoryPoint(60, 508.26164242241), - TrajectoryPoint(70, 506.089240058818), - TrajectoryPoint(80, 503.916837695226), - TrajectoryPoint(90, 501.731504222196), - TrajectoryPoint(100, 499.539825001482), - TrajectoryPoint(110, 497.344824136831), - TrajectoryPoint(120, 495.133433312379), - TrajectoryPoint(130, 492.922042487927), - TrajectoryPoint(140, 490.696668629275), - TrajectoryPoint(150, 488.46511793058), - TrajectoryPoint(160, 486.228493346599), - TrajectoryPoint(170, 483.976320405152), - TrajectoryPoint(180, 481.724147463705), - TrajectoryPoint(190, 479.454551687215), - TrajectoryPoint(200, 477.181279431688), - TrajectoryPoint(210, 474.898664539356), - TrajectoryPoint(220, 472.603800558107), - TrajectoryPoint(230, 470.307460055081), - TrajectoryPoint(240, 467.990495923824), - TrajectoryPoint(250, 465.673531792567), - TrajectoryPoint(260, 463.340095398418), - TrajectoryPoint(270, 461.000505970764), - TrajectoryPoint(280, 458.65127057735), - TrajectoryPoint(290, 456.288513235716), - TrajectoryPoint(300, 453.922631510944), - TrajectoryPoint(310, 451.536145375146), - TrajectoryPoint(320, 449.149659239347), - TrajectoryPoint(330, 446.741928299143), - TrajectoryPoint(340, 444.331133389775), - TrajectoryPoint(350, 441.904318252896), - TrajectoryPoint(360, 439.468614606361), - TrajectoryPoint(370, 437.021697763097), - TrajectoryPoint(380, 434.560464494884), - TrajectoryPoint(390, 432.092371295971), - TrajectoryPoint(400, 429.604965608517), - TrajectoryPoint(410, 427.114560602746), - TrajectoryPoint(420, 424.600316733894), - TrajectoryPoint(430, 422.086072865043), - TrajectoryPoint(440, 419.544627833795), - TrajectoryPoint(450, 417.002855941526), - TrajectoryPoint(460, 414.435914616953), - TrajectoryPoint(470, 411.865899595707), - TrajectoryPoint(480, 409.27209270257), - TrajectoryPoint(490, 406.673092926047), - TrajectoryPoint(500, 404.050971343853), - TrajectoryPoint(510, 401.422217328759), - TrajectoryPoint(520, 398.770246671263), - TrajectoryPoint(530, 396.110939655939), - TrajectoryPoint(540, 393.427494412086), - TrajectoryPoint(550, 390.736804843449), - TrajectoryPoint(560, 388.020162038425), - TrajectoryPoint(570, 385.297227960018), - TrajectoryPoint(580, 382.545560290619), - TrajectoryPoint(590, 379.789485623912), - TrajectoryPoint(600, 377.000854017401), - TrajectoryPoint(610, 374.208242129888), - TrajectoryPoint(620, 371.383052267733), - TrajectoryPoint(630, 368.5502399551), - TrajectoryPoint(640, 365.688997562073), - TrajectoryPoint(650, 362.813701394117), - TrajectoryPoint(660, 359.915354262726), - TrajectoryPoint(670, 357.32260718315), - TrajectoryPoint(680, 354.958253640362), - TrajectoryPoint(690, 352.623468030845), - TrajectoryPoint(700, 350.297592787733), - TrajectoryPoint(710, 348.008085164846), - TrajectoryPoint(720, 345.729189579957), - TrajectoryPoint(730, 343.476843175116), - TrajectoryPoint(740, 341.245222151474), - TrajectoryPoint(750, 339.029661821691), - TrajectoryPoint(760, 336.845324052314), - TrajectoryPoint(770, 334.672333471892), - TrajectoryPoint(780, 332.52875604073), - TrajectoryPoint(790, 330.403023144118), - TrajectoryPoint(800, 328.29446065421), - TrajectoryPoint(810, 326.215403681309), - TrajectoryPoint(820, 324.148792210556), - TrajectoryPoint(830, 322.107979412238), - TrajectoryPoint(840, 320.087229071478), - TrajectoryPoint(850, 318.079569910648), - TrajectoryPoint(860, 316.103191352049), - TrajectoryPoint(870, 314.140204405162), - TrajectoryPoint(880, 312.194737518311), - TrajectoryPoint(890, 310.275270850366), - TrajectoryPoint(900, 308.368969789847), - TrajectoryPoint(910, 306.482665571424), - TrajectoryPoint(920, 304.61828770851), - TrajectoryPoint(930, 302.767156573424), - TrajectoryPoint(940, 300.936474144206), - TrajectoryPoint(950, 299.125501207428), - TrajectoryPoint(960, 297.327684699286), - TrajectoryPoint(970, 295.549153942853), - TrajectoryPoint(980, 293.78962393444), - TrajectoryPoint(990, 292.043019854867), - TrajectoryPoint(1000, 290.313291077487), - TrajectoryPoint(1010, 288.603045890991), - TrajectoryPoint(1020, 286.905386012368), - TrajectoryPoint(1030, 285.221260980693), - TrajectoryPoint(1040, 283.558017060944), - TrajectoryPoint(1050, 281.906934764266), - TrajectoryPoint(1060, 280.268135081471), - TrajectoryPoint(1070, 278.646790967731), - TrajectoryPoint(1080, 277.039875858583), - TrajectoryPoint(1090, 275.444715192965), - TrajectoryPoint(1100, 273.861733860144), - TrajectoryPoint(1110, 272.296574550798), - TrajectoryPoint(1120, 270.742609805965), - TrajectoryPoint(1130, 269.19985418361), - TrajectoryPoint(1140, 267.66962154525), - TrajectoryPoint(1150, 266.154455581122), - TrajectoryPoint(1160, 264.64989672029), - TrajectoryPoint(1170, 263.155914598756), - TrajectoryPoint(1180, 261.673183373565), - TrajectoryPoint(1190, 260.204490577437), - TrajectoryPoint(1200, 258.745756034462), - TrajectoryPoint(1210, 257.296917860176), - TrajectoryPoint(1220, 255.857900297539), - TrajectoryPoint(1230, 254.43125615693), - TrajectoryPoint(1240, 253.014818390154), - TrajectoryPoint(1250, 251.607577269978), - TrajectoryPoint(1260, 250.209439259995), - TrajectoryPoint(1270, 248.820301546194), - TrajectoryPoint(1280, 247.44248963384), - TrajectoryPoint(1290, 246.073433747702), - TrajectoryPoint(1300, 244.712771291403), - TrajectoryPoint(1310, 243.360391050712), - TrajectoryPoint(1320, 242.016175807355), - TrajectoryPoint(1330, 240.680921280826), - TrajectoryPoint(1340, 239.354508653423), - TrajectoryPoint(1350, 238.03568428165), - TrajectoryPoint(1360, 236.724328683521), - TrajectoryPoint(1370, 235.420318649447), - TrajectoryPoint(1380, 234.123527798845), - TrajectoryPoint(1390, 232.833911366531), - TrajectoryPoint(1400, 231.552442971861), - TrajectoryPoint(1410, 230.277658448206), - TrajectoryPoint(1420, 229.009433992513), - TrajectoryPoint(1430, 227.747644022401), - TrajectoryPoint(1440, 226.492161534326), - TrajectoryPoint(1450, 225.242858427892), - TrajectoryPoint(1460, 223.999605798976), - TrajectoryPoint(1470, 222.762274204143), - TrajectoryPoint(1480, 221.531307239179), - TrajectoryPoint(1490, 220.30603760666), - TrajectoryPoint(1500, 219.086218595482), - TrajectoryPoint(1510, 217.871727115404), - TrajectoryPoint(1520, 216.662440085799), - TrajectoryPoint(1530, 215.458234599419), - TrajectoryPoint(1540, 214.25898806858), - TrajectoryPoint(1550, 213.064578355244), - TrajectoryPoint(1560, 211.874883886333), - TrajectoryPoint(1570, 210.689783755549), - TrajectoryPoint(1580, 209.509157812835), - TrajectoryPoint(1590, 208.332886742547), - TrajectoryPoint(1600, 207.160852131313), - TrajectoryPoint(1610, 205.992936526466), - TrajectoryPoint(1620, 204.82902348589), - TrajectoryPoint(1630, 203.66899762003), - TrajectoryPoint(1640, 202.512744626749), - TrajectoryPoint(1650, 201.360151319693), - TrajectoryPoint(1660, 200.211105650727), - TrajectoryPoint(1670, 199.065496726992), - TrajectoryPoint(1680, 197.923214823063), - TrajectoryPoint(1690, 196.784151388666), - TrajectoryPoint(1700, 195.648199052364), - TrajectoryPoint(1710, 194.515251621588), - TrajectoryPoint(1720, 193.385204079349), - TrajectoryPoint(1730, 192.257952577966), - TrajectoryPoint(1740, 191.133394430078), - TrajectoryPoint(1750, 190.011428097218), - TrajectoryPoint(1760, 188.891953176176), - TrajectoryPoint(1770, 187.774870383385), - TrajectoryPoint(1780, 186.660081537517), - TrajectoryPoint(1790, 185.547489540483), - TrajectoryPoint(1800, 184.436998356994), - TrajectoryPoint(1810, 183.328512992838), - TrajectoryPoint(1820, 182.221939472019), - TrajectoryPoint(1830, 181.117184812867), - TrajectoryPoint(1840, 180.014157003249), - TrajectoryPoint(1850, 178.912876309929), - TrajectoryPoint(1860, 177.813165516071), - TrajectoryPoint(1870, 176.714900564586), - TrajectoryPoint(1880, 175.617992382794), - TrajectoryPoint(1890, 174.522352762002), - TrajectoryPoint(1900, 173.427894326819), - TrajectoryPoint(1910, 172.334530504245), - TrajectoryPoint(1920, 171.242235376914), - TrajectoryPoint(1930, 170.15090643089), - TrajectoryPoint(1940, 169.060400475654), - TrajectoryPoint(1950, 167.9706333759), - TrajectoryPoint(1960, 166.881521654137), - TrajectoryPoint(1970, 165.79298977618), - TrajectoryPoint(1980, 164.705000214645), - TrajectoryPoint(1990, 163.617399304431), - TrajectoryPoint(2000, 162.530105500651), - TrajectoryPoint(2010, 161.4430377559), - TrajectoryPoint(2020, 160.356121815525), - TrajectoryPoint(2030, 159.2692565601), - TrajectoryPoint(2040, 158.182354078541), - TrajectoryPoint(2050, 157.095334648252), - TrajectoryPoint(2060, 156.008081048174), - TrajectoryPoint(2070, 154.920518336546), - TrajectoryPoint(2080, 153.832576317611), - TrajectoryPoint(2090, 152.744142735198), - TrajectoryPoint(2100, 151.655084007351), - TrajectoryPoint(2110, 150.565382905551), - TrajectoryPoint(2120, 149.47492700139), - TrajectoryPoint(2130, 148.383524606988), - TrajectoryPoint(2140, 147.291215147378), - TrajectoryPoint(2150, 146.197840193004), - TrajectoryPoint(2160, 145.103232347324), - TrajectoryPoint(2170, 144.007450084582), - TrajectoryPoint(2180, 142.910205735737), - TrajectoryPoint(2190, 141.811513658577), - TrajectoryPoint(2200, 140.711292709606), - TrajectoryPoint(2210, 139.60925748977), - TrajectoryPoint(2220, 138.505582028893), - TrajectoryPoint(2230, 137.39979176046), - TrajectoryPoint(2240, 136.292130696626), - TrajectoryPoint(2250, 135.182188878635), - TrajectoryPoint(2260, 134.070082184691), - TrajectoryPoint(2270, 132.955482203964), - TrajectoryPoint(2280, 131.838456624828), - TrajectoryPoint(2290, 130.718664344809), - TrajectoryPoint(2300, 129.596232286281), - TrajectoryPoint(2310, 128.47068504852), - TrajectoryPoint(2320, 127.342320573594), - TrajectoryPoint(2330, 126.210448699626), - TrajectoryPoint(2340, 125.07542124522), - TrajectoryPoint(2350, 123.936811433677), - TrajectoryPoint(2360, 122.794476554548), - TrajectoryPoint(2370, 121.648502556774), - TrajectoryPoint(2380, 120.498256924178), - TrajectoryPoint(2390, 119.34392487721), - TrajectoryPoint(2400, 118.185388743453), - TrajectoryPoint(2410, 117.02204647557), - TrajectoryPoint(2420, 115.854002602854), - TrajectoryPoint(2430, 114.681125989036), - TrajectoryPoint(2440, 113.503121022244), - TrajectoryPoint(2450, 112.319477354966), - TrajectoryPoint(2460, 111.130302169627), - TrajectoryPoint(2470, 109.935339654805), - TrajectoryPoint(2480, 108.734322728103), - TrajectoryPoint(2490, 107.526972585311), - TrajectoryPoint(2500, 106.312764906374), - TrajectoryPoint(2510, 105.091641408405), - TrajectoryPoint(2520, 103.863309280202), - TrajectoryPoint(2530, 102.627441654131), - TrajectoryPoint(2540, 101.383697233385), - TrajectoryPoint(2550, 100.13171959447), - TrajectoryPoint(2560, 98.8711364376235), - TrajectoryPoint(2570, 97.601558781944), - TrajectoryPoint(2580, 96.3225801016818), - TrajectoryPoint(2590, 95.0337753997379), - TrajectoryPoint(2600, 93.7347002140031), - TrajectoryPoint(2610, 92.4248001314896), - TrajectoryPoint(2620, 91.1033239911738), - TrajectoryPoint(2630, 89.77002096111), - TrajectoryPoint(2640, 88.4243499314687), - TrajectoryPoint(2650, 87.0657436983054), - TrajectoryPoint(2660, 85.6928954416259), - TrajectoryPoint(2670, 84.3056384957582), - TrajectoryPoint(2680, 82.9033983924275), - TrajectoryPoint(2690, 81.4843217486486), - TrajectoryPoint(2700, 80.0487023349478), - TrajectoryPoint(2710, 78.5944468068267), - TrajectoryPoint(2720, 77.1215852209347), - TrajectoryPoint(2730, 75.6276292144849), - TrajectoryPoint(2740, 74.1123357025503), - TrajectoryPoint(2750, 72.5741737086814), - TrajectoryPoint(2760, 71.0108143169275), - TrajectoryPoint(2770, 69.4210851134829), - TrajectoryPoint(2780, 67.8030655923401), - TrajectoryPoint(2790, 66.1545480056578), - TrajectoryPoint(2800, 64.4731102141604), - TrajectoryPoint(2810, 62.7560900611626), - TrajectoryPoint(2820, 61.0005451401103), - TrajectoryPoint(2830, 59.201938261766), - TrajectoryPoint(2840, 57.357500451166), - TrajectoryPoint(2850, 55.4618551497509), - TrajectoryPoint(2860, 53.5101472407736), - TrajectoryPoint(2870, 51.4945963227155), - TrajectoryPoint(2880, 49.4084336376015), - TrajectoryPoint(2890, 47.2421692640004), - TrajectoryPoint(2900, 44.9833942277677), - TrajectoryPoint(2910, 42.6180522003692), - TrajectoryPoint(2920, 40.1266741856633), - TrajectoryPoint(2930, 37.4847526201682), - TrajectoryPoint(2940, 34.6569277185914), - TrajectoryPoint(2950, 31.5938499317644), - TrajectoryPoint(2960, 28.2196614984515), - TrajectoryPoint(2970, 24.4030107389703), - TrajectoryPoint(2980, 19.8945111716972), - TrajectoryPoint(2990, 14.0425210341658), + TrajectoryPoint(0, 567.599412547472), + TrajectoryPoint(10, 565.634508813588), + TrajectoryPoint(20, 563.669553038523), + TrajectoryPoint(30, 561.702123128184), + TrajectoryPoint(40, 559.722243092414), + TrajectoryPoint(50, 557.742363056645), + TrajectoryPoint(60, 555.756855621449), + TrajectoryPoint(70, 553.761744522398), + TrajectoryPoint(80, 551.766633423348), + TrajectoryPoint(90, 549.762181992153), + TrajectoryPoint(100, 547.751524611564), + TrajectoryPoint(110, 545.740867230974), + TrajectoryPoint(120, 543.716565647917), + TrajectoryPoint(130, 541.690038034709), + TrajectoryPoint(140, 539.661141685086), + TrajectoryPoint(150, 537.618410823218), + TrajectoryPoint(160, 535.57567996135), + TrajectoryPoint(170, 533.525336309052), + TrajectoryPoint(180, 531.46605976953), + TrajectoryPoint(190, 529.406783230007), + TrajectoryPoint(200, 527.333964206246), + TrajectoryPoint(210, 525.257789782343), + TrajectoryPoint(220, 523.178679404486), + TrajectoryPoint(230, 521.085244729219), + TrajectoryPoint(240, 518.991810053953), + TrajectoryPoint(250, 516.888394050435), + TrajectoryPoint(260, 514.777326195228), + TrajectoryPoint(270, 512.666258340021), + TrajectoryPoint(280, 510.537367320126), + TrajectoryPoint(290, 508.408282373548), + TrajectoryPoint(300, 506.271103510088), + TrajectoryPoint(310, 504.123606135468), + TrajectoryPoint(320, 501.976108760848), + TrajectoryPoint(330, 499.811352688315), + TrajectoryPoint(340, 497.645035658945), + TrajectoryPoint(350, 495.470607701439), + TrajectoryPoint(360, 493.28505141199), + TrajectoryPoint(370, 491.099495122541), + TrajectoryPoint(380, 488.89518949195), + TrajectoryPoint(390, 486.689961444621), + TrajectoryPoint(400, 484.474441493013), + TrajectoryPoint(410, 482.249095756835), + TrajectoryPoint(420, 480.021754941544), + TrajectoryPoint(430, 477.775831583131), + TrajectoryPoint(440, 475.529908224718), + TrajectoryPoint(450, 473.269055449147), + TrajectoryPoint(460, 471.002079933068), + TrajectoryPoint(470, 468.727604367556), + TrajectoryPoint(480, 466.439086924359), + TrajectoryPoint(490, 464.150263158292), + TrajectoryPoint(500, 461.839698118061), + TrajectoryPoint(510, 459.529133077829), + TrajectoryPoint(520, 457.202626680074), + TrajectoryPoint(530, 454.869491769246), + TrajectoryPoint(540, 452.526526934132), + TrajectoryPoint(550, 450.170282533105), + TrajectoryPoint(560, 447.809991063673), + TrajectoryPoint(570, 445.430079422557), + TrajectoryPoint(580, 443.050167781441), + TrajectoryPoint(590, 440.647389997101), + TrajectoryPoint(600, 438.243234406744), + TrajectoryPoint(610, 435.820651505855), + TrajectoryPoint(620, 433.391655421051), + TrajectoryPoint(630, 430.948226802967), + TrajectoryPoint(640, 428.493772914498), + TrajectoryPoint(650, 426.028399973042), + TrajectoryPoint(660, 423.547849224919), + TrajectoryPoint(670, 421.059371642311), + TrajectoryPoint(680, 418.552062190291), + TrajectoryPoint(690, 416.039253948947), + TrajectoryPoint(700, 413.504500056061), + TrajectoryPoint(710, 410.96606514331), + TrajectoryPoint(720, 408.403156007777), + TrajectoryPoint(730, 405.837723786013), + TrajectoryPoint(740, 403.245922296506), + TrajectoryPoint(750, 400.65204250848), + TrajectoryPoint(760, 398.030583921275), + TrajectoryPoint(770, 395.406721297059), + TrajectoryPoint(780, 392.754811829103), + TrajectoryPoint(790, 390.099340257754), + TrajectoryPoint(800, 387.416155589168), + TrajectoryPoint(810, 384.727351814167), + TrajectoryPoint(820, 382.012035493079), + TrajectoryPoint(830, 379.2880722862), + TrajectoryPoint(840, 376.539734028181), + TrajectoryPoint(850, 373.778672791481), + TrajectoryPoint(860, 370.996386665097), + TrajectoryPoint(870, 368.19616940515), + TrajectoryPoint(880, 365.378971894365), + TrajectoryPoint(890, 362.537412506564), + TrajectoryPoint(900, 359.684300439818), + TrajectoryPoint(910, 356.839002314492), + TrajectoryPoint(920, 353.999908606003), + TrajectoryPoint(930, 351.214906113714), + TrajectoryPoint(940, 348.448781582548), + TrajectoryPoint(950, 345.72167491209), + TrajectoryPoint(960, 343.028009938231), + TrajectoryPoint(970, 340.357468521472), + TrajectoryPoint(980, 337.735428178293), + TrajectoryPoint(990, 335.130242787), + TrajectoryPoint(1000, 332.568479083662), + TrajectoryPoint(1010, 330.033954081217), + TrajectoryPoint(1020, 327.524266905743), + TrajectoryPoint(1030, 325.058827628317), + TrajectoryPoint(1040, 322.611853884005), + TrajectoryPoint(1050, 320.201486841939), + TrajectoryPoint(1060, 317.821529665559), + TrajectoryPoint(1070, 315.460960117056), + TrajectoryPoint(1080, 313.143371637686), + TrajectoryPoint(1090, 310.847227360187), + TrajectoryPoint(1100, 308.573585690434), + TrajectoryPoint(1110, 306.339620156369), + TrajectoryPoint(1120, 304.124769258684), + TrajectoryPoint(1130, 301.934242276981), + TrajectoryPoint(1140, 299.778500117429), + TrajectoryPoint(1150, 297.641780113819), + TrajectoryPoint(1160, 295.528216045484), + TrajectoryPoint(1170, 293.447365896252), + TrajectoryPoint(1180, 291.385166945724), + TrajectoryPoint(1190, 289.342739116059), + TrajectoryPoint(1200, 287.333102633785), + TrajectoryPoint(1210, 285.341537231835), + TrajectoryPoint(1220, 283.368328710007), + TrajectoryPoint(1230, 281.422483734681), + TrajectoryPoint(1240, 279.497525379153), + TrajectoryPoint(1250, 277.590092101593), + TrajectoryPoint(1260, 275.702443735819), + TrajectoryPoint(1270, 273.84003499862), + TrajectoryPoint(1280, 271.994242912759), + TrajectoryPoint(1290, 270.165115363451), + TrajectoryPoint(1300, 268.356409545524), + TrajectoryPoint(1310, 266.568210241741), + TrajectoryPoint(1320, 264.795674137934), + TrajectoryPoint(1330, 263.038756212308), + TrajectoryPoint(1340, 261.300024906814), + TrajectoryPoint(1350, 259.580166605722), + TrajectoryPoint(1360, 257.874893986349), + TrajectoryPoint(1370, 256.184101169238), + TrajectoryPoint(1380, 254.507656164327), + TrajectoryPoint(1390, 252.850129767769), + TrajectoryPoint(1400, 251.206256976066), + TrajectoryPoint(1410, 249.575698357537), + TrajectoryPoint(1420, 247.958291966329), + TrajectoryPoint(1430, 246.353859847049), + TrajectoryPoint(1440, 244.765743339109), + TrajectoryPoint(1450, 243.189829974607), + TrajectoryPoint(1460, 241.625903014836), + TrajectoryPoint(1470, 240.073773936602), + TrajectoryPoint(1480, 238.533244882778), + TrajectoryPoint(1490, 237.004613858671), + TrajectoryPoint(1500, 235.488987672429), + TrajectoryPoint(1510, 233.984042966702), + TrajectoryPoint(1520, 232.489582835697), + TrajectoryPoint(1530, 231.005405334044), + TrajectoryPoint(1540, 229.531304506152), + TrajectoryPoint(1550, 228.067071304578), + TrajectoryPoint(1560, 226.612494407477), + TrajectoryPoint(1570, 225.168584321416), + TrajectoryPoint(1580, 223.733848343464), + TrajectoryPoint(1590, 222.307964795186), + TrajectoryPoint(1600, 220.890734039143), + TrajectoryPoint(1610, 219.481955920319), + TrajectoryPoint(1620, 218.081430239122), + TrajectoryPoint(1630, 216.688957167561), + TrajectoryPoint(1640, 215.304337614116), + TrajectoryPoint(1650, 213.927373542359), + TrajectoryPoint(1660, 212.5578682479), + TrajectoryPoint(1670, 211.195626597836), + TrajectoryPoint(1680, 209.840455236464), + TrajectoryPoint(1690, 208.492349149163), + TrajectoryPoint(1700, 207.15099918168), + TrajectoryPoint(1710, 205.816088526966), + TrajectoryPoint(1720, 204.487438728277), + TrajectoryPoint(1730, 203.164873269463), + TrajectoryPoint(1740, 201.848217676463), + TrajectoryPoint(1750, 200.537299600291), + TrajectoryPoint(1760, 199.231948883444), + TrajectoryPoint(1770, 197.931997611482), + TrajectoryPoint(1780, 196.637280151332), + TrajectoryPoint(1790, 195.347633177754), + TrajectoryPoint(1800, 194.062895689239), + TrajectoryPoint(1810, 192.7829090145), + TrajectoryPoint(1820, 191.507516810604), + TrajectoryPoint(1830, 190.236701030112), + TrajectoryPoint(1840, 188.970236138412), + TrajectoryPoint(1850, 187.707917425844), + TrajectoryPoint(1860, 186.449595500359), + TrajectoryPoint(1870, 185.195123344273), + TrajectoryPoint(1880, 183.944356267168), + TrajectoryPoint(1890, 182.697151856201), + TrajectoryPoint(1900, 181.453369924237), + TrajectoryPoint(1910, 180.212872456113), + TrajectoryPoint(1920, 178.975523553352), + TrajectoryPoint(1930, 177.741189377584), + TrajectoryPoint(1940, 176.509825294235), + TrajectoryPoint(1950, 175.281404509393), + TrajectoryPoint(1960, 174.055594096025), + TrajectoryPoint(1970, 172.832266975665), + TrajectoryPoint(1980, 171.611297885103), + TrajectoryPoint(1990, 170.392563311687), + TrajectoryPoint(2000, 169.175941428861), + TrajectoryPoint(2010, 167.96154410154), + TrajectoryPoint(2020, 166.749021543458), + TrajectoryPoint(2030, 165.538233060748), + TrajectoryPoint(2040, 164.329062407197), + TrajectoryPoint(2050, 163.121398172083), + TrajectoryPoint(2060, 161.915320755608), + TrajectoryPoint(2070, 160.710493815013), + TrajectoryPoint(2080, 159.506805879758), + TrajectoryPoint(2090, 158.304146618524), + TrajectoryPoint(2100, 157.102538279777), + TrajectoryPoint(2110, 155.901721969099), + TrajectoryPoint(2120, 154.701579342497), + TrajectoryPoint(2130, 153.50203565209), + TrajectoryPoint(2140, 152.302983441816), + TrajectoryPoint(2150, 151.104254588817), + TrajectoryPoint(2160, 149.905748530355), + TrajectoryPoint(2170, 148.707352184325), + TrajectoryPoint(2180, 147.508932146198), + TrajectoryPoint(2190, 146.310368297912), + TrajectoryPoint(2200, 145.111516119293), + TrajectoryPoint(2210, 143.912294887112), + TrajectoryPoint(2220, 142.712514290259), + TrajectoryPoint(2230, 141.512087271428), + TrajectoryPoint(2240, 140.310901235408), + TrajectoryPoint(2250, 139.10872756508), + TrajectoryPoint(2260, 137.905594672371), + TrajectoryPoint(2270, 136.701137969181), + TrajectoryPoint(2280, 135.495460340024), + TrajectoryPoint(2290, 134.288197481033), + TrajectoryPoint(2300, 133.079410077226), + TrajectoryPoint(2310, 131.868740981007), + TrajectoryPoint(2320, 130.656265804597), + TrajectoryPoint(2330, 129.441557591924), + TrajectoryPoint(2340, 128.224799166599), + TrajectoryPoint(2350, 127.00538838178), + TrajectoryPoint(2360, 125.783578946427), + TrajectoryPoint(2370, 124.558923462326), + TrajectoryPoint(2380, 123.331337521737), + TrajectoryPoint(2390, 122.100798520247), + TrajectoryPoint(2400, 120.866672980295), + TrajectoryPoint(2410, 119.629191023848), + TrajectoryPoint(2420, 118.388122615698), + TrajectoryPoint(2430, 117.142860343399), + TrajectoryPoint(2440, 115.89357828712), + TrajectoryPoint(2450, 114.640039353552), + TrajectoryPoint(2460, 113.381820080208), + TrajectoryPoint(2470, 112.118638166858), + TrajectoryPoint(2480, 110.850427014922), + TrajectoryPoint(2490, 109.576905457436), + TrajectoryPoint(2500, 108.297779262431), + TrajectoryPoint(2510, 107.012676768096), + TrajectoryPoint(2520, 105.72118179333), + TrajectoryPoint(2530, 104.423147946966), + TrajectoryPoint(2540, 103.118228420086), + TrajectoryPoint(2550, 101.806060596355), + TrajectoryPoint(2560, 100.486265327172), + TrajectoryPoint(2570, 99.1584461452944), + TrajectoryPoint(2580, 97.8221884138166), + TrajectoryPoint(2590, 96.477058406908), + TrajectoryPoint(2600, 95.1226023182531), + TrajectoryPoint(2610, 93.7583451925806), + TrajectoryPoint(2620, 92.3836686863305), + TrajectoryPoint(2630, 90.9978604954921), + TrajectoryPoint(2640, 89.6005885023197), + TrajectoryPoint(2650, 88.1912725538891), + TrajectoryPoint(2660, 86.7693041464581), + TrajectoryPoint(2670, 85.3332409260423), + TrajectoryPoint(2680, 83.8830389375843), + TrajectoryPoint(2690, 82.4178113243298), + TrajectoryPoint(2700, 80.9359757561963), + TrajectoryPoint(2710, 79.4375524867695), + TrajectoryPoint(2720, 77.9202258682753), + TrajectoryPoint(2730, 76.3839630626876), + TrajectoryPoint(2740, 74.8267551206521), + TrajectoryPoint(2750, 73.2472905546458), + TrajectoryPoint(2760, 71.6443335414036), + TrajectoryPoint(2770, 70.0160215687687), + TrajectoryPoint(2780, 68.3602333245402), + TrajectoryPoint(2790, 66.6747568855646), + TrajectoryPoint(2800, 64.9574611370676), + TrajectoryPoint(2810, 63.2053156477162), + TrajectoryPoint(2820, 61.4153088388591), + TrajectoryPoint(2830, 59.5842279599065), + TrajectoryPoint(2840, 57.7083231887428), + TrajectoryPoint(2850, 55.7815037613542), + TrajectoryPoint(2860, 53.7998389810961), + TrajectoryPoint(2870, 51.756322980491), + TrajectoryPoint(2880, 49.6425482476495), + TrajectoryPoint(2890, 47.4496531083778), + TrajectoryPoint(2900, 45.1652924272839), + TrajectoryPoint(2910, 42.776201193772), + TrajectoryPoint(2920, 40.2617091831041), + TrajectoryPoint(2930, 37.5980998403117), + TrajectoryPoint(2940, 34.7494942470342), + TrajectoryPoint(2950, 31.6672334620239), + TrajectoryPoint(2960, 28.2750737726353), + TrajectoryPoint(2970, 24.4422576738385), + TrajectoryPoint(2980, 19.9188888195089), + TrajectoryPoint(2990, 14.053664833529), TrajectoryPoint(3000, 0), }; TrajectoryPoint t1_open[] = { - TrajectoryPoint(0, 516.075462318736), - TrajectoryPoint(10, 513.951767963176), - TrajectoryPoint(20, 511.816892070643), - TrajectoryPoint(30, 509.681943626028), - TrajectoryPoint(40, 507.538901983707), - TrajectoryPoint(50, 505.385455032326), - TrajectoryPoint(60, 503.232008080945), - TrajectoryPoint(70, 501.061378463031), - TrajectoryPoint(80, 498.889022744504), - TrajectoryPoint(90, 496.708796715245), - TrajectoryPoint(100, 494.517109465635), - TrajectoryPoint(110, 492.325422216025), - TrajectoryPoint(120, 490.115298470141), - TrajectoryPoint(130, 487.903843901604), - TrajectoryPoint(140, 485.682577838891), - TrajectoryPoint(150, 483.450906592059), - TrajectoryPoint(160, 481.217891298104), - TrajectoryPoint(170, 478.965539865484), - TrajectoryPoint(180, 476.713188432863), - TrajectoryPoint(190, 474.446625985688), - TrajectoryPoint(200, 472.173116104199), - TrajectoryPoint(210, 469.892997363922), - TrajectoryPoint(220, 467.597835374581), - TrajectoryPoint(230, 465.30267338524), - TrajectoryPoint(240, 462.986110026064), - TrajectoryPoint(250, 460.668786198653), - TrajectoryPoint(260, 458.336647684613), - TrajectoryPoint(270, 455.996635505007), - TrajectoryPoint(280, 453.648096700647), - TrajectoryPoint(290, 451.284852118303), - TrajectoryPoint(300, 448.919042817371), - TrajectoryPoint(310, 446.532003450262), - TrajectoryPoint(320, 444.144964083153), - TrajectoryPoint(330, 441.736589903981), - TrajectoryPoint(340, 439.32517419807), - TrajectoryPoint(350, 436.897041016659), - TrajectoryPoint(360, 434.460647356738), - TrajectoryPoint(370, 432.011711330841), - TrajectoryPoint(380, 429.549717099335), - TrajectoryPoint(390, 427.078875971681), - TrajectoryPoint(400, 424.590636551708), - TrajectoryPoint(410, 422.096725905539), - TrajectoryPoint(420, 419.58157362422), - TrajectoryPoint(430, 417.06336285287), - TrajectoryPoint(440, 414.520605860541), - TrajectoryPoint(450, 411.976793825682), - TrajectoryPoint(460, 409.405714906275), - TrajectoryPoint(470, 406.834635986868), - TrajectoryPoint(480, 404.234780564351), - TrajectoryPoint(490, 401.634635871822), - TrajectoryPoint(500, 399.005574400743), - TrajectoryPoint(510, 396.375592115945), - TrajectoryPoint(520, 393.715752860396), - TrajectoryPoint(530, 391.054941904306), - TrajectoryPoint(540, 388.36284984906), - TrajectoryPoint(550, 385.668696431895), - TrajectoryPoint(560, 382.944268732136), - TrajectoryPoint(570, 380.214935999433), - TrajectoryPoint(580, 377.457273696392), - TrajectoryPoint(590, 374.690812395256), - TrajectoryPoint(600, 371.898980414652), - TrajectoryPoint(610, 369.093320764613), - TrajectoryPoint(620, 366.266345946983), - TrajectoryPoint(630, 363.419288809556), - TrajectoryPoint(640, 360.556157804582), - TrajectoryPoint(650, 358.07750540975), - TrajectoryPoint(660, 355.73159501216), - TrajectoryPoint(670, 353.420537615106), - TrajectoryPoint(680, 351.117950070915), - TrajectoryPoint(690, 348.845037965951), - TrajectoryPoint(700, 346.588068491621), - TrajectoryPoint(710, 344.351469128974), - TrajectoryPoint(720, 342.14045224522), - TrajectoryPoint(730, 339.939902913167), - TrajectoryPoint(740, 337.774834895347), - TrajectoryPoint(750, 335.620656133682), - TrajectoryPoint(760, 333.490583670304), - TrajectoryPoint(770, 331.382458545804), - TrajectoryPoint(780, 329.286751272891), - TrajectoryPoint(790, 327.224163668299), - TrajectoryPoint(800, 325.173510509683), - TrajectoryPoint(810, 323.144389118234), - TrajectoryPoint(820, 321.138552238337), - TrajectoryPoint(830, 319.145310388317), - TrajectoryPoint(840, 317.179625528437), - TrajectoryPoint(850, 315.23011166703), - TrajectoryPoint(860, 313.294896069763), - TrajectoryPoint(870, 311.388026542861), - TrajectoryPoint(880, 309.49388803068), - TrajectoryPoint(890, 307.617051528777), - TrajectoryPoint(900, 305.76405865343), - TrajectoryPoint(910, 303.923914343046), - TrajectoryPoint(920, 302.102036253489), - TrajectoryPoint(930, 300.301366608351), - TrajectoryPoint(940, 298.513494384318), - TrajectoryPoint(950, 296.743208344859), - TrajectoryPoint(960, 294.993026758467), - TrajectoryPoint(970, 293.255451626422), - TrajectoryPoint(980, 291.533496983133), - TrajectoryPoint(990, 289.831765152282), - TrajectoryPoint(1000, 288.142337500014), - TrajectoryPoint(1010, 286.465592126747), - TrajectoryPoint(1020, 284.810137342228), - TrajectoryPoint(1030, 283.166599236242), - TrajectoryPoint(1040, 281.535109007165), - TrajectoryPoint(1050, 279.92067141799), - TrajectoryPoint(1060, 278.320710759617), - TrajectoryPoint(1070, 276.732302864371), - TrajectoryPoint(1080, 275.155978122154), - TrajectoryPoint(1090, 273.597271552795), - TrajectoryPoint(1100, 272.04958778684), - TrajectoryPoint(1110, 270.512950582499), - TrajectoryPoint(1120, 268.989078767115), - TrajectoryPoint(1130, 267.479797155222), - TrajectoryPoint(1140, 265.980986119023), - TrajectoryPoint(1150, 264.49262359021), - TrajectoryPoint(1160, 263.01603403852), - TrajectoryPoint(1170, 261.552781767992), - TrajectoryPoint(1180, 260.099381772819), - TrajectoryPoint(1190, 258.655779451436), - TrajectoryPoint(1200, 257.221906135797), - TrajectoryPoint(1210, 255.801202718471), - TrajectoryPoint(1220, 254.389787356041), - TrajectoryPoint(1230, 252.987495024856), - TrajectoryPoint(1240, 251.594238264859), - TrajectoryPoint(1250, 250.210684749988), - TrajectoryPoint(1260, 248.837925929596), - TrajectoryPoint(1270, 247.473612391355), - TrajectoryPoint(1280, 246.117644929749), - TrajectoryPoint(1290, 244.769917286544), - TrajectoryPoint(1300, 243.430327214359), - TrajectoryPoint(1310, 242.100814009726), - TrajectoryPoint(1320, 240.778973698845), - TrajectoryPoint(1330, 239.464695304326), - TrajectoryPoint(1340, 238.157863332843), - TrajectoryPoint(1350, 236.858358388465), - TrajectoryPoint(1360, 235.566057733331), - TrajectoryPoint(1370, 234.282167267295), - TrajectoryPoint(1380, 233.005178406709), - TrajectoryPoint(1390, 231.734866945997), - TrajectoryPoint(1400, 230.471112123031), - TrajectoryPoint(1410, 229.213791255182), - TrajectoryPoint(1420, 227.962780102539), - TrajectoryPoint(1430, 226.717953197416), - TrajectoryPoint(1440, 225.47953716872), - TrajectoryPoint(1450, 224.247490434176), - TrajectoryPoint(1460, 223.021150580813), - TrajectoryPoint(1470, 221.800397266915), - TrajectoryPoint(1480, 220.585109669361), - TrajectoryPoint(1490, 219.375166692189), - TrajectoryPoint(1500, 218.170447154204), - TrajectoryPoint(1510, 216.970829957341), - TrajectoryPoint(1520, 215.776194237339), - TrajectoryPoint(1530, 214.5864194982), - TrajectoryPoint(1540, 213.401385731773), - TrajectoryPoint(1550, 212.220973523707), - TrajectoryPoint(1560, 211.045276051436), - TrajectoryPoint(1570, 209.873975026309), - TrajectoryPoint(1580, 208.706899596091), - TrajectoryPoint(1590, 207.543937230756), - TrajectoryPoint(1600, 206.384976126029), - TrajectoryPoint(1610, 205.22990526409), - TrajectoryPoint(1620, 204.078614465974), - TrajectoryPoint(1630, 202.930994436394), - TrajectoryPoint(1640, 201.78693680162), - TrajectoryPoint(1650, 200.646334141034), - TrajectoryPoint(1660, 199.509080012902), - TrajectoryPoint(1670, 198.375068974869), - TrajectoryPoint(1680, 197.244196599655), - TrajectoryPoint(1690, 196.116359486365), - TrajectoryPoint(1700, 194.991455267815), - TrajectoryPoint(1710, 193.869382614221), - TrajectoryPoint(1720, 192.750041233603), - TrajectoryPoint(1730, 191.633331869182), - TrajectoryPoint(1740, 190.51915629406), - TrajectoryPoint(1750, 189.407417303433), - TrajectoryPoint(1760, 188.298062371199), - TrajectoryPoint(1770, 187.191030802736), - TrajectoryPoint(1780, 186.086149070392), - TrajectoryPoint(1790, 184.983322842924), - TrajectoryPoint(1800, 183.882458800182), - TrajectoryPoint(1810, 182.783464610757), - TrajectoryPoint(1820, 181.686248908668), - TrajectoryPoint(1830, 180.590721269201), - TrajectoryPoint(1840, 179.496792183993), - TrajectoryPoint(1850, 178.404373035445), - TrajectoryPoint(1860, 177.313376070553), - TrajectoryPoint(1870, 176.223810878003), - TrajectoryPoint(1880, 175.135518140618), - TrajectoryPoint(1890, 174.048376618935), - TrajectoryPoint(1900, 172.962301175474), - TrajectoryPoint(1910, 171.877207420869), - TrajectoryPoint(1920, 170.793011683607), - TrajectoryPoint(1930, 169.709650613285), - TrajectoryPoint(1940, 168.627087534098), - TrajectoryPoint(1950, 167.545158183061), - TrajectoryPoint(1960, 166.463781035553), - TrajectoryPoint(1970, 165.382875141106), - TrajectoryPoint(1980, 164.30236536343), - TrajectoryPoint(1990, 163.222195645432), - TrajectoryPoint(2000, 162.142236964217), - TrajectoryPoint(2010, 161.062409998055), - TrajectoryPoint(2020, 159.982635842776), - TrajectoryPoint(2030, 158.902821053688), - TrajectoryPoint(2040, 157.822878454364), - TrajectoryPoint(2050, 156.74273093052), - TrajectoryPoint(2060, 155.662293848312), - TrajectoryPoint(2070, 154.581422101799), - TrajectoryPoint(2080, 153.500087477817), - TrajectoryPoint(2090, 152.418212441148), - TrajectoryPoint(2100, 151.335617084348), - TrajectoryPoint(2110, 150.252270147482), - TrajectoryPoint(2120, 149.168123874255), - TrajectoryPoint(2130, 148.082960464206), - TrajectoryPoint(2140, 146.996762701771), - TrajectoryPoint(2150, 145.909504427634), - TrajectoryPoint(2160, 144.820868170309), - TrajectoryPoint(2170, 143.730965319885), - TrajectoryPoint(2180, 142.639636591109), - TrajectoryPoint(2190, 141.546670023277), - TrajectoryPoint(2200, 140.452189079909), - TrajectoryPoint(2210, 139.355768958293), - TrajectoryPoint(2220, 138.257602236553), - TrajectoryPoint(2230, 137.157375967441), - TrajectoryPoint(2240, 136.055079320287), - TrajectoryPoint(2250, 134.950567388492), - TrajectoryPoint(2260, 133.843684316085), - TrajectoryPoint(2270, 132.734380690456), - TrajectoryPoint(2280, 131.622441342454), - TrajectoryPoint(2290, 130.507812699109), - TrajectoryPoint(2300, 129.390332758933), - TrajectoryPoint(2310, 128.269817431044), - TrajectoryPoint(2320, 127.146296883748), - TrajectoryPoint(2330, 126.019303548196), - TrajectoryPoint(2340, 124.889118314658), - TrajectoryPoint(2350, 123.755131438307), - TrajectoryPoint(2360, 122.617509321186), - TrajectoryPoint(2370, 121.476109920764), - TrajectoryPoint(2380, 120.330373689998), - TrajectoryPoint(2390, 119.180566676227), - TrajectoryPoint(2400, 118.026428598958), - TrajectoryPoint(2410, 116.867398322719), - TrajectoryPoint(2420, 115.703693208571), - TrajectoryPoint(2430, 114.535095215592), - TrajectoryPoint(2440, 113.361155158109), - TrajectoryPoint(2450, 112.181665877777), - TrajectoryPoint(2460, 110.996585122804), - TrajectoryPoint(2470, 109.805656950286), - TrajectoryPoint(2480, 108.608614188462), - TrajectoryPoint(2490, 107.405050761812), - TrajectoryPoint(2500, 106.194675760476), - TrajectoryPoint(2510, 104.977345526093), - TrajectoryPoint(2520, 103.752746982078), - TrajectoryPoint(2530, 102.520553299366), - TrajectoryPoint(2540, 101.280423245652), - TrajectoryPoint(2550, 100.032000485686), - TrajectoryPoint(2560, 98.774912829721), - TrajectoryPoint(2570, 97.5087714268899), - TrajectoryPoint(2580, 96.2331698999251), - TrajectoryPoint(2590, 94.9476834172508), - TrajectoryPoint(2600, 93.6518676980616), - TrajectoryPoint(2610, 92.3452579455445), - TrajectoryPoint(2620, 91.0269579210489), - TrajectoryPoint(2630, 89.6967350865243), - TrajectoryPoint(2640, 88.3540861183212), - TrajectoryPoint(2650, 86.9984440723996), - TrajectoryPoint(2660, 85.6286161640558), - TrajectoryPoint(2670, 84.2442030808829), - TrajectoryPoint(2680, 82.8447847615517), - TrajectoryPoint(2690, 81.4285079764025), - TrajectoryPoint(2700, 79.9955555712281), - TrajectoryPoint(2710, 78.5440110858705), - TrajectoryPoint(2720, 77.0737349533772), - TrajectoryPoint(2730, 75.5823276082931), - TrajectoryPoint(2740, 74.069557449954), - TrajectoryPoint(2750, 72.5338553726178), - TrajectoryPoint(2760, 70.972800620144), - TrajectoryPoint(2770, 69.3854050643102), - TrajectoryPoint(2780, 67.7696549887913), - TrajectoryPoint(2790, 66.1233423531312), - TrajectoryPoint(2800, 64.4440447975735), - TrajectoryPoint(2810, 62.7291000128289), - TrajectoryPoint(2820, 60.9755762587353), - TrajectoryPoint(2830, 59.1789723575138), - TrajectoryPoint(2840, 57.3364103021364), - TrajectoryPoint(2850, 55.4426379416606), - TrajectoryPoint(2860, 53.4926702226482), - TrajectoryPoint(2870, 51.4788490429852), - TrajectoryPoint(2880, 49.3943424001609), - TrajectoryPoint(2890, 47.2296596537324), - TrajectoryPoint(2900, 44.9724378947071), - TrajectoryPoint(2910, 42.6085225877237), - TrajectoryPoint(2920, 40.1185344210058), - TrajectoryPoint(2930, 37.4779176587061), - TrajectoryPoint(2940, 34.6513439483134), - TrajectoryPoint(2950, 31.5894217580687), - TrajectoryPoint(2960, 28.2163166308658), - TrajectoryPoint(2970, 24.4006408180068), - TrajectoryPoint(2980, 19.8930385895336), - TrajectoryPoint(2990, 14.0418475561034), + TrajectoryPoint(0, 560.850225361233), + TrajectoryPoint(10, 558.909307881787), + TrajectoryPoint(20, 556.961808279414), + TrajectoryPoint(30, 555.014308677041), + TrajectoryPoint(40, 553.061256600214), + TrajectoryPoint(50, 551.099062514689), + TrajectoryPoint(60, 549.136868429164), + TrajectoryPoint(70, 547.165342787615), + TrajectoryPoint(80, 545.188154992725), + TrajectoryPoint(90, 543.210967197834), + TrajectoryPoint(100, 541.220102195839), + TrajectoryPoint(110, 539.227613324596), + TrajectoryPoint(120, 537.232120957618), + TrajectoryPoint(130, 535.224015198105), + TrajectoryPoint(140, 533.215909438591), + TrajectoryPoint(150, 531.199551429708), + TrajectoryPoint(160, 529.175504206659), + TrajectoryPoint(170, 527.15145698361), + TrajectoryPoint(180, 525.113253301924), + TrajectoryPoint(190, 523.072930943239), + TrajectoryPoint(200, 521.028474777848), + TrajectoryPoint(210, 518.971534165163), + TrajectoryPoint(220, 516.914593552479), + TrajectoryPoint(230, 514.846547142854), + TrajectoryPoint(240, 512.772635345255), + TrajectoryPoint(250, 510.697220907681), + TrajectoryPoint(260, 508.605974797569), + TrajectoryPoint(270, 506.514728687457), + TrajectoryPoint(280, 504.413821450463), + TrajectoryPoint(290, 502.304867300523), + TrajectoryPoint(300, 500.195352017088), + TrajectoryPoint(310, 498.068305077225), + TrajectoryPoint(320, 495.941258137361), + TrajectoryPoint(330, 493.80417280857), + TrajectoryPoint(340, 491.658636861607), + TrajectoryPoint(350, 489.511564636975), + TrajectoryPoint(360, 487.347131531831), + TrajectoryPoint(370, 485.182698426687), + TrajectoryPoint(380, 483.005785359931), + TrajectoryPoint(390, 480.822034520878), + TrajectoryPoint(400, 478.633600562654), + TrajectoryPoint(410, 476.430098473176), + TrajectoryPoint(420, 474.226596383699), + TrajectoryPoint(430, 472.005835896762), + TrajectoryPoint(440, 469.782135556424), + TrajectoryPoint(450, 467.548146453578), + TrajectoryPoint(460, 465.303786806181), + TrajectoryPoint(470, 463.055881418653), + TrajectoryPoint(480, 460.790386749847), + TrajectoryPoint(490, 458.524892081041), + TrajectoryPoint(500, 456.240720388456), + TrajectoryPoint(510, 453.953599690823), + TrajectoryPoint(520, 451.653518308083), + TrajectoryPoint(530, 449.344264611562), + TrajectoryPoint(540, 447.02745369483), + TrajectoryPoint(550, 444.695543360183), + TrajectoryPoint(560, 442.361139149384), + TrajectoryPoint(570, 440.006031122237), + TrajectoryPoint(580, 437.650923095089), + TrajectoryPoint(590, 435.2742583081), + TrajectoryPoint(600, 432.895393330878), + TrajectoryPoint(610, 430.49868687275), + TrajectoryPoint(620, 428.095486651629), + TrajectoryPoint(630, 425.677706380008), + TrajectoryPoint(640, 423.249572703757), + TrajectoryPoint(650, 420.809629790353), + TrajectoryPoint(660, 418.355943597703), + TrajectoryPoint(670, 415.892688949426), + TrajectoryPoint(680, 413.412809341309), + TrajectoryPoint(690, 410.925029752163), + TrajectoryPoint(700, 408.418292944862), + TrajectoryPoint(710, 405.904706955073), + TrajectoryPoint(720, 403.370425169992), + TrajectoryPoint(730, 400.829678606459), + TrajectoryPoint(740, 398.267138891847), + TrajectoryPoint(750, 395.697800061398), + TrajectoryPoint(760, 393.106263040968), + TrajectoryPoint(770, 390.506817544973), + TrajectoryPoint(780, 387.885516087892), + TrajectoryPoint(790, 385.254361223491), + TrajectoryPoint(800, 382.602499029748), + TrajectoryPoint(810, 379.937937739312), + TrajectoryPoint(820, 377.25468783391), + TrajectoryPoint(830, 374.554922160257), + TrajectoryPoint(840, 371.83942528909), + TrajectoryPoint(850, 369.10254928937), + TrajectoryPoint(860, 366.353912208979), + TrajectoryPoint(870, 363.577904275003), + TrajectoryPoint(880, 360.795197927664), + TrajectoryPoint(890, 357.977912454652), + TrajectoryPoint(900, 355.169933922391), + TrajectoryPoint(910, 352.402063156316), + TrajectoryPoint(920, 349.658582893069), + TrajectoryPoint(930, 346.947507679686), + TrajectoryPoint(940, 344.274598029962), + TrajectoryPoint(950, 341.619065569106), + TrajectoryPoint(960, 339.015997052312), + TrajectoryPoint(970, 336.428982267333), + TrajectoryPoint(980, 333.880414136349), + TrajectoryPoint(990, 331.362434607517), + TrajectoryPoint(1000, 328.86514786704), + TrajectoryPoint(1010, 326.414751953013), + TrajectoryPoint(1020, 323.982100912531), + TrajectoryPoint(1030, 321.582750132984), + TrajectoryPoint(1040, 319.215793721672), + TrajectoryPoint(1050, 316.867562278919), + TrajectoryPoint(1060, 314.559853123701), + TrajectoryPoint(1070, 312.274905422942), + TrajectoryPoint(1080, 310.010656522456), + TrajectoryPoint(1090, 307.786857910924), + TrajectoryPoint(1100, 305.581641865394), + TrajectoryPoint(1110, 303.399677308866), + TrajectoryPoint(1120, 301.25270174163), + TrajectoryPoint(1130, 299.124288232265), + TrajectoryPoint(1140, 297.018620600559), + TrajectoryPoint(1150, 294.945354959303), + TrajectoryPoint(1160, 292.890350240902), + TrajectoryPoint(1170, 290.855289255363), + TrajectoryPoint(1180, 288.852254618703), + TrajectoryPoint(1190, 286.866965790403), + TrajectoryPoint(1200, 284.899727311365), + TrajectoryPoint(1210, 282.960658976121), + TrajectoryPoint(1220, 281.041231227157), + TrajectoryPoint(1230, 279.139079599089), + TrajectoryPoint(1240, 277.257922210717), + TrajectoryPoint(1250, 275.400447283831), + TrajectoryPoint(1260, 273.559390521745), + TrajectoryPoint(1270, 271.734815578258), + TrajectoryPoint(1280, 269.932295459497), + TrajectoryPoint(1290, 268.148406457891), + TrajectoryPoint(1300, 266.380039692636), + TrajectoryPoint(1310, 264.627163616088), + TrajectoryPoint(1320, 262.894425265396), + TrajectoryPoint(1330, 261.178449629364), + TrajectoryPoint(1340, 259.47696588911), + TrajectoryPoint(1350, 257.789879305561), + TrajectoryPoint(1360, 256.119120836596), + TrajectoryPoint(1370, 254.465402137018), + TrajectoryPoint(1380, 252.825085134366), + TrajectoryPoint(1390, 251.198035410196), + TrajectoryPoint(1400, 249.584099561322), + TrajectoryPoint(1410, 247.985453997188), + TrajectoryPoint(1420, 246.400814960261), + TrajectoryPoint(1430, 244.828321034951), + TrajectoryPoint(1440, 243.267801505581), + TrajectoryPoint(1450, 241.719074207778), + TrajectoryPoint(1460, 240.182251910378), + TrajectoryPoint(1470, 238.65916690655), + TrajectoryPoint(1480, 237.146962522559), + TrajectoryPoint(1490, 235.645453003366), + TrajectoryPoint(1500, 234.15444608034), + TrajectoryPoint(1510, 232.673744136267), + TrajectoryPoint(1520, 231.203145249056), + TrajectoryPoint(1530, 229.743186921742), + TrajectoryPoint(1540, 228.293706967649), + TrajectoryPoint(1550, 226.853509846183), + TrajectoryPoint(1560, 225.42240172643), + TrajectoryPoint(1570, 224.000186896308), + TrajectoryPoint(1580, 222.58666838076), + TrajectoryPoint(1590, 221.181648490131), + TrajectoryPoint(1600, 219.784929305292), + TrajectoryPoint(1610, 218.396313105531), + TrajectoryPoint(1620, 217.015602744715), + TrajectoryPoint(1630, 215.64321810495), + TrajectoryPoint(1640, 214.278285773342), + TrajectoryPoint(1650, 212.920579339641), + TrajectoryPoint(1660, 211.569915516421), + TrajectoryPoint(1670, 210.226112204247), + TrajectoryPoint(1680, 208.888988699232), + TrajectoryPoint(1690, 207.55836587174), + TrajectoryPoint(1700, 206.234066319099), + TrajectoryPoint(1710, 204.91591449495), + TrajectoryPoint(1720, 203.603736817586), + TrajectoryPoint(1730, 202.297361759423), + TrajectoryPoint(1740, 200.996619919555), + TrajectoryPoint(1750, 199.701344081129), + TrajectoryPoint(1760, 198.411369255158), + TrajectoryPoint(1770, 197.126532712169), + TrajectoryPoint(1780, 195.84667400302), + TrajectoryPoint(1790, 194.571634970029), + TrajectoryPoint(1800, 193.301259749497), + TrajectoryPoint(1810, 192.035394766556), + TrajectoryPoint(1820, 190.773888723221), + TrajectoryPoint(1830, 189.516592580413), + TrajectoryPoint(1840, 188.263359534654), + TrajectoryPoint(1850, 187.01404499007), + TrajectoryPoint(1860, 185.768506526253), + TrajectoryPoint(1870, 184.526603862516), + TrajectoryPoint(1880, 183.288443175843), + TrajectoryPoint(1890, 182.053645512044), + TrajectoryPoint(1900, 180.822069796598), + TrajectoryPoint(1910, 179.593582519224), + TrajectoryPoint(1920, 178.368052176912), + TrajectoryPoint(1930, 177.145349217622), + TrajectoryPoint(1940, 175.925345983221), + TrajectoryPoint(1950, 174.707916651854), + TrajectoryPoint(1960, 173.493040013028), + TrajectoryPoint(1970, 172.280645735882), + TrajectoryPoint(1980, 171.070440739845), + TrajectoryPoint(1990, 169.862305249949), + TrajectoryPoint(2000, 168.656121070124), + TrajectoryPoint(2010, 167.451771521311), + TrajectoryPoint(2020, 166.249281993354), + TrajectoryPoint(2030, 165.048467250255), + TrajectoryPoint(2040, 163.849121851705), + TrajectoryPoint(2050, 162.651134112372), + TrajectoryPoint(2060, 161.454398180788), + TrajectoryPoint(2070, 160.25896332261), + TrajectoryPoint(2080, 159.064530814447), + TrajectoryPoint(2090, 157.870993152975), + TrajectoryPoint(2100, 156.678259269958), + TrajectoryPoint(2110, 155.486294721167), + TrajectoryPoint(2120, 154.294877895918), + TrajectoryPoint(2130, 153.103904571211), + TrajectoryPoint(2140, 151.913302829745), + TrajectoryPoint(2150, 150.722923644514), + TrajectoryPoint(2160, 149.532646696093), + TrajectoryPoint(2170, 148.342356269422), + TrajectoryPoint(2180, 147.151928494671), + TrajectoryPoint(2190, 145.961263845706), + TrajectoryPoint(2200, 144.770183076519), + TrajectoryPoint(2210, 143.578614335985), + TrajectoryPoint(2220, 142.386432748247), + TrajectoryPoint(2230, 141.193435029278), + TrajectoryPoint(2240, 139.999622724248), + TrajectoryPoint(2250, 138.804696524668), + TrajectoryPoint(2260, 137.60867975058), + TrajectoryPoint(2270, 136.411327084212), + TrajectoryPoint(2280, 135.212558670844), + TrajectoryPoint(2290, 134.012212293662), + TrajectoryPoint(2300, 132.810133145901), + TrajectoryPoint(2310, 131.606193958112), + TrajectoryPoint(2320, 130.40023178592), + TrajectoryPoint(2330, 129.192068314047), + TrajectoryPoint(2340, 127.981636190776), + TrajectoryPoint(2350, 126.768583619888), + TrajectoryPoint(2360, 125.55305454851), + TrajectoryPoint(2370, 124.334437170493), + TrajectoryPoint(2380, 123.112949856363), + TrajectoryPoint(2390, 121.888271766614), + TrajectoryPoint(2400, 120.660065461107), + TrajectoryPoint(2410, 119.428420609122), + TrajectoryPoint(2420, 118.192945738035), + TrajectoryPoint(2430, 116.95334389638), + TrajectoryPoint(2440, 115.709639843035), + TrajectoryPoint(2450, 114.46159601791), + TrajectoryPoint(2460, 113.20862204099), + TrajectoryPoint(2470, 111.950762315555), + TrajectoryPoint(2480, 110.687790826503), + TrajectoryPoint(2490, 109.419426226751), + TrajectoryPoint(2500, 108.145374180336), + TrajectoryPoint(2510, 106.865099146561), + TrajectoryPoint(2520, 105.578510649665), + TrajectoryPoint(2530, 104.285301391819), + TrajectoryPoint(2540, 102.985124634953), + TrajectoryPoint(2550, 101.677617882582), + TrajectoryPoint(2560, 100.362402150228), + TrajectoryPoint(2570, 99.0390811748583), + TrajectoryPoint(2580, 97.707240560144), + TrajectoryPoint(2590, 96.3664468539102), + TrajectoryPoint(2600, 95.0162465536431), + TrajectoryPoint(2610, 93.6561650354156), + TrajectoryPoint(2620, 92.2857054010285), + TrajectoryPoint(2630, 90.9039352314083), + TrajectoryPoint(2640, 89.5105953968194), + TrajectoryPoint(2650, 88.1051326159171), + TrajectoryPoint(2660, 86.6869388488148), + TrajectoryPoint(2670, 85.2547052011948), + TrajectoryPoint(2680, 83.8081153827789), + TrajectoryPoint(2690, 82.3465533762916), + TrajectoryPoint(2700, 80.8681681743076), + TrajectoryPoint(2710, 79.3731775027166), + TrajectoryPoint(2720, 77.859207706606), + TrajectoryPoint(2730, 76.3262777628869), + TrajectoryPoint(2740, 74.7722001418454), + TrajectoryPoint(2750, 73.1959010614565), + TrajectoryPoint(2760, 71.5960253133985), + TrajectoryPoint(2770, 69.9707098075482), + TrajectoryPoint(2780, 68.31772847426), + TrajectoryPoint(2790, 66.6350808464468), + TrajectoryPoint(2800, 64.9205287556364), + TrajectoryPoint(2810, 63.1711346889008), + TrajectoryPoint(2820, 61.3836960351921), + TrajectoryPoint(2830, 59.5550975335096), + TrajectoryPoint(2840, 57.6816721060444), + TrajectoryPoint(2850, 55.7571576878315), + TrajectoryPoint(2860, 53.7777866824379), + TrajectoryPoint(2870, 51.7363981176312), + TrajectoryPoint(2880, 49.6247295236073), + TrajectoryPoint(2890, 47.4339071035705), + TrajectoryPoint(2900, 45.1514542110518), + TrajectoryPoint(2910, 42.7641729596947), + TrajectoryPoint(2920, 40.2514414886875), + TrajectoryPoint(2930, 37.5894836064426), + TrajectoryPoint(2940, 34.7424596451006), + TrajectoryPoint(2950, 31.6616584751945), + TrajectoryPoint(2960, 28.2708655794887), + TrajectoryPoint(2970, 24.4392784471726), + TrajectoryPoint(2980, 19.917039309648), + TrajectoryPoint(2990, 14.0528199917077), TrajectoryPoint(3000, 0), }; TrajectoryPoint t2_open[] = { - TrajectoryPoint(0, 510.438944020476), - TrajectoryPoint(10, 508.336075559748), - TrajectoryPoint(20, 506.224157422375), - TrajectoryPoint(30, 504.109073957462), - TrajectoryPoint(40, 501.990078128675), - TrajectoryPoint(50, 499.856819982617), - TrajectoryPoint(60, 497.723561836559), - TrajectoryPoint(70, 495.576998381722), - TrajectoryPoint(80, 493.425166355719), - TrajectoryPoint(90, 491.268700955086), - TrajectoryPoint(100, 489.0978837954), - TrajectoryPoint(110, 486.927066635715), - TrajectoryPoint(120, 484.740754672874), - TrajectoryPoint(130, 482.550528573838), - TrajectoryPoint(140, 480.352778261895), - TrajectoryPoint(150, 478.142706343131), - TrajectoryPoint(160, 475.932634424368), - TrajectoryPoint(170, 473.702542206166), - TrajectoryPoint(180, 471.472173962392), - TrajectoryPoint(190, 469.228932180325), - TrajectoryPoint(200, 466.977802902002), - TrajectoryPoint(210, 464.72072358017), - TrajectoryPoint(220, 462.448353743114), - TrajectoryPoint(230, 460.175983906057), - TrajectoryPoint(240, 457.882607021545), - TrajectoryPoint(250, 455.588501643493), - TrajectoryPoint(260, 453.279288483466), - TrajectoryPoint(270, 450.962936445422), - TrajectoryPoint(280, 448.63706607167), - TrajectoryPoint(290, 446.297939401685), - TrajectoryPoint(300, 443.954546708919), - TrajectoryPoint(310, 441.592099825793), - TrajectoryPoint(320, 439.229652942667), - TrajectoryPoint(330, 436.843941776459), - TrajectoryPoint(340, 434.457610690628), - TrajectoryPoint(350, 432.051920339639), - TrajectoryPoint(360, 429.641121808321), - TrajectoryPoint(370, 427.214417651668), - TrajectoryPoint(380, 424.778548285076), - TrajectoryPoint(390, 422.329738642242), - TrajectoryPoint(400, 419.868173957427), - TrajectoryPoint(410, 417.396106474007), - TrajectoryPoint(420, 414.90819989261), - TrajectoryPoint(430, 412.411657653271), - TrajectoryPoint(440, 409.89673943913), - TrajectoryPoint(450, 407.374436783869), - TrajectoryPoint(460, 404.831812916119), - TrajectoryPoint(470, 402.282390933487), - TrajectoryPoint(480, 399.711341910368), - TrajectoryPoint(490, 397.133363578656), - TrajectoryPoint(500, 394.533143146876), - TrajectoryPoint(510, 391.925088091255), - TrajectoryPoint(520, 389.294921895265), - TrajectoryPoint(530, 386.655180725547), - TrajectoryPoint(540, 383.99426487059), - TrajectoryPoint(550, 381.321133060532), - TrajectoryPoint(560, 378.628632582783), - TrajectoryPoint(570, 375.920303847669), - TrajectoryPoint(580, 373.195351084157), - TrajectoryPoint(590, 370.449910208707), - TrajectoryPoint(600, 367.691603059037), - TrajectoryPoint(610, 364.907018122424), - TrajectoryPoint(620, 362.114418193569), - TrajectoryPoint(630, 359.288532132394), - TrajectoryPoint(640, 356.539105670124), - TrajectoryPoint(650, 354.246008711818), - TrajectoryPoint(660, 351.966178869211), - TrajectoryPoint(670, 349.708700394863), - TrajectoryPoint(680, 347.473166984683), - TrajectoryPoint(690, 345.251178625487), - TrajectoryPoint(700, 343.060313750778), - TrajectoryPoint(710, 340.879398952424), - TrajectoryPoint(720, 338.727451423805), - TrajectoryPoint(730, 336.591674009833), - TrajectoryPoint(740, 334.474051997262), - TrajectoryPoint(750, 332.383155307184), - TrajectoryPoint(760, 330.303595206886), - TrajectoryPoint(770, 328.252807850172), - TrajectoryPoint(780, 326.217762523003), - TrajectoryPoint(790, 324.199360394516), - TrajectoryPoint(800, 322.208111931427), - TrajectoryPoint(810, 320.22895960087), - TrajectoryPoint(820, 318.273049531377), - TrajectoryPoint(830, 316.33670341381), - TrajectoryPoint(840, 314.412911349317), - TrajectoryPoint(850, 312.516289135939), - TrajectoryPoint(860, 310.63402346781), - TrajectoryPoint(870, 308.765811320178), - TrajectoryPoint(880, 306.92393229391), - TrajectoryPoint(890, 305.094497766026), - TrajectoryPoint(900, 303.280627612389), - TrajectoryPoint(910, 301.490000887359), - TrajectoryPoint(920, 299.711806392195), - TrajectoryPoint(930, 297.949012715548), - TrajectoryPoint(940, 296.207928073765), - TrajectoryPoint(950, 294.479124224312), - TrajectoryPoint(960, 292.76423248221), - TrajectoryPoint(970, 291.070770062134), - TrajectoryPoint(980, 289.389324677751), - TrajectoryPoint(990, 287.720093128336), - TrajectoryPoint(1000, 286.071382921106), - TrajectoryPoint(1010, 284.435145861461), - TrajectoryPoint(1020, 282.810716702151), - TrajectoryPoint(1030, 281.202564909554), - TrajectoryPoint(1040, 279.609321683532), - TrajectoryPoint(1050, 278.027424637499), - TrajectoryPoint(1060, 276.457167388104), - TrajectoryPoint(1070, 274.904682120259), - TrajectoryPoint(1080, 273.363043341617), - TrajectoryPoint(1090, 271.832284460829), - TrajectoryPoint(1100, 270.314227414656), - TrajectoryPoint(1110, 268.810599641995), - TrajectoryPoint(1120, 267.317302133533), - TrajectoryPoint(1130, 265.834321515683), - TrajectoryPoint(1140, 264.363365842169), - TrajectoryPoint(1150, 262.905325188571), - TrajectoryPoint(1160, 261.457027720216), - TrajectoryPoint(1170, 260.018426463953), - TrajectoryPoint(1180, 258.589973825141), - TrajectoryPoint(1190, 257.174234164876), - TrajectoryPoint(1200, 255.767611911171), - TrajectoryPoint(1210, 254.370036824462), - TrajectoryPoint(1220, 252.981427794748), - TrajectoryPoint(1230, 251.603282523696), - TrajectoryPoint(1240, 250.235092302875), - TrajectoryPoint(1250, 248.875293031428), - TrajectoryPoint(1260, 247.523790891387), - TrajectoryPoint(1270, 246.180484793705), - TrajectoryPoint(1280, 244.846258176969), - TrajectoryPoint(1290, 243.521123284475), - TrajectoryPoint(1300, 242.203629496326), - TrajectoryPoint(1310, 240.893670180688), - TrajectoryPoint(1320, 239.591133997306), - TrajectoryPoint(1330, 238.295905515086), - TrajectoryPoint(1340, 237.008861764547), - TrajectoryPoint(1350, 235.729343404159), - TrajectoryPoint(1360, 234.456610477226), - TrajectoryPoint(1370, 233.190547854754), - TrajectoryPoint(1380, 231.931037931043), - TrajectoryPoint(1390, 230.677961028943), - TrajectoryPoint(1400, 229.431195768794), - TrajectoryPoint(1410, 228.191242042023), - TrajectoryPoint(1420, 226.957632352407), - TrajectoryPoint(1430, 225.72985735465), - TrajectoryPoint(1440, 224.507799806885), - TrajectoryPoint(1450, 223.291341638293), - TrajectoryPoint(1460, 222.080364185713), - TrajectoryPoint(1470, 220.874748407395), - TrajectoryPoint(1480, 219.67437507571), - TrajectoryPoint(1490, 218.479124950493), - TrajectoryPoint(1500, 217.28887893458), - TrajectoryPoint(1510, 216.103913811166), - TrajectoryPoint(1520, 214.923688046284), - TrajectoryPoint(1530, 213.74805545381), - TrajectoryPoint(1540, 212.576903274009), - TrajectoryPoint(1550, 211.410119162983), - TrajectoryPoint(1560, 210.247591287103), - TrajectoryPoint(1570, 209.089208406473), - TrajectoryPoint(1580, 207.934859948354), - TrajectoryPoint(1590, 206.784436071385), - TrajectoryPoint(1600, 205.637827721367), - TrajectoryPoint(1610, 204.494926679339), - TrajectoryPoint(1620, 203.355625602584), - TrajectoryPoint(1630, 202.219818059186), - TrajectoryPoint(1640, 201.087398556683), - TrajectoryPoint(1650, 199.958262565336), - TrajectoryPoint(1660, 198.832306536475), - TrajectoryPoint(1670, 197.70942791636), - TrajectoryPoint(1680, 196.58952515595), - TrajectoryPoint(1690, 195.472497716944), - TrajectoryPoint(1700, 194.358246074434), - TrajectoryPoint(1710, 193.246671716465), - TrajectoryPoint(1720, 192.137677140792), - TrajectoryPoint(1730, 191.031165849091), - TrajectoryPoint(1740, 189.927042338851), - TrajectoryPoint(1750, 188.825212093178), - TrajectoryPoint(1760, 187.725581568693), - TrajectoryPoint(1770, 186.628058181715), - TrajectoryPoint(1780, 185.532550292897), - TrajectoryPoint(1790, 184.438967190454), - TrajectoryPoint(1800, 183.347316657309), - TrajectoryPoint(1810, 182.257440514159), - TrajectoryPoint(1820, 181.169215924193), - TrajectoryPoint(1830, 180.082554885517), - TrajectoryPoint(1840, 178.997370261122), - TrajectoryPoint(1850, 177.913575753458), - TrajectoryPoint(1860, 176.831085878528), - TrajectoryPoint(1870, 175.749815939547), - TrajectoryPoint(1880, 174.669686983332), - TrajectoryPoint(1890, 173.590716357941), - TrajectoryPoint(1900, 172.512702209773), - TrajectoryPoint(1910, 171.435562209799), - TrajectoryPoint(1920, 170.35921469624), - TrajectoryPoint(1930, 169.283578645068), - TrajectoryPoint(1940, 168.208576248062), - TrajectoryPoint(1950, 167.134187663271), - TrajectoryPoint(1960, 166.060252977035), - TrajectoryPoint(1970, 164.98669303105), - TrajectoryPoint(1980, 163.91342916273), - TrajectoryPoint(1990, 162.840387580692), - TrajectoryPoint(2000, 161.767489743081), - TrajectoryPoint(2010, 160.69463366266), - TrajectoryPoint(2020, 159.62174201671), - TrajectoryPoint(2030, 158.5487342576), - TrajectoryPoint(2040, 157.475493937166), - TrajectoryPoint(2050, 156.401964751756), - TrajectoryPoint(2060, 155.328070245315), - TrajectoryPoint(2070, 154.253687199598), - TrajectoryPoint(2080, 153.178717897483), - TrajectoryPoint(2090, 152.103129720852), - TrajectoryPoint(2100, 151.026811696914), - TrajectoryPoint(2110, 149.949587798145), - TrajectoryPoint(2120, 148.871489883762), - TrajectoryPoint(2130, 147.792387256151), - TrajectoryPoint(2140, 146.712080470218), - TrajectoryPoint(2150, 145.630642008614), - TrajectoryPoint(2160, 144.547852610447), - TrajectoryPoint(2170, 143.46361833659), - TrajectoryPoint(2180, 142.377991171378), - TrajectoryPoint(2190, 141.290559988109), - TrajectoryPoint(2200, 140.20153430118), - TrajectoryPoint(2210, 139.110620635151), - TrajectoryPoint(2220, 138.017767318833), - TrajectoryPoint(2230, 136.922917706154), - TrajectoryPoint(2240, 135.825796075724), - TrajectoryPoint(2250, 134.726531358393), - TrajectoryPoint(2260, 133.624688265252), - TrajectoryPoint(2270, 132.520503033195), - TrajectoryPoint(2280, 131.413471860235), - TrajectoryPoint(2290, 130.303833617324), - TrajectoryPoint(2300, 129.19113315951), - TrajectoryPoint(2310, 128.075481226642), - TrajectoryPoint(2320, 126.956614457742), - TrajectoryPoint(2330, 125.834358621532), - TrajectoryPoint(2340, 124.708811346036), - TrajectoryPoint(2350, 123.579330257577), - TrajectoryPoint(2360, 122.446263721663), - TrajectoryPoint(2370, 121.309208969182), - TrajectoryPoint(2380, 120.167904923082), - TrajectoryPoint(2390, 119.022472433814), - TrajectoryPoint(2400, 117.872498486347), - TrajectoryPoint(2410, 116.717720915557), - TrajectoryPoint(2420, 115.558210709353), - TrajectoryPoint(2430, 114.393749564257), - TrajectoryPoint(2440, 113.223736608425), - TrajectoryPoint(2450, 112.048264469815), - TrajectoryPoint(2460, 110.867142984631), - TrajectoryPoint(2470, 109.680116090926), - TrajectoryPoint(2480, 108.48691653709), - TrajectoryPoint(2490, 107.28699308468), - TrajectoryPoint(2500, 106.080344482169), - TrajectoryPoint(2510, 104.866683047908), - TrajectoryPoint(2520, 103.645695718079), - TrajectoryPoint(2530, 102.417055702894), - TrajectoryPoint(2540, 101.180421833564), - TrajectoryPoint(2550, 99.9354378605575), - TrajectoryPoint(2560, 98.6817317002351), - TrajectoryPoint(2570, 97.4189146265985), - TrajectoryPoint(2580, 96.1465804045545), - TrajectoryPoint(2590, 94.8643043607048), - TrajectoryPoint(2600, 93.5716423872569), - TrajectoryPoint(2610, 92.2681298741985), - TrajectoryPoint(2620, 90.9529909579097), - TrajectoryPoint(2630, 89.6257488059519), - TrajectoryPoint(2640, 88.2860244163942), - TrajectoryPoint(2650, 86.9332510923595), - TrajectoryPoint(2660, 85.5663473201793), - TrajectoryPoint(2670, 84.1846867699902), - TrajectoryPoint(2680, 82.7879657500223), - TrajectoryPoint(2690, 81.3744339597015), - TrajectoryPoint(2700, 79.9440633148982), - TrajectoryPoint(2710, 78.4951440004728), - TrajectoryPoint(2720, 77.0273345993343), - TrajectoryPoint(2730, 75.5384317464843), - TrajectoryPoint(2740, 74.0281053005299), - TrajectoryPoint(2750, 72.4946976021054), - TrajectoryPoint(2760, 70.9359625270873), - TrajectoryPoint(2770, 69.3508272707421), - TrajectoryPoint(2780, 67.7372754058456), - TrajectoryPoint(2790, 66.0930986077318), - TrajectoryPoint(2800, 64.415874301262), - TrajectoryPoint(2810, 62.7029400265993), - TrajectoryPoint(2820, 60.9513639542653), - TrajectoryPoint(2830, 59.1567112456614), - TrajectoryPoint(2840, 57.3159665939673), - TrajectoryPoint(2850, 55.424009158904), - TrajectoryPoint(2860, 53.4757276711571), - TrajectoryPoint(2870, 51.4635828074135), - TrajectoryPoint(2880, 49.3806811333399), - TrajectoryPoint(2890, 47.2175313092844), - TrajectoryPoint(2900, 44.9618151377485), - TrajectoryPoint(2910, 42.5992827520479), - TrajectoryPoint(2920, 40.1106418853167), - TrajectoryPoint(2930, 37.4712900421995), - TrajectoryPoint(2940, 34.6459293664533), - TrajectoryPoint(2950, 31.5851275844203), - TrajectoryPoint(2960, 28.2130728448859), - TrajectoryPoint(2970, 24.3983424037428), - TrajectoryPoint(2980, 19.8916103594115), - TrajectoryPoint(2990, 14.0411943132275), + TrajectoryPoint(0, 556.417497703149), + TrajectoryPoint(10, 554.480283257302), + TrajectoryPoint(20, 552.536654806173), + TrajectoryPoint(30, 550.589881040521), + TrajectoryPoint(40, 548.643107274869), + TrajectoryPoint(50, 546.682854469427), + TrajectoryPoint(60, 544.721352196168), + TrajectoryPoint(70, 542.757052294071), + TrajectoryPoint(80, 540.780521877342), + TrajectoryPoint(90, 538.803991460612), + TrajectoryPoint(100, 536.820040180955), + TrajectoryPoint(110, 534.828173825795), + TrajectoryPoint(120, 532.836307470634), + TrajectoryPoint(130, 530.831789580596), + TrajectoryPoint(140, 528.824271027976), + TrajectoryPoint(150, 526.814207081803), + TrajectoryPoint(160, 524.790711289344), + TrajectoryPoint(170, 522.767215496884), + TrajectoryPoint(180, 520.734962163414), + TrajectoryPoint(190, 518.69515497098), + TrajectoryPoint(200, 516.655347778547), + TrajectoryPoint(210, 514.599868467364), + TrajectoryPoint(220, 512.543406246674), + TrajectoryPoint(230, 510.480625041208), + TrajectoryPoint(240, 508.407154328521), + TrajectoryPoint(250, 506.333683615834), + TrajectoryPoint(260, 504.245820974519), + TrajectoryPoint(270, 502.154978085421), + TrajectoryPoint(280, 500.058603395925), + TrajectoryPoint(290, 497.950014021142), + TrajectoryPoint(300, 495.841424646358), + TrajectoryPoint(310, 493.717944287831), + TrajectoryPoint(320, 491.591223068951), + TrajectoryPoint(330, 489.457886354935), + TrajectoryPoint(340, 487.312636438819), + TrajectoryPoint(350, 485.167386522703), + TrajectoryPoint(360, 483.004733090857), + TrajectoryPoint(370, 480.840545661438), + TrajectoryPoint(380, 478.666541810151), + TrajectoryPoint(390, 476.482995596239), + TrajectoryPoint(400, 474.29704980278), + TrajectoryPoint(410, 472.093710560376), + TrajectoryPoint(420, 469.890371317971), + TrajectoryPoint(430, 467.671620506214), + TrajectoryPoint(440, 465.448040473726), + TrajectoryPoint(450, 463.215608781872), + TrajectoryPoint(460, 460.97132610653), + TrajectoryPoint(470, 458.724509658358), + TrajectoryPoint(480, 456.459047791956), + TrajectoryPoint(490, 454.193585925554), + TrajectoryPoint(500, 451.909972757854), + TrajectoryPoint(510, 449.622839819849), + TrajectoryPoint(520, 447.322813042723), + TrajectoryPoint(530, 445.013501148545), + TrajectoryPoint(540, 442.69622246525), + TrajectoryPoint(550, 440.364207017509), + TrajectoryPoint(560, 438.028793390266), + TrajectoryPoint(570, 435.673532330385), + TrajectoryPoint(580, 433.318271270504), + TrajectoryPoint(590, 430.939986292594), + TrajectoryPoint(600, 428.560919310167), + TrajectoryPoint(610, 426.1620086752), + TrajectoryPoint(620, 423.75855637219), + TrajectoryPoint(630, 421.337965819201), + TrajectoryPoint(640, 418.909528825843), + TrajectoryPoint(650, 416.466146359008), + TrajectoryPoint(660, 414.012104398021), + TrajectoryPoint(670, 411.544756641852), + TrajectoryPoint(680, 409.064467537301), + TrajectoryPoint(690, 406.571915817653), + TrajectoryPoint(700, 404.064714444477), + TrajectoryPoint(710, 401.545650571377), + TrajectoryPoint(720, 399.010847741272), + TrajectoryPoint(730, 396.463889467213), + TrajectoryPoint(740, 393.900770746181), + TrajectoryPoint(750, 391.324456870793), + TrajectoryPoint(760, 388.732281323271), + TrajectoryPoint(770, 386.125066412348), + TrajectoryPoint(780, 383.503065266371), + TrajectoryPoint(790, 380.863313949852), + TrajectoryPoint(800, 378.210689177215), + TrajectoryPoint(810, 375.536669987009), + TrajectoryPoint(820, 372.852592791858), + TrajectoryPoint(830, 370.142471496227), + TrajectoryPoint(840, 367.426080704885), + TrajectoryPoint(850, 364.677913091413), + TrajectoryPoint(860, 361.923777204648), + TrajectoryPoint(870, 359.140037489517), + TrajectoryPoint(880, 356.366787985023), + TrajectoryPoint(890, 353.614463381118), + TrajectoryPoint(900, 350.893340568479), + TrajectoryPoint(910, 348.196763187314), + TrajectoryPoint(920, 345.544359807686), + TrajectoryPoint(930, 342.906748818903), + TrajectoryPoint(940, 340.318040709105), + TrajectoryPoint(950, 337.748964001899), + TrajectoryPoint(960, 335.212203300236), + TrajectoryPoint(970, 332.710564337478), + TrajectoryPoint(980, 330.225963410582), + TrajectoryPoint(990, 327.788802155689), + TrajectoryPoint(1000, 325.370271840915), + TrajectoryPoint(1010, 322.980681261314), + TrajectoryPoint(1020, 320.626543623211), + TrajectoryPoint(1030, 318.290446087037), + TrajectoryPoint(1040, 315.991441210226), + TrajectoryPoint(1050, 313.717502774078), + TrajectoryPoint(1060, 311.462192754852), + TrajectoryPoint(1070, 309.247706042714), + TrajectoryPoint(1080, 307.051930247724), + TrajectoryPoint(1090, 304.87746422887), + TrajectoryPoint(1100, 302.73907391181), + TrajectoryPoint(1110, 300.618764479466), + TrajectoryPoint(1120, 298.51999675637), + TrajectoryPoint(1130, 296.454125269477), + TrajectoryPoint(1140, 294.406104954151), + TrajectoryPoint(1150, 292.377476461437), + TrajectoryPoint(1160, 290.380845074103), + TrajectoryPoint(1170, 288.401616509642), + TrajectoryPoint(1180, 286.440115527538), + TrajectoryPoint(1190, 284.506973578881), + TrajectoryPoint(1200, 282.592854818847), + TrajectoryPoint(1210, 280.695748707312), + TrajectoryPoint(1220, 278.820282422728), + TrajectoryPoint(1230, 276.96751560881), + TrajectoryPoint(1240, 275.130955580844), + TrajectoryPoint(1250, 273.310683006887), + TrajectoryPoint(1260, 271.513616541248), + TrajectoryPoint(1270, 269.733797832951), + TrajectoryPoint(1280, 267.969350128016), + TrajectoryPoint(1290, 266.220256410567), + TrajectoryPoint(1300, 264.492838456131), + TrajectoryPoint(1310, 262.780495922062), + TrajectoryPoint(1320, 261.082543405417), + TrajectoryPoint(1330, 259.398898185365), + TrajectoryPoint(1340, 257.733401870404), + TrajectoryPoint(1350, 256.083039521116), + TrajectoryPoint(1360, 254.446016634248), + TrajectoryPoint(1370, 252.822208519242), + TrajectoryPoint(1380, 251.211826236736), + TrajectoryPoint(1390, 249.618090644561), + TrajectoryPoint(1400, 248.036626653033), + TrajectoryPoint(1410, 246.467284658718), + TrajectoryPoint(1420, 244.909901242856), + TrajectoryPoint(1430, 243.364301090352), + TrajectoryPoint(1440, 241.832808034152), + TrajectoryPoint(1450, 240.31287024545), + TrajectoryPoint(1460, 238.803818582441), + TrajectoryPoint(1470, 237.305472645492), + TrajectoryPoint(1480, 235.817645164284), + TrajectoryPoint(1490, 234.340143179182), + TrajectoryPoint(1500, 232.874000649537), + TrajectoryPoint(1510, 231.418302144695), + TrajectoryPoint(1520, 229.972107672282), + TrajectoryPoint(1530, 228.535229571975), + TrajectoryPoint(1540, 227.107477348105), + TrajectoryPoint(1550, 225.688658379622), + TrajectoryPoint(1560, 224.278578552761), + TrajectoryPoint(1570, 222.877042823483), + TrajectoryPoint(1580, 221.484303896061), + TrajectoryPoint(1590, 220.100153836865), + TrajectoryPoint(1600, 218.723834594173), + TrajectoryPoint(1610, 217.355162912887), + TrajectoryPoint(1620, 215.993955739464), + TrajectoryPoint(1630, 214.640030547104), + TrajectoryPoint(1640, 213.29320562109), + TrajectoryPoint(1650, 211.953300308129), + TrajectoryPoint(1660, 210.620135233171), + TrajectoryPoint(1670, 209.293532486894), + TrajectoryPoint(1680, 207.973315786742), + TrajectoryPoint(1690, 206.659310614152), + TrajectoryPoint(1700, 205.351344330327), + TrajectoryPoint(1710, 204.049246272749), + TrajectoryPoint(1720, 202.752847834369), + TrajectoryPoint(1730, 201.46198252725), + TrajectoryPoint(1740, 200.176486032283), + TrajectoryPoint(1750, 198.89619623642), + TrajectoryPoint(1760, 197.620953258742), + TrajectoryPoint(1770, 196.35059946655), + TrajectoryPoint(1780, 195.084979482562), + TrajectoryPoint(1790, 193.823940184177), + TrajectoryPoint(1800, 192.567330695689), + TrajectoryPoint(1810, 191.315002374241), + TrajectoryPoint(1820, 190.066808790232), + TrajectoryPoint(1830, 188.822605702827), + TrajectoryPoint(1840, 187.582251031137), + TrajectoryPoint(1850, 186.345604821604), + TrajectoryPoint(1860, 185.112529212057), + TrajectoryPoint(1870, 183.88288839286), + TrajectoryPoint(1880, 182.656548565533), + TrajectoryPoint(1890, 181.43337789919), + TrajectoryPoint(1900, 180.213256275123), + TrajectoryPoint(1910, 178.996292649156), + TrajectoryPoint(1920, 177.7821039467), + TrajectoryPoint(1930, 176.570564667167), + TrajectoryPoint(1940, 175.361551099185), + TrajectoryPoint(1950, 174.154941264093), + TrajectoryPoint(1960, 172.95061485919), + TrajectoryPoint(1970, 171.748453200845), + TrajectoryPoint(1980, 170.548526230193), + TrajectoryPoint(1990, 169.350570971662), + TrajectoryPoint(2000, 168.154413676884), + TrajectoryPoint(2010, 166.959940983005), + TrajectoryPoint(2020, 165.767040886016), + TrajectoryPoint(2030, 164.575695738905), + TrajectoryPoint(2040, 163.38579313667), + TrajectoryPoint(2050, 162.197110031706), + TrajectoryPoint(2060, 161.009538855139), + TrajectoryPoint(2070, 159.822991630934), + TrajectoryPoint(2080, 158.637458541825), + TrajectoryPoint(2090, 157.452692973039), + TrajectoryPoint(2100, 156.26859098107), + TrajectoryPoint(2110, 155.085081522011), + TrajectoryPoint(2120, 153.902058942579), + TrajectoryPoint(2130, 152.719362308156), + TrajectoryPoint(2140, 151.536892176119), + TrajectoryPoint(2150, 150.354548111286), + TrajectoryPoint(2160, 149.17219539418), + TrajectoryPoint(2170, 147.989729893576), + TrajectoryPoint(2180, 146.806995893868), + TrajectoryPoint(2190, 145.623920270409), + TrajectoryPoint(2200, 144.440361452127), + TrajectoryPoint(2210, 143.256161850046), + TrajectoryPoint(2220, 142.071287707065), + TrajectoryPoint(2230, 140.885476795934), + TrajectoryPoint(2240, 139.698724576879), + TrajectoryPoint(2250, 138.510841034721), + TrajectoryPoint(2260, 137.321680454701), + TrajectoryPoint(2270, 136.131188819763), + TrajectoryPoint(2280, 134.939078560481), + TrajectoryPoint(2290, 133.745412174481), + TrajectoryPoint(2300, 132.549798778838), + TrajectoryPoint(2310, 131.352359619007), + TrajectoryPoint(2320, 130.152676208268), + TrajectoryPoint(2330, 128.950834252126), + TrajectoryPoint(2340, 127.746499078639), + TrajectoryPoint(2350, 126.539591242908), + TrajectoryPoint(2360, 125.330006086707), + TrajectoryPoint(2370, 124.117334771278), + TrajectoryPoint(2380, 122.901738792164), + TrajectoryPoint(2390, 121.682714443414), + TrajectoryPoint(2400, 120.460226725207), + TrajectoryPoint(2410, 119.234221098288), + TrajectoryPoint(2420, 118.004143461767), + TrajectoryPoint(2430, 116.770010755577), + TrajectoryPoint(2440, 115.531696254851), + TrajectoryPoint(2450, 114.288845223294), + TrajectoryPoint(2460, 113.041050951232), + TrajectoryPoint(2470, 111.788334325406), + TrajectoryPoint(2480, 110.530426322246), + TrajectoryPoint(2490, 109.267045438189), + TrajectoryPoint(2500, 107.99776175462), + TrajectoryPoint(2510, 106.722283806725), + TrajectoryPoint(2520, 105.440437761788), + TrajectoryPoint(2530, 104.151891993743), + TrajectoryPoint(2540, 102.8562998398), + TrajectoryPoint(2550, 101.553298924212), + TrajectoryPoint(2560, 100.242510424352), + TrajectoryPoint(2570, 98.9235382762983), + TrajectoryPoint(2580, 97.5959683166849), + TrajectoryPoint(2590, 96.2593673571114), + TrajectoryPoint(2600, 94.9132821869583), + TrajectoryPoint(2610, 93.5572384999133), + TrajectoryPoint(2620, 92.1907397389712), + TrajectoryPoint(2630, 90.8129938681059), + TrajectoryPoint(2640, 89.4234570421882), + TrajectoryPoint(2650, 88.0217211103351), + TrajectoryPoint(2660, 86.6071784745447), + TrajectoryPoint(2670, 85.17865080726), + TrajectoryPoint(2680, 83.7355553659653), + TrajectoryPoint(2690, 82.2774948399834), + TrajectoryPoint(2700, 80.8024939701783), + TrajectoryPoint(2710, 79.3107678369252), + TrajectoryPoint(2720, 77.8001040248674), + TrajectoryPoint(2730, 76.2704002000511), + TrajectoryPoint(2740, 74.719351984937), + TrajectoryPoint(2750, 73.146117340694), + TrajectoryPoint(2760, 71.5492246314614), + TrajectoryPoint(2770, 69.9268102120231), + TrajectoryPoint(2780, 68.2765460440962), + TrajectoryPoint(2790, 66.5966375297662), + TrajectoryPoint(2800, 64.884742249073), + TrajectoryPoint(2810, 63.1380130668081), + TrajectoryPoint(2820, 61.3530615442063), + TrajectoryPoint(2830, 59.5268672566121), + TrajectoryPoint(2840, 57.6557824800586), + TrajectoryPoint(2850, 55.7335618308727), + TrajectoryPoint(2860, 53.7564130200845), + TrajectoryPoint(2870, 51.7170854359411), + TrajectoryPoint(2880, 49.6074575038646), + TrajectoryPoint(2890, 47.4186436105903), + TrajectoryPoint(2900, 45.1380394067557), + TrajectoryPoint(2910, 42.7525121829229), + TrajectoryPoint(2920, 40.2414870166826), + TrajectoryPoint(2930, 37.5811298150901), + TrajectoryPoint(2940, 34.7356389939737), + TrajectoryPoint(2950, 31.6562527713687), + TrajectoryPoint(2960, 28.2667849508683), + TrajectoryPoint(2970, 24.436389353638), + TrajectoryPoint(2980, 19.9152456290338), + TrajectoryPoint(2990, 14.0520005751646), TrajectoryPoint(3000, 0), }; TrajectoryPoint t3_open[] = { - TrajectoryPoint(0, 505.673314279408), - TrajectoryPoint(10, 503.571309337535), - TrajectoryPoint(20, 501.462198249855), - TrajectoryPoint(30, 499.346984013761), - TrajectoryPoint(40, 497.231073804537), - TrajectoryPoint(50, 495.097632729956), - TrajectoryPoint(60, 492.964191655374), - TrajectoryPoint(70, 490.820229779375), - TrajectoryPoint(80, 488.668161661023), - TrajectoryPoint(90, 486.513850709671), - TrajectoryPoint(100, 484.342743242901), - TrajectoryPoint(110, 482.171635776131), - TrajectoryPoint(120, 479.986959956721), - TrajectoryPoint(130, 477.796388238276), - TrajectoryPoint(140, 475.599793412978), - TrajectoryPoint(150, 473.389319415815), - TrajectoryPoint(160, 471.178845418652), - TrajectoryPoint(170, 468.949353115059), - TrajectoryPoint(180, 466.718525135607), - TrajectoryPoint(190, 464.475366110723), - TrajectoryPoint(200, 462.223718186821), - TrajectoryPoint(210, 459.966185642958), - TrajectoryPoint(220, 457.693236940578), - TrajectoryPoint(230, 455.420288238199), - TrajectoryPoint(240, 453.125840917815), - TrajectoryPoint(250, 450.831095084557), - TrajectoryPoint(260, 448.5202339146), - TrajectoryPoint(270, 446.203178397754), - TrajectoryPoint(280, 443.875060932814), - TrajectoryPoint(290, 441.535166259644), - TrajectoryPoint(300, 439.188904903967), - TrajectoryPoint(310, 436.825623921675), - TrajectoryPoint(320, 434.460283189767), - TrajectoryPoint(330, 432.073050262396), - TrajectoryPoint(340, 429.685817335024), - TrajectoryPoint(350, 427.275874000826), - TrajectoryPoint(360, 424.864104160132), - TrajectoryPoint(370, 422.432449645892), - TrajectoryPoint(380, 419.995537692997), - TrajectoryPoint(390, 417.541053160247), - TrajectoryPoint(400, 415.07837271459), - TrajectoryPoint(410, 412.599877314747), - TrajectoryPoint(420, 410.110779806595), - TrajectoryPoint(430, 407.607026707573), - TrajectoryPoint(440, 405.090840310015), - TrajectoryPoint(450, 402.560512419461), - TrajectoryPoint(460, 400.016540915465), - TrajectoryPoint(470, 397.458246273671), - TrajectoryPoint(480, 394.885767853424), - TrajectoryPoint(490, 392.29803466624), - TrajectoryPoint(500, 389.696300649536), - TrajectoryPoint(510, 387.077571928537), - TrajectoryPoint(520, 384.445805406555), - TrajectoryPoint(530, 381.794433180289), - TrajectoryPoint(540, 379.131827570564), - TrajectoryPoint(550, 376.446066626894), - TrajectoryPoint(560, 373.751784134747), - TrajectoryPoint(570, 371.029785250003), - TrajectoryPoint(580, 368.302955229069), - TrajectoryPoint(590, 365.54275783492), - TrajectoryPoint(600, 362.776676556562), - TrajectoryPoint(610, 359.981999272286), - TrajectoryPoint(620, 357.375927861028), - TrajectoryPoint(630, 355.098049957626), - TrajectoryPoint(640, 352.840476297135), - TrajectoryPoint(650, 350.597362638867), - TrajectoryPoint(660, 348.382804137875), - TrajectoryPoint(670, 346.1771986137), - TrajectoryPoint(680, 344.003243299432), - TrajectoryPoint(690, 341.841552086956), - TrajectoryPoint(700, 339.701723077021), - TrajectoryPoint(710, 337.583968436858), - TrajectoryPoint(720, 335.4778183136), - TrajectoryPoint(730, 333.403801552188), - TrajectoryPoint(740, 331.340592496704), - TrajectoryPoint(750, 329.300125888697), - TrajectoryPoint(760, 327.280369776211), - TrajectoryPoint(770, 325.272246784855), - TrajectoryPoint(780, 323.294824353252), - TrajectoryPoint(790, 321.329465581858), - TrajectoryPoint(800, 319.382469066472), - TrajectoryPoint(810, 317.459015297307), - TrajectoryPoint(820, 315.54763991517), - TrajectoryPoint(830, 313.659176913637), - TrajectoryPoint(840, 311.788523402819), - TrajectoryPoint(850, 309.930231687277), - TrajectoryPoint(860, 308.097131859418), - TrajectoryPoint(870, 306.278157727583), - TrajectoryPoint(880, 304.471646851342), - TrajectoryPoint(890, 302.690724470728), - TrajectoryPoint(900, 300.921967185769), - TrajectoryPoint(910, 299.16595290998), - TrajectoryPoint(920, 297.433737908412), - TrajectoryPoint(930, 295.71347196902), - TrajectoryPoint(940, 294.005427518377), - TrajectoryPoint(950, 292.319552990522), - TrajectoryPoint(960, 290.645862433995), - TrajectoryPoint(970, 288.984103702291), - TrajectoryPoint(980, 287.341321696607), - TrajectoryPoint(990, 285.712163318988), - TrajectoryPoint(1000, 284.094567452432), - TrajectoryPoint(1010, 282.492108564521), - TrajectoryPoint(1020, 280.905364872013), - TrajectoryPoint(1030, 279.329755666396), - TrajectoryPoint(1040, 277.765358455558), - TrajectoryPoint(1050, 276.218524384088), - TrajectoryPoint(1060, 274.682711941348), - TrajectoryPoint(1070, 273.157608372656), - TrajectoryPoint(1080, 271.64484237367), - TrajectoryPoint(1090, 270.146653824708), - TrajectoryPoint(1100, 268.658651194353), - TrajectoryPoint(1110, 267.180830182683), - TrajectoryPoint(1120, 265.71502038601), - TrajectoryPoint(1130, 264.261976788164), - TrajectoryPoint(1140, 262.818563921565), - TrajectoryPoint(1150, 261.38474277624), - TrajectoryPoint(1160, 259.961342931237), - TrajectoryPoint(1170, 258.550265015189), - TrajectoryPoint(1180, 257.148219282345), - TrajectoryPoint(1190, 255.755142360112), - TrajectoryPoint(1200, 254.370959759411), - TrajectoryPoint(1210, 252.997803975035), - TrajectoryPoint(1220, 251.633967580259), - TrajectoryPoint(1230, 250.278465760067), - TrajectoryPoint(1240, 248.931210314696), - TrajectoryPoint(1250, 247.592105538553), - TrajectoryPoint(1260, 246.262855805616), - TrajectoryPoint(1270, 244.941884938995), - TrajectoryPoint(1280, 243.628521911628), - TrajectoryPoint(1290, 242.322664617964), - TrajectoryPoint(1300, 241.024206038033), - TrajectoryPoint(1310, 239.733349959227), - TrajectoryPoint(1320, 238.451001377562), - TrajectoryPoint(1330, 237.175535502023), - TrajectoryPoint(1340, 235.906843739737), - TrajectoryPoint(1350, 234.64481440398), - TrajectoryPoint(1360, 233.389333164586), - TrajectoryPoint(1370, 232.140283459408), - TrajectoryPoint(1380, 230.898205196113), - TrajectoryPoint(1390, 229.662690474805), - TrajectoryPoint(1400, 228.43313173581), - TrajectoryPoint(1410, 227.20941542742), - TrajectoryPoint(1420, 225.991426778439), - TrajectoryPoint(1430, 224.779050065385), - TrajectoryPoint(1440, 223.572168854832), - TrajectoryPoint(1450, 222.370666222793), - TrajectoryPoint(1460, 221.174424952934), - TrajectoryPoint(1470, 219.983884761016), - TrajectoryPoint(1480, 218.798308392023), - TrajectoryPoint(1490, 217.617574583726), - TrajectoryPoint(1500, 216.441571764602), - TrajectoryPoint(1510, 215.270188470366), - TrajectoryPoint(1520, 214.103313467832), - TrajectoryPoint(1530, 212.940835865621), - TrajectoryPoint(1540, 211.782645212761), - TrajectoryPoint(1550, 210.628631586183), - TrajectoryPoint(1560, 209.478685668018), - TrajectoryPoint(1570, 208.332698813533), - TrajectoryPoint(1580, 207.190563110497), - TrajectoryPoint(1590, 206.052171430675), - TrajectoryPoint(1600, 204.917417474135), - TrajectoryPoint(1610, 203.786195806947), - TrajectoryPoint(1620, 202.658401892867), - TrajectoryPoint(1630, 201.533932119493), - TrajectoryPoint(1640, 200.412683819386), - TrajectoryPoint(1650, 199.29455528659), - TrajectoryPoint(1660, 198.179445788942), - TrajectoryPoint(1670, 197.067255576555), - TrajectoryPoint(1680, 195.957885886803), - TrajectoryPoint(1690, 194.851238946121), - TrajectoryPoint(1700, 193.747217968909), - TrajectoryPoint(1710, 192.645727153797), - TrajectoryPoint(1720, 191.546671677518), - TrajectoryPoint(1730, 190.449957686602), - TrajectoryPoint(1740, 189.355492287093), - TrajectoryPoint(1750, 188.263183532489), - TrajectoryPoint(1760, 187.172940410045), - TrajectoryPoint(1770, 186.08467282563), - TrajectoryPoint(1780, 184.998291587248), - TrajectoryPoint(1790, 183.913708387371), - TrajectoryPoint(1800, 182.830835784199), - TrajectoryPoint(1810, 181.749587181951), - TrajectoryPoint(1820, 180.669899537425), - TrajectoryPoint(1830, 179.591764558373), - TrajectoryPoint(1840, 178.514989633085), - TrajectoryPoint(1850, 177.439490660505), - TrajectoryPoint(1860, 176.365184304181), - TrajectoryPoint(1870, 175.291987966354), - TrajectoryPoint(1880, 174.219819761737), - TrajectoryPoint(1890, 173.148598491027), - TrajectoryPoint(1900, 172.078298555941), - TrajectoryPoint(1910, 171.008813308556), - TrajectoryPoint(1920, 169.940019947379), - TrajectoryPoint(1930, 168.871839298533), - TrajectoryPoint(1940, 167.804192750189), - TrajectoryPoint(1950, 166.737002223853), - TrajectoryPoint(1960, 165.67023275995), - TrajectoryPoint(1970, 164.603746993282), - TrajectoryPoint(1980, 163.537466894326), - TrajectoryPoint(1990, 162.471315868705), - TrajectoryPoint(2000, 161.405215889623), - TrajectoryPoint(2010, 160.339075352706), - TrajectoryPoint(2020, 159.272814889976), - TrajectoryPoint(2030, 158.206358972611), - TrajectoryPoint(2040, 157.139606146026), - TrajectoryPoint(2050, 156.07245530354), - TrajectoryPoint(2060, 155.004860322057), - TrajectoryPoint(2070, 153.936746267285), - TrajectoryPoint(2080, 152.867923580772), - TrajectoryPoint(2090, 151.798396561662), - TrajectoryPoint(2100, 150.728100784551), - TrajectoryPoint(2110, 149.656827143468), - TrajectoryPoint(2120, 148.584561974873), - TrajectoryPoint(2130, 147.51127620845), - TrajectoryPoint(2140, 146.436693490123), - TrajectoryPoint(2150, 145.360868823331), - TrajectoryPoint(2160, 144.283731915086), - TrajectoryPoint(2170, 143.204966416396), - TrajectoryPoint(2180, 142.124743024093), - TrajectoryPoint(2190, 141.042761130079), - TrajectoryPoint(2200, 139.95899973215), - TrajectoryPoint(2210, 138.873409848003), - TrajectoryPoint(2220, 137.785684728609), - TrajectoryPoint(2230, 136.696033503369), - TrajectoryPoint(2240, 135.603907271519), - TrajectoryPoint(2250, 134.509676297611), - TrajectoryPoint(2260, 133.412738653818), - TrajectoryPoint(2270, 132.313458237307), - TrajectoryPoint(2280, 131.211210571734), - TrajectoryPoint(2290, 130.106397911041), - TrajectoryPoint(2300, 128.998313116614), - TrajectoryPoint(2310, 127.887364251613), - TrajectoryPoint(2320, 126.772992401749), - TrajectoryPoint(2330, 125.65531820751), - TrajectoryPoint(2340, 124.534147829708), - TrajectoryPoint(2350, 123.409128126869), - TrajectoryPoint(2360, 122.280467626596), - TrajectoryPoint(2370, 121.147610681928), - TrajectoryPoint(2380, 120.010593690396), - TrajectoryPoint(2390, 118.869392522116), - TrajectoryPoint(2400, 117.723442785128), - TrajectoryPoint(2410, 116.572779083497), - TrajectoryPoint(2420, 115.417326905112), - TrajectoryPoint(2430, 114.256776720111), - TrajectoryPoint(2440, 113.090650907429), - TrajectoryPoint(2450, 111.919065300544), - TrajectoryPoint(2460, 110.741774457595), - TrajectoryPoint(2470, 109.558522208659), - TrajectoryPoint(2480, 108.368911705953), - TrajectoryPoint(2490, 107.172637530315), - TrajectoryPoint(2500, 105.969594867631), - TrajectoryPoint(2510, 104.759483760812), - TrajectoryPoint(2520, 103.541991160897), - TrajectoryPoint(2530, 102.316790317746), - TrajectoryPoint(2540, 101.083540124905), - TrajectoryPoint(2550, 99.8418844159803), - TrajectoryPoint(2560, 98.5914512095855), - TrajectoryPoint(2570, 97.3318518995843), - TrajectoryPoint(2580, 96.0626803870046), - TrajectoryPoint(2590, 94.7835121496189), - TrajectoryPoint(2600, 93.4939032447719), - TrajectoryPoint(2610, 92.1933892405828), - TrajectoryPoint(2620, 90.8813119121372), - TrajectoryPoint(2630, 89.5569556622576), - TrajectoryPoint(2640, 88.2200629981109), - TrajectoryPoint(2650, 86.8700674580021), - TrajectoryPoint(2660, 85.5059961193338), - TrajectoryPoint(2670, 84.1270010932271), - TrajectoryPoint(2680, 82.7328922479654), - TrajectoryPoint(2690, 81.3220196568161), - TrajectoryPoint(2700, 79.894149540421), - TrajectoryPoint(2710, 78.4477735322434), - TrajectoryPoint(2720, 76.9823534941141), - TrajectoryPoint(2730, 75.4958772290697), - TrajectoryPoint(2740, 73.9879185597794), - TrajectoryPoint(2750, 72.4567313464441), - TrajectoryPoint(2760, 70.9002463544824), - TrajectoryPoint(2770, 69.3173014497324), - TrajectoryPoint(2780, 67.7058798588637), - TrajectoryPoint(2790, 66.0637729809836), - TrajectoryPoint(2800, 64.38855803046), - TrajectoryPoint(2810, 62.6775723989456), - TrajectoryPoint(2820, 60.9278841670521), - TrajectoryPoint(2830, 59.1351229781754), - TrajectoryPoint(2840, 57.2961400583996), - TrajectoryPoint(2850, 55.4059421861985), - TrajectoryPoint(2860, 53.459295441486), - TrajectoryPoint(2870, 51.4487759074568), - TrajectoryPoint(2880, 49.3674304546589), - TrajectoryPoint(2890, 47.2057670631994), - TrajectoryPoint(2900, 44.951510951961), - TrajectoryPoint(2910, 42.5903196745025), - TrajectoryPoint(2920, 40.1029854838136), - TrajectoryPoint(2930, 37.4648604768426), - TrajectoryPoint(2940, 34.6406763982697), - TrajectoryPoint(2950, 31.5809614191273), - TrajectoryPoint(2960, 28.2099256267369), - TrajectoryPoint(2970, 24.3961123079863), - TrajectoryPoint(2980, 19.8902245073417), - TrajectoryPoint(2990, 14.040560407066), + TrajectoryPoint(0, 552.118744505108), + TrajectoryPoint(10, 550.18359586301), + TrajectoryPoint(20, 548.245560179972), + TrajectoryPoint(30, 546.299384614031), + TrajectoryPoint(40, 544.353209048089), + TrajectoryPoint(50, 542.399189894492), + TrajectoryPoint(60, 540.438252066734), + TrajectoryPoint(70, 538.477314238976), + TrajectoryPoint(80, 536.503914181843), + TrajectoryPoint(90, 534.527914023035), + TrajectoryPoint(100, 532.549609663325), + TrajectoryPoint(110, 530.558238926132), + TrajectoryPoint(120, 528.566868188939), + TrajectoryPoint(130, 526.567671567813), + TrajectoryPoint(140, 524.560613520973), + TrajectoryPoint(150, 522.553555474132), + TrajectoryPoint(160, 520.532499122544), + TrajectoryPoint(170, 518.509428230682), + TrajectoryPoint(180, 516.481848224363), + TrajectoryPoint(190, 514.442429812638), + TrajectoryPoint(200, 512.403011400914), + TrajectoryPoint(210, 510.351846703257), + TrajectoryPoint(220, 508.29573660596), + TrajectoryPoint(230, 506.236936464235), + TrajectoryPoint(240, 504.163780656412), + TrajectoryPoint(250, 502.090624848589), + TrajectoryPoint(260, 500.006360555869), + TrajectoryPoint(270, 497.915794766971), + TrajectoryPoint(280, 495.822661116377), + TrajectoryPoint(290, 493.714310424883), + TrajectoryPoint(300, 491.605959733388), + TrajectoryPoint(310, 489.485311783986), + TrajectoryPoint(320, 487.358790191848), + TrajectoryPoint(330, 485.227902906919), + TrajectoryPoint(340, 483.082812892631), + TrajectoryPoint(350, 480.937722878344), + TrajectoryPoint(360, 478.777082202625), + TrajectoryPoint(370, 476.613014251592), + TrajectoryPoint(380, 474.440612377204), + TrajectoryPoint(390, 472.257144488025), + TrajectoryPoint(400, 470.072375499922), + TrajectoryPoint(410, 467.869072665093), + TrajectoryPoint(420, 465.665769830264), + TrajectoryPoint(430, 463.447712951669), + TrajectoryPoint(440, 461.224126611086), + TrajectoryPoint(450, 458.991932249288), + TrajectoryPoint(460, 456.747599714829), + TrajectoryPoint(470, 454.500547681492), + TrajectoryPoint(480, 452.234991530821), + TrajectoryPoint(490, 449.969435380149), + TrajectoryPoint(500, 447.685051357392), + TrajectoryPoint(510, 445.397778794986), + TrajectoryPoint(520, 443.096472517029), + TrajectoryPoint(530, 440.78697470028), + TrajectoryPoint(540, 438.467889279726), + TrajectoryPoint(550, 436.135640607797), + TrajectoryPoint(560, 433.797873579525), + TrajectoryPoint(570, 431.442330942461), + TrajectoryPoint(580, 429.084931507883), + TrajectoryPoint(590, 426.70553349329), + TrajectoryPoint(600, 424.326135478696), + TrajectoryPoint(610, 421.923665620382), + TrajectoryPoint(620, 419.519831674752), + TrajectoryPoint(630, 417.095070198219), + TrajectoryPoint(640, 414.666199739761), + TrajectoryPoint(650, 412.218011273685), + TrajectoryPoint(660, 409.763482753249), + TrajectoryPoint(670, 407.29066941516), + TrajectoryPoint(680, 404.809839321573), + TrajectoryPoint(690, 402.311136726781), + TrajectoryPoint(700, 399.803338532599), + TrajectoryPoint(710, 397.277411499455), + TrajectoryPoint(720, 394.741954542787), + TrajectoryPoint(730, 392.187392467399), + TrajectoryPoint(740, 389.623560765103), + TrajectoryPoint(750, 387.038872635906), + TrajectoryPoint(760, 384.445923623031), + TrajectoryPoint(770, 381.829532642547), + TrajectoryPoint(780, 379.206695832459), + TrajectoryPoint(790, 376.556933610205), + TrajectoryPoint(800, 373.903409169321), + TrajectoryPoint(810, 371.218509445996), + TrajectoryPoint(820, 368.528982811923), + TrajectoryPoint(830, 365.811558535373), + TrajectoryPoint(840, 363.083937941689), + TrajectoryPoint(850, 360.333234775279), + TrajectoryPoint(860, 357.588749199467), + TrajectoryPoint(870, 354.850501540872), + TrajectoryPoint(880, 352.151484469903), + TrajectoryPoint(890, 349.467981596436), + TrajectoryPoint(900, 346.83586955461), + TrajectoryPoint(910, 344.217686408397), + TrajectoryPoint(920, 341.640270534557), + TrajectoryPoint(930, 339.088936707045), + TrajectoryPoint(940, 336.562687591861), + TrajectoryPoint(950, 334.077219788632), + TrajectoryPoint(960, 331.607976954691), + TrajectoryPoint(970, 329.179974881641), + TrajectoryPoint(980, 326.775399847097), + TrajectoryPoint(990, 324.394389466689), + TrajectoryPoint(1000, 322.052922684481), + TrajectoryPoint(1010, 319.72879101431), + TrajectoryPoint(1020, 317.437382023612), + TrajectoryPoint(1030, 315.17429896307), + TrajectoryPoint(1040, 312.929209534609), + TrajectoryPoint(1050, 310.721537256904), + TrajectoryPoint(1060, 308.535039004461), + TrajectoryPoint(1070, 306.367062370453), + TrajectoryPoint(1080, 304.237105155105), + TrajectoryPoint(1090, 302.124727199206), + TrajectoryPoint(1100, 300.031910998244), + TrajectoryPoint(1110, 297.973270505199), + TrajectoryPoint(1120, 295.932052223501), + TrajectoryPoint(1130, 293.9089643717), + TrajectoryPoint(1140, 291.918562626054), + TrajectoryPoint(1150, 289.945203034159), + TrajectoryPoint(1160, 287.98923187933), + TrajectoryPoint(1170, 286.061201618182), + TrajectoryPoint(1180, 284.152192855673), + TrajectoryPoint(1190, 282.259918511659), + TrajectoryPoint(1200, 280.38937522757), + TrajectoryPoint(1210, 278.541111194704), + TrajectoryPoint(1220, 276.708829385385), + TrajectoryPoint(1230, 274.892628657781), + TrajectoryPoint(1240, 273.100310912967), + TrajectoryPoint(1250, 271.324340464726), + TrajectoryPoint(1260, 269.563579162391), + TrajectoryPoint(1270, 267.818540344638), + TrajectoryPoint(1280, 266.095278860501), + TrajectoryPoint(1290, 264.386335627438), + TrajectoryPoint(1300, 262.691672082621), + TrajectoryPoint(1310, 261.011218384623), + TrajectoryPoint(1320, 259.350384346348), + TrajectoryPoint(1330, 257.703136809506), + TrajectoryPoint(1340, 256.069159838393), + TrajectoryPoint(1350, 254.448339183405), + TrajectoryPoint(1360, 252.842658104282), + TrajectoryPoint(1370, 251.25188231382), + TrajectoryPoint(1380, 249.673342033496), + TrajectoryPoint(1390, 248.106895999849), + TrajectoryPoint(1400, 246.552388628956), + TrajectoryPoint(1410, 245.011094243757), + TrajectoryPoint(1420, 243.482993189432), + TrajectoryPoint(1430, 241.965946656503), + TrajectoryPoint(1440, 240.459788594082), + TrajectoryPoint(1450, 238.964344358675), + TrajectoryPoint(1460, 237.479432045508), + TrajectoryPoint(1470, 236.006151251059), + TrajectoryPoint(1480, 234.543737074254), + TrajectoryPoint(1490, 233.091034931295), + TrajectoryPoint(1500, 231.647864956949), + TrajectoryPoint(1510, 230.214043356176), + TrajectoryPoint(1520, 228.78938321596), + TrajectoryPoint(1530, 227.373695231844), + TrajectoryPoint(1540, 225.967085239547), + TrajectoryPoint(1550, 224.569939959488), + TrajectoryPoint(1560, 223.181036104507), + TrajectoryPoint(1570, 221.800193715764), + TrajectoryPoint(1580, 220.427232052104), + TrajectoryPoint(1590, 219.061970020904), + TrajectoryPoint(1600, 217.704226559688), + TrajectoryPoint(1610, 216.353820973123), + TrajectoryPoint(1620, 215.010573229588), + TrajectoryPoint(1630, 213.674304221172), + TrajectoryPoint(1640, 212.344835990591), + TrajectoryPoint(1650, 211.021991928234), + TrajectoryPoint(1660, 209.705596942233), + TrajectoryPoint(1670, 208.395762614034), + TrajectoryPoint(1680, 207.091970816637), + TrajectoryPoint(1690, 205.794057300869), + TrajectoryPoint(1700, 204.501859784755), + TrajectoryPoint(1710, 203.215217640386), + TrajectoryPoint(1720, 201.933971979689), + TrajectoryPoint(1730, 200.657965725084), + TrajectoryPoint(1740, 199.387043666518), + TrajectoryPoint(1750, 198.121052506271), + TrajectoryPoint(1760, 196.859840892775), + TrajectoryPoint(1770, 195.603259444569), + TrajectoryPoint(1780, 194.351160765433), + TrajectoryPoint(1790, 193.103399451607), + TrajectoryPoint(1800, 191.859832091958), + TrajectoryPoint(1810, 190.62033939632), + TrajectoryPoint(1820, 189.384915919353), + TrajectoryPoint(1830, 188.153274139719), + TrajectoryPoint(1840, 186.925276497205), + TrajectoryPoint(1850, 185.70078747496), + TrajectoryPoint(1860, 184.479673560894), + TrajectoryPoint(1870, 183.261803206744), + TrajectoryPoint(1880, 182.047046785133), + TrajectoryPoint(1890, 180.835276544883), + TrajectoryPoint(1900, 179.626366564861), + TrajectoryPoint(1910, 178.420192706569), + TrajectoryPoint(1920, 177.216632565694), + TrajectoryPoint(1930, 176.015766927029), + TrajectoryPoint(1940, 174.817310234389), + TrajectoryPoint(1950, 173.621095478723), + TrajectoryPoint(1960, 172.427005887891), + TrajectoryPoint(1970, 171.234926212743), + TrajectoryPoint(1980, 170.044742671864), + TrajectoryPoint(1990, 168.856425903911), + TrajectoryPoint(2000, 167.669907578121), + TrajectoryPoint(2010, 166.484931143753), + TrajectoryPoint(2020, 165.301387626455), + TrajectoryPoint(2030, 164.119169263177), + TrajectoryPoint(2040, 162.938243028857), + TrajectoryPoint(2050, 161.758510044055), + TrajectoryPoint(2060, 160.579760223235), + TrajectoryPoint(2070, 159.401889709335), + TrajectoryPoint(2080, 158.22482994994), + TrajectoryPoint(2090, 157.048506212121), + TrajectoryPoint(2100, 155.872727215036), + TrajectoryPoint(2110, 154.697392205771), + TrajectoryPoint(2120, 153.522432897783), + TrajectoryPoint(2130, 152.347705087054), + TrajectoryPoint(2140, 151.173092120116), + TrajectoryPoint(2150, 149.998486555011), + TrajectoryPoint(2160, 148.823765801808), + TrajectoryPoint(2170, 147.648832771173), + TrajectoryPoint(2180, 146.473538851074), + TrajectoryPoint(2190, 145.297774714481), + TrajectoryPoint(2200, 144.121471780001), + TrajectoryPoint(2210, 142.944385660045), + TrajectoryPoint(2220, 141.766517888738), + TrajectoryPoint(2230, 140.58768797236), + TrajectoryPoint(2240, 139.407741111949), + TrajectoryPoint(2250, 138.226662905705), + TrajectoryPoint(2260, 137.04411242011), + TrajectoryPoint(2270, 135.860227753757), + TrajectoryPoint(2280, 134.674560741461), + TrajectoryPoint(2290, 133.487298131999), + TrajectoryPoint(2300, 132.297972027478), + TrajectoryPoint(2310, 131.106779451406), + TrajectoryPoint(2320, 129.913187660572), + TrajectoryPoint(2330, 128.717454926068), + TrajectoryPoint(2340, 127.519002262742), + TrajectoryPoint(2350, 126.318033212059), + TrajectoryPoint(2360, 125.114160948491), + TrajectoryPoint(2370, 123.907259890063), + TrajectoryPoint(2380, 122.697356051914), + TrajectoryPoint(2390, 121.483791077152), + TrajectoryPoint(2400, 120.266831148618), + TrajectoryPoint(2410, 119.046224099817), + TrajectoryPoint(2420, 117.821409981394), + TrajectoryPoint(2430, 116.592564504495), + TrajectoryPoint(2440, 115.359460363652), + TrajectoryPoint(2450, 114.121582911408), + TrajectoryPoint(2460, 112.878838066932), + TrajectoryPoint(2470, 111.631094232977), + TrajectoryPoint(2480, 110.378082177557), + TrajectoryPoint(2490, 109.119508136265), + TrajectoryPoint(2500, 107.854819924374), + TrajectoryPoint(2510, 106.584004631452), + TrajectoryPoint(2520, 105.306745027225), + TrajectoryPoint(2530, 104.022709517513), + TrajectoryPoint(2540, 102.731551518168), + TrajectoryPoint(2550, 101.432908774323), + TrajectoryPoint(2560, 100.126402622475), + TrajectoryPoint(2570, 98.8116371925286), + TrajectoryPoint(2580, 97.4881985464913), + TrajectoryPoint(2590, 96.1556537500962), + TrajectoryPoint(2600, 94.8135498731277), + TrajectoryPoint(2610, 93.461412913735), + TrajectoryPoint(2620, 92.0987466414572), + TrajectoryPoint(2630, 90.7248966624579), + TrajectoryPoint(2640, 89.3390399290344), + TrajectoryPoint(2650, 87.940910615055), + TrajectoryPoint(2660, 86.5299015436999), + TrajectoryPoint(2670, 85.1049621218301), + TrajectoryPoint(2680, 83.6652489163542), + TrajectoryPoint(2690, 82.2104986798731), + TrajectoryPoint(2700, 80.7388541236569), + TrajectoryPoint(2710, 79.2502883526712), + TrajectoryPoint(2720, 77.7428261909113), + TrajectoryPoint(2730, 76.2162467741218), + TrajectoryPoint(2740, 74.6681318434662), + TrajectoryPoint(2750, 73.0978653365292), + TrajectoryPoint(2760, 71.5038620527926), + TrajectoryPoint(2770, 69.8842330300303), + TrajectoryPoint(2780, 68.2366252964322), + TrajectoryPoint(2790, 66.5593703907172), + TrajectoryPoint(2800, 64.8500491260427), + TrajectoryPoint(2810, 63.105902302955), + TrajectoryPoint(2820, 61.3233606583017), + TrajectoryPoint(2830, 59.4994960527389), + TrajectoryPoint(2840, 57.6306609138748), + TrajectoryPoint(2850, 55.7106820472151), + TrajectoryPoint(2860, 53.7356871474459), + TrajectoryPoint(2870, 51.6983571533038), + TrajectoryPoint(2880, 49.5907074113256), + TrajectoryPoint(2890, 47.4038407873991), + TrajectoryPoint(2900, 45.1250288758263), + TrajectoryPoint(2910, 42.7412022794528), + TrajectoryPoint(2920, 40.2318316505816), + TrajectoryPoint(2930, 37.5730266559745), + TrajectoryPoint(2940, 34.7290226794509), + TrajectoryPoint(2950, 31.6510087556607), + TrajectoryPoint(2960, 28.2628261730911), + TrajectoryPoint(2970, 24.4335863639287), + TrajectoryPoint(2980, 19.9135052873926), + TrajectoryPoint(2990, 14.0512054531767), TrajectoryPoint(3000, 0), }; TrajectoryPoint t4_open[] = { - TrajectoryPoint(0, 501.011831601148), - TrajectoryPoint(10, 498.910275275413), - TrajectoryPoint(20, 496.80313301355), - TrajectoryPoint(30, 494.687649597284), - TrajectoryPoint(40, 492.572166181019), - TrajectoryPoint(50, 490.439757552511), - TrajectoryPoint(60, 488.305994721969), - TrajectoryPoint(70, 486.163323016975), - TrajectoryPoint(80, 484.010879516332), - TrajectoryPoint(90, 481.857405085496), - TrajectoryPoint(100, 479.685867513483), - TrajectoryPoint(110, 477.51432994147), - TrajectoryPoint(120, 475.329965091921), - TrajectoryPoint(130, 473.138907400239), - TrajectoryPoint(140, 470.942135968601), - TrajectoryPoint(150, 468.731118934247), - TrajectoryPoint(160, 466.520101899893), - TrajectoryPoint(170, 464.289869645841), - TrajectoryPoint(180, 462.05844031572), - TrajectoryPoint(190, 459.814016802862), - TrajectoryPoint(200, 457.561707908902), - TrajectoryPoint(210, 455.302367289329), - TrajectoryPoint(220, 453.028696632207), - TrajectoryPoint(230, 450.753674889665), - TrajectoryPoint(240, 448.458144689095), - TrajectoryPoint(250, 446.162614488526), - TrajectoryPoint(260, 443.848733603067), - TrajectoryPoint(270, 441.530829812458), - TrajectoryPoint(280, 439.199085091469), - TrajectoryPoint(290, 436.858276674566), - TrajectoryPoint(300, 434.507757728438), - TrajectoryPoint(310, 432.143495895401), - TrajectoryPoint(320, 429.773243380208), - TrajectoryPoint(330, 427.38496078036), - TrajectoryPoint(340, 424.993963394525), - TrajectoryPoint(350, 422.581073262788), - TrajectoryPoint(360, 420.16818313105), - TrajectoryPoint(370, 417.73015977797), - TrajectoryPoint(380, 415.292055031762), - TrajectoryPoint(390, 412.830466845898), - TrajectoryPoint(400, 410.366519129002), - TrajectoryPoint(410, 407.880156338589), - TrajectoryPoint(420, 405.389715008208), - TrajectoryPoint(430, 402.877300405396), - TrajectoryPoint(440, 400.359691458295), - TrajectoryPoint(450, 397.819876027173), - TrajectoryPoint(460, 395.274400960464), - TrajectoryPoint(470, 392.705759167282), - TrajectoryPoint(480, 390.131693769013), - TrajectoryPoint(490, 387.532718484226), - TrajectoryPoint(500, 384.929311548516), - TrajectoryPoint(510, 382.298408567138), - TrajectoryPoint(520, 379.664821172904), - TrajectoryPoint(530, 377.000362651398), - TrajectoryPoint(540, 374.332214511475), - TrajectoryPoint(550, 371.635984767183), - TrajectoryPoint(560, 368.931415986492), - TrajectoryPoint(570, 366.202541268844), - TrajectoryPoint(580, 363.4595798983), - TrajectoryPoint(590, 360.697151687422), - TrajectoryPoint(600, 358.238591938618), - TrajectoryPoint(610, 355.9749349171), - TrajectoryPoint(620, 353.739140244251), - TrajectoryPoint(630, 351.511215449331), - TrajectoryPoint(640, 349.315389753838), - TrajectoryPoint(650, 347.129845272164), - TrajectoryPoint(660, 344.967758823777), - TrajectoryPoint(670, 342.824909685462), - TrajectoryPoint(680, 340.696271806021), - TrajectoryPoint(690, 338.596190366938), - TrajectoryPoint(700, 336.506167422886), - TrajectoryPoint(710, 334.443147221629), - TrajectoryPoint(720, 332.395975857659), - TrajectoryPoint(730, 330.364962052424), - TrajectoryPoint(740, 328.360206325315), - TrajectoryPoint(750, 326.366558674982), - TrajectoryPoint(760, 324.397651900161), - TrajectoryPoint(770, 322.445820880983), - TrajectoryPoint(780, 320.506930200583), - TrajectoryPoint(790, 318.5961219278), - TrajectoryPoint(800, 316.696914239036), - TrajectoryPoint(810, 314.815842006258), - TrajectoryPoint(820, 312.95656788272), - TrajectoryPoint(830, 311.109209852234), - TrajectoryPoint(840, 309.282908838304), - TrajectoryPoint(850, 307.474172518963), - TrajectoryPoint(860, 305.67749167396), - TrajectoryPoint(870, 303.902881242454), - TrajectoryPoint(880, 302.143346032911), - TrajectoryPoint(890, 300.395850866721), - TrajectoryPoint(900, 298.669885607527), - TrajectoryPoint(910, 296.957948004568), - TrajectoryPoint(920, 295.257905001225), - TrajectoryPoint(930, 293.577622035441), - TrajectoryPoint(940, 291.911481016706), - TrajectoryPoint(950, 290.256984049878), - TrajectoryPoint(960, 288.61953416604), - TrajectoryPoint(970, 286.997252614701), - TrajectoryPoint(980, 285.38628259194), - TrajectoryPoint(990, 283.788949355392), - TrajectoryPoint(1000, 282.208506220077), - TrajectoryPoint(1010, 280.638980549451), - TrajectoryPoint(1020, 279.080461072082), - TrajectoryPoint(1030, 277.538523754555), - TrajectoryPoint(1040, 276.008336180711), - TrajectoryPoint(1050, 274.488681825754), - TrajectoryPoint(1060, 272.980703685605), - TrajectoryPoint(1070, 271.487755526576), - TrajectoryPoint(1080, 270.004844640325), - TrajectoryPoint(1090, 268.531976160512), - TrajectoryPoint(1100, 267.070842427118), - TrajectoryPoint(1110, 265.62259556837), - TrajectoryPoint(1120, 264.18386335563), - TrajectoryPoint(1130, 262.754615067255), - TrajectoryPoint(1140, 261.335828177703), - TrajectoryPoint(1150, 259.929211048086), - TrajectoryPoint(1160, 258.531537843023), - TrajectoryPoint(1170, 257.142752342932), - TrajectoryPoint(1180, 255.762786948742), - TrajectoryPoint(1190, 254.39421606484), - TrajectoryPoint(1200, 253.034530095862), - TrajectoryPoint(1210, 251.683120052634), - TrajectoryPoint(1220, 250.339903585138), - TrajectoryPoint(1230, 249.004819199555), - TrajectoryPoint(1240, 247.680143697496), - TrajectoryPoint(1250, 246.363132670705), - TrajectoryPoint(1260, 245.053694539157), - TrajectoryPoint(1270, 243.751731907328), - TrajectoryPoint(1280, 242.457142246331), - TrajectoryPoint(1290, 241.170938789962), - TrajectoryPoint(1300, 239.892453846147), - TrajectoryPoint(1310, 238.62083544771), - TrajectoryPoint(1320, 237.355978760764), - TrajectoryPoint(1330, 236.097775674215), - TrajectoryPoint(1340, 234.846115256769), - TrajectoryPoint(1350, 233.601314833465), - TrajectoryPoint(1360, 232.36357203808), - TrajectoryPoint(1370, 231.131898891793), - TrajectoryPoint(1380, 229.906186194541), - TrajectoryPoint(1390, 228.686323089591), - TrajectoryPoint(1400, 227.472197364003), - TrajectoryPoint(1410, 226.263695722108), - TrajectoryPoint(1420, 225.060704034019), - TrajectoryPoint(1430, 223.86345408056), - TrajectoryPoint(1440, 222.671789655937), - TrajectoryPoint(1450, 221.485209770253), - TrajectoryPoint(1460, 220.303604996177), - TrajectoryPoint(1470, 219.126865624062), - TrajectoryPoint(1480, 217.954881820805), - TrajectoryPoint(1490, 216.787543772977), - TrajectoryPoint(1500, 215.624741815463), - TrajectoryPoint(1510, 214.466366546774), - TrajectoryPoint(1520, 213.312308932085), - TrajectoryPoint(1530, 212.162460394984), - TrajectoryPoint(1540, 211.016712898867), - TrajectoryPoint(1550, 209.874959018799), - TrajectoryPoint(1560, 208.737188389876), - TrajectoryPoint(1570, 207.603252874027), - TrajectoryPoint(1580, 206.472960694832), - TrajectoryPoint(1590, 205.346210340825), - TrajectoryPoint(1600, 204.222900980061), - TrajectoryPoint(1610, 203.102932500515), - TrajectoryPoint(1620, 201.986205544577), - TrajectoryPoint(1630, 200.872621538143), - TrajectoryPoint(1640, 199.762082714757), - TrajectoryPoint(1650, 198.654492135217), - TrajectoryPoint(1660, 197.549753703022), - TrajectoryPoint(1670, 196.447772176024), - TrajectoryPoint(1680, 195.348453174605), - TrajectoryPoint(1690, 194.251703186674), - TrajectoryPoint(1700, 193.157429569767), - TrajectoryPoint(1710, 192.065540550495), - TrajectoryPoint(1720, 190.975952359583), - TrajectoryPoint(1730, 189.888656627771), - TrajectoryPoint(1740, 188.803476744573), - TrajectoryPoint(1750, 187.720323218041), - TrajectoryPoint(1760, 186.639107449743), - TrajectoryPoint(1770, 185.559741718621), - TrajectoryPoint(1780, 184.482139163723), - TrajectoryPoint(1790, 183.406213765911), - TrajectoryPoint(1800, 182.331880328657), - TrajectoryPoint(1810, 181.259054458001), - TrajectoryPoint(1820, 180.187652541783), - TrajectoryPoint(1830, 179.1175917282), - TrajectoryPoint(1840, 178.04880639304), - TrajectoryPoint(1850, 176.981291691348), - TrajectoryPoint(1860, 175.91486278596), - TrajectoryPoint(1870, 174.849439065793), - TrajectoryPoint(1880, 173.784940586438), - TrajectoryPoint(1890, 172.721288044253), - TrajectoryPoint(1900, 171.658402750259), - TrajectoryPoint(1910, 170.596229150332), - TrajectoryPoint(1920, 169.534711685655), - TrajectoryPoint(1930, 168.473712703709), - TrajectoryPoint(1940, 167.413155296663), - TrajectoryPoint(1950, 166.352963047292), - TrajectoryPoint(1960, 165.293060696756), - TrajectoryPoint(1970, 164.233391851482), - TrajectoryPoint(1980, 163.173842348616), - TrajectoryPoint(1990, 162.114337106978), - TrajectoryPoint(2000, 161.054801398575), - TrajectoryPoint(2010, 159.995142022085), - TrajectoryPoint(2020, 158.935274713262), - TrajectoryPoint(2030, 157.87513272378), - TrajectoryPoint(2040, 156.814642130798), - TrajectoryPoint(2050, 155.753658689766), - TrajectoryPoint(2060, 154.692139345057), - TrajectoryPoint(2070, 153.630026810156), - TrajectoryPoint(2080, 152.567195060339), - TrajectoryPoint(2090, 151.503515288), - TrajectoryPoint(2100, 150.438996176293), - TrajectoryPoint(2110, 149.373511699917), - TrajectoryPoint(2120, 148.306874865985), - TrajectoryPoint(2130, 147.239150148223), - TrajectoryPoint(2140, 146.170156824464), - TrajectoryPoint(2150, 145.099750576168), - TrajectoryPoint(2160, 144.028004564788), - TrajectoryPoint(2170, 142.954594757833), - TrajectoryPoint(2180, 141.879588351799), - TrajectoryPoint(2190, 140.802877638679), - TrajectoryPoint(2200, 139.724199334209), - TrajectoryPoint(2210, 138.643740504799), - TrajectoryPoint(2220, 137.560986576288), - TrajectoryPoint(2230, 136.476245193123), - TrajectoryPoint(2240, 135.389062658967), - TrajectoryPoint(2250, 134.299600378242), - TrajectoryPoint(2260, 133.207502365147), - TrajectoryPoint(2270, 132.112867704636), - TrajectoryPoint(2280, 131.015340985864), - TrajectoryPoint(2290, 129.915068276456), - TrajectoryPoint(2300, 128.811572262761), - TrajectoryPoint(2310, 127.70517381454), - TrajectoryPoint(2320, 126.595145976192), - TrajectoryPoint(2330, 125.481905023643), - TrajectoryPoint(2340, 124.364965182652), - TrajectoryPoint(2350, 123.24426268382), - TrajectoryPoint(2360, 122.119865829321), - TrajectoryPoint(2370, 120.991067137268), - TrajectoryPoint(2380, 119.858199003943), - TrajectoryPoint(2390, 118.721083276317), - TrajectoryPoint(2400, 117.57903425801), - TrajectoryPoint(2410, 116.432352213256), - TrajectoryPoint(2420, 115.280827714441), - TrajectoryPoint(2430, 114.124006634284), - TrajectoryPoint(2440, 112.96169682862), - TrajectoryPoint(2450, 111.79387336148), - TrajectoryPoint(2460, 110.62029065528), - TrajectoryPoint(2470, 109.440692441966), - TrajectoryPoint(2480, 108.254542272019), - TrajectoryPoint(2490, 107.061813004956), - TrajectoryPoint(2500, 105.862261535746), - TrajectoryPoint(2510, 104.655587898418), - TrajectoryPoint(2520, 103.441479060529), - TrajectoryPoint(2530, 102.219608311681), - TrajectoryPoint(2540, 100.989634606426), - TrajectoryPoint(2550, 99.7512018588889), - TrajectoryPoint(2560, 98.5039381861555), - TrajectoryPoint(2570, 97.247455097111), - TrajectoryPoint(2580, 95.981346623101), - TrajectoryPoint(2590, 94.7051883863886), - TrajectoryPoint(2600, 93.4185366019755), - TrajectoryPoint(2610, 92.1209270079005), - TrajectoryPoint(2620, 90.8118163531082), - TrajectoryPoint(2630, 89.490255662728), - TrajectoryPoint(2640, 88.1561062124945), - TrajectoryPoint(2650, 86.8088017646198), - TrajectoryPoint(2660, 85.4474753898248), - TrajectoryPoint(2670, 84.0710629319449), - TrajectoryPoint(2680, 82.6794850961345), - TrajectoryPoint(2690, 81.2711898584975), - TrajectoryPoint(2700, 79.8457428067736), - TrajectoryPoint(2710, 78.4018320023688), - TrajectoryPoint(2720, 76.9387275376952), - TrajectoryPoint(2730, 75.4546035286158), - TrajectoryPoint(2740, 73.9489401797798), - TrajectoryPoint(2750, 72.419905205717), - TrajectoryPoint(2760, 70.865601637311), - TrajectoryPoint(2770, 69.2847803297828), - TrajectoryPoint(2780, 67.6754241744377), - TrajectoryPoint(2790, 66.0353243017501), - TrajectoryPoint(2800, 64.3620577202878), - TrajectoryPoint(2810, 62.6529616752113), - TrajectoryPoint(2820, 60.9051041567696), - TrajectoryPoint(2830, 59.1141775088849), - TrajectoryPoint(2840, 57.2769031675002), - TrajectoryPoint(2850, 55.38841198935), - TrajectoryPoint(2860, 53.4433508214166), - TrajectoryPoint(2870, 51.4344079213076), - TrajectoryPoint(2880, 49.3545721292828), - TrajectoryPoint(2890, 47.1943507633915), - TrajectoryPoint(2900, 44.9415112190163), - TrajectoryPoint(2910, 42.5816211045782), - TrajectoryPoint(2920, 40.0955547757743), - TrajectoryPoint(2930, 37.4586202160777), - TrajectoryPoint(2940, 34.6355779145418), - TrajectoryPoint(2950, 31.5769176224689), - TrajectoryPoint(2960, 28.2068707274524), - TrajectoryPoint(2970, 24.3939475293035), - TrajectoryPoint(2980, 19.8888791747687), - TrajectoryPoint(2990, 14.0399449915658), + TrajectoryPoint(0, 546.035792620688), + TrajectoryPoint(10, 544.119072133863), + TrajectoryPoint(20, 542.202351647038), + TrajectoryPoint(30, 540.276374488442), + TrajectoryPoint(40, 538.346906714066), + TrajectoryPoint(50, 536.416991496271), + TrajectoryPoint(60, 534.472987912768), + TrajectoryPoint(70, 532.528984329265), + TrajectoryPoint(80, 530.57962211197), + TrajectoryPoint(90, 528.620789921182), + TrajectoryPoint(100, 526.661957730395), + TrajectoryPoint(110, 524.692264513362), + TrajectoryPoint(120, 522.718303001766), + TrajectoryPoint(130, 520.742793800195), + TrajectoryPoint(140, 518.753394045375), + TrajectoryPoint(150, 516.763994290556), + TrajectoryPoint(160, 514.766583879941), + TrajectoryPoint(170, 512.761428443416), + TrajectoryPoint(180, 510.75627300689), + TrajectoryPoint(190, 508.735962532482), + TrajectoryPoint(200, 506.71472513808), + TrajectoryPoint(210, 504.68688801201), + TrajectoryPoint(220, 502.649233208999), + TrajectoryPoint(230, 500.611578405989), + TrajectoryPoint(240, 498.55905073626), + TrajectoryPoint(250, 496.504633546345), + TrajectoryPoint(260, 494.443401100959), + TrajectoryPoint(270, 492.3718666482), + TrajectoryPoint(280, 490.30033219544), + TrajectoryPoint(290, 488.212459218052), + TrajectoryPoint(300, 486.123442340718), + TrajectoryPoint(310, 484.02555922655), + TrajectoryPoint(320, 481.918684069836), + TrajectoryPoint(330, 479.81027945598), + TrajectoryPoint(340, 477.685159044431), + TrajectoryPoint(350, 475.560038632882), + TrajectoryPoint(360, 473.421931535976), + TrajectoryPoint(370, 471.278167324403), + TrajectoryPoint(380, 469.128026542897), + TrajectoryPoint(390, 466.965207944473), + TrajectoryPoint(400, 464.80238934605), + TrajectoryPoint(410, 462.620131681358), + TrajectoryPoint(420, 460.437835571486), + TrajectoryPoint(430, 458.24186580481), + TrajectoryPoint(440, 456.039655999248), + TrajectoryPoint(450, 453.829291380387), + TrajectoryPoint(460, 451.606718086017), + TrajectoryPoint(470, 449.381240837999), + TrajectoryPoint(480, 447.137840074503), + TrajectoryPoint(490, 444.894439311008), + TrajectoryPoint(500, 442.631788374351), + TrajectoryPoint(510, 440.367081364917), + TrajectoryPoint(520, 438.087274772473), + TrajectoryPoint(530, 435.800767301518), + TrajectoryPoint(540, 433.502953459759), + TrajectoryPoint(550, 431.194135195512), + TrajectoryPoint(560, 428.877417859934), + TrajectoryPoint(570, 426.545761639535), + TrajectoryPoint(580, 424.209197245058), + TrajectoryPoint(590, 421.854158319668), + TrajectoryPoint(600, 419.496753120799), + TrajectoryPoint(610, 417.117768357988), + TrajectoryPoint(620, 414.738475362999), + TrajectoryPoint(630, 412.334962403495), + TrajectoryPoint(640, 409.93144944399), + TrajectoryPoint(650, 407.504034451024), + TrajectoryPoint(660, 405.07539081664), + TrajectoryPoint(670, 402.623197365838), + TrajectoryPoint(680, 400.168799515157), + TrajectoryPoint(690, 397.69057808948), + TrajectoryPoint(700, 395.209780417564), + TrajectoryPoint(710, 392.704212500127), + TrajectoryPoint(720, 390.196346278236), + TrajectoryPoint(730, 387.662039898078), + TrajectoryPoint(740, 385.126004779726), + TrajectoryPoint(750, 382.561897084135), + TrajectoryPoint(760, 379.994844767165), + TrajectoryPoint(770, 377.401511995407), + TrajectoryPoint(780, 374.801827895209), + TrajectoryPoint(790, 372.178496859505), + TrajectoryPoint(800, 369.544472803622), + TrajectoryPoint(810, 366.890340824113), + TrajectoryPoint(820, 364.220168636314), + TrajectoryPoint(830, 361.534402014452), + TrajectoryPoint(840, 358.826166574222), + TrajectoryPoint(850, 356.107898966208), + TrajectoryPoint(860, 353.43149608521), + TrajectoryPoint(870, 350.766741057111), + TrajectoryPoint(880, 348.147743261867), + TrajectoryPoint(890, 345.548800316768), + TrajectoryPoint(900, 342.981430599411), + TrajectoryPoint(910, 340.447680523154), + TrajectoryPoint(920, 337.930732563219), + TrajectoryPoint(930, 335.461301141652), + TrajectoryPoint(940, 333.007268684252), + TrajectoryPoint(950, 330.587283495647), + TrajectoryPoint(960, 328.196534308086), + TrajectoryPoint(970, 325.822994517276), + TrajectoryPoint(980, 323.494084574998), + TrajectoryPoint(990, 321.18178671402), + TrajectoryPoint(1000, 318.896926849024), + TrajectoryPoint(1010, 316.644578818806), + TrajectoryPoint(1020, 314.409570218269), + TrajectoryPoint(1030, 312.207725178098), + TrajectoryPoint(1040, 310.03037400529), + TrajectoryPoint(1050, 307.870710318238), + TrajectoryPoint(1060, 305.746281592617), + TrajectoryPoint(1070, 303.641692843851), + TrajectoryPoint(1080, 301.554816013228), + TrajectoryPoint(1090, 299.502379324897), + TrajectoryPoint(1100, 297.467808784442), + TrajectoryPoint(1110, 295.450712188827), + TrajectoryPoint(1120, 293.465088805912), + TrajectoryPoint(1130, 291.497432585498), + TrajectoryPoint(1140, 289.54680907605), + TrajectoryPoint(1150, 287.623108400407), + TrajectoryPoint(1160, 285.719033959381), + TrajectoryPoint(1170, 283.83140064166), + TrajectoryPoint(1180, 281.965041330969), + TrajectoryPoint(1190, 280.121095793076), + TrajectoryPoint(1200, 278.292894374135), + TrajectoryPoint(1210, 276.480555231763), + TrajectoryPoint(1220, 274.692306031221), + TrajectoryPoint(1230, 272.91998037226), + TrajectoryPoint(1240, 271.16269095881), + TrajectoryPoint(1250, 269.421695848558), + TrajectoryPoint(1260, 267.701749689459), + TrajectoryPoint(1270, 265.995988208577), + TrajectoryPoint(1280, 264.304387220143), + TrajectoryPoint(1290, 262.627771954381), + TrajectoryPoint(1300, 260.970137634317), + TrajectoryPoint(1310, 259.325777574666), + TrajectoryPoint(1320, 257.694612139739), + TrajectoryPoint(1330, 256.076538231694), + TrajectoryPoint(1340, 254.475018453154), + TrajectoryPoint(1350, 252.886968786683), + TrajectoryPoint(1360, 251.311112983768), + TrajectoryPoint(1370, 249.747318708153), + TrajectoryPoint(1380, 248.195438753989), + TrajectoryPoint(1390, 246.658455098213), + TrajectoryPoint(1400, 245.133007412297), + TrajectoryPoint(1410, 243.618606548271), + TrajectoryPoint(1420, 242.115093063618), + TrajectoryPoint(1430, 240.622298479397), + TrajectoryPoint(1440, 239.14089501081), + TrajectoryPoint(1450, 237.671301245202), + TrajectoryPoint(1460, 236.211611375743), + TrajectoryPoint(1470, 234.76165518516), + TrajectoryPoint(1480, 233.321257277269), + TrajectoryPoint(1490, 231.890238001217), + TrajectoryPoint(1500, 230.468414282007), + TrajectoryPoint(1510, 229.056459695556), + TrajectoryPoint(1520, 227.65381759211), + TrajectoryPoint(1530, 226.25963656114), + TrajectoryPoint(1540, 224.873740870433), + TrajectoryPoint(1550, 223.495953292217), + TrajectoryPoint(1560, 222.126095603057), + TrajectoryPoint(1570, 220.763989028857), + TrajectoryPoint(1580, 219.409454639999), + TrajectoryPoint(1590, 218.062313701192), + TrajectoryPoint(1600, 216.72238798025), + TrajectoryPoint(1610, 215.390042017034), + TrajectoryPoint(1620, 214.064513917447), + TrajectoryPoint(1630, 212.745587628806), + TrajectoryPoint(1640, 211.43309684436), + TrajectoryPoint(1650, 210.126876266168), + TrajectoryPoint(1660, 208.826761778733), + TrajectoryPoint(1670, 207.532590599239), + TrajectoryPoint(1680, 206.244201406637), + TrajectoryPoint(1690, 204.961434451643), + TrajectoryPoint(1700, 203.684131649495), + TrajectoryPoint(1710, 202.412136657176), + TrajectoryPoint(1720, 201.145294936639), + TrajectoryPoint(1730, 199.88345380543), + TrajectoryPoint(1740, 198.626462475978), + TrajectoryPoint(1750, 197.374172084709), + TrajectoryPoint(1760, 196.12643571202), + TrajectoryPoint(1770, 194.883108394067), + TrajectoryPoint(1780, 193.644047127219), + TrajectoryPoint(1790, 192.409110865961), + TrajectoryPoint(1800, 191.178160514946), + TrajectoryPoint(1810, 189.951058915827), + TrajectoryPoint(1820, 188.727670829458), + TrajectoryPoint(1830, 187.507862913972), + TrajectoryPoint(1840, 186.291503699217), + TrajectoryPoint(1850, 185.078463557964), + TrajectoryPoint(1860, 183.868775717782), + TrajectoryPoint(1870, 182.662211333275), + TrajectoryPoint(1880, 181.458582855696), + TrajectoryPoint(1890, 180.257766408935), + TrajectoryPoint(1900, 179.059639856584), + TrajectoryPoint(1910, 177.86408275462), + TrajectoryPoint(1920, 176.67097630328), + TrajectoryPoint(1930, 175.480203298302), + TrajectoryPoint(1940, 174.291648081646), + TrajectoryPoint(1950, 173.105425667329), + TrajectoryPoint(1960, 171.921179507108), + TrajectoryPoint(1970, 170.738795895417), + TrajectoryPoint(1980, 169.558164202094), + TrajectoryPoint(1990, 168.379175121732), + TrajectoryPoint(2000, 167.201749276686), + TrajectoryPoint(2010, 166.025909369991), + TrajectoryPoint(2020, 164.851369376033), + TrajectoryPoint(2030, 163.678024300873), + TrajectoryPoint(2040, 162.505770224477), + TrajectoryPoint(2050, 161.334573610108), + TrajectoryPoint(2060, 160.164316071533), + TrajectoryPoint(2070, 158.994817641489), + TrajectoryPoint(2080, 157.825977806363), + TrajectoryPoint(2090, 156.657740269082), + TrajectoryPoint(2100, 155.489977446603), + TrajectoryPoint(2110, 154.32254751535), + TrajectoryPoint(2120, 153.15535425255), + TrajectoryPoint(2130, 151.988303948374), + TrajectoryPoint(2140, 150.821263619928), + TrajectoryPoint(2150, 149.654136707765), + TrajectoryPoint(2160, 148.486773071518), + TrajectoryPoint(2170, 147.319096243477), + TrajectoryPoint(2180, 146.150999846985), + TrajectoryPoint(2190, 144.982284393243), + TrajectoryPoint(2200, 143.812936326501), + TrajectoryPoint(2210, 142.642769102394), + TrajectoryPoint(2220, 141.471657955035), + TrajectoryPoint(2230, 140.29957732363), + TrajectoryPoint(2240, 139.126194474418), + TrajectoryPoint(2250, 137.951626848167), + TrajectoryPoint(2260, 136.775521990485), + TrajectoryPoint(2270, 135.597931220103), + TrajectoryPoint(2280, 134.418575031138), + TrajectoryPoint(2290, 133.237427206995), + TrajectoryPoint(2300, 132.054245449953), + TrajectoryPoint(2310, 130.868993477077), + TrajectoryPoint(2320, 129.681380708125), + TrajectoryPoint(2330, 128.491462963946), + TrajectoryPoint(2340, 127.29878158649), + TrajectoryPoint(2350, 126.103555322264), + TrajectoryPoint(2360, 124.905199365246), + TrajectoryPoint(2370, 123.703878572772), + TrajectoryPoint(2380, 122.499332496652), + TrajectoryPoint(2390, 121.291187252911), + TrajectoryPoint(2400, 120.079573545391), + TrajectoryPoint(2410, 118.864084796267), + TrajectoryPoint(2420, 117.644458638743), + TrajectoryPoint(2430, 116.420727280176), + TrajectoryPoint(2440, 115.192636111983), + TrajectoryPoint(2450, 113.959591527332), + TrajectoryPoint(2460, 112.721731413502), + TrajectoryPoint(2470, 111.47879828715), + TrajectoryPoint(2480, 110.23052273138), + TrajectoryPoint(2490, 108.976456454561), + TrajectoryPoint(2500, 107.71635332425), + TrajectoryPoint(2510, 106.450049545112), + TrajectoryPoint(2520, 105.177227876324), + TrajectoryPoint(2530, 103.897556761321), + TrajectoryPoint(2540, 102.610689697048), + TrajectoryPoint(2550, 101.316264549047), + TrajectoryPoint(2560, 100.013902809863), + TrajectoryPoint(2570, 98.7032087978106), + TrajectoryPoint(2580, 97.3837687927682), + TrajectoryPoint(2590, 96.0551501052193), + TrajectoryPoint(2600, 94.716900074283), + TrajectoryPoint(2610, 93.3685449899809), + TrajectoryPoint(2620, 92.0095889344373), + TrajectoryPoint(2630, 90.6395124484391), + TrajectoryPoint(2640, 89.2572187318982), + TrajectoryPoint(2650, 87.862581508496), + TrajectoryPoint(2660, 86.4549940030764), + TrajectoryPoint(2670, 85.0335305868062), + TrajectoryPoint(2680, 83.5970927727158), + TrajectoryPoint(2690, 82.1455484584259), + TrajectoryPoint(2700, 80.6771556427043), + TrajectoryPoint(2710, 79.1916509544017), + TrajectoryPoint(2720, 77.6872909555235), + TrajectoryPoint(2730, 76.163738957513), + TrajectoryPoint(2740, 74.6184656851195), + TrajectoryPoint(2750, 73.0510754748262), + TrajectoryPoint(2760, 71.459872332512), + TrajectoryPoint(2770, 69.8428680765789), + TrajectoryPoint(2780, 68.1979091550507), + TrajectoryPoint(2790, 66.5232262890058), + TrajectoryPoint(2800, 64.8164000516915), + TrajectoryPoint(2810, 63.0747568314165), + TrajectoryPoint(2820, 61.2945513522541), + TrajectoryPoint(2830, 59.4729453065072), + TrajectoryPoint(2840, 57.6062912618706), + TrajectoryPoint(2850, 55.6884862340628), + TrajectoryPoint(2860, 53.7155800591687), + TrajectoryPoint(2870, 51.68018714336), + TrajectoryPoint(2880, 49.5744559436351), + TrajectoryPoint(2890, 47.3894780905454), + TrajectoryPoint(2900, 45.1124046159178), + TrajectoryPoint(2910, 42.7302276483715), + TrajectoryPoint(2920, 40.2224621095561), + TrajectoryPoint(2930, 37.5651630169491), + TrajectoryPoint(2940, 34.7226016548474), + TrajectoryPoint(2950, 31.6459192808035), + TrajectoryPoint(2960, 28.2589838686706), + TrajectoryPoint(2970, 24.4308656853732), + TrajectoryPoint(2980, 19.9118159403811), + TrajectoryPoint(2990, 14.0504335610825), TrajectoryPoint(3000, 0), }; TrajectoryPoint t5_open[] = { - TrajectoryPoint(0, 495.893395461229), - TrajectoryPoint(10, 493.810993067849), - TrajectoryPoint(20, 491.723623806074), - TrajectoryPoint(30, 489.627258378458), - TrajectoryPoint(40, 487.530892950843), - TrajectoryPoint(50, 485.418249444041), - TrajectoryPoint(60, 483.303921136716), - TrajectoryPoint(70, 481.180740058117), - TrajectoryPoint(80, 479.04805822962), - TrajectoryPoint(90, 476.913799276504), - TrajectoryPoint(100, 474.762361567924), - TrajectoryPoint(110, 472.610923859345), - TrajectoryPoint(120, 470.445848776917), - TrajectoryPoint(130, 468.275240632425), - TrajectoryPoint(140, 466.097495740579), - TrajectoryPoint(150, 463.907289903251), - TrajectoryPoint(160, 461.716234446234), - TrajectoryPoint(170, 459.505990427636), - TrajectoryPoint(180, 457.295746409038), - TrajectoryPoint(190, 455.070214214563), - TrajectoryPoint(200, 452.839477736434), - TrajectoryPoint(210, 450.598784057996), - TrajectoryPoint(220, 448.347086464256), - TrajectoryPoint(230, 446.090470909099), - TrajectoryPoint(240, 443.81732854626), - TrajectoryPoint(250, 441.543991076714), - TrajectoryPoint(260, 439.248904640641), - TrajectoryPoint(270, 436.953818204568), - TrajectoryPoint(280, 434.640457089716), - TrajectoryPoint(290, 432.322910936517), - TrajectoryPoint(300, 429.990566697908), - TrajectoryPoint(310, 427.650028116558), - TrajectoryPoint(320, 425.297749292189), - TrajectoryPoint(330, 422.933667736322), - TrajectoryPoint(340, 420.560452047679), - TrajectoryPoint(350, 418.172258323749), - TrajectoryPoint(360, 415.777049559525), - TrajectoryPoint(370, 413.36415496834), - TrajectoryPoint(380, 410.945839640421), - TrajectoryPoint(390, 408.507635068793), - TrajectoryPoint(400, 406.065038821181), - TrajectoryPoint(410, 403.600893780176), - TrajectoryPoint(420, 401.132777529652), - TrajectoryPoint(430, 398.64203913562), - TrajectoryPoint(440, 396.147094920836), - TrajectoryPoint(450, 393.629086815097), - TrajectoryPoint(460, 391.105933328478), - TrajectoryPoint(470, 388.559954531165), - TrajectoryPoint(480, 386.00713230542), - TrajectoryPoint(490, 383.432455998614), - TrajectoryPoint(500, 380.84842221676), - TrajectoryPoint(510, 378.244294451611), - TrajectoryPoint(520, 375.627417346211), - TrajectoryPoint(530, 372.99305566828), - TrajectoryPoint(540, 370.341608472009), - TrajectoryPoint(550, 367.676200458531), - TrajectoryPoint(560, 364.988354864159), - TrajectoryPoint(570, 362.29105656638), - TrajectoryPoint(580, 359.564875649757), - TrajectoryPoint(590, 356.877812546097), - TrajectoryPoint(600, 354.660563862069), - TrajectoryPoint(610, 352.453533239782), - TrajectoryPoint(620, 350.269419346282), - TrajectoryPoint(630, 348.103545396908), - TrajectoryPoint(640, 345.952455029112), - TrajectoryPoint(650, 343.828092339714), - TrajectoryPoint(660, 341.712919882817), - TrajectoryPoint(670, 339.62705603907), - TrajectoryPoint(680, 337.553860465795), - TrajectoryPoint(690, 335.50000019761), - TrajectoryPoint(700, 333.468581549406), - TrajectoryPoint(710, 331.447650000944), - TrajectoryPoint(720, 329.456195105124), - TrajectoryPoint(730, 327.476765906696), - TrajectoryPoint(740, 325.515599925019), - TrajectoryPoint(750, 323.577059166331), - TrajectoryPoint(760, 321.649748978644), - TrajectoryPoint(770, 319.747133871286), - TrajectoryPoint(780, 317.859873109628), - TrajectoryPoint(790, 315.985467757623), - TrajectoryPoint(800, 314.137366949025), - TrajectoryPoint(810, 312.300733409882), - TrajectoryPoint(820, 310.480540575317), - TrajectoryPoint(830, 308.681845346624), - TrajectoryPoint(840, 306.894793272802), - TrajectoryPoint(850, 305.125836379044), - TrajectoryPoint(860, 303.375332776532), - TrajectoryPoint(870, 301.636496455236), - TrajectoryPoint(880, 299.915817905577), - TrajectoryPoint(890, 298.212022324272), - TrajectoryPoint(900, 296.519788693651), - TrajectoryPoint(910, 294.844499327861), - TrajectoryPoint(920, 293.18572430559), - TrajectoryPoint(930, 291.538299698869), - TrajectoryPoint(940, 289.905611954089), - TrajectoryPoint(950, 288.290025587958), - TrajectoryPoint(960, 286.685493997892), - TrajectoryPoint(970, 285.092742847463), - TrajectoryPoint(980, 283.518420003648), - TrajectoryPoint(990, 281.954792051268), - TrajectoryPoint(1000, 280.401959270446), - TrajectoryPoint(1010, 278.864411855548), - TrajectoryPoint(1020, 277.339664710456), - TrajectoryPoint(1030, 275.82527021877), - TrajectoryPoint(1040, 274.321595674167), - TrajectoryPoint(1050, 272.833704738262), - TrajectoryPoint(1060, 271.355697852343), - TrajectoryPoint(1070, 269.887589924874), - TrajectoryPoint(1080, 268.430679185858), - TrajectoryPoint(1090, 266.987042898227), - TrajectoryPoint(1100, 265.552801260825), - TrajectoryPoint(1110, 264.127932156465), - TrajectoryPoint(1120, 262.713333334318), - TrajectoryPoint(1130, 261.310988794171), - TrajectoryPoint(1140, 259.917496619146), - TrajectoryPoint(1150, 258.532808025578), - TrajectoryPoint(1160, 257.156862572419), - TrajectoryPoint(1170, 255.792485031092), - TrajectoryPoint(1180, 254.436757364152), - TrajectoryPoint(1190, 253.08924445696), - TrajectoryPoint(1200, 251.749870042421), - TrajectoryPoint(1210, 250.419011150129), - TrajectoryPoint(1220, 249.098143264294), - TrajectoryPoint(1230, 247.784897883706), - TrajectoryPoint(1240, 246.479188562563), - TrajectoryPoint(1250, 245.180922802817), - TrajectoryPoint(1260, 243.890002741704), - TrajectoryPoint(1270, 242.608114697835), - TrajectoryPoint(1280, 241.333298514383), - TrajectoryPoint(1290, 240.065331308404), - TrajectoryPoint(1300, 238.804112153356), - TrajectoryPoint(1310, 237.54953665173), - TrajectoryPoint(1320, 236.301497399213), - TrajectoryPoint(1330, 235.061131748147), - TrajectoryPoint(1340, 233.827033279834), - TrajectoryPoint(1350, 232.599005165637), - TrajectoryPoint(1360, 231.376941151161), - TrajectoryPoint(1370, 230.160733174253), - TrajectoryPoint(1380, 228.950271672266), - TrajectoryPoint(1390, 227.745445862251), - TrajectoryPoint(1400, 226.546662123896), - TrajectoryPoint(1410, 225.35352298062), - TrajectoryPoint(1420, 224.165593878836), - TrajectoryPoint(1430, 222.982767951493), - TrajectoryPoint(1440, 221.804937764672), - TrajectoryPoint(1450, 220.631995499108), - TrajectoryPoint(1460, 219.463833114491), - TrajectoryPoint(1470, 218.300342497839), - TrajectoryPoint(1480, 217.141415597213), - TrajectoryPoint(1490, 215.98694454189), - TrajectoryPoint(1500, 214.83686129325), - TrajectoryPoint(1510, 213.691290814749), - TrajectoryPoint(1520, 212.549807517293), - TrajectoryPoint(1530, 211.41230900981), - TrajectoryPoint(1540, 210.278693285792), - TrajectoryPoint(1550, 209.148858796874), - TrajectoryPoint(1560, 208.022704517951), - TrajectoryPoint(1570, 206.900130004505), - TrajectoryPoint(1580, 205.781035442789), - TrajectoryPoint(1590, 204.66532169343), - TrajectoryPoint(1600, 203.552890329003), - TrajectoryPoint(1610, 202.443643666062), - TrajectoryPoint(1620, 201.337484792092), - TrajectoryPoint(1630, 200.234317587797), - TrajectoryPoint(1640, 199.134046745126), - TrajectoryPoint(1650, 198.036577781376), - TrajectoryPoint(1660, 196.941817049718), - TrajectoryPoint(1670, 195.849671746449), - TrajectoryPoint(1680, 194.760049915236), - TrajectoryPoint(1690, 193.672860448629), - TrajectoryPoint(1700, 192.588013087064), - TrajectoryPoint(1710, 191.505418415587), - TrajectoryPoint(1720, 190.424987858486), - TrajectoryPoint(1730, 189.346633672029), - TrajectoryPoint(1740, 188.270268935464), - TrajectoryPoint(1750, 187.195807540446), - TrajectoryPoint(1760, 186.123164179032), - TrajectoryPoint(1770, 185.052358205946), - TrajectoryPoint(1780, 183.983204984588), - TrajectoryPoint(1790, 182.915613568121), - TrajectoryPoint(1800, 181.849500894911), - TrajectoryPoint(1810, 180.784784663588), - TrajectoryPoint(1820, 179.721383312216), - TrajectoryPoint(1830, 178.659215996897), - TrajectoryPoint(1840, 177.598202569869), - TrajectoryPoint(1850, 176.538263557143), - TrajectoryPoint(1860, 175.479363769597), - TrajectoryPoint(1870, 174.421427705209), - TrajectoryPoint(1880, 173.364318661386), - TrajectoryPoint(1890, 172.307959128872), - TrajectoryPoint(1900, 171.252272170697), - TrajectoryPoint(1910, 170.197181396571), - TrajectoryPoint(1920, 169.142619283827), - TrajectoryPoint(1930, 168.088542697927), - TrajectoryPoint(1940, 167.034819310001), - TrajectoryPoint(1950, 165.981374273152), - TrajectoryPoint(1960, 164.928133163716), - TrajectoryPoint(1970, 163.875023027652), - TrajectoryPoint(1980, 162.82196422019), - TrajectoryPoint(1990, 161.768868610692), - TrajectoryPoint(2000, 160.715662863601), - TrajectoryPoint(2010, 159.66227393177), - TrajectoryPoint(2020, 158.608578090986), - TrajectoryPoint(2030, 157.554527852596), - TrajectoryPoint(2040, 156.500054501047), - TrajectoryPoint(2050, 155.445065091192), - TrajectoryPoint(2060, 154.389409065964), - TrajectoryPoint(2070, 153.333088921158), - TrajectoryPoint(2080, 152.276032204878), - TrajectoryPoint(2090, 151.218019301767), - TrajectoryPoint(2100, 150.159076943771), - TrajectoryPoint(2110, 149.099154970456), - TrajectoryPoint(2120, 148.037992273448), - TrajectoryPoint(2130, 146.975637471456), - TrajectoryPoint(2140, 145.912053252946), - TrajectoryPoint(2150, 144.846879976045), - TrajectoryPoint(2160, 143.780305379313), - TrajectoryPoint(2170, 142.712114332152), - TrajectoryPoint(2180, 141.642147562469), - TrajectoryPoint(2190, 140.570525911569), - TrajectoryPoint(2200, 139.496770987418), - TrajectoryPoint(2210, 138.421166027237), - TrajectoryPoint(2220, 137.343327739557), - TrajectoryPoint(2230, 136.26331632478), - TrajectoryPoint(2240, 135.18093363586), - TrajectoryPoint(2250, 134.096080328852), - TrajectoryPoint(2260, 133.008666839912), - TrajectoryPoint(2270, 131.918522966773), - TrajectoryPoint(2280, 130.825566111821), - TrajectoryPoint(2290, 129.729668710133), - TrajectoryPoint(2300, 128.630628706097), - TrajectoryPoint(2310, 127.528499364839), - TrajectoryPoint(2320, 126.422807924827), - TrajectoryPoint(2330, 125.31385881044), - TrajectoryPoint(2340, 124.201010328155), - TrajectoryPoint(2350, 123.084487642166), - TrajectoryPoint(2360, 121.964092598988), - TrajectoryPoint(2370, 120.839345574661), - TrajectoryPoint(2380, 119.710494607687), - TrajectoryPoint(2390, 118.577200943165), - TrajectoryPoint(2400, 117.43905953008), - TrajectoryPoint(2410, 116.29623314359), - TrajectoryPoint(2420, 115.148512102922), - TrajectoryPoint(2430, 113.995299524828), - TrajectoryPoint(2440, 112.836685381886), - TrajectoryPoint(2450, 111.672505495286), - TrajectoryPoint(2460, 110.502514162983), - TrajectoryPoint(2470, 109.326363229242), - TrajectoryPoint(2480, 108.143654313685), - TrajectoryPoint(2490, 106.954358774437), - TrajectoryPoint(2500, 105.758189111665), - TrajectoryPoint(2510, 104.55484535341), - TrajectoryPoint(2520, 103.344014485055), - TrajectoryPoint(2530, 102.125369835799), - TrajectoryPoint(2540, 100.898570419754), - TrajectoryPoint(2550, 99.6632602289389), - TrajectoryPoint(2560, 98.4190674752137), - TrajectoryPoint(2570, 97.1656037778128), - TrajectoryPoint(2580, 95.9024632928412), - TrajectoryPoint(2590, 94.6292217806866), - TrajectoryPoint(2600, 93.345435606903), - TrajectoryPoint(2610, 92.0506406716688), - TrajectoryPoint(2620, 90.7443512624303), - TrajectoryPoint(2630, 89.4255547962579), - TrajectoryPoint(2640, 88.0940641243211), - TrajectoryPoint(2650, 86.7493680635676), - TrajectoryPoint(2660, 85.3907031603099), - TrajectoryPoint(2670, 84.0167941204665), - TrajectoryPoint(2680, 82.6276698469137), - TrajectoryPoint(2690, 81.221873828954), - TrajectoryPoint(2700, 79.7987759172389), - TrajectoryPoint(2710, 78.3572557497955), - TrajectoryPoint(2720, 76.8963964307387), - TrajectoryPoint(2730, 75.4145537036169), - TrajectoryPoint(2740, 73.9111164894967), - TrajectoryPoint(2750, 72.3841686044142), - TrajectoryPoint(2760, 70.8319808913), - TrajectoryPoint(2770, 69.2532194288865), - TrajectoryPoint(2780, 67.6458667832983), - TrajectoryPoint(2790, 66.0077138236099), - TrajectoryPoint(2800, 64.3363373571012), - TrajectoryPoint(2810, 62.6290744844389), - TrajectoryPoint(2820, 60.8829931051843), - TrajectoryPoint(2830, 59.0938465540543), - TrajectoryPoint(2840, 57.2582300062206), - TrajectoryPoint(2850, 55.3713949995749), - TrajectoryPoint(2860, 53.4278724266371), - TrajectoryPoint(2870, 51.4204596199541), - TrajectoryPoint(2880, 49.3420889863206), - TrajectoryPoint(2890, 47.1832671991707), - TrajectoryPoint(2900, 44.9318026426547), - TrajectoryPoint(2910, 42.5731755042324), - TrajectoryPoint(2920, 40.0883399270314), - TrajectoryPoint(2930, 37.4525610208921), - TrajectoryPoint(2940, 34.6306271992805), - TrajectoryPoint(2950, 31.5729908812172), - TrajectoryPoint(2960, 28.2039041437284), - TrajectoryPoint(2970, 24.3918452395342), - TrajectoryPoint(2980, 19.8875726102464), - TrajectoryPoint(2990, 14.0393472693167), + TrajectoryPoint(0, 542.02118045862), + TrajectoryPoint(10, 540.105773418912), + TrajectoryPoint(20, 538.190366379203), + TrajectoryPoint(30, 536.268506692496), + TrajectoryPoint(40, 534.339389856164), + TrajectoryPoint(50, 532.410273019832), + TrajectoryPoint(60, 530.469535282931), + TrajectoryPoint(70, 528.525849863138), + TrajectoryPoint(80, 526.579928741814), + TrajectoryPoint(90, 524.621381472786), + TrajectoryPoint(100, 522.662834203757), + TrajectoryPoint(110, 520.696267266089), + TrajectoryPoint(120, 518.722556946989), + TrajectoryPoint(130, 516.748846627889), + TrajectoryPoint(140, 514.760700429556), + TrajectoryPoint(150, 512.771517630084), + TrajectoryPoint(160, 510.776607595884), + TrajectoryPoint(170, 508.77163434816), + TrajectoryPoint(180, 506.766661100435), + TrajectoryPoint(190, 504.748504906177), + TrajectoryPoint(200, 502.727414382136), + TrajectoryPoint(210, 500.701409916175), + TrajectoryPoint(220, 498.663866089654), + TrajectoryPoint(230, 496.626322263132), + TrajectoryPoint(240, 494.575258470424), + TrajectoryPoint(250, 492.52091576305), + TrajectoryPoint(260, 490.460803211927), + TrajectoryPoint(270, 488.389306121874), + TrajectoryPoint(280, 486.317809031822), + TrajectoryPoint(290, 484.230662678696), + TrajectoryPoint(300, 482.141645391302), + TrajectoryPoint(310, 480.044120765041), + TrajectoryPoint(320, 477.937206744206), + TrajectoryPoint(330, 475.828780027156), + TrajectoryPoint(340, 473.703581586381), + TrajectoryPoint(350, 471.578383145607), + TrajectoryPoint(360, 469.439820498331), + TrajectoryPoint(370, 467.295938350163), + TrajectoryPoint(380, 465.144934233764), + TrajectoryPoint(390, 462.981957016319), + TrajectoryPoint(400, 460.817891689851), + TrajectoryPoint(410, 458.635395469025), + TrajectoryPoint(420, 456.452899248199), + TrajectoryPoint(430, 454.255165496433), + TrajectoryPoint(440, 452.052713242258), + TrajectoryPoint(450, 449.840132029618), + TrajectoryPoint(460, 447.617273065152), + TrajectoryPoint(470, 445.389110674235), + TrajectoryPoint(480, 443.14538009524), + TrajectoryPoint(490, 440.900865083025), + TrajectoryPoint(500, 438.635783146542), + TrajectoryPoint(510, 436.37070121006), + TrajectoryPoint(520, 434.08717563691), + TrajectoryPoint(530, 431.800247116718), + TrajectoryPoint(540, 429.498192569663), + TrajectoryPoint(550, 427.188906076439), + TrajectoryPoint(560, 424.867407314249), + TrajectoryPoint(570, 422.535234578092), + TrajectoryPoint(580, 420.193328170168), + TrajectoryPoint(590, 417.837723282952), + TrajectoryPoint(600, 415.474394696992), + TrajectoryPoint(610, 413.094793311811), + TrajectoryPoint(620, 410.708973791707), + TrajectoryPoint(630, 408.304792276481), + TrajectoryPoint(640, 405.895355492907), + TrajectoryPoint(650, 403.465990034941), + TrajectoryPoint(660, 401.031748489412), + TrajectoryPoint(670, 398.576574147474), + TrajectoryPoint(680, 396.116275308767), + TrajectoryPoint(690, 393.634645008939), + TrajectoryPoint(700, 391.146967158732), + TrajectoryPoint(710, 388.638210629985), + TrajectoryPoint(720, 386.121758392237), + TrajectoryPoint(730, 383.58518103734), + TrajectoryPoint(740, 381.038480563388), + TrajectoryPoint(750, 378.473362260374), + TrajectoryPoint(760, 375.894856038881), + TrajectoryPoint(770, 373.300449867876), + TrajectoryPoint(780, 370.688491125552), + TrajectoryPoint(790, 368.06402201533), + TrajectoryPoint(800, 365.416868670841), + TrajectoryPoint(810, 362.761531958943), + TrajectoryPoint(820, 360.077340088399), + TrajectoryPoint(830, 357.393130458234), + TrajectoryPoint(840, 354.731906305716), + TrajectoryPoint(850, 352.087965304871), + TrajectoryPoint(860, 349.478636946668), + TrajectoryPoint(870, 346.898781734415), + TrajectoryPoint(880, 344.340296450231), + TrajectoryPoint(890, 341.824005333524), + TrajectoryPoint(900, 339.322007970933), + TrajectoryPoint(910, 336.861730971183), + TrajectoryPoint(920, 334.422797858342), + TrajectoryPoint(930, 332.009757187409), + TrajectoryPoint(940, 329.632739485857), + TrajectoryPoint(950, 327.271718965952), + TrajectoryPoint(960, 324.949192361094), + TrajectoryPoint(970, 322.648631713951), + TrajectoryPoint(980, 320.369331500414), + TrajectoryPoint(990, 318.127631487569), + TrajectoryPoint(1000, 315.902598632226), + TrajectoryPoint(1010, 313.705643706718), + TrajectoryPoint(1020, 311.537341483319), + TrajectoryPoint(1030, 309.386130156114), + TrajectoryPoint(1040, 307.266086338847), + TrajectoryPoint(1050, 305.169175167914), + TrajectoryPoint(1060, 303.089457287445), + TrajectoryPoint(1070, 301.041034853097), + TrajectoryPoint(1080, 299.012986297137), + TrajectoryPoint(1090, 297.001968680765), + TrajectoryPoint(1100, 295.020097653113), + TrajectoryPoint(1110, 293.05800544292), + TrajectoryPoint(1120, 291.112573401252), + TrajectoryPoint(1130, 289.192450200845), + TrajectoryPoint(1140, 287.293158316086), + TrajectoryPoint(1150, 285.409998843082), + TrajectoryPoint(1160, 283.547111170383), + TrajectoryPoint(1170, 281.707321495451), + TrajectoryPoint(1180, 279.88302388408), + TrajectoryPoint(1190, 278.074356837005), + TrajectoryPoint(1200, 276.289518658947), + TrajectoryPoint(1210, 274.520653425805), + TrajectoryPoint(1220, 272.766640025006), + TrajectoryPoint(1230, 271.029064526198), + TrajectoryPoint(1240, 269.312243078884), + TrajectoryPoint(1250, 267.609462520552), + TrajectoryPoint(1260, 265.920713927355), + TrajectoryPoint(1270, 264.247583259189), + TrajectoryPoint(1280, 262.592719621741), + TrajectoryPoint(1290, 260.951034293429), + TrajectoryPoint(1300, 259.322460177505), + TrajectoryPoint(1310, 257.70690603905), + TrajectoryPoint(1320, 256.109022680831), + TrajectoryPoint(1330, 254.523478207728), + TrajectoryPoint(1340, 252.950080019747), + TrajectoryPoint(1350, 251.388705300787), + TrajectoryPoint(1360, 249.840265315001), + TrajectoryPoint(1370, 248.30606387035), + TrajectoryPoint(1380, 246.783038707104), + TrajectoryPoint(1390, 245.271048472651), + TrajectoryPoint(1400, 243.76994078536), + TrajectoryPoint(1410, 242.279553749018), + TrajectoryPoint(1420, 240.802199107678), + TrajectoryPoint(1430, 239.335076730485), + TrajectoryPoint(1440, 237.877872169722), + TrajectoryPoint(1450, 236.430420361719), + TrajectoryPoint(1460, 234.992550692996), + TrajectoryPoint(1470, 233.564087945284), + TrajectoryPoint(1480, 232.145917392954), + TrajectoryPoint(1490, 230.737286012418), + TrajectoryPoint(1500, 229.337325405069), + TrajectoryPoint(1510, 227.945865330805), + TrajectoryPoint(1520, 226.562733230739), + TrajectoryPoint(1530, 225.187754804181), + TrajectoryPoint(1540, 223.820754524603), + TrajectoryPoint(1550, 222.46155610002), + TrajectoryPoint(1560, 221.110199433985), + TrajectoryPoint(1570, 219.766876637892), + TrajectoryPoint(1580, 218.430713140125), + TrajectoryPoint(1590, 217.101542824796), + TrajectoryPoint(1600, 215.779199741099), + TrajectoryPoint(1610, 214.463518374269), + TrajectoryPoint(1620, 213.154333884366), + TrajectoryPoint(1630, 211.851482315885), + TrajectoryPoint(1640, 210.554800780915), + TrajectoryPoint(1650, 209.264127618352), + TrajectoryPoint(1660, 207.979302531443), + TrajectoryPoint(1670, 206.700166705725), + TrajectoryPoint(1680, 205.42656290926), + TrajectoryPoint(1690, 204.15833557689), + TrajectoryPoint(1700, 202.895330880056), + TrajectoryPoint(1710, 201.637396783626), + TrajectoryPoint(1720, 200.384383091018), + TrajectoryPoint(1730, 199.136141478785), + TrajectoryPoint(1740, 197.892525521736), + TrajectoryPoint(1750, 196.653390709557), + TrajectoryPoint(1760, 195.418594455818), + TrajectoryPoint(1770, 194.187996100141), + TrajectoryPoint(1780, 192.961456904279), + TrajectoryPoint(1790, 191.738840042735), + TrajectoryPoint(1800, 190.520010588521), + TrajectoryPoint(1810, 189.304835494601), + TrajectoryPoint(1820, 188.093183571487), + TrajectoryPoint(1830, 186.884925461441), + TrajectoryPoint(1840, 185.679933609663), + TrajectoryPoint(1850, 184.47808223284), + TrajectoryPoint(1860, 183.279247285361), + TrajectoryPoint(1870, 182.08330642351), + TrajectoryPoint(1880, 180.890138967869), + TrajectoryPoint(1890, 179.699829996657), + TrajectoryPoint(1900, 178.512072570015), + TrajectoryPoint(1910, 177.326725856204), + TrajectoryPoint(1920, 176.143674470683), + TrajectoryPoint(1930, 174.962804538307), + TrajectoryPoint(1940, 173.784003644992), + TrajectoryPoint(1950, 172.607160789118), + TrajectoryPoint(1960, 171.43226334729), + TrajectoryPoint(1970, 170.259210765561), + TrajectoryPoint(1980, 169.087772710496), + TrajectoryPoint(1990, 167.917842767548), + TrajectoryPoint(2000, 166.749315712426), + TrajectoryPoint(2010, 165.582095478697), + TrajectoryPoint(2020, 164.416224974463), + TrajectoryPoint(2030, 163.251425247058), + TrajectoryPoint(2040, 162.087594909068), + TrajectoryPoint(2050, 160.924633519144), + TrajectoryPoint(2060, 159.762511492801), + TrajectoryPoint(2070, 158.601079265012), + TrajectoryPoint(2080, 157.440193252505), + TrajectoryPoint(2090, 156.279755949658), + TrajectoryPoint(2100, 155.119709073079), + TrajectoryPoint(2110, 153.95989877611), + TrajectoryPoint(2120, 152.800219443234), + TrajectoryPoint(2130, 151.640569503904), + TrajectoryPoint(2140, 150.480830625753), + TrajectoryPoint(2150, 149.320906847571), + TrajectoryPoint(2160, 148.160669111148), + TrajectoryPoint(2170, 146.99999078215), + TrajectoryPoint(2180, 145.838812308949), + TrajectoryPoint(2190, 144.676940570006), + TrajectoryPoint(2200, 143.514302400971), + TrajectoryPoint(2210, 142.350827919667), + TrajectoryPoint(2220, 141.186236604976), + TrajectoryPoint(2230, 140.020604931155), + TrajectoryPoint(2240, 138.853636694727), + TrajectoryPoint(2250, 137.685321993964), + TrajectoryPoint(2260, 136.515483855545), + TrajectoryPoint(2270, 135.343969271616), + TrajectoryPoint(2280, 134.170718093474), + TrajectoryPoint(2290, 132.995474590339), + TrajectoryPoint(2300, 131.818236994599), + TrajectoryPoint(2310, 130.638722162598), + TrajectoryPoint(2320, 129.456893894955), + TrajectoryPoint(2330, 128.272550602748), + TrajectoryPoint(2340, 127.085495506552), + TrajectoryPoint(2350, 125.895750405608), + TrajectoryPoint(2360, 124.7027990321), + TrajectoryPoint(2370, 123.506877563663), + TrajectoryPoint(2380, 122.307508789565), + TrajectoryPoint(2390, 121.104607999419), + TrajectoryPoint(2400, 119.898167599468), + TrajectoryPoint(2410, 118.68762594854), + TrajectoryPoint(2420, 117.473020456795), + TrajectoryPoint(2430, 116.254238352226), + TrajectoryPoint(2440, 115.030872171887), + TrajectoryPoint(2450, 113.802626752491), + TrajectoryPoint(2460, 112.569494504433), + TrajectoryPoint(2470, 111.331217710603), + TrajectoryPoint(2480, 110.087516573462), + TrajectoryPoint(2490, 108.837820210297), + TrajectoryPoint(2500, 107.582155686024), + TrajectoryPoint(2510, 106.320219444554), + TrajectoryPoint(2520, 105.051694242525), + TrajectoryPoint(2530, 103.776248565658), + TrajectoryPoint(2540, 102.493535993676), + TrajectoryPoint(2550, 101.203194511561), + TrajectoryPoint(2560, 99.9048457645557), + TrajectoryPoint(2570, 98.5980942539034), + TrajectoryPoint(2580, 97.282526469965), + TrajectoryPoint(2590, 95.9577099588694), + TrajectoryPoint(2600, 94.6231923184212), + TrajectoryPoint(2610, 93.2785001184742), + TrajectoryPoint(2620, 91.923137740441), + TrajectoryPoint(2630, 90.556586130021), + TrajectoryPoint(2640, 89.1778756927169), + TrajectoryPoint(2650, 87.7866213826516), + TrajectoryPoint(2660, 86.3823486681054), + TrajectoryPoint(2670, 84.9642541777382), + TrajectoryPoint(2680, 83.5309898800393), + TrajectoryPoint(2690, 82.082551966338), + TrajectoryPoint(2700, 80.6173111120633), + TrajectoryPoint(2710, 79.1347728219368), + TrajectoryPoint(2720, 77.6334200502711), + TrajectoryPoint(2730, 76.1127045303928), + TrajectoryPoint(2740, 74.5702838958959), + TrajectoryPoint(2750, 73.0056823294134), + TrajectoryPoint(2760, 71.4171941113723), + TrajectoryPoint(2770, 69.8027343655081), + TrajectoryPoint(2780, 68.1603439334909), + TrajectoryPoint(2790, 66.4881552365525), + TrajectoryPoint(2800, 64.7837486140094), + TrajectoryPoint(2810, 63.0444635802309), + TrajectoryPoint(2820, 61.2665940850842), + TrajectoryPoint(2830, 59.4471786820857), + TrajectoryPoint(2840, 57.5826402714871), + TrajectoryPoint(2850, 55.6669441789419), + TrajectoryPoint(2860, 53.6960644558068), + TrajectoryPoint(2870, 51.6625508139959), + TrajectoryPoint(2880, 49.5586811650867), + TrajectoryPoint(2890, 47.3755130126341), + TrajectoryPoint(2900, 45.1001496778362), + TrajectoryPoint(2910, 42.719573600087), + TrajectoryPoint(2920, 40.2133658875325), + TrajectoryPoint(2930, 37.5575284331785), + TrajectoryPoint(2940, 34.7163673997412), + TrajectoryPoint(2950, 31.6409776146625), + TrajectoryPoint(2960, 28.2552529719592), + TrajectoryPoint(2970, 24.4282237448255), + TrajectoryPoint(2980, 19.9101753790627), + TrajectoryPoint(2990, 14.0496838955429), TrajectoryPoint(3000, 0), }; TrajectoryPoint t6_open[] = { - TrajectoryPoint(0, 491.462437549768), - TrajectoryPoint(10, 489.379712617304), - TrajectoryPoint(20, 487.292182881464), - TrajectoryPoint(30, 485.195308275166), - TrajectoryPoint(40, 483.098433668869), - TrajectoryPoint(50, 480.985124362365), - TrajectoryPoint(60, 478.870234647171), - TrajectoryPoint(70, 476.745950078586), - TrajectoryPoint(80, 474.612653518557), - TrajectoryPoint(90, 472.476838243683), - TrajectoryPoint(100, 470.324731338337), - TrajectoryPoint(110, 468.172624432992), - TrajectoryPoint(120, 466.005468776384), - TrajectoryPoint(130, 463.834135778838), - TrajectoryPoint(140, 461.65382405153), - TrajectoryPoint(150, 459.462836461792), - TrajectoryPoint(160, 457.268710736369), - TrajectoryPoint(170, 455.057626768234), - TrajectoryPoint(180, 452.846542800098), - TrajectoryPoint(190, 450.617359442783), - TrajectoryPoint(200, 448.385723462656), - TrajectoryPoint(210, 446.140837174581), - TrajectoryPoint(220, 443.888179110438), - TrajectoryPoint(230, 441.626809920875), - TrajectoryPoint(240, 439.352644639431), - TrajectoryPoint(250, 437.073972055534), - TrajectoryPoint(260, 434.777798705549), - TrajectoryPoint(270, 432.480959329006), - TrajectoryPoint(280, 430.162260648487), - TrajectoryPoint(290, 427.843561967967), - TrajectoryPoint(300, 425.504587209956), - TrajectoryPoint(310, 423.162828794852), - TrajectoryPoint(320, 420.803269030112), - TrajectoryPoint(330, 418.437898561902), - TrajectoryPoint(340, 416.056726904515), - TrajectoryPoint(350, 413.667173333887), - TrajectoryPoint(360, 411.263307782365), - TrajectoryPoint(370, 408.848980465945), - TrajectoryPoint(380, 406.421280484921), - TrajectoryPoint(390, 403.981568271791), - TrajectoryPoint(400, 401.528831121062), - TrajectoryPoint(410, 399.063101385507), - TrajectoryPoint(420, 396.584058174739), - TrajectoryPoint(430, 394.091655791379), - TrajectoryPoint(440, 391.584967236608), - TrajectoryPoint(450, 389.06521349376), - TrajectoryPoint(460, 386.529465349485), - TrajectoryPoint(470, 383.981656796214), - TrajectoryPoint(480, 381.415354934194), - TrajectoryPoint(490, 378.838762156147), - TrajectoryPoint(500, 376.240327259089), - TrajectoryPoint(510, 373.634193577772), - TrajectoryPoint(520, 371.001955412785), - TrajectoryPoint(530, 368.365288319669), - TrajectoryPoint(540, 365.697686735469), - TrajectoryPoint(550, 363.024425049035), - TrajectoryPoint(560, 360.324834659557), - TrajectoryPoint(570, 357.808821406912), - TrajectoryPoint(580, 355.603230874743), - TrajectoryPoint(590, 353.416686222753), - TrajectoryPoint(600, 351.24346987129), - TrajectoryPoint(610, 349.096897323424), - TrajectoryPoint(620, 346.958552408028), - TrajectoryPoint(630, 344.849789732894), - TrajectoryPoint(640, 342.752264375336), - TrajectoryPoint(650, 340.675343241069), - TrajectoryPoint(660, 338.618689890455), - TrajectoryPoint(670, 336.573222940984), - TrajectoryPoint(680, 334.557297568576), - TrajectoryPoint(690, 332.551327106871), - TrajectoryPoint(700, 330.567304717794), - TrajectoryPoint(710, 328.601864352275), - TrajectoryPoint(720, 326.647713871543), - TrajectoryPoint(730, 324.72225219659), - TrajectoryPoint(740, 322.807515758115), - TrajectoryPoint(750, 320.911194954742), - TrajectoryPoint(760, 319.035686994102), - TrajectoryPoint(770, 317.171380787399), - TrajectoryPoint(780, 315.330158137077), - TrajectoryPoint(790, 313.504066141523), - TrajectoryPoint(800, 311.689474913661), - TrajectoryPoint(810, 309.900502040529), - TrajectoryPoint(820, 308.122902829243), - TrajectoryPoint(830, 306.358974339333), - TrajectoryPoint(840, 304.617335759212), - TrajectoryPoint(850, 302.886986586766), - TrajectoryPoint(860, 301.170997114872), - TrajectoryPoint(870, 299.475179912819), - TrajectoryPoint(880, 297.790586310029), - TrajectoryPoint(890, 296.119719419639), - TrajectoryPoint(900, 294.468148168004), - TrajectoryPoint(910, 292.827627756767), - TrajectoryPoint(920, 291.199156396652), - TrajectoryPoint(930, 289.590103474277), - TrajectoryPoint(940, 287.991842642884), - TrajectoryPoint(950, 286.404529551622), - TrajectoryPoint(960, 284.834787639717), - TrajectoryPoint(970, 283.276889858344), - TrajectoryPoint(980, 281.729570741622), - TrajectoryPoint(990, 280.195925471571), - TrajectoryPoint(1000, 278.676451184232), - TrajectoryPoint(1010, 277.167143793967), - TrajectoryPoint(1020, 275.668055063775), - TrajectoryPoint(1030, 274.184304743214), - TrajectoryPoint(1040, 272.71102938647), - TrajectoryPoint(1050, 271.247505003057), - TrajectoryPoint(1060, 269.794379637349), - TrajectoryPoint(1070, 268.355181814537), - TrajectoryPoint(1080, 266.925254447926), - TrajectoryPoint(1090, 265.504584331959), - TrajectoryPoint(1100, 264.093762465101), - TrajectoryPoint(1110, 262.695515003384), - TrajectoryPoint(1120, 261.306024771372), - TrajectoryPoint(1130, 259.925250701435), - TrajectoryPoint(1140, 258.553139777871), - TrajectoryPoint(1150, 257.192576013266), - TrajectoryPoint(1160, 255.840625720184), - TrajectoryPoint(1170, 254.496826251001), - TrajectoryPoint(1180, 253.161107656844), - TrajectoryPoint(1190, 251.834115762726), - TrajectoryPoint(1200, 250.516873518626), - TrajectoryPoint(1210, 249.207209492411), - TrajectoryPoint(1220, 247.90504257648), - TrajectoryPoint(1230, 246.610285361939), - TrajectoryPoint(1240, 245.323200473145), - TrajectoryPoint(1250, 244.044944484838), - TrajectoryPoint(1260, 242.773610988068), - TrajectoryPoint(1270, 241.509107304524), - TrajectoryPoint(1280, 240.251336568219), - TrajectoryPoint(1290, 239.00019823826), - TrajectoryPoint(1300, 237.756168981327), - TrajectoryPoint(1310, 236.519356079147), - TrajectoryPoint(1320, 235.28871404392), - TrajectoryPoint(1330, 234.064141989958), - TrajectoryPoint(1340, 232.845536720993), - TrajectoryPoint(1350, 231.632793073893), - TrajectoryPoint(1360, 230.425804233165), - TrajectoryPoint(1370, 229.224941876566), - TrajectoryPoint(1380, 228.030002854653), - TrajectoryPoint(1390, 226.840393574009), - TrajectoryPoint(1400, 225.656010232137), - TrajectoryPoint(1410, 224.476748138883), - TrajectoryPoint(1420, 223.302501922764), - TrajectoryPoint(1430, 222.133165718442), - TrajectoryPoint(1440, 220.968633336768), - TrajectoryPoint(1450, 219.808798418717), - TrajectoryPoint(1460, 218.653687783351), - TrajectoryPoint(1470, 217.503351156827), - TrajectoryPoint(1480, 216.357336236767), - TrajectoryPoint(1490, 215.215541600524), - TrajectoryPoint(1500, 214.077865959229), - TrajectoryPoint(1510, 212.944208254951), - TrajectoryPoint(1520, 211.814467747675), - TrajectoryPoint(1530, 210.688544092908), - TrajectoryPoint(1540, 209.566337410641), - TrajectoryPoint(1550, 208.447748346367), - TrajectoryPoint(1560, 207.332678124779), - TrajectoryPoint(1570, 206.221028596742), - TrajectoryPoint(1580, 205.112702280078), - TrajectoryPoint(1590, 204.007602394669), - TrajectoryPoint(1600, 202.90563289234), - TrajectoryPoint(1610, 201.806698481948), - TrajectoryPoint(1620, 200.710704650078), - TrajectoryPoint(1630, 199.617557677701), - TrajectoryPoint(1640, 198.527164653146), - TrajectoryPoint(1650, 197.439433481671), - TrajectoryPoint(1660, 196.354272891944), - TrajectoryPoint(1670, 195.271592439683), - TrajectoryPoint(1680, 194.191302508698), - TrajectoryPoint(1690, 193.113314309558), - TrajectoryPoint(1700, 192.0375398761), - TrajectoryPoint(1710, 190.963892059942), - TrajectoryPoint(1720, 189.892284523207), - TrajectoryPoint(1730, 188.82263172959), - TrajectoryPoint(1740, 187.754848933928), - TrajectoryPoint(1750, 186.688852170404), - TrajectoryPoint(1760, 185.62455823951), - TrajectoryPoint(1770, 184.561884693882), - TrajectoryPoint(1780, 183.500749823105), - TrajectoryPoint(1790, 182.441092124742), - TrajectoryPoint(1800, 181.382898598308), - TrajectoryPoint(1810, 180.325995390523), - TrajectoryPoint(1820, 179.270302887053), - TrajectoryPoint(1830, 178.21574215079), - TrajectoryPoint(1840, 177.162234900164), - TrajectoryPoint(1850, 176.109703487055), - TrajectoryPoint(1860, 175.058070874361), - TrajectoryPoint(1870, 174.007260613263), - TrajectoryPoint(1880, 172.957273278608), - TrajectoryPoint(1890, 171.907945437882), - TrajectoryPoint(1900, 170.85919970078), - TrajectoryPoint(1910, 169.810961296547), - TrajectoryPoint(1920, 168.763155936466), - TrajectoryPoint(1930, 167.715713881046), - TrajectoryPoint(1940, 166.668582634656), - TrajectoryPoint(1950, 165.621646744611), - TrajectoryPoint(1960, 164.57483323541), - TrajectoryPoint(1970, 163.528069491258), - TrajectoryPoint(1980, 162.48127784464), - TrajectoryPoint(1990, 161.434367871891), - TrajectoryPoint(2000, 160.387271536359), - TrajectoryPoint(2010, 159.339917073519), - TrajectoryPoint(2020, 158.292215230168), - TrajectoryPoint(2030, 157.244045923679), - TrajectoryPoint(2040, 156.195382174117), - TrajectoryPoint(2050, 155.146152651484), - TrajectoryPoint(2060, 154.096201957997), - TrajectoryPoint(2070, 153.045475682509), - TrajectoryPoint(2080, 151.993945974813), - TrajectoryPoint(2090, 150.941470727309), - TrajectoryPoint(2100, 149.887915298549), - TrajectoryPoint(2110, 148.833316488452), - TrajectoryPoint(2120, 147.777504714374), - TrajectoryPoint(2130, 146.720338285409), - TrajectoryPoint(2140, 145.661885388165), - TrajectoryPoint(2150, 144.601874691968), - TrajectoryPoint(2160, 143.540297849069), - TrajectoryPoint(2170, 142.477159931246), - TrajectoryPoint(2180, 141.41206426564), - TrajectoryPoint(2190, 140.345257222658), - TrajectoryPoint(2200, 139.276374682147), - TrajectoryPoint(2210, 138.205462328844), - TrajectoryPoint(2220, 137.132384142624), - TrajectoryPoint(2230, 136.056946192636), - TrajectoryPoint(2240, 134.979211611432), - TrajectoryPoint(2250, 133.898815397383), - TrajectoryPoint(2260, 132.815938524625), - TrajectoryPoint(2270, 131.730138048489), - TrajectoryPoint(2280, 130.641606988911), - TrajectoryPoint(2290, 129.549941866577), - TrajectoryPoint(2300, 128.455217639162), - TrajectoryPoint(2310, 127.357211939182), - TrajectoryPoint(2320, 126.255727160004), - TrajectoryPoint(2330, 125.15088813489), - TrajectoryPoint(2340, 124.042045471977), - TrajectoryPoint(2350, 122.929571584419), - TrajectoryPoint(2360, 121.813032577904), - TrajectoryPoint(2370, 120.692227258067), - TrajectoryPoint(2380, 119.567267873082), - TrajectoryPoint(2390, 118.437673700185), - TrajectoryPoint(2400, 117.30331805144), - TrajectoryPoint(2410, 116.164227158845), - TrajectoryPoint(2420, 115.02012489874), - TrajectoryPoint(2430, 113.870472164399), - TrajectoryPoint(2440, 112.715438900117), - TrajectoryPoint(2450, 111.554789511499), - TrajectoryPoint(2460, 110.388278182147), - TrajectoryPoint(2470, 109.215422632291), - TrajectoryPoint(2480, 108.036091567496), - TrajectoryPoint(2490, 106.850123693671), - TrajectoryPoint(2500, 105.657231483005), - TrajectoryPoint(2510, 104.457114960015), - TrajectoryPoint(2520, 103.249461128895), - TrajectoryPoint(2530, 102.033943358115), - TrajectoryPoint(2540, 100.810220719813), - TrajectoryPoint(2550, 99.5779372812867), - TrajectoryPoint(2560, 98.336721345563), - TrajectoryPoint(2570, 97.0861846377244), - TrajectoryPoint(2580, 95.8259214333161), - TrajectoryPoint(2590, 94.5555076247842), - TrajectoryPoint(2600, 93.2744997214876), - TrajectoryPoint(2610, 91.9824337783719), - TrajectoryPoint(2620, 90.6788242479101), - TrajectoryPoint(2630, 89.3627645931361), - TrajectoryPoint(2640, 88.0338520938974), - TrajectoryPoint(2650, 86.6916854615471), - TrajectoryPoint(2660, 85.3356022780388), - TrajectoryPoint(2670, 83.9641210828783), - TrajectoryPoint(2680, 82.5773764191885), - TrajectoryPoint(2690, 81.1740049783589), - TrajectoryPoint(2700, 79.7531856090451), - TrajectoryPoint(2710, 78.3139848376293), - TrajectoryPoint(2720, 76.8553033971801), - TrajectoryPoint(2730, 75.3756741369541), - TrajectoryPoint(2740, 73.8743969486829), - TrajectoryPoint(2750, 72.3494739135721), - TrajectoryPoint(2760, 70.7993393961434), - TrajectoryPoint(2770, 69.2225768518375), - TrajectoryPoint(2780, 67.6171685312658), - TrajectoryPoint(2790, 65.9809050490019), - TrajectoryPoint(2800, 64.3113630153795), - TrajectoryPoint(2810, 62.60587938855), - TrajectoryPoint(2820, 60.8615219771788), - TrajectoryPoint(2830, 59.074103465051), - TrajectoryPoint(2840, 57.2400961559979), - TrajectoryPoint(2850, 55.3548690078386), - TrajectoryPoint(2860, 53.4128401051064), - TrajectoryPoint(2870, 51.4069128813601), - TrajectoryPoint(2880, 49.329964842355), - TrajectoryPoint(2890, 47.1725020336528), - TrajectoryPoint(2900, 44.92237268972), - TrajectoryPoint(2910, 42.5649719968482), - TrajectoryPoint(2920, 40.0813316665653), - TrajectoryPoint(2930, 37.4466751235382), - TrajectoryPoint(2940, 34.6258179202231), - TrajectoryPoint(2950, 31.5691761853542), - TrajectoryPoint(2960, 28.2010221004294), - TrajectoryPoint(2970, 24.3898027714716), - TrajectoryPoint(2980, 19.8863031618382), - TrajectoryPoint(2990, 14.0387664881145), + TrajectoryPoint(0, 538.119445348186), + TrajectoryPoint(10, 536.205094328917), + TrajectoryPoint(20, 534.290534978564), + TrajectoryPoint(30, 532.371942023411), + TrajectoryPoint(40, 530.44306755123), + TrajectoryPoint(50, 528.51419307905), + TrajectoryPoint(60, 526.576120104496), + TrajectoryPoint(70, 524.632644429235), + TrajectoryPoint(80, 522.68911304366), + TrajectoryPoint(90, 520.730742410969), + TrajectoryPoint(100, 518.772371778277), + TrajectoryPoint(110, 516.807877023956), + TrajectoryPoint(120, 514.834309724104), + TrajectoryPoint(130, 512.860742424252), + TrajectoryPoint(140, 510.874340576661), + TrajectoryPoint(150, 508.885266649222), + TrajectoryPoint(160, 506.891797158845), + TrajectoryPoint(170, 504.886898083614), + TrajectoryPoint(180, 502.881999008383), + TrajectoryPoint(190, 500.864934338713), + TrajectoryPoint(200, 498.84388271208), + TrajectoryPoint(210, 496.818645125821), + TrajectoryPoint(220, 494.781104321774), + TrajectoryPoint(230, 492.743563517728), + TrajectoryPoint(240, 490.692894750715), + TrajectoryPoint(250, 488.638518565592), + TrajectoryPoint(260, 486.578453921739), + TrajectoryPoint(270, 484.506886201767), + TrajectoryPoint(280, 482.435318481795), + TrajectoryPoint(290, 480.3478235197), + TrajectoryPoint(300, 478.258697770336), + TrajectoryPoint(310, 476.160453126862), + TrajectoryPoint(320, 474.053392102831), + TrajectoryPoint(330, 471.943861441464), + TrajectoryPoint(340, 469.818476716359), + TrajectoryPoint(350, 467.693091991253), + TrajectoryPoint(360, 465.552988399978), + TrajectoryPoint(370, 463.408879914176), + TrajectoryPoint(380, 461.255923554288), + TrajectoryPoint(390, 459.092679139855), + TrajectoryPoint(400, 456.926236130838), + TrajectoryPoint(410, 454.743431012014), + TrajectoryPoint(420, 452.560625893189), + TrajectoryPoint(430, 450.360031710381), + TrajectoryPoint(440, 448.157227978105), + TrajectoryPoint(450, 445.941329895287), + TrajectoryPoint(460, 443.718075954146), + TrajectoryPoint(470, 441.486124201858), + TrajectoryPoint(480, 439.24195418769), + TrajectoryPoint(490, 436.993160572553), + TrajectoryPoint(500, 434.727593738815), + TrajectoryPoint(510, 432.461129415748), + TrajectoryPoint(520, 430.173669486628), + TrajectoryPoint(530, 427.886209557509), + TrajectoryPoint(540, 425.578797065117), + TrajectoryPoint(550, 423.268931553191), + TrajectoryPoint(560, 420.941529594837), + TrajectoryPoint(570, 418.608729080914), + TrajectoryPoint(580, 416.260354194416), + TrajectoryPoint(590, 413.904071567041), + TrajectoryPoint(600, 411.533688254413), + TrajectoryPoint(610, 409.153357906263), + TrajectoryPoint(620, 406.75987545445), + TrajectoryPoint(630, 404.354912432679), + TrajectoryPoint(640, 401.937181502805), + TrajectoryPoint(650, 399.506980610115), + TrajectoryPoint(660, 397.063789575642), + TrajectoryPoint(670, 394.607724418625), + TrajectoryPoint(680, 392.137795430936), + TrajectoryPoint(690, 389.655217411921), + TrajectoryPoint(700, 387.157202169737), + TrajectoryPoint(710, 384.647439418074), + TrajectoryPoint(720, 382.119914614738), + TrajectoryPoint(730, 379.582270853095), + TrajectoryPoint(740, 377.02373327318), + TrajectoryPoint(750, 374.457486614058), + TrajectoryPoint(760, 371.866347847824), + TrajectoryPoint(770, 369.270749515063), + TrajectoryPoint(780, 366.645330256056), + TrajectoryPoint(790, 364.014789559044), + TrajectoryPoint(800, 361.358127113123), + TrajectoryPoint(810, 358.703131422186), + TrajectoryPoint(820, 356.051293367269), + TrajectoryPoint(830, 353.428014482226), + TrajectoryPoint(840, 350.827245101675), + TrajectoryPoint(850, 348.266357860693), + TrajectoryPoint(860, 345.718413771632), + TrajectoryPoint(870, 343.216749243608), + TrajectoryPoint(880, 340.731237132543), + TrajectoryPoint(890, 338.27745307485), + TrajectoryPoint(900, 335.853543237037), + TrajectoryPoint(910, 333.446440114114), + TrajectoryPoint(920, 331.083093286267), + TrajectoryPoint(930, 328.734937130129), + TrajectoryPoint(940, 326.417417558463), + TrajectoryPoint(950, 324.128532143866), + TrajectoryPoint(960, 321.855903239877), + TrajectoryPoint(970, 319.622749446742), + TrajectoryPoint(980, 317.407621508177), + TrajectoryPoint(990, 315.214666299663), + TrajectoryPoint(1000, 313.05534706795), + TrajectoryPoint(1010, 310.912504007031), + TrajectoryPoint(1020, 308.795998796764), + TrajectoryPoint(1030, 306.706684330653), + TrajectoryPoint(1040, 304.634026034128), + TrajectoryPoint(1050, 302.588814037682), + TrajectoryPoint(1060, 300.567190556922), + TrajectoryPoint(1070, 298.562136974186), + TrajectoryPoint(1080, 296.583255169647), + TrajectoryPoint(1090, 294.626614287391), + TrajectoryPoint(1100, 292.686243971688), + TrajectoryPoint(1110, 290.768973838452), + TrajectoryPoint(1120, 288.874337168528), + TrajectoryPoint(1130, 286.995508408113), + TrajectoryPoint(1140, 285.135404623243), + TrajectoryPoint(1150, 283.299630380216), + TrajectoryPoint(1160, 281.479081752298), + TrajectoryPoint(1170, 279.673918559876), + TrajectoryPoint(1180, 277.891854667294), + TrajectoryPoint(1190, 276.126285116119), + TrajectoryPoint(1200, 274.37537096128), + TrajectoryPoint(1210, 272.640609706793), + TrajectoryPoint(1220, 270.926740019032), + TrajectoryPoint(1230, 269.226756725245), + TrajectoryPoint(1240, 267.540667031325), + TrajectoryPoint(1250, 265.870458818264), + TrajectoryPoint(1260, 264.21817678435), + TrajectoryPoint(1270, 262.578968413911), + TrajectoryPoint(1280, 260.952779905438), + TrajectoryPoint(1290, 259.340208398198), + TrajectoryPoint(1300, 257.74477445064), + TrajectoryPoint(1310, 256.16152730063), + TrajectoryPoint(1320, 254.59037251333), + TrajectoryPoint(1330, 253.031197393451), + TrajectoryPoint(1340, 251.48606002133), + TrajectoryPoint(1350, 249.954085821563), + TrajectoryPoint(1360, 248.433263412805), + TrajectoryPoint(1370, 246.923459501674), + TrajectoryPoint(1380, 245.424529230805), + TrajectoryPoint(1390, 243.93754141676), + TrajectoryPoint(1400, 242.462582728336), + TrajectoryPoint(1410, 240.99770512685), + TrajectoryPoint(1420, 239.542756071533), + TrajectoryPoint(1430, 238.097576003876), + TrajectoryPoint(1440, 236.661999417732), + TrajectoryPoint(1450, 235.236713460939), + TrajectoryPoint(1460, 233.821627308438), + TrajectoryPoint(1470, 232.415409309355), + TrajectoryPoint(1480, 231.01789616709), + TrajectoryPoint(1490, 229.628921320931), + TrajectoryPoint(1500, 228.248315608708), + TrajectoryPoint(1510, 226.875907861872), + TrajectoryPoint(1520, 225.511525438799), + TrajectoryPoint(1530, 224.155935856371), + TrajectoryPoint(1540, 222.808016075224), + TrajectoryPoint(1550, 221.467473199024), + TrajectoryPoint(1560, 220.134143476164), + TrajectoryPoint(1570, 218.807862832101), + TrajectoryPoint(1580, 217.488467188636), + TrajectoryPoint(1590, 216.175792747048), + TrajectoryPoint(1600, 214.869676238384), + TrajectoryPoint(1610, 213.569955143904), + TrajectoryPoint(1620, 212.276467888465), + TrajectoryPoint(1630, 210.989054009336), + TrajectoryPoint(1640, 209.707554302783), + TrajectoryPoint(1650, 208.431810950504), + TrajectoryPoint(1660, 207.161843026109), + TrajectoryPoint(1670, 205.897313929897), + TrajectoryPoint(1680, 204.638030858019), + TrajectoryPoint(1690, 203.383847018441), + TrajectoryPoint(1700, 202.134617081588), + TrajectoryPoint(1710, 200.89019724371), + TrajectoryPoint(1720, 199.650445278725), + TrajectoryPoint(1730, 198.41522057967), + TrajectoryPoint(1740, 197.184384190764), + TrajectoryPoint(1750, 195.957798831024), + TrajectoryPoint(1760, 194.73532891026), + TrajectoryPoint(1770, 193.516840538238), + TrajectoryPoint(1780, 192.302201527682), + TrajectoryPoint(1790, 191.091406614411), + TrajectoryPoint(1800, 189.884227958328), + TrajectoryPoint(1810, 188.680518213252), + TrajectoryPoint(1820, 187.480150073621), + TrajectoryPoint(1830, 186.282997997174), + TrajectoryPoint(1840, 185.088938173798), + TrajectoryPoint(1850, 183.897848492197), + TrajectoryPoint(1860, 182.709608504651), + TrajectoryPoint(1870, 181.524099390124), + TrajectoryPoint(1880, 180.341203915924), + TrajectoryPoint(1890, 179.160806398123), + TrajectoryPoint(1900, 177.982792660923), + TrajectoryPoint(1910, 176.80721118323), + TrajectoryPoint(1920, 175.633837518563), + TrajectoryPoint(1930, 174.462500424752), + TrajectoryPoint(1940, 173.293090558583), + TrajectoryPoint(1950, 172.125499908925), + TrajectoryPoint(1960, 170.959621749222), + TrajectoryPoint(1970, 169.795372149046), + TrajectoryPoint(1980, 168.632788604881), + TrajectoryPoint(1990, 167.471584914263), + TrajectoryPoint(2000, 166.311658505242), + TrajectoryPoint(2010, 165.15290786996), + TrajectoryPoint(2020, 163.995240570085), + TrajectoryPoint(2030, 162.838675612083), + TrajectoryPoint(2040, 161.68296400246), + TrajectoryPoint(2050, 160.528007618055), + TrajectoryPoint(2060, 159.373709162812), + TrajectoryPoint(2070, 158.220038985904), + TrajectoryPoint(2080, 157.066822085908), + TrajectoryPoint(2090, 155.913948662897), + TrajectoryPoint(2100, 154.76132878011), + TrajectoryPoint(2110, 153.608867573279), + TrajectoryPoint(2120, 152.45643792577), + TrajectoryPoint(2130, 151.303946329848), + TrajectoryPoint(2140, 150.151254411979), + TrajectoryPoint(2150, 148.998280973509), + TrajectoryPoint(2160, 147.844935975414), + TrajectoryPoint(2170, 146.691015562638), + TrajectoryPoint(2180, 145.536502169374), + TrajectoryPoint(2190, 144.38126597718), + TrajectoryPoint(2200, 143.225105288478), + TrajectoryPoint(2210, 142.068043998246), + TrajectoryPoint(2220, 140.909811615242), + TrajectoryPoint(2230, 139.750393558568), + TrajectoryPoint(2240, 138.589647422066), + TrajectoryPoint(2250, 137.427371859128), + TrajectoryPoint(2260, 136.263598899541), + TrajectoryPoint(2270, 135.097953784508), + TrajectoryPoint(2280, 133.93061140105), + TrajectoryPoint(2290, 132.761072336464), + TrajectoryPoint(2300, 131.589588073146), + TrajectoryPoint(2310, 130.415617106245), + TrajectoryPoint(2320, 129.239387925398), + TrajectoryPoint(2330, 128.060432195606), + TrajectoryPoint(2340, 126.878823379721), + TrajectoryPoint(2350, 125.694313622835), + TrajectoryPoint(2360, 124.506657327262), + TrajectoryPoint(2370, 123.315962737973), + TrajectoryPoint(2380, 122.121599710261), + TrajectoryPoint(2390, 120.92377631921), + TrajectoryPoint(2400, 119.722303636678), + TrajectoryPoint(2410, 118.516587079409), + TrajectoryPoint(2420, 117.306842805213), + TrajectoryPoint(2430, 116.092852829607), + TrajectoryPoint(2440, 114.874057192054), + TrajectoryPoint(2450, 113.650459072354), + TrajectoryPoint(2460, 112.421905175015), + TrajectoryPoint(2470, 111.188137572518), + TrajectoryPoint(2480, 109.948727476085), + TrajectoryPoint(2490, 108.703398732872), + TrajectoryPoint(2500, 107.452033182162), + TrajectoryPoint(2510, 106.194327225856), + TrajectoryPoint(2520, 104.929963624861), + TrajectoryPoint(2530, 103.658610910943), + TrajectoryPoint(2540, 102.37992274765), + TrajectoryPoint(2550, 101.093537238024), + TrajectoryPoint(2560, 99.7990761764505), + TrajectoryPoint(2570, 98.4961442416053), + TrajectoryPoint(2580, 97.1843281270843), + TrajectoryPoint(2590, 95.8631956058448), + TrajectoryPoint(2600, 94.5322945241441), + TrajectoryPoint(2610, 93.1911517201587), + TrajectoryPoint(2620, 91.8392718619271), + TrajectoryPoint(2630, 90.476136198675), + TrajectoryPoint(2640, 89.1009000590957), + TrajectoryPoint(2650, 87.7129245082723), + TrajectoryPoint(2660, 86.311864714243), + TrajectoryPoint(2670, 84.8970369202214), + TrajectoryPoint(2680, 83.4668489307692), + TrajectoryPoint(2690, 82.0214224471652), + TrajectoryPoint(2700, 80.5592382818296), + TrajectoryPoint(2710, 79.0795760218273), + TrajectoryPoint(2720, 77.5811398208338), + TrajectoryPoint(2730, 76.0631658537748), + TrajectoryPoint(2740, 74.5235209555994), + TrajectoryPoint(2750, 72.9616243177144), + TrajectoryPoint(2760, 71.3757696309213), + TrajectoryPoint(2770, 69.763777759362), + TrajectoryPoint(2780, 68.1238790872176), + TrajectoryPoint(2790, 66.4541101672878), + TrajectoryPoint(2800, 64.7520511106252), + TrajectoryPoint(2810, 63.0150412900475), + TrajectoryPoint(2820, 61.2394516192204), + TrajectoryPoint(2830, 59.4221619574752), + TrajectoryPoint(2840, 57.5596766219413), + TrajectoryPoint(2850, 55.6460274226066), + TrajectoryPoint(2860, 53.6771146202396), + TrajectoryPoint(2870, 51.6454249963625), + TrajectoryPoint(2880, 49.5433624078868), + TrajectoryPoint(2890, 47.3619191872009), + TrajectoryPoint(2900, 45.088248089633), + TrajectoryPoint(2910, 42.7092262907382), + TrajectoryPoint(2920, 40.2045311975006), + TrajectoryPoint(2930, 37.5501130406701), + TrajectoryPoint(2940, 34.7103118822442), + TrajectoryPoint(2950, 31.6361774105155), + TrajectoryPoint(2960, 28.2516287068551), + TrajectoryPoint(2970, 24.4256571729961), + TrajectoryPoint(2980, 19.9085815202555), + TrajectoryPoint(2990, 14.0489555101715), TrajectoryPoint(3000, 0), }; TrajectoryPoint t7_open[] = { - TrajectoryPoint(0, 486.660814948149), - TrajectoryPoint(10, 484.596148511444), - TrajectoryPoint(20, 482.52584171389), - TrajectoryPoint(30, 480.447515471832), - TrajectoryPoint(40, 478.369038909708), - TrajectoryPoint(50, 476.273006098312), - TrajectoryPoint(60, 474.176973286915), - TrajectoryPoint(70, 472.06956262566), - TrajectoryPoint(80, 469.95544171111), - TrajectoryPoint(90, 467.836248290991), - TrajectoryPoint(100, 465.703646383332), - TrajectoryPoint(110, 463.571044475673), - TrajectoryPoint(120, 461.420599655275), - TrajectoryPoint(130, 459.269112047477), - TrajectoryPoint(140, 457.105272345394), - TrajectoryPoint(150, 454.93448202887), - TrajectoryPoint(160, 452.756591610395), - TrajectoryPoint(170, 450.566068765502), - TrajectoryPoint(180, 448.373438683061), - TrajectoryPoint(190, 446.162740143029), - TrajectoryPoint(200, 443.952041602997), - TrajectoryPoint(210, 441.723315153173), - TrajectoryPoint(220, 439.491983839771), - TrajectoryPoint(230, 437.246561303749), - TrajectoryPoint(240, 434.994125632891), - TrajectoryPoint(250, 432.731191860915), - TrajectoryPoint(260, 430.457165116247), - TrajectoryPoint(270, 428.175862910846), - TrajectoryPoint(280, 425.879742583239), - TrajectoryPoint(290, 423.579170226921), - TrajectoryPoint(300, 421.26043731761), - TrajectoryPoint(310, 418.93964592728), - TrajectoryPoint(320, 416.597764212217), - TrajectoryPoint(330, 414.25575490623), - TrajectoryPoint(340, 411.890170159039), - TrajectoryPoint(350, 409.524585411847), - TrajectoryPoint(360, 407.136030192172), - TrajectoryPoint(370, 404.746169362869), - TrajectoryPoint(380, 402.333643363933), - TrajectoryPoint(390, 399.918913710364), - TrajectoryPoint(400, 397.481228332273), - TrajectoryPoint(410, 395.041016500959), - TrajectoryPoint(420, 392.576918635716), - TrajectoryPoint(430, 390.110589688523), - TrajectoryPoint(440, 387.618757629711), - TrajectoryPoint(450, 385.125252606899), - TrajectoryPoint(460, 382.604693055793), - TrajectoryPoint(470, 380.081292831057), - TrajectoryPoint(480, 377.53257121215), - TrajectoryPoint(490, 374.977746614056), - TrajectoryPoint(500, 372.400130691078), - TrajectoryPoint(510, 369.812265520399), - TrajectoryPoint(520, 367.204995645349), - TrajectoryPoint(530, 364.582380820962), - TrajectoryPoint(540, 361.944668541655), - TrajectoryPoint(550, 359.285495776845), - TrajectoryPoint(560, 356.616522355015), - TrajectoryPoint(570, 354.399260232196), - TrajectoryPoint(580, 352.240015989844), - TrajectoryPoint(590, 350.108572817777), - TrajectoryPoint(600, 347.988707954534), - TrajectoryPoint(610, 345.888757179014), - TrajectoryPoint(620, 343.808587335196), - TrajectoryPoint(630, 341.739888168349), - TrajectoryPoint(640, 339.699514299151), - TrajectoryPoint(650, 337.668349362137), - TrajectoryPoint(660, 335.661060592562), - TrajectoryPoint(670, 333.669826368116), - TrajectoryPoint(680, 331.692546673794), - TrajectoryPoint(690, 329.740890301969), - TrajectoryPoint(700, 327.799442690578), - TrajectoryPoint(710, 325.880507175304), - TrajectoryPoint(720, 323.978161400915), - TrajectoryPoint(730, 322.087479895422), - TrajectoryPoint(740, 320.223555536362), - TrajectoryPoint(750, 318.370351952941), - TrajectoryPoint(760, 316.53420424058), - TrajectoryPoint(770, 314.718495753322), - TrajectoryPoint(780, 312.913838302188), - TrajectoryPoint(790, 311.129488975498), - TrajectoryPoint(800, 309.361191045715), - TrajectoryPoint(810, 307.604115421654), - TrajectoryPoint(820, 305.868779915492), - TrajectoryPoint(830, 304.146769553572), - TrajectoryPoint(840, 302.436010374018), - TrajectoryPoint(850, 300.74691901707), - TrajectoryPoint(860, 299.069818245982), - TrajectoryPoint(870, 297.40387571384), - TrajectoryPoint(880, 295.758318910417), - TrajectoryPoint(890, 294.124555340981), - TrajectoryPoint(900, 292.501756649291), - TrajectoryPoint(910, 290.897115535511), - TrajectoryPoint(920, 289.304977213173), - TrajectoryPoint(930, 287.723530368441), - TrajectoryPoint(940, 286.157296490286), - TrajectoryPoint(950, 284.604979378008), - TrajectoryPoint(960, 283.063018684483), - TrajectoryPoint(970, 281.532805518535), - TrajectoryPoint(980, 280.018453229286), - TrajectoryPoint(990, 278.514076613715), - TrajectoryPoint(1000, 277.019738746315), - TrajectoryPoint(1010, 275.539361250464), - TrajectoryPoint(1020, 274.070660114859), - TrajectoryPoint(1030, 272.611557127073), - TrajectoryPoint(1040, 271.162068089096), - TrajectoryPoint(1050, 269.726876316377), - TrajectoryPoint(1060, 268.301100607484), - TrajectoryPoint(1070, 266.884462673618), - TrajectoryPoint(1080, 265.477019365918), - TrajectoryPoint(1090, 264.082706095692), - TrajectoryPoint(1100, 262.697051061193), - TrajectoryPoint(1110, 261.320021188148), - TrajectoryPoint(1120, 259.951571152876), - TrajectoryPoint(1130, 258.594452650838), - TrajectoryPoint(1140, 257.246109934625), - TrajectoryPoint(1150, 255.905851075749), - TrajectoryPoint(1160, 254.573612681246), - TrajectoryPoint(1170, 253.250139342003), - TrajectoryPoint(1180, 251.93635082744), - TrajectoryPoint(1190, 250.630093692621), - TrajectoryPoint(1200, 249.331292376066), - TrajectoryPoint(1210, 248.039864754323), - TrajectoryPoint(1220, 246.756416471113), - TrajectoryPoint(1230, 245.481491213966), - TrajectoryPoint(1240, 244.213463050712), - TrajectoryPoint(1250, 242.952243743747), - TrajectoryPoint(1260, 241.697740646122), - TrajectoryPoint(1270, 240.44985722207), - TrajectoryPoint(1280, 239.209632109046), - TrajectoryPoint(1290, 237.976100333045), - TrajectoryPoint(1300, 236.748734462669), - TrajectoryPoint(1310, 235.52743696283), - TrajectoryPoint(1320, 234.312107813031), - TrajectoryPoint(1330, 233.102644858798), - TrajectoryPoint(1340, 231.899148143101), - TrajectoryPoint(1350, 230.70210125475), - TrajectoryPoint(1360, 229.510497033724), - TrajectoryPoint(1370, 228.32423530846), - TrajectoryPoint(1380, 227.143214659562), - TrajectoryPoint(1390, 225.967332653146), - TrajectoryPoint(1400, 224.796486053632), - TrajectoryPoint(1410, 223.6305710175), - TrajectoryPoint(1420, 222.469483269394), - TrajectoryPoint(1430, 221.313573631851), - TrajectoryPoint(1440, 220.162320333145), - TrajectoryPoint(1450, 219.015517101023), - TrajectoryPoint(1460, 217.873064097935), - TrajectoryPoint(1470, 216.734861427814), - TrajectoryPoint(1480, 215.600809249083), - TrajectoryPoint(1490, 214.470807876416), - TrajectoryPoint(1500, 213.344757872134), - TrajectoryPoint(1510, 212.222560128032), - TrajectoryPoint(1520, 211.104115938381), - TrajectoryPoint(1530, 209.989327064803), - TrajectoryPoint(1540, 208.878095793658), - TrajectoryPoint(1550, 207.770324986526), - TrajectoryPoint(1560, 206.665918124355), - TrajectoryPoint(1570, 205.564779345768), - TrajectoryPoint(1580, 204.466813479996), - TrajectoryPoint(1590, 203.371926074892), - TrajectoryPoint(1600, 202.280052476617), - TrajectoryPoint(1610, 201.191064672811), - TrajectoryPoint(1620, 200.104859932958), - TrajectoryPoint(1630, 199.021348750639), - TrajectoryPoint(1640, 197.940442312883), - TrajectoryPoint(1650, 196.86205562593), - TrajectoryPoint(1660, 195.786137099552), - TrajectoryPoint(1670, 194.712569311271), - TrajectoryPoint(1680, 193.641264899292), - TrajectoryPoint(1690, 192.572137303969), - TrajectoryPoint(1700, 191.505100762284), - TrajectoryPoint(1710, 190.440070300606), - TrajectoryPoint(1720, 189.376961725873), - TrajectoryPoint(1730, 188.315691615355), - TrajectoryPoint(1740, 187.256177305101), - TrajectoryPoint(1750, 186.198336877204), - TrajectoryPoint(1760, 185.142089145986), - TrajectoryPoint(1770, 184.0873536432), - TrajectoryPoint(1780, 183.034050602341), - TrajectoryPoint(1790, 181.982100942149), - TrajectoryPoint(1800, 180.931426249375), - TrajectoryPoint(1810, 179.881952264116), - TrajectoryPoint(1820, 178.833692019705), - TrajectoryPoint(1830, 177.786465792625), - TrajectoryPoint(1840, 176.740197073365), - TrajectoryPoint(1850, 175.69480994722), - TrajectoryPoint(1860, 174.650229072231), - TrajectoryPoint(1870, 173.606379656859), - TrajectoryPoint(1880, 172.563187437423), - TrajectoryPoint(1890, 171.520621497372), - TrajectoryPoint(1900, 170.478573071639), - TrajectoryPoint(1910, 169.43694699576), - TrajectoryPoint(1920, 168.39567047863), - TrajectoryPoint(1930, 167.354671149829), - TrajectoryPoint(1940, 166.313879971939), - TrajectoryPoint(1950, 165.273227305364), - TrajectoryPoint(1960, 164.232618979775), - TrajectoryPoint(1970, 163.191983715932), - TrajectoryPoint(1980, 162.151250534376), - TrajectoryPoint(1990, 161.110325488039), - TrajectoryPoint(2000, 160.069129163946), - TrajectoryPoint(2010, 159.027602941595), - TrajectoryPoint(2020, 157.985676466675), - TrajectoryPoint(2030, 156.943218845248), - TrajectoryPoint(2040, 155.900167480302), - TrajectoryPoint(2050, 154.856483100845), - TrajectoryPoint(2060, 153.812078919316), - TrajectoryPoint(2070, 152.76675790669), - TrajectoryPoint(2080, 151.72056936332), - TrajectoryPoint(2090, 150.673442925454), - TrajectoryPoint(2100, 149.625109367937), - TrajectoryPoint(2110, 148.575655930408), - TrajectoryPoint(2120, 147.525027091347), - TrajectoryPoint(2130, 146.472876870746), - TrajectoryPoint(2140, 145.419381345343), - TrajectoryPoint(2150, 144.364375488945), - TrajectoryPoint(2160, 143.307631266869), - TrajectoryPoint(2170, 142.249297524064), - TrajectoryPoint(2180, 141.189003542312), - TrajectoryPoint(2190, 140.126853059969), - TrajectoryPoint(2200, 139.062690870546), - TrajectoryPoint(2210, 137.996317707886), - TrajectoryPoint(2220, 136.927851187692), - TrajectoryPoint(2230, 135.856837786742), - TrajectoryPoint(2240, 134.783606516015), - TrajectoryPoint(2250, 133.707522851733), - TrajectoryPoint(2260, 132.629041457479), - TrajectoryPoint(2270, 131.547444083197), - TrajectoryPoint(2280, 130.46320134647), - TrajectoryPoint(2290, 129.375632335805), - TrajectoryPoint(2300, 128.285090070687), - TrajectoryPoint(2310, 127.191075855452), - TrajectoryPoint(2320, 126.093667564109), - TrajectoryPoint(2330, 124.992717666221), - TrajectoryPoint(2340, 123.887846971164), - TrajectoryPoint(2350, 122.779296861176), - TrajectoryPoint(2360, 121.666491476579), - TrajectoryPoint(2370, 120.549506439508), - TrajectoryPoint(2380, 119.428318792048), - TrajectoryPoint(2390, 118.30230731804), - TrajectoryPoint(2400, 117.171621151242), - TrajectoryPoint(2410, 116.03615107118), - TrajectoryPoint(2420, 114.895484945392), - TrajectoryPoint(2430, 113.749352150098), - TrajectoryPoint(2440, 112.597790206159), - TrajectoryPoint(2450, 111.440563380015), - TrajectoryPoint(2460, 110.277409434154), - TrajectoryPoint(2470, 109.107763053155), - TrajectoryPoint(2480, 107.931706963597), - TrajectoryPoint(2490, 106.748965503704), - TrajectoryPoint(2500, 105.559251121256), - TrajectoryPoint(2510, 104.362263839322), - TrajectoryPoint(2520, 103.157690681642), - TrajectoryPoint(2530, 101.945205055464), - TrajectoryPoint(2540, 100.724466089362), - TrajectoryPoint(2550, 99.4951179233155), - TrajectoryPoint(2560, 98.2567889480153), - TrajectoryPoint(2570, 97.0090909900587), - TrajectoryPoint(2580, 95.7516184393428), - TrajectoryPoint(2590, 94.4839473145945), - TrajectoryPoint(2600, 93.2056342625679), - TrajectoryPoint(2610, 91.9162154859886), - TrajectoryPoint(2620, 90.6152055948366), - TrajectoryPoint(2630, 89.3018017230889), - TrajectoryPoint(2640, 87.9753903933219), - TrajectoryPoint(2650, 86.6356777546464), - TrajectoryPoint(2660, 85.2820705869692), - TrajectoryPoint(2670, 83.9129745012814), - TrajectoryPoint(2680, 82.5285387830767), - TrajectoryPoint(2690, 81.127520563678), - TrajectoryPoint(2700, 79.7089122698112), - TrajectoryPoint(2710, 78.2719627848807), - TrajectoryPoint(2720, 76.8153949307389), - TrajectoryPoint(2730, 75.3379142968893), - TrajectoryPoint(2740, 73.8387339229663), - TrajectoryPoint(2750, 72.3157762393546), - TrajectoryPoint(2760, 70.7676349973495), - TrajectoryPoint(2770, 69.1928131049419), - TrajectoryPoint(2780, 67.5892925064193), - TrajectoryPoint(2790, 65.9548635684414), - TrajectoryPoint(2800, 64.2871027085788), - TrajectoryPoint(2810, 62.5833467444262), - TrajectoryPoint(2820, 60.8406633936496), - TrajectoryPoint(2830, 59.0549231118858), - TrajectoryPoint(2840, 57.2224785882852), - TrajectoryPoint(2850, 55.3388130681981), - TrajectoryPoint(2860, 53.3982348495599), - TrajectoryPoint(2870, 51.3937506119402), - TrajectoryPoint(2880, 49.3181844314639), - TrajectoryPoint(2890, 47.1620417419014), - TrajectoryPoint(2900, 44.9132095361844), - TrajectoryPoint(2910, 42.5570003205028), - TrajectoryPoint(2920, 40.0745212467583), - TrajectoryPoint(2930, 37.4409551943101), - TrajectoryPoint(2940, 34.6211441018107), - TrajectoryPoint(2950, 31.5654688067431), - TrajectoryPoint(2960, 28.1982210345552), - TrajectoryPoint(2970, 24.3878176075679), - TrajectoryPoint(2980, 19.8850692701429), - TrajectoryPoint(2990, 14.0382019377923), + TrajectoryPoint(0, 532.590748733435), + TrajectoryPoint(10, 530.694298117331), + TrajectoryPoint(20, 528.795580353788), + TrajectoryPoint(30, 526.896862590245), + TrajectoryPoint(40, 524.984268854819), + TrajectoryPoint(50, 523.071451916081), + TrajectoryPoint(60, 521.153424601399), + TrajectoryPoint(70, 519.226229157415), + TrajectoryPoint(80, 517.299033713431), + TrajectoryPoint(90, 515.360610177495), + TrajectoryPoint(100, 513.418749465531), + TrajectoryPoint(110, 511.47398846549), + TrajectoryPoint(120, 509.51716801892), + TrajectoryPoint(130, 507.56034757235), + TrajectoryPoint(140, 505.593651493624), + TrajectoryPoint(150, 503.621568858301), + TrajectoryPoint(160, 501.647537267481), + TrajectoryPoint(170, 499.659881704998), + TrajectoryPoint(180, 497.672226142515), + TrajectoryPoint(190, 495.674589015604), + TrajectoryPoint(200, 493.671041192706), + TrajectoryPoint(210, 491.664966285906), + TrajectoryPoint(220, 489.645197949281), + TrajectoryPoint(230, 487.625429612656), + TrajectoryPoint(240, 485.593933953116), + TrajectoryPoint(250, 483.557607588716), + TrajectoryPoint(260, 481.516456332554), + TrajectoryPoint(270, 479.463224808564), + TrajectoryPoint(280, 477.409993284574), + TrajectoryPoint(290, 475.341446537694), + TrajectoryPoint(300, 473.270952730197), + TrajectoryPoint(310, 471.191404233923), + TrajectoryPoint(320, 469.103280634243), + TrajectoryPoint(330, 467.01219389172), + TrajectoryPoint(340, 464.906062194349), + TrajectoryPoint(350, 462.799930496978), + TrajectoryPoint(360, 460.678344956885), + TrajectoryPoint(370, 458.553815626839), + TrajectoryPoint(380, 456.41913693324), + TrajectoryPoint(390, 454.275808751601), + TrajectoryPoint(400, 452.127404600546), + TrajectoryPoint(410, 449.964864186841), + TrajectoryPoint(420, 447.802070778514), + TrajectoryPoint(430, 445.619892088518), + TrajectoryPoint(440, 443.437713398522), + TrajectoryPoint(450, 441.239756170783), + TrajectoryPoint(460, 439.037499968199), + TrajectoryPoint(470, 436.823271279462), + TrajectoryPoint(480, 434.600484579835), + TrajectoryPoint(490, 432.369200810481), + TrajectoryPoint(500, 430.125416295576), + TrajectoryPoint(510, 427.876253961579), + TrajectoryPoint(520, 425.610989362315), + TrajectoryPoint(530, 423.343082804632), + TrajectoryPoint(540, 421.055840250534), + TrajectoryPoint(550, 418.76827916484), + TrajectoryPoint(560, 416.458544497792), + TrajectoryPoint(570, 414.148809830743), + TrajectoryPoint(580, 411.817613341669), + TrajectoryPoint(590, 409.484855391597), + TrajectoryPoint(600, 407.131490125661), + TrajectoryPoint(610, 404.775159945586), + TrajectoryPoint(620, 402.398546459957), + TrajectoryPoint(630, 400.018076517645), + TrajectoryPoint(640, 397.617078117441), + TrajectoryPoint(650, 395.211881440659), + TrajectoryPoint(660, 392.785300643371), + TrajectoryPoint(670, 390.354769915529), + TrajectoryPoint(680, 387.901344655207), + TrajectoryPoint(690, 385.444851257875), + TrajectoryPoint(700, 382.963250806808), + TrajectoryPoint(710, 380.479359320677), + TrajectoryPoint(720, 377.968964388715), + TrajectoryPoint(730, 375.454711254804), + TrajectoryPoint(740, 372.916329533523), + TrajectoryPoint(750, 370.370176105448), + TrajectoryPoint(760, 367.80308299226), + TrajectoryPoint(770, 365.223403582501), + TrajectoryPoint(780, 362.626847444279), + TrajectoryPoint(790, 360.011923494445), + TrajectoryPoint(800, 357.385124299409), + TrajectoryPoint(810, 354.785542426414), + TrajectoryPoint(820, 352.194182023071), + TrajectoryPoint(830, 349.650290260317), + TrajectoryPoint(840, 347.120315753021), + TrajectoryPoint(850, 344.624777284109), + TrajectoryPoint(860, 342.155688658961), + TrajectoryPoint(870, 339.707431473707), + TrajectoryPoint(880, 337.298501729664), + TrajectoryPoint(890, 334.903837650913), + TrajectoryPoint(900, 332.546686164527), + TrajectoryPoint(910, 330.211357183936), + TrajectoryPoint(920, 327.897939273111), + TrajectoryPoint(930, 325.620700565697), + TrajectoryPoint(940, 323.358958028466), + TrajectoryPoint(950, 321.129227565774), + TrajectoryPoint(960, 318.923967289578), + TrajectoryPoint(970, 316.734947516585), + TrajectoryPoint(980, 314.583794822678), + TrajectoryPoint(990, 312.449268613263), + TrajectoryPoint(1000, 310.335493913768), + TrajectoryPoint(1010, 308.253725965378), + TrajectoryPoint(1020, 306.188058961316), + TrajectoryPoint(1030, 304.145286936389), + TrajectoryPoint(1040, 302.130020639496), + TrajectoryPoint(1050, 300.130845182526), + TrajectoryPoint(1060, 298.154218677929), + TrajectoryPoint(1070, 296.202943454699), + TrajectoryPoint(1080, 294.267531910219), + TrajectoryPoint(1090, 292.35241613386), + TrajectoryPoint(1100, 290.462332197773), + TrajectoryPoint(1110, 288.587715500472), + TrajectoryPoint(1120, 286.729730583317), + TrajectoryPoint(1130, 284.897854034252), + TrajectoryPoint(1140, 283.080921798549), + TrajectoryPoint(1150, 281.279115921942), + TrajectoryPoint(1160, 279.499208701474), + TrajectoryPoint(1170, 277.736790194062), + TrajectoryPoint(1180, 275.988818084429), + TrajectoryPoint(1190, 274.256282888239), + TrajectoryPoint(1200, 272.545210146786), + TrajectoryPoint(1210, 270.847858074857), + TrajectoryPoint(1220, 269.16425085867), + TrajectoryPoint(1230, 267.496417772542), + TrajectoryPoint(1240, 265.846544120262), + TrajectoryPoint(1250, 264.209630291171), + TrajectoryPoint(1260, 262.585636533755), + TrajectoryPoint(1270, 260.975624756035), + TrajectoryPoint(1280, 259.382365770262), + TrajectoryPoint(1290, 257.801221453977), + TrajectoryPoint(1300, 256.23210878869), + TrajectoryPoint(1310, 254.674925809726), + TrajectoryPoint(1320, 253.132624556421), + TrajectoryPoint(1330, 251.602674560516), + TrajectoryPoint(1340, 250.083846443857), + TrajectoryPoint(1350, 248.576015482506), + TrajectoryPoint(1360, 247.07904481915), + TrajectoryPoint(1370, 245.595183766731), + TrajectoryPoint(1380, 244.122251946215), + TrajectoryPoint(1390, 242.659402131452), + TrajectoryPoint(1400, 241.206488099656), + TrajectoryPoint(1410, 239.763356161349), + TrajectoryPoint(1420, 238.330025304285), + TrajectoryPoint(1430, 236.90805032216), + TrajectoryPoint(1440, 235.495125847527), + TrajectoryPoint(1450, 234.091097183829), + TrajectoryPoint(1460, 232.695805290304), + TrajectoryPoint(1470, 231.30908753933), + TrajectoryPoint(1480, 229.930778399251), + TrajectoryPoint(1490, 228.560860625025), + TrajectoryPoint(1500, 227.200106225893), + TrajectoryPoint(1510, 225.847098894636), + TrajectoryPoint(1520, 224.501679463434), + TrajectoryPoint(1530, 223.163687454899), + TrajectoryPoint(1540, 221.832961500069), + TrajectoryPoint(1550, 220.509339711985), + TrajectoryPoint(1560, 219.192660018764), + TrajectoryPoint(1570, 217.882760459768), + TrajectoryPoint(1580, 216.579479448185), + TrajectoryPoint(1590, 215.282656003071), + TrajectoryPoint(1600, 213.992585342985), + TrajectoryPoint(1610, 212.708598757128), + TrajectoryPoint(1620, 211.43052226914), + TrajectoryPoint(1630, 210.158205326585), + TrajectoryPoint(1640, 208.891498341195), + TrajectoryPoint(1650, 207.630252820199), + TrajectoryPoint(1660, 206.374321479918), + TrajectoryPoint(1670, 205.123558343319), + TrajectoryPoint(1680, 203.877818823006), + TrajectoryPoint(1690, 202.636959791045), + TrajectoryPoint(1700, 201.40083963687), + TrajectoryPoint(1710, 200.169318314417), + TrajectoryPoint(1720, 198.94225737953), + TrajectoryPoint(1730, 197.719520018579), + TrajectoryPoint(1740, 196.500971069174), + TrajectoryPoint(1750, 195.286477033734), + TrajectoryPoint(1760, 194.07590608665), + TrajectoryPoint(1770, 192.869128075674), + TrajectoryPoint(1780, 191.666014518138), + TrajectoryPoint(1790, 190.466438592524), + TrajectoryPoint(1800, 189.270275125889), + TrajectoryPoint(1810, 188.077400577576), + TrajectoryPoint(1820, 186.887693019606), + TrajectoryPoint(1830, 185.701066253125), + TrajectoryPoint(1840, 184.517525931781), + TrajectoryPoint(1850, 183.336793244943), + TrajectoryPoint(1860, 182.158751174099), + TrajectoryPoint(1870, 180.983284253095), + TrajectoryPoint(1880, 179.810278529472), + TrajectoryPoint(1890, 178.639621524784), + TrajectoryPoint(1900, 177.471202194082), + TrajectoryPoint(1910, 176.304910884675), + TrajectoryPoint(1920, 175.140639294305), + TrajectoryPoint(1930, 173.978475166799), + TrajectoryPoint(1940, 172.818112117271), + TrajectoryPoint(1950, 171.659435829663), + TrajectoryPoint(1960, 170.502342332659), + TrajectoryPoint(1970, 169.346728818008), + TrajectoryPoint(1980, 168.192493594444), + TrajectoryPoint(1990, 167.039687177099), + TrajectoryPoint(2000, 165.888051687847), + TrajectoryPoint(2010, 164.737474514608), + TrajectoryPoint(2020, 163.587857529873), + TrajectoryPoint(2030, 162.439121601275), + TrajectoryPoint(2040, 161.291239574386), + TrajectoryPoint(2050, 160.144004145065), + TrajectoryPoint(2060, 158.99732014112), + TrajectoryPoint(2070, 157.851100161792), + TrajectoryPoint(2080, 156.705282371318), + TrajectoryPoint(2090, 155.559707473137), + TrajectoryPoint(2100, 154.414282558561), + TrajectoryPoint(2110, 153.26891086859), + TrajectoryPoint(2120, 152.123478610515), + TrajectoryPoint(2130, 150.977891076), + TrajectoryPoint(2140, 149.832029172665), + TrajectoryPoint(2150, 148.685766155633), + TrajectoryPoint(2160, 147.539043219432), + TrajectoryPoint(2170, 146.391700312432), + TrajectoryPoint(2180, 145.243623787187), + TrajectoryPoint(2190, 144.094782047793), + TrajectoryPoint(2200, 142.944908558826), + TrajectoryPoint(2210, 141.794023178937), + TrajectoryPoint(2220, 140.641967665802), + TrajectoryPoint(2230, 139.488553204558), + TrajectoryPoint(2240, 138.333831856825), + TrajectoryPoint(2250, 137.177392311248), + TrajectoryPoint(2260, 136.019439030093), + TrajectoryPoint(2270, 134.859520148006), + TrajectoryPoint(2280, 133.697808688691), + TrajectoryPoint(2290, 132.533874759818), + TrajectoryPoint(2300, 131.367881006512), + TrajectoryPoint(2310, 130.199350950694), + TrajectoryPoint(2320, 129.028536428256), + TrajectoryPoint(2330, 127.854798119944), + TrajectoryPoint(2340, 126.678463901504), + TrajectoryPoint(2350, 125.49901760337), + TrajectoryPoint(2360, 124.316489843529), + TrajectoryPoint(2370, 123.130759540273), + TrajectoryPoint(2380, 121.94133716864), + TrajectoryPoint(2390, 120.748431849042), + TrajectoryPoint(2400, 119.551664281496), + TrajectoryPoint(2410, 118.35072331714), + TrajectoryPoint(2420, 117.1456881841), + TrajectoryPoint(2430, 115.936288306008), + TrajectoryPoint(2440, 114.721968352579), + TrajectoryPoint(2450, 113.502872677409), + TrajectoryPoint(2460, 112.278754519288), + TrajectoryPoint(2470, 111.049355761105), + TrajectoryPoint(2480, 109.814099874258), + TrajectoryPoint(2490, 108.573003287404), + TrajectoryPoint(2500, 107.325803505407), + TrajectoryPoint(2510, 106.072196897036), + TrajectoryPoint(2520, 104.811866233233), + TrajectoryPoint(2530, 103.544480094796), + TrajectoryPoint(2540, 102.269692229605), + TrajectoryPoint(2550, 100.987140857052), + TrajectoryPoint(2560, 99.6964479169643), + TrajectoryPoint(2570, 98.397218259971), + TrajectoryPoint(2580, 97.0890387758208), + TrajectoryPoint(2590, 95.7714774557756), + TrajectoryPoint(2600, 94.4440823847224), + TrajectoryPoint(2610, 93.1063806581641), + TrajectoryPoint(2620, 91.7578772187068), + TrajectoryPoint(2630, 90.3980536060832), + TrajectoryPoint(2640, 89.0261875717925), + TrajectoryPoint(2650, 87.6413913468535), + TrajectoryPoint(2660, 86.243447212819), + TrajectoryPoint(2670, 84.8317195255813), + TrajectoryPoint(2680, 83.4045839460865), + TrajectoryPoint(2690, 81.9620782005965), + TrajectoryPoint(2700, 80.5028596918741), + TrajectoryPoint(2710, 79.0259871525316), + TrajectoryPoint(2720, 77.530380892224), + TrajectoryPoint(2730, 76.0150665064549), + TrajectoryPoint(2740, 74.4781151414948), + TrajectoryPoint(2750, 72.9188434227707), + TrajectoryPoint(2760, 71.3355444733398), + TrajectoryPoint(2770, 69.725947246982), + TrajectoryPoint(2780, 68.0884669872092), + TrajectoryPoint(2790, 66.4210467268205), + TrajectoryPoint(2800, 64.72126635399), + TrajectoryPoint(2810, 62.9864651015802), + TrajectoryPoint(2820, 61.213088855229), + TrajectoryPoint(2830, 59.3978628730402), + TrajectoryPoint(2840, 57.5373707859899), + TrajectoryPoint(2850, 55.6257091337099), + TrajectoryPoint(2860, 53.6587063046882), + TrajectoryPoint(2870, 51.6287878433987), + TrajectoryPoint(2880, 49.528480181866), + TrajectoryPoint(2890, 47.3487122148686), + TrajectoryPoint(2900, 45.0766847871855), + TrajectoryPoint(2910, 42.699172662204), + TrajectoryPoint(2920, 40.1959469205755), + TrajectoryPoint(2930, 37.5429075337725), + TrajectoryPoint(2940, 34.704427524491), + TrajectoryPoint(2950, 31.6315126798681), + TrajectoryPoint(2960, 28.2481065664133), + TrajectoryPoint(2970, 24.4231627901258), + TrajectoryPoint(2980, 19.9070323977196), + TrajectoryPoint(2990, 14.0482475115599), TrajectoryPoint(3000, 0), }; TrajectoryPoint t8_open[] = { - TrajectoryPoint(0, 482.432419304485), - TrajectoryPoint(10, 480.366734302352), - TrajectoryPoint(20, 478.294316452994), - TrajectoryPoint(30, 476.215266067988), - TrajectoryPoint(40, 474.134094650682), - TrajectoryPoint(50, 472.037285712667), - TrajectoryPoint(60, 469.940476774652), - TrajectoryPoint(70, 467.829882625219), - TrajectoryPoint(80, 465.714932467905), - TrajectoryPoint(90, 463.592104004629), - TrajectoryPoint(100, 461.458618557657), - TrajectoryPoint(110, 459.322957317805), - TrajectoryPoint(120, 457.170530643401), - TrajectoryPoint(130, 455.018103968997), - TrajectoryPoint(140, 452.849622088485), - TrajectoryPoint(150, 450.677835894419), - TrajectoryPoint(160, 448.494801852423), - TrajectoryPoint(170, 446.303224979792), - TrajectoryPoint(180, 444.104932186964), - TrajectoryPoint(190, 441.893120071231), - TrajectoryPoint(200, 439.678826185846), - TrajectoryPoint(210, 437.446320289432), - TrajectoryPoint(220, 435.213814393017), - TrajectoryPoint(230, 432.961572391933), - TrajectoryPoint(240, 430.707899606545), - TrajectoryPoint(250, 428.437567964323), - TrajectoryPoint(260, 426.162239981063), - TrajectoryPoint(270, 423.872940427329), - TrajectoryPoint(280, 421.575453072472), - TrajectoryPoint(290, 419.26626184561), - TrajectoryPoint(300, 416.946094379777), - TrajectoryPoint(310, 414.616039522768), - TrajectoryPoint(320, 412.272653901052), - TrajectoryPoint(330, 409.920712365718), - TrajectoryPoint(340, 407.553552456125), - TrajectoryPoint(350, 405.178647000026), - TrajectoryPoint(360, 402.787137757371), - TrajectoryPoint(370, 400.388133616109), - TrajectoryPoint(380, 397.971680208288), - TrajectoryPoint(390, 395.547381524325), - TrajectoryPoint(400, 393.105368407635), - TrajectoryPoint(410, 390.654514394909), - TrajectoryPoint(420, 388.186304334802), - TrajectoryPoint(430, 385.707565156403), - TrajectoryPoint(440, 383.212498189762), - TrajectoryPoint(450, 380.704470523691), - TrajectoryPoint(460, 378.181862858394), - TrajectoryPoint(470, 375.643065123916), - TrajectoryPoint(480, 373.092207971077), - TrajectoryPoint(490, 370.521075185409), - TrajectoryPoint(500, 367.941233519292), - TrajectoryPoint(510, 365.336111751268), - TrajectoryPoint(520, 362.725790765554), - TrajectoryPoint(530, 360.085663375322), - TrajectoryPoint(540, 357.553510846317), - TrajectoryPoint(550, 355.399919575575), - TrajectoryPoint(560, 353.259978150606), - TrajectoryPoint(570, 351.137314015269), - TrajectoryPoint(580, 349.035622353165), - TrajectoryPoint(590, 346.943812828319), - TrajectoryPoint(600, 344.880724895773), - TrajectoryPoint(610, 342.826004985817), - TrajectoryPoint(620, 340.795244480765), - TrajectoryPoint(630, 338.779602829698), - TrajectoryPoint(640, 336.778853448289), - TrajectoryPoint(650, 334.802152841558), - TrajectoryPoint(660, 332.835028657664), - TrajectoryPoint(670, 330.892917978247), - TrajectoryPoint(680, 328.964554963966), - TrajectoryPoint(690, 327.050964496887), - TrajectoryPoint(700, 325.160850064674), - TrajectoryPoint(710, 323.281048259448), - TrajectoryPoint(720, 321.42270538191), - TrajectoryPoint(730, 319.580459832752), - TrajectoryPoint(740, 317.748982703256), - TrajectoryPoint(750, 315.943331810125), - TrajectoryPoint(760, 314.148472022709), - TrajectoryPoint(770, 312.368171217432), - TrajectoryPoint(780, 310.60904621147), - TrajectoryPoint(790, 308.860727503621), - TrajectoryPoint(800, 307.129105042963), - TrajectoryPoint(810, 305.415307677264), - TrajectoryPoint(820, 303.712384189747), - TrajectoryPoint(830, 302.026749556044), - TrajectoryPoint(840, 300.357015948813), - TrajectoryPoint(850, 298.698102828426), - TrajectoryPoint(860, 297.055811835381), - TrajectoryPoint(870, 295.428678110227), - TrajectoryPoint(880, 293.812210186811), - TrajectoryPoint(890, 292.210697767046), - TrajectoryPoint(900, 290.624552800927), - TrajectoryPoint(910, 289.048836953628), - TrajectoryPoint(920, 287.485638719373), - TrajectoryPoint(930, 285.938770588338), - TrajectoryPoint(940, 284.402030655887), - TrajectoryPoint(950, 282.875528100405), - TrajectoryPoint(960, 281.365431448771), - TrajectoryPoint(970, 279.865845567304), - TrajectoryPoint(980, 278.376113045761), - TrajectoryPoint(990, 276.898681542691), - TrajectoryPoint(1000, 275.43441238126), - TrajectoryPoint(1010, 273.979583400678), - TrajectoryPoint(1020, 272.534220866898), - TrajectoryPoint(1030, 271.101990660837), - TrajectoryPoint(1040, 269.680217618205), - TrajectoryPoint(1050, 268.267458376922), - TrajectoryPoint(1060, 266.863702540813), - TrajectoryPoint(1070, 265.472477601669), - TrajectoryPoint(1080, 264.09050330695), - TrajectoryPoint(1090, 262.717059300963), - TrajectoryPoint(1100, 261.352108217842), - TrajectoryPoint(1110, 259.998076662371), - TrajectoryPoint(1120, 258.653182809509), - TrajectoryPoint(1130, 257.316302548955), - TrajectoryPoint(1140, 255.987379283775), - TrajectoryPoint(1150, 254.667085321076), - TrajectoryPoint(1160, 253.356588638433), - TrajectoryPoint(1170, 252.053573705757), - TrajectoryPoint(1180, 250.757970719773), - TrajectoryPoint(1190, 249.469703043619), - TrajectoryPoint(1200, 248.189575128404), - TrajectoryPoint(1210, 246.917814074136), - TrajectoryPoint(1220, 245.65292254615), - TrajectoryPoint(1230, 244.394816921711), - TrajectoryPoint(1240, 243.14340893698), - TrajectoryPoint(1250, 241.898606215616), - TrajectoryPoint(1260, 240.661893975167), - TrajectoryPoint(1270, 239.431472135603), - TrajectoryPoint(1280, 238.207209705201), - TrajectoryPoint(1290, 236.989012631021), - TrajectoryPoint(1300, 235.776784191496), - TrajectoryPoint(1310, 234.57042535596), - TrajectoryPoint(1320, 233.370641788231), - TrajectoryPoint(1330, 232.176745727493), - TrajectoryPoint(1340, 230.988301496816), - TrajectoryPoint(1350, 229.8052115384), - TrajectoryPoint(1360, 228.627376906451), - TrajectoryPoint(1370, 227.454697507523), - TrajectoryPoint(1380, 226.287072320119), - TrajectoryPoint(1390, 225.12439959503), - TrajectoryPoint(1400, 223.967199778985), - TrajectoryPoint(1410, 222.814701736747), - TrajectoryPoint(1420, 221.666778010186), - TrajectoryPoint(1430, 220.52333070547), - TrajectoryPoint(1440, 219.384261651317), - TrajectoryPoint(1450, 218.249472529422), - TrajectoryPoint(1460, 217.118864992508), - TrajectoryPoint(1470, 215.992340770928), - TrajectoryPoint(1480, 214.869801768683), - TrajectoryPoint(1490, 213.751150149674), - TrajectoryPoint(1500, 212.636288414936), - TrajectoryPoint(1510, 211.525119471543), - TrajectoryPoint(1520, 210.417733039504), - TrajectoryPoint(1530, 209.3138269912), - TrajectoryPoint(1540, 208.213293837029), - TrajectoryPoint(1550, 207.116041366406), - TrajectoryPoint(1560, 206.021977859575), - TrajectoryPoint(1570, 204.931012128332), - TrajectoryPoint(1580, 203.84305355147), - TrajectoryPoint(1590, 202.758012105371), - TrajectoryPoint(1600, 201.675798390122), - TrajectoryPoint(1610, 200.59632365152), - TrajectoryPoint(1620, 199.519499799284), - TrajectoryPoint(1630, 198.445239421789), - TrajectoryPoint(1640, 197.373455797593), - TrajectoryPoint(1650, 196.304062904022), - TrajectoryPoint(1660, 195.23697542306), - TrajectoryPoint(1670, 194.172108744745), - TrajectoryPoint(1680, 193.109378968298), - TrajectoryPoint(1690, 192.048702901159), - TrajectoryPoint(1700, 190.989998056105), - TrajectoryPoint(1710, 189.933182646619), - TrajectoryPoint(1720, 188.878198737529), - TrajectoryPoint(1730, 187.825008931333), - TrajectoryPoint(1740, 186.773465699824), - TrajectoryPoint(1750, 185.723489081294), - TrajectoryPoint(1760, 184.674999812504), - TrajectoryPoint(1770, 183.627919313434), - TrajectoryPoint(1780, 182.582169671262), - TrajectoryPoint(1790, 181.537673623624), - TrajectoryPoint(1800, 180.494354541248), - TrajectoryPoint(1810, 179.452136409997), - TrajectoryPoint(1820, 178.410943812389), - TrajectoryPoint(1830, 177.370725174022), - TrajectoryPoint(1840, 176.331440980936), - TrajectoryPoint(1850, 175.29294821838), - TrajectoryPoint(1860, 174.255173153992), - TrajectoryPoint(1870, 173.218042569694), - TrajectoryPoint(1880, 172.181483739586), - TrajectoryPoint(1890, 171.145424407669), - TrajectoryPoint(1900, 170.109817008199), - TrajectoryPoint(1910, 169.074575339921), - TrajectoryPoint(1920, 168.03960330826), - TrajectoryPoint(1930, 167.004829928339), - TrajectoryPoint(1940, 165.970184577777), - TrajectoryPoint(1950, 164.935596157115), - TrajectoryPoint(1960, 163.900981744439), - TrajectoryPoint(1970, 162.866266920333), - TrajectoryPoint(1980, 161.831381939927), - TrajectoryPoint(1990, 160.796257301571), - TrajectoryPoint(2000, 159.760767437266), - TrajectoryPoint(2010, 158.724873467251), - TrajectoryPoint(2020, 157.688511580146), - TrajectoryPoint(2030, 156.651606632146), - TrajectoryPoint(2040, 155.61398018234), - TrajectoryPoint(2050, 154.575656235319), - TrajectoryPoint(2060, 153.536565658177), - TrajectoryPoint(2070, 152.49653209329), - TrajectoryPoint(2080, 151.455507984514), - TrajectoryPoint(2090, 150.413485421677), - TrajectoryPoint(2100, 149.37028128537), - TrajectoryPoint(2110, 148.325804102124), - TrajectoryPoint(2120, 147.280093676593), - TrajectoryPoint(2130, 146.232899901482), - TrajectoryPoint(2140, 145.184199881882), - TrajectoryPoint(2150, 144.134028009305), - TrajectoryPoint(2160, 143.08197577587), - TrajectoryPoint(2170, 142.028263812445), - TrajectoryPoint(2180, 140.97265036563), - TrajectoryPoint(2190, 139.915005993894), - TrajectoryPoint(2200, 138.855418961864), - TrajectoryPoint(2210, 137.793438922855), - TrajectoryPoint(2220, 136.72938857102), - TrajectoryPoint(2230, 135.662711664391), - TrajectoryPoint(2240, 134.593727140872), - TrajectoryPoint(2250, 133.521936658692), - TrajectoryPoint(2260, 132.447585887956), - TrajectoryPoint(2270, 131.370188059917), - TrajectoryPoint(2280, 130.290024994876), - TrajectoryPoint(2290, 129.206499745392), - TrajectoryPoint(2300, 128.120011668018), - TrajectoryPoint(2310, 127.029863000871), - TrajectoryPoint(2320, 125.936406895458), - TrajectoryPoint(2330, 124.839223882823), - TrajectoryPoint(2340, 123.738204301365), - TrajectoryPoint(2350, 122.633458586322), - TrajectoryPoint(2360, 121.524270121248), - TrajectoryPoint(2370, 120.410989412811), - TrajectoryPoint(2380, 119.293417062541), - TrajectoryPoint(2390, 118.170918912305), - TrajectoryPoint(2400, 117.043791173909), - TrajectoryPoint(2410, 115.911832382551), - TrajectoryPoint(2420, 114.774496155249), - TrajectoryPoint(2430, 113.631777118127), - TrajectoryPoint(2440, 112.483581852022), - TrajectoryPoint(2450, 111.329674494512), - TrajectoryPoint(2460, 110.169664062161), - TrajectoryPoint(2470, 109.003241349627), - TrajectoryPoint(2480, 107.830361960994), - TrajectoryPoint(2490, 106.65075018957), - TrajectoryPoint(2500, 105.464118461849), - TrajectoryPoint(2510, 104.270166801199), - TrajectoryPoint(2520, 103.068582251414), - TrajectoryPoint(2530, 101.859038257902), - TrajectoryPoint(2540, 100.64119400404), - TrajectoryPoint(2550, 99.4146936999291), - TrajectoryPoint(2560, 98.1791658205251), - TrajectoryPoint(2570, 96.9342222897745), - TrajectoryPoint(2580, 95.6794576070614), - TrajectoryPoint(2590, 94.4144479118905), - TrajectoryPoint(2600, 93.1387499823229), - TrajectoryPoint(2610, 91.8519001622385), - TrajectoryPoint(2620, 90.5534132120059), - TrajectoryPoint(2630, 89.2425876277869), - TrajectoryPoint(2640, 87.918603855618), - TrajectoryPoint(2650, 86.5812730936994), - TrajectoryPoint(2660, 85.2300023137453), - TrajectoryPoint(2670, 83.8632890123968), - TrajectoryPoint(2680, 82.4810946715773), - TrajectoryPoint(2690, 81.0823614150301), - TrajectoryPoint(2700, 79.6658996781679), - TrajectoryPoint(2710, 78.2311363210671), - TrajectoryPoint(2720, 76.7766205630051), - TrajectoryPoint(2730, 75.3012265183905), - TrajectoryPoint(2740, 73.8040824780579), - TrajectoryPoint(2750, 72.2830332295862), - TrajectoryPoint(2760, 70.7368279249012), - TrajectoryPoint(2770, 69.1638909264375), - TrajectoryPoint(2780, 67.5622038809035), - TrajectoryPoint(2790, 65.9295569133427), - TrajectoryPoint(2800, 64.2635262525964), - TrajectoryPoint(2810, 62.5614485776395), - TrajectoryPoint(2820, 60.8203915151314), - TrajectoryPoint(2830, 59.0362817765735), - TrajectoryPoint(2840, 57.2053555670495), - TrajectoryPoint(2850, 55.3232074092806), - TrajectoryPoint(2860, 53.3840387173703), - TrajectoryPoint(2870, 51.3809566746338), - TrajectoryPoint(2880, 49.3067333411177), - TrajectoryPoint(2890, 47.1518735542573), - TrajectoryPoint(2900, 44.9043020177021), - TrajectoryPoint(2910, 42.5492507851539), - TrajectoryPoint(2920, 40.0679004069758), - TrajectoryPoint(2930, 37.4353943110974), - TrajectoryPoint(2940, 34.6166001004217), - TrajectoryPoint(2950, 31.5618642795822), - TrajectoryPoint(2960, 28.195497580552), - TrajectoryPoint(2970, 24.3858873695873), - TrajectoryPoint(2980, 19.8838694619109), - TrajectoryPoint(2990, 14.0376529473327), + TrajectoryPoint(0, 528.926954043038), + TrajectoryPoint(10, 527.031206614025), + TrajectoryPoint(20, 525.132555441784), + TrajectoryPoint(30, 523.233904269543), + TrajectoryPoint(40, 521.3222174439), + TrajectoryPoint(50, 519.409435720731), + TrajectoryPoint(60, 517.492049464105), + TrajectoryPoint(70, 515.564857363706), + TrajectoryPoint(80, 513.637665263307), + TrajectoryPoint(90, 511.699576157372), + TrajectoryPoint(100, 509.757686400798), + TrajectoryPoint(110, 507.812976373392), + TrajectoryPoint(120, 505.856093956961), + TrajectoryPoint(130, 503.89921154053), + TrajectoryPoint(140, 501.932240483853), + TrajectoryPoint(150, 499.960062394579), + TrajectoryPoint(160, 497.985453445245), + TrajectoryPoint(170, 495.997668363111), + TrajectoryPoint(180, 494.009883280976), + TrajectoryPoint(190, 492.011322047891), + TrajectoryPoint(200, 490.007610034215), + TrajectoryPoint(210, 488.000288260242), + TrajectoryPoint(220, 485.980320431364), + TrajectoryPoint(230, 483.960352602486), + TrajectoryPoint(240, 481.927240900074), + TrajectoryPoint(250, 479.890679085509), + TrajectoryPoint(260, 477.847567030779), + TrajectoryPoint(270, 475.794063414954), + TrajectoryPoint(280, 473.740462096377), + TrajectoryPoint(290, 471.669658842983), + TrajectoryPoint(300, 469.598855589588), + TrajectoryPoint(310, 467.516584342454), + TrajectoryPoint(320, 465.428113200403), + TrajectoryPoint(330, 463.333922926251), + TrajectoryPoint(340, 461.227404816138), + TrajectoryPoint(350, 459.120719865456), + TrajectoryPoint(360, 456.995764445359), + TrajectoryPoint(370, 454.870809025262), + TrajectoryPoint(380, 452.732186008587), + TrajectoryPoint(390, 450.588391217953), + TrajectoryPoint(400, 448.435621308884), + TrajectoryPoint(410, 446.272572889156), + TrajectoryPoint(420, 444.104977876603), + TrajectoryPoint(430, 441.922248867162), + TrajectoryPoint(440, 439.739116679136), + TrajectoryPoint(450, 437.536266886997), + TrajectoryPoint(460, 435.333417094859), + TrajectoryPoint(470, 433.113425127346), + TrajectoryPoint(480, 430.890000568973), + TrajectoryPoint(490, 428.652469589955), + TrajectoryPoint(500, 426.408001903389), + TrajectoryPoint(510, 424.15209130969), + TrajectoryPoint(520, 421.886097135107), + TrajectoryPoint(530, 419.610923382369), + TrajectoryPoint(540, 417.322903708981), + TrajectoryPoint(550, 415.027537796353), + TrajectoryPoint(560, 412.716977273455), + TrajectoryPoint(570, 410.400442052655), + TrajectoryPoint(580, 408.066808262413), + TrajectoryPoint(590, 405.728075556937), + TrajectoryPoint(600, 403.370818246352), + TrajectoryPoint(610, 401.00880576527), + TrajectoryPoint(620, 398.627356034526), + TrajectoryPoint(630, 396.240924063843), + TrajectoryPoint(640, 393.834693508036), + TrajectoryPoint(650, 391.422641360997), + TrajectoryPoint(660, 388.991021161999), + TrajectoryPoint(670, 386.5520833679), + TrajectoryPoint(680, 384.094443332824), + TrajectoryPoint(690, 381.627285541926), + TrajectoryPoint(700, 379.142973084404), + TrajectoryPoint(710, 376.646187664328), + TrajectoryPoint(720, 374.134526724443), + TrajectoryPoint(730, 371.606628020975), + TrajectoryPoint(740, 369.066917919384), + TrajectoryPoint(750, 366.506337151911), + TrajectoryPoint(760, 363.937851373266), + TrajectoryPoint(770, 361.342931131984), + TrajectoryPoint(780, 358.745920442027), + TrajectoryPoint(790, 356.159243787766), + TrajectoryPoint(800, 353.587413163709), + TrajectoryPoint(810, 351.04937351457), + TrajectoryPoint(820, 348.537314436594), + TrajectoryPoint(830, 346.046980377018), + TrajectoryPoint(840, 343.594284196859), + TrajectoryPoint(850, 341.154693725845), + TrajectoryPoint(860, 338.756687301276), + TrajectoryPoint(870, 336.376124319648), + TrajectoryPoint(880, 334.022620234598), + TrajectoryPoint(890, 331.700114194112), + TrajectoryPoint(900, 329.392393332445), + TrajectoryPoint(910, 327.124354963602), + TrajectoryPoint(920, 324.873491037922), + TrajectoryPoint(930, 322.646362274152), + TrajectoryPoint(940, 320.450965046255), + TrajectoryPoint(950, 318.271104157107), + TrajectoryPoint(960, 316.122086342801), + TrajectoryPoint(970, 313.995857758303), + TrajectoryPoint(980, 311.88563956638), + TrajectoryPoint(990, 309.809800265054), + TrajectoryPoint(1000, 307.751087189428), + TrajectoryPoint(1010, 305.710015982473), + TrajectoryPoint(1020, 303.701068025079), + TrajectoryPoint(1030, 301.707713925579), + TrajectoryPoint(1040, 299.732636126532), + TrajectoryPoint(1050, 297.786668137178), + TrajectoryPoint(1060, 295.856139467684), + TrajectoryPoint(1070, 293.942503290313), + TrajectoryPoint(1080, 292.056894829712), + TrajectoryPoint(1090, 290.186396406951), + TrajectoryPoint(1100, 288.331298592748), + TrajectoryPoint(1110, 286.501812981184), + TrajectoryPoint(1120, 284.688387217164), + TrajectoryPoint(1130, 282.889814248794), + TrajectoryPoint(1140, 281.111463739662), + TrajectoryPoint(1150, 279.352072206694), + TrajectoryPoint(1160, 277.606904951481), + TrajectoryPoint(1170, 275.876052485468), + TrajectoryPoint(1180, 274.167611424994), + TrajectoryPoint(1190, 272.472742586283), + TrajectoryPoint(1200, 270.791458911829), + TrajectoryPoint(1210, 269.125467183271), + TrajectoryPoint(1220, 267.477844968365), + TrajectoryPoint(1230, 265.843059010976), + TrajectoryPoint(1240, 264.221084362756), + TrajectoryPoint(1250, 262.613133833919), + TrajectoryPoint(1260, 261.021876953602), + TrajectoryPoint(1270, 259.44265469408), + TrajectoryPoint(1280, 257.875396108922), + TrajectoryPoint(1290, 256.320010583931), + TrajectoryPoint(1300, 254.780089029168), + TrajectoryPoint(1310, 253.251972158442), + TrajectoryPoint(1320, 251.734941420974), + TrajectoryPoint(1330, 250.228881185145), + TrajectoryPoint(1340, 248.733826106094), + TrajectoryPoint(1350, 247.252509153864), + TrajectoryPoint(1360, 245.781401226284), + TrajectoryPoint(1370, 244.320371999251), + TrajectoryPoint(1380, 242.869281973699), + TrajectoryPoint(1390, 241.42798370663), + TrajectoryPoint(1400, 239.997683362161), + TrajectoryPoint(1410, 238.577636800244), + TrajectoryPoint(1420, 237.166660789485), + TrajectoryPoint(1430, 235.764605542596), + TrajectoryPoint(1440, 234.371316561618), + TrajectoryPoint(1450, 232.986635417485), + TrajectoryPoint(1460, 231.610485940324), + TrajectoryPoint(1470, 230.243976140572), + TrajectoryPoint(1480, 228.885410961669), + TrajectoryPoint(1490, 227.534636286564), + TrajectoryPoint(1500, 226.191495963975), + TrajectoryPoint(1510, 224.855832292276), + TrajectoryPoint(1520, 223.527486453874), + TrajectoryPoint(1530, 222.206298904325), + TrajectoryPoint(1540, 220.892109720104), + TrajectoryPoint(1550, 219.584961600907), + TrajectoryPoint(1560, 218.284949728879), + TrajectoryPoint(1570, 216.991362824353), + TrajectoryPoint(1580, 215.704050094077), + TrajectoryPoint(1590, 214.422861048362), + TrajectoryPoint(1600, 213.147645707768), + TrajectoryPoint(1610, 211.87825478548), + TrajectoryPoint(1620, 210.614539847568), + TrajectoryPoint(1630, 209.356353453155), + TrajectoryPoint(1640, 208.103549276326), + TrajectoryPoint(1650, 206.855982211462), + TrajectoryPoint(1660, 205.613508463547), + TrajectoryPoint(1670, 204.375985624848), + TrajectoryPoint(1680, 203.143272739241), + TrajectoryPoint(1690, 201.915230355381), + TrajectoryPoint(1700, 200.691720569755), + TrajectoryPoint(1710, 199.472607060609), + TrajectoryPoint(1720, 198.257755113625), + TrajectoryPoint(1730, 197.047031640165), + TrajectoryPoint(1740, 195.84030518881), + TrajectoryPoint(1750, 194.637445950861), + TrajectoryPoint(1760, 193.438325760424), + TrajectoryPoint(1770, 192.24281808961), + TrajectoryPoint(1780, 191.050798039371), + TrajectoryPoint(1790, 189.862142326426), + TrajectoryPoint(1800, 188.676729266679), + TrajectoryPoint(1810, 187.49443875552), + TrajectoryPoint(1820, 186.315152245345), + TrajectoryPoint(1830, 185.138752720605), + TrajectoryPoint(1840, 183.965124670654), + TrajectoryPoint(1850, 182.794154060676), + TrajectoryPoint(1860, 181.625784718356), + TrajectoryPoint(1870, 180.459990638031), + TrajectoryPoint(1880, 179.29651222824), + TrajectoryPoint(1890, 178.135240057771), + TrajectoryPoint(1900, 176.976066056585), + TrajectoryPoint(1910, 175.818883475078), + TrajectoryPoint(1920, 174.663586842899), + TrajectoryPoint(1930, 173.51007192739), + TrajectoryPoint(1940, 172.35831964196), + TrajectoryPoint(1950, 171.208237360521), + TrajectoryPoint(1960, 170.059614012916), + TrajectoryPoint(1970, 168.91234932886), + TrajectoryPoint(1980, 167.766344086169), + TrajectoryPoint(1990, 166.621500066232), + TrajectoryPoint(2000, 165.477840046829), + TrajectoryPoint(2010, 164.335147805976), + TrajectoryPoint(2020, 163.19330576697), + TrajectoryPoint(2030, 162.052218873316), + TrajectoryPoint(2040, 160.911822252649), + TrajectoryPoint(2050, 159.772038241758), + TrajectoryPoint(2060, 158.632703821204), + TrajectoryPoint(2070, 157.493726482928), + TrajectoryPoint(2080, 156.355027311383), + TrajectoryPoint(2090, 155.216499041855), + TrajectoryPoint(2100, 154.078026327703), + TrajectoryPoint(2110, 152.939518405077), + TrajectoryPoint(2120, 151.800843970039), + TrajectoryPoint(2130, 150.66192491452), + TrajectoryPoint(2140, 149.522671439807), + TrajectoryPoint(2150, 148.382899117886), + TrajectoryPoint(2160, 147.242574082595), + TrajectoryPoint(2170, 146.101603059287), + TrajectoryPoint(2180, 144.959746562872), + TrajectoryPoint(2190, 143.817044560603), + TrajectoryPoint(2200, 142.673301981547), + TrajectoryPoint(2210, 141.528386110435), + TrajectoryPoint(2220, 140.382314353703), + TrajectoryPoint(2230, 139.234703823632), + TrajectoryPoint(2240, 138.085727882235), + TrajectoryPoint(2250, 136.93502219124), + TrajectoryPoint(2260, 135.782640424149), + TrajectoryPoint(2270, 134.628325530672), + TrajectoryPoint(2280, 133.47203117173), + TrajectoryPoint(2290, 132.31355679396), + TrajectoryPoint(2300, 131.152829812222), + TrajectoryPoint(2310, 129.989615832664), + TrajectoryPoint(2320, 128.823921675023), + TrajectoryPoint(2330, 127.655357158122), + TrajectoryPoint(2340, 126.48413368122), + TrajectoryPoint(2350, 125.309587224557), + TrajectoryPoint(2360, 124.132029048116), + TrajectoryPoint(2370, 122.951061252507), + TrajectoryPoint(2380, 121.766468946534), + TrajectoryPoint(2390, 120.578329637442), + TrajectoryPoint(2400, 119.38611685637), + TrajectoryPoint(2410, 118.189804250847), + TrajectoryPoint(2420, 116.98933311405), + TrajectoryPoint(2430, 115.784287398394), + TrajectoryPoint(2440, 114.574395954708), + TrajectoryPoint(2450, 113.359664460069), + TrajectoryPoint(2460, 112.139845919827), + TrajectoryPoint(2470, 110.914566915866), + TrajectoryPoint(2480, 109.683449950449), + TrajectoryPoint(2490, 108.446456203802), + TrajectoryPoint(2500, 107.20329502855), + TrajectoryPoint(2510, 105.953662768039), + TrajectoryPoint(2520, 104.69724220811), + TrajectoryPoint(2530, 103.43370198092), + TrajectoryPoint(2540, 102.162695918737), + TrajectoryPoint(2550, 100.883862355322), + TrajectoryPoint(2560, 99.5968233721532), + TrajectoryPoint(2570, 98.301183986377), + TrajectoryPoint(2580, 96.9965312769935), + TrajectoryPoint(2590, 95.6824334453418), + TrajectoryPoint(2600, 94.3584388055164), + TrajectoryPoint(2610, 93.024074699843), + TrajectoryPoint(2620, 91.678846334014), + TrajectoryPoint(2630, 90.3222355259007), + TrajectoryPoint(2640, 88.9536399964805), + TrajectoryPoint(2650, 87.5719281047354), + TrajectoryPoint(2660, 86.1770067068956), + TrajectoryPoint(2670, 84.7682405032035), + TrajectoryPoint(2680, 83.3441138932311), + TrajectoryPoint(2690, 81.9044422198329), + TrajectoryPoint(2700, 80.4481023285392), + TrajectoryPoint(2710, 78.9739370200437), + TrajectoryPoint(2720, 77.48107786272), + TrajectoryPoint(2730, 75.9683447024794), + TrajectoryPoint(2740, 74.434008257325), + TrajectoryPoint(2750, 72.8772849390361), + TrajectoryPoint(2760, 71.2964673235093), + TrajectoryPoint(2770, 69.6891947211824), + TrajectoryPoint(2780, 68.0540627128405), + TrajectoryPoint(2790, 66.3889230800159), + TrajectoryPoint(2800, 64.6913554931284), + TrajectoryPoint(2810, 62.9586990466547), + TrajectoryPoint(2820, 61.1874726805736), + TrajectoryPoint(2830, 59.3742509928802), + TrajectoryPoint(2840, 57.5156949033964), + TrajectoryPoint(2850, 55.6059639940748), + TrajectoryPoint(2860, 53.6408166272737), + TrajectoryPoint(2870, 51.6126187369133), + TrajectoryPoint(2880, 49.5140160917944), + TrajectoryPoint(2890, 47.3358758152498), + TrajectoryPoint(2900, 45.0654455506057), + TrajectoryPoint(2910, 42.6894003871412), + TrajectoryPoint(2920, 40.1876025593213), + TrajectoryPoint(2930, 37.5359031262212), + TrajectoryPoint(2940, 34.6987071710056), + TrajectoryPoint(2950, 31.626977767532), + TrajectoryPoint(2960, 28.2446822941487), + TrajectoryPoint(2970, 24.4207375928433), + TrajectoryPoint(2980, 19.905526154062), + TrajectoryPoint(2990, 14.047559055623), TrajectoryPoint(3000, 0), }; TrajectoryPoint t9_open[] = { - TrajectoryPoint(0, 478.278547728422), - TrajectoryPoint(10, 476.211500029465), - TrajectoryPoint(20, 474.136178146084), - TrajectoryPoint(30, 472.056290888838), - TrajectoryPoint(40, 469.971428207939), - TrajectoryPoint(50, 467.873729866974), - TrajectoryPoint(60, 465.776031526009), - TrajectoryPoint(70, 463.661251221006), - TrajectoryPoint(80, 461.545357958572), - TrajectoryPoint(90, 459.417885897606), - TrajectoryPoint(100, 457.283402422459), - TrajectoryPoint(110, 455.142624434551), - TrajectoryPoint(120, 452.989143536112), - TrajectoryPoint(130, 450.834414906302), - TrajectoryPoint(140, 448.661516964976), - TrajectoryPoint(150, 446.48861902365), - TrajectoryPoint(160, 444.299413213795), - TrajectoryPoint(170, 442.106665685941), - TrajectoryPoint(180, 439.901675280017), - TrajectoryPoint(190, 437.688632156), - TrajectoryPoint(200, 435.467096158021), - TrajectoryPoint(210, 433.233297391626), - TrajectoryPoint(220, 430.994416183029), - TrajectoryPoint(230, 428.739387090409), - TrajectoryPoint(240, 426.482320202574), - TrajectoryPoint(250, 424.205570828753), - TrajectoryPoint(260, 421.928821454933), - TrajectoryPoint(270, 419.63045901318), - TrajectoryPoint(280, 417.331483463991), - TrajectoryPoint(290, 415.012599629394), - TrajectoryPoint(300, 412.690875366555), - TrajectoryPoint(310, 410.350474773329), - TrajectoryPoint(320, 408.005461870203), - TrajectoryPoint(330, 405.64249694696), - TrajectoryPoint(340, 403.273637302319), - TrajectoryPoint(350, 400.887005100071), - TrajectoryPoint(360, 398.493721607004), - TrajectoryPoint(370, 396.082260397478), - TrajectoryPoint(380, 393.663956064328), - TrajectoryPoint(390, 391.226441689245), - TrajectoryPoint(400, 388.782498709209), - TrajectoryPoint(410, 386.317640659335), - TrajectoryPoint(420, 383.847419425095), - TrajectoryPoint(430, 381.353856625769), - TrajectoryPoint(440, 378.856694685211), - TrajectoryPoint(450, 376.332990962789), - TrajectoryPoint(460, 373.805968806575), - TrajectoryPoint(470, 371.252841112584), - TrajectoryPoint(480, 368.693298395491), - TrajectoryPoint(490, 366.111094150961), - TrajectoryPoint(500, 363.517366273052), - TrajectoryPoint(510, 360.905319867744), - TrajectoryPoint(520, 358.562139740762), - TrajectoryPoint(530, 356.417404465994), - TrajectoryPoint(540, 354.296432124676), - TrajectoryPoint(550, 352.182400328728), - TrajectoryPoint(560, 350.098117929582), - TrajectoryPoint(570, 348.021765758857), - TrajectoryPoint(580, 345.967569559375), - TrajectoryPoint(590, 343.929185229801), - TrajectoryPoint(600, 341.904841222673), - TrajectoryPoint(610, 339.904516207286), - TrajectoryPoint(620, 337.913030082638), - TrajectoryPoint(630, 335.947352483533), - TrajectoryPoint(640, 333.994057160077), - TrajectoryPoint(650, 332.057057505269), - TrajectoryPoint(660, 330.141626498005), - TrajectoryPoint(670, 328.235987061237), - TrajectoryPoint(680, 326.354774939281), - TrajectoryPoint(690, 324.486565633175), - TrajectoryPoint(700, 322.632388337983), - TrajectoryPoint(710, 320.800978853921), - TrajectoryPoint(720, 318.979858035), - TrajectoryPoint(730, 317.177903945648), - TrajectoryPoint(740, 315.39272865858), - TrajectoryPoint(750, 313.618163296168), - TrajectoryPoint(760, 311.865872492707), - TrajectoryPoint(770, 310.126201386254), - TrajectoryPoint(780, 308.397764262136), - TrajectoryPoint(790, 306.692075701567), - TrajectoryPoint(800, 304.996879116948), - TrajectoryPoint(810, 303.314191679415), - TrajectoryPoint(820, 301.651720428767), - TrajectoryPoint(830, 299.999726346608), - TrajectoryPoint(840, 298.360209912748), - TrajectoryPoint(850, 296.739598904127), - TrajectoryPoint(860, 295.12934855463), - TrajectoryPoint(870, 293.530491690323), - TrajectoryPoint(880, 291.950229677145), - TrajectoryPoint(890, 290.380128186566), - TrajectoryPoint(900, 288.820350627951), - TrajectoryPoint(910, 287.277976945634), - TrajectoryPoint(920, 285.746337475045), - TrajectoryPoint(930, 284.224713492855), - TrajectoryPoint(940, 282.717148462183), - TrajectoryPoint(950, 281.222229413559), - TrajectoryPoint(960, 279.736972575034), - TrajectoryPoint(970, 278.262073646057), - TrajectoryPoint(980, 276.802109176751), - TrajectoryPoint(990, 275.351421485093), - TrajectoryPoint(1000, 273.910047568257), - TrajectoryPoint(1010, 272.480388665787), - TrajectoryPoint(1020, 271.062482861403), - TrajectoryPoint(1030, 269.653462081901), - TrajectoryPoint(1040, 268.253325414814), - TrajectoryPoint(1050, 266.864743598368), - TrajectoryPoint(1060, 265.486307834605), - TrajectoryPoint(1070, 264.116303320306), - TrajectoryPoint(1080, 262.754700911756), - TrajectoryPoint(1090, 261.403407410393), - TrajectoryPoint(1100, 260.061814759537), - TrajectoryPoint(1110, 258.728161864122), - TrajectoryPoint(1120, 257.402399165612), - TrajectoryPoint(1130, 256.084953948957), - TrajectoryPoint(1140, 254.777597184355), - TrajectoryPoint(1150, 253.477669500875), - TrajectoryPoint(1160, 252.185107069754), - TrajectoryPoint(1170, 250.899838946819), - TrajectoryPoint(1180, 249.622722774112), - TrajectoryPoint(1190, 248.353968216479), - TrajectoryPoint(1200, 247.092053232479), - TrajectoryPoint(1210, 245.836898993923), - TrajectoryPoint(1220, 244.588421789969), - TrajectoryPoint(1230, 243.346763457361), - TrajectoryPoint(1240, 242.113049645146), - TrajectoryPoint(1250, 240.885574207344), - TrajectoryPoint(1260, 239.664249970017), - TrajectoryPoint(1270, 238.44898649968), - TrajectoryPoint(1280, 237.23969050265), - TrajectoryPoint(1290, 236.036397006985), - TrajectoryPoint(1300, 234.839931940379), - TrajectoryPoint(1310, 233.649019685451), - TrajectoryPoint(1320, 232.463567205621), - TrajectoryPoint(1330, 231.283479659242), - TrajectoryPoint(1340, 230.108660669765), - TrajectoryPoint(1350, 228.939012573411), - TrajectoryPoint(1360, 227.774436645889), - TrajectoryPoint(1370, 226.615445809232), - TrajectoryPoint(1380, 225.461388458994), - TrajectoryPoint(1390, 224.31202484224), - TrajectoryPoint(1400, 223.167259415197), - TrajectoryPoint(1410, 222.026996108553), - TrajectoryPoint(1420, 220.891138477002), - TrajectoryPoint(1430, 219.759589835196), - TrajectoryPoint(1440, 218.632253381067), - TrajectoryPoint(1450, 217.509032307502), - TrajectoryPoint(1460, 216.389829903194), - TrajectoryPoint(1470, 215.274735584944), - TrajectoryPoint(1480, 214.163565474396), - TrajectoryPoint(1490, 213.056083062091), - TrajectoryPoint(1500, 211.952196148293), - TrajectoryPoint(1510, 210.851812805912), - TrajectoryPoint(1520, 209.754841443641), - TrajectoryPoint(1530, 208.661190862187), - TrajectoryPoint(1540, 207.570770304126), - TrajectoryPoint(1550, 206.483489497888), - TrajectoryPoint(1560, 205.399258696307), - TrajectoryPoint(1570, 204.317988710172), - TrajectoryPoint(1580, 203.239590937173), - TrajectoryPoint(1590, 202.16397738659), - TrajectoryPoint(1600, 201.091060700075), - TrajectoryPoint(1610, 200.020754168828), - TrajectoryPoint(1620, 198.952971747463), - TrajectoryPoint(1630, 197.887628064821), - TrajectoryPoint(1640, 196.824638431975), - TrajectoryPoint(1650, 195.763918847664), - TrajectoryPoint(1660, 194.705386001358), - TrajectoryPoint(1670, 193.648957274144), - TrajectoryPoint(1680, 192.594550737615), - TrajectoryPoint(1690, 191.542085150937), - TrajectoryPoint(1700, 190.491479956223), - TrajectoryPoint(1710, 189.442655272378), - TrajectoryPoint(1720, 188.395531887526), - TrajectoryPoint(1730, 187.350031250149), - TrajectoryPoint(1740, 186.306075459043), - TrajectoryPoint(1750, 185.263587252192), - TrajectoryPoint(1760, 184.22257834641), - TrajectoryPoint(1770, 183.182884088986), - TrajectoryPoint(1780, 182.144423437366), - TrajectoryPoint(1790, 181.107120862674), - TrajectoryPoint(1800, 180.070901435236), - TrajectoryPoint(1810, 179.035690806653), - TrajectoryPoint(1820, 178.001415191414), - TrajectoryPoint(1830, 176.968001348094), - TrajectoryPoint(1840, 175.935376560164), - TrajectoryPoint(1850, 174.903521457037), - TrajectoryPoint(1860, 173.872318583998), - TrajectoryPoint(1870, 172.841676899671), - TrajectoryPoint(1880, 171.8115251387), - TrajectoryPoint(1890, 170.781792472125), - TrajectoryPoint(1900, 169.75240848545), - TrajectoryPoint(1910, 168.723316718141), - TrajectoryPoint(1920, 167.694435952139), - TrajectoryPoint(1930, 166.665678587122), - TrajectoryPoint(1940, 165.636975283328), - TrajectoryPoint(1950, 164.608257008322), - TrajectoryPoint(1960, 163.579443098681), - TrajectoryPoint(1970, 162.550450918036), - TrajectoryPoint(1980, 161.52121932179), - TrajectoryPoint(1990, 160.491679949716), - TrajectoryPoint(2000, 159.461745815048), - TrajectoryPoint(2010, 158.431297695513), - TrajectoryPoint(2020, 157.400316749897), - TrajectoryPoint(2030, 156.368734921188), - TrajectoryPoint(2040, 155.336415481238), - TrajectoryPoint(2050, 154.303276223903), - TrajectoryPoint(2060, 153.26930941469), - TrajectoryPoint(2070, 152.234418560403), - TrajectoryPoint(2080, 151.198390692574), - TrajectoryPoint(2090, 150.161306216899), - TrajectoryPoint(2100, 149.12307544443), - TrajectoryPoint(2110, 148.083413521095), - TrajectoryPoint(2120, 147.042462786841), - TrajectoryPoint(2130, 146.000074817725), - TrajectoryPoint(2140, 144.956016169875), - TrajectoryPoint(2150, 143.910432507446), - TrajectoryPoint(2160, 142.86302085654), - TrajectoryPoint(2170, 141.813783074681), - TrajectoryPoint(2180, 140.762708157439), - TrajectoryPoint(2190, 139.709426568294), - TrajectoryPoint(2200, 138.654204582747), - TrajectoryPoint(2210, 137.596549855736), - TrajectoryPoint(2220, 136.53670532252), - TrajectoryPoint(2230, 135.474304678838), - TrajectoryPoint(2240, 134.409420927981), - TrajectoryPoint(2250, 133.341806276512), - TrajectoryPoint(2260, 132.271453577915), - TrajectoryPoint(2270, 131.198131677988), - TrajectoryPoint(2280, 130.121866247956), - TrajectoryPoint(2290, 129.04231767556), - TrajectoryPoint(2300, 127.959680582777), - TrajectoryPoint(2310, 126.873358481043), - TrajectoryPoint(2320, 125.783735788258), - TrajectoryPoint(2330, 124.690203065621), - TrajectoryPoint(2340, 123.592919112812), - TrajectoryPoint(2350, 122.491752178433), - TrajectoryPoint(2360, 121.386180834529), - TrajectoryPoint(2370, 120.276493648523), - TrajectoryPoint(2380, 119.162336533532), - TrajectoryPoint(2390, 118.043336129891), - TrajectoryPoint(2400, 116.919660689373), - TrajectoryPoint(2410, 115.791108518486), - TrajectoryPoint(2420, 114.657000788222), - TrajectoryPoint(2430, 113.517594025613), - TrajectoryPoint(2440, 112.37266542314), - TrajectoryPoint(2450, 111.221978998853), - TrajectoryPoint(2460, 110.065017028763), - TrajectoryPoint(2470, 108.901722568979), - TrajectoryPoint(2480, 107.731925939518), - TrajectoryPoint(2490, 106.5553513929), - TrajectoryPoint(2500, 105.371711337064), - TrajectoryPoint(2510, 104.18070579714), - TrajectoryPoint(2520, 102.982021837292), - TrajectoryPoint(2530, 101.775332940371), - TrajectoryPoint(2540, 100.560298342896), - TrajectoryPoint(2550, 99.3365623225769), - TrajectoryPoint(2560, 98.1037534353411), - TrajectoryPoint(2570, 96.8614836984831), - TrajectoryPoint(2580, 95.6093477162258), - TrajectoryPoint(2590, 94.3469217436098), - TrajectoryPoint(2600, 93.0737626842191), - TrajectoryPoint(2610, 91.7894070168044), - TrajectoryPoint(2620, 90.4933696453812), - TrajectoryPoint(2630, 89.185048184399), - TrajectoryPoint(2640, 87.8634215534808), - TrajectoryPoint(2650, 86.5284036778613), - TrajectoryPoint(2660, 85.1794017123534), - TrajectoryPoint(2670, 83.8150029297168), - TrajectoryPoint(2680, 82.4349853164742), - TrajectoryPoint(2690, 81.0384716850518), - TrajectoryPoint(2700, 79.6240947661602), - TrajectoryPoint(2710, 78.1914551614109), - TrajectoryPoint(2720, 76.7389326509665), - TrajectoryPoint(2730, 75.2655658027758), - TrajectoryPoint(2740, 73.7704001911862), - TrajectoryPoint(2750, 72.2512048964613), - TrajectoryPoint(2760, 70.7068806270656), - TrajectoryPoint(2770, 69.1357751310688), - TrajectoryPoint(2780, 67.5358697659312), - TrajectoryPoint(2790, 65.9049544211068), - TrajectoryPoint(2800, 64.2406051406011), - TrajectoryPoint(2810, 62.5401584666845), - TrajectoryPoint(2820, 60.8006819350896), - TrajectoryPoint(2830, 59.0181570553473), - TrajectoryPoint(2840, 57.1887065593569), - TrajectoryPoint(2850, 55.308033353097), - TrajectoryPoint(2860, 53.370234757043), - TrajectoryPoint(2870, 51.3685158229248), - TrajectoryPoint(2880, 49.2955979533709), - TrajectoryPoint(2890, 47.1419854043448), - TrajectoryPoint(2900, 44.8956395842352), - TrajectoryPoint(2910, 42.5417142333501), - TrajectoryPoint(2920, 40.0614613401445), - TrajectoryPoint(2930, 37.4299859314421), - TrajectoryPoint(2940, 34.612180581639), - TrajectoryPoint(2950, 31.5583583824579), - TrajectoryPoint(2960, 28.1928485568192), - TrajectoryPoint(2970, 24.384009809099), - TrajectoryPoint(2980, 19.8827023441736), - TrajectoryPoint(2990, 14.0371188822043), + TrajectoryPoint(0, 523.747393474258), + TrajectoryPoint(10, 521.868557563024), + TrajectoryPoint(20, 519.985269847294), + TrajectoryPoint(30, 518.101982131565), + TrajectoryPoint(40, 516.208053029857), + TrajectoryPoint(50, 514.310846416394), + TrajectoryPoint(60, 512.410965227755), + TrajectoryPoint(70, 510.499566399391), + TrajectoryPoint(80, 508.588167571027), + TrajectoryPoint(90, 506.667552624142), + TrajectoryPoint(100, 504.74168104148), + TrajectoryPoint(110, 502.814193309934), + TrajectoryPoint(120, 500.87356094978), + TrajectoryPoint(130, 498.932928589626), + TrajectoryPoint(140, 496.983164434426), + TrajectoryPoint(150, 495.027475516337), + TrajectoryPoint(160, 493.069823969761), + TrajectoryPoint(170, 491.09877467004), + TrajectoryPoint(180, 489.12772537032), + TrajectoryPoint(190, 487.146124391592), + TrajectoryPoint(200, 485.159402544047), + TrajectoryPoint(210, 483.168795727231), + TrajectoryPoint(220, 481.166080509939), + TrajectoryPoint(230, 479.163365292647), + TrajectoryPoint(240, 477.146992762935), + TrajectoryPoint(250, 475.12795437023), + TrajectoryPoint(260, 473.101342540712), + TrajectoryPoint(270, 471.065641839555), + TrajectoryPoint(280, 469.028301383047), + TrajectoryPoint(290, 466.975589552857), + TrajectoryPoint(300, 464.922877722667), + TrajectoryPoint(310, 462.856925761861), + TrajectoryPoint(320, 460.786843916868), + TrajectoryPoint(330, 458.708743484202), + TrajectoryPoint(340, 456.620922277275), + TrajectoryPoint(350, 454.530098772404), + TrajectoryPoint(360, 452.424157979256), + TrajectoryPoint(370, 450.318217186109), + TrajectoryPoint(380, 448.195556961183), + TrajectoryPoint(390, 446.071105043786), + TrajectoryPoint(400, 443.934083955429), + TrajectoryPoint(410, 441.790717603358), + TrajectoryPoint(420, 439.638660398402), + TrajectoryPoint(430, 437.475964046776), + TrajectoryPoint(440, 435.308162210868), + TrajectoryPoint(450, 433.125707533424), + TrajectoryPoint(460, 430.94141743911), + TrajectoryPoint(470, 428.738762814867), + TrajectoryPoint(480, 426.536108190623), + TrajectoryPoint(490, 424.313893698494), + TrajectoryPoint(500, 422.090583650322), + TrajectoryPoint(510, 419.849810348826), + TrajectoryPoint(520, 417.605374952143), + TrajectoryPoint(530, 415.345166414232), + TrajectoryPoint(540, 413.079120673888), + TrajectoryPoint(550, 410.798555965792), + TrajectoryPoint(560, 408.510399159069), + TrajectoryPoint(570, 406.208510233832), + TrajectoryPoint(580, 403.897725217319), + TrajectoryPoint(590, 401.573494126384), + TrajectoryPoint(600, 399.239546604323), + TrajectoryPoint(610, 396.891902512423), + TrajectoryPoint(620, 394.534240263923), + TrajectoryPoint(630, 392.162056251142), + TrajectoryPoint(640, 389.780108313453), + TrajectoryPoint(650, 387.38219794683), + TrajectoryPoint(660, 384.975373751648), + TrajectoryPoint(670, 382.550487406995), + TrajectoryPoint(680, 380.118175866512), + TrajectoryPoint(690, 377.664996779283), + TrajectoryPoint(700, 375.206565318439), + TrajectoryPoint(710, 372.723705340397), + TrajectoryPoint(720, 370.237154072212), + TrajectoryPoint(730, 367.724493907659), + TrajectoryPoint(740, 365.205956142155), + TrajectoryPoint(750, 362.66513884096), + TrajectoryPoint(760, 360.113009456777), + TrajectoryPoint(770, 357.543305599686), + TrajectoryPoint(780, 354.99549634391), + TrajectoryPoint(790, 352.462434163807), + TrajectoryPoint(800, 349.968263841985), + TrajectoryPoint(810, 347.485825105683), + TrajectoryPoint(820, 345.045967528117), + TrajectoryPoint(830, 342.621864207911), + TrajectoryPoint(840, 340.227130172082), + TrajectoryPoint(850, 337.860684436884), + TrajectoryPoint(860, 335.510008625818), + TrajectoryPoint(870, 333.200352103423), + TrajectoryPoint(880, 330.904649102918), + TrajectoryPoint(890, 328.638717940934), + TrajectoryPoint(900, 326.398757395989), + TrajectoryPoint(910, 324.173815410609), + TrajectoryPoint(920, 321.987943543234), + TrajectoryPoint(930, 319.817254923104), + TrajectoryPoint(940, 317.66961996065), + TrajectoryPoint(950, 315.551701264683), + TrajectoryPoint(960, 313.449149422828), + TrajectoryPoint(970, 311.374401127662), + TrajectoryPoint(980, 309.322635237161), + TrajectoryPoint(990, 307.286489840848), + TrajectoryPoint(1000, 305.279915740541), + TrajectoryPoint(1010, 303.292355354019), + TrajectoryPoint(1020, 301.320417260777), + TrajectoryPoint(1030, 299.377453568815), + TrajectoryPoint(1040, 297.451759124565), + TrajectoryPoint(1050, 295.541482796895), + TrajectoryPoint(1060, 293.657765497346), + TrajectoryPoint(1070, 291.791316742938), + TrajectoryPoint(1080, 289.939920147022), + TrajectoryPoint(1090, 288.111316044006), + TrajectoryPoint(1100, 286.301309903063), + TrajectoryPoint(1110, 284.505867972923), + TrajectoryPoint(1120, 282.728490569996), + TrajectoryPoint(1130, 280.972022952494), + TrajectoryPoint(1140, 279.2295438036), + TrajectoryPoint(1150, 277.501164639792), + TrajectoryPoint(1160, 275.793889729698), + TrajectoryPoint(1170, 274.10137462528), + TrajectoryPoint(1180, 272.422273457041), + TrajectoryPoint(1190, 270.757601749953), + TrajectoryPoint(1200, 269.112090728776), + TrajectoryPoint(1210, 267.47928211803), + TrajectoryPoint(1220, 265.859166523224), + TrajectoryPoint(1230, 264.252789544788), + TrajectoryPoint(1240, 262.663376481687), + TrajectoryPoint(1250, 261.085909559407), + TrajectoryPoint(1260, 259.520330566758), + TrajectoryPoint(1270, 257.966560870373), + TrajectoryPoint(1280, 256.428571738377), + TrajectoryPoint(1290, 254.902109164625), + TrajectoryPoint(1300, 253.386690704439), + TrajectoryPoint(1310, 251.882210354948), + TrajectoryPoint(1320, 250.389360392791), + TrajectoryPoint(1330, 248.90969026314), + TrajectoryPoint(1340, 247.440213590685), + TrajectoryPoint(1350, 245.980807727366), + TrajectoryPoint(1360, 244.531340318074), + TrajectoryPoint(1370, 243.091670558425), + TrajectoryPoint(1380, 241.664020259531), + TrajectoryPoint(1390, 240.245700716288), + TrajectoryPoint(1400, 238.836468462221), + TrajectoryPoint(1410, 237.4361789424), + TrajectoryPoint(1420, 236.044682501706), + TrajectoryPoint(1430, 234.66182518788), + TrajectoryPoint(1440, 233.288747384671), + TrajectoryPoint(1450, 231.924177783005), + TrajectoryPoint(1460, 230.567590855619), + TrajectoryPoint(1470, 229.218835987142), + TrajectoryPoint(1480, 227.877760252731), + TrajectoryPoint(1490, 226.544208920252), + TrajectoryPoint(1500, 225.218025902051), + TrajectoryPoint(1510, 223.899054160569), + TrajectoryPoint(1520, 222.587917851891), + TrajectoryPoint(1530, 221.283673873772), + TrajectoryPoint(1540, 219.986061961108), + TrajectoryPoint(1550, 218.694933194189), + TrajectoryPoint(1560, 217.410138559732), + TrajectoryPoint(1570, 216.131529196312), + TrajectoryPoint(1580, 214.858956612368), + TrajectoryPoint(1590, 213.592272879236), + TrajectoryPoint(1600, 212.331330801415), + TrajectoryPoint(1610, 211.075984066127), + TrajectoryPoint(1620, 209.826087374041), + TrajectoryPoint(1630, 208.581496552879), + TrajectoryPoint(1640, 207.342068655467), + TrajectoryPoint(1650, 206.107662043683), + TrajectoryPoint(1660, 204.878136459598), + TrajectoryPoint(1670, 203.653353085019), + TrajectoryPoint(1680, 202.433237353929), + TrajectoryPoint(1690, 201.217564828883), + TrajectoryPoint(1700, 200.006198815249), + TrajectoryPoint(1710, 198.799009815042), + TrajectoryPoint(1720, 197.595869722303), + TrajectoryPoint(1730, 196.39665729189), + TrajectoryPoint(1740, 195.201311496286), + TrajectoryPoint(1750, 194.009653296539), + TrajectoryPoint(1760, 192.82155807025), + TrajectoryPoint(1770, 191.636902791301), + TrajectoryPoint(1780, 190.455566016454), + TrajectoryPoint(1790, 189.277427868631), + TrajectoryPoint(1800, 188.102370017245), + TrajectoryPoint(1810, 186.930275655892), + TrajectoryPoint(1820, 185.76102947771), + TrajectoryPoint(1830, 184.594517648653), + TrajectoryPoint(1840, 183.430627778934), + TrajectoryPoint(1850, 182.26924889284), + TrajectoryPoint(1860, 181.110271397138), + TrajectoryPoint(1870, 179.953587048214), + TrajectoryPoint(1880, 178.799104838089), + TrajectoryPoint(1890, 177.646880027131), + TrajectoryPoint(1900, 176.496620110176), + TrajectoryPoint(1910, 175.348221094657), + TrajectoryPoint(1920, 174.201580198865), + TrajectoryPoint(1930, 173.056595811242), + TrajectoryPoint(1940, 171.913167449479), + TrajectoryPoint(1950, 170.771216883118), + TrajectoryPoint(1960, 169.630765202834), + TrajectoryPoint(1970, 168.491556231485), + TrajectoryPoint(1980, 167.353493084884), + TrajectoryPoint(1990, 166.216479818488), + TrajectoryPoint(2000, 165.080421384456), + TrajectoryPoint(2010, 163.945326258292), + TrajectoryPoint(2020, 162.810990055698), + TrajectoryPoint(2030, 161.677305868339), + TrajectoryPoint(2040, 160.544181426173), + TrajectoryPoint(2050, 159.411559899119), + TrajectoryPoint(2060, 158.279323489216), + TrajectoryPoint(2070, 157.147348558512), + TrajectoryPoint(2080, 156.015545000293), + TrajectoryPoint(2090, 154.883821758573), + TrajectoryPoint(2100, 153.752065944582), + TrajectoryPoint(2110, 152.620186265376), + TrajectoryPoint(2120, 151.488066055267), + TrajectoryPoint(2130, 150.355591566311), + TrajectoryPoint(2140, 149.222698566118), + TrajectoryPoint(2150, 148.089244085444), + TrajectoryPoint(2160, 146.95510382731), + TrajectoryPoint(2170, 145.820249872424), + TrajectoryPoint(2180, 144.684465404767), + TrajectoryPoint(2190, 143.547700222645), + TrajectoryPoint(2200, 142.409899618492), + TrajectoryPoint(2210, 141.2707569161), + TrajectoryPoint(2220, 140.130392134247), + TrajectoryPoint(2230, 138.988487809338), + TrajectoryPoint(2240, 137.845055015396), + TrajectoryPoint(2250, 136.699921641719), + TrajectoryPoint(2260, 135.552930411771), + TrajectoryPoint(2270, 134.404047295601), + TrajectoryPoint(2280, 133.252994910704), + TrajectoryPoint(2290, 132.099812491766), + TrajectoryPoint(2300, 130.944182816401), + TrajectoryPoint(2310, 129.786121966008), + TrajectoryPoint(2320, 128.625384185858), + TrajectoryPoint(2330, 127.461835161049), + TrajectoryPoint(2340, 126.295442384669), + TrajectoryPoint(2350, 125.125763457497), + TrajectoryPoint(2360, 123.953023058062), + TrajectoryPoint(2370, 122.776666958284), + TrajectoryPoint(2380, 121.596757547772), + TrajectoryPoint(2390, 120.413239027703), + TrajectoryPoint(2400, 119.225437753712), + TrajectoryPoint(2410, 118.033612884456), + TrajectoryPoint(2420, 116.837567121887), + TrajectoryPoint(2430, 115.636739495629), + TrajectoryPoint(2440, 114.431142473696), + TrajectoryPoint(2450, 113.220643097922), + TrajectoryPoint(2460, 112.00499416104), + TrajectoryPoint(2470, 110.783680057809), + TrajectoryPoint(2480, 109.55660451851), + TrajectoryPoint(2490, 108.32359008065), + TrajectoryPoint(2500, 107.084346036371), + TrajectoryPoint(2510, 105.838568710284), + TrajectoryPoint(2520, 104.585940907215), + TrajectoryPoint(2530, 103.326131312436), + TrajectoryPoint(2540, 102.058793842281), + TrajectoryPoint(2550, 100.783536226793), + TrajectoryPoint(2560, 99.5000354399248), + TrajectoryPoint(2570, 98.2079166913638), + TrajectoryPoint(2580, 96.9066857794576), + TrajectoryPoint(2590, 95.5959485007236), + TrajectoryPoint(2600, 94.2752533894305), + TrajectoryPoint(2610, 92.9441280246976), + TrajectoryPoint(2620, 91.6020778643713), + TrajectoryPoint(2630, 90.2485849927092), + TrajectoryPoint(2640, 88.8831067752384), + TrajectoryPoint(2650, 87.5044463251253), + TrajectoryPoint(2660, 86.1124588231539), + TrajectoryPoint(2670, 84.7065672188813), + TrajectoryPoint(2680, 83.2853623352815), + TrajectoryPoint(2690, 81.8484418596819), + TrajectoryPoint(2700, 80.3948973104004), + TrajectoryPoint(2710, 78.9233603409451), + TrajectoryPoint(2720, 77.4331690236604), + TrajectoryPoint(2730, 75.9229421397488), + TrajectoryPoint(2740, 74.3911453851764), + TrajectoryPoint(2750, 72.8368972395868), + TrajectoryPoint(2760, 71.2584581149918), + TrajectoryPoint(2770, 69.6534747751097), + TrajectoryPoint(2780, 68.020623862156), + TrajectoryPoint(2790, 66.3576997347094), + TrajectoryPoint(2800, 64.6622818503231), + TrajectoryPoint(2810, 62.931709166631), + TrajectoryPoint(2820, 61.1625718310199), + TrajectoryPoint(2830, 59.3512975777779), + TrajectoryPoint(2840, 57.4946226649486), + TrajectoryPoint(2850, 55.5867680935224), + TrajectoryPoint(2860, 53.6234239771862), + TrajectoryPoint(2870, 51.5968982023884), + TrajectoryPoint(2880, 49.499952761562), + TrajectoryPoint(2890, 47.3233946087588), + TrajectoryPoint(2900, 45.054516945917), + TrajectoryPoint(2910, 42.679897818568), + TrajectoryPoint(2920, 40.1794881949309), + TrajectoryPoint(2930, 37.5290915153985), + TrajectoryPoint(2940, 34.6931440596717), + TrajectoryPoint(2950, 31.6225673287491), + TrajectoryPoint(2960, 28.2413518668718), + TrajectoryPoint(2970, 24.4183787420978), + TrajectoryPoint(2980, 19.9040610333049), + TrajectoryPoint(2990, 14.0468893442335), TrajectoryPoint(3000, 0), }; TrajectoryPoint t10_open[] = { - TrajectoryPoint(0, 473.862370607181), - TrajectoryPoint(10, 471.812107673286), - TrajectoryPoint(20, 469.75170401644), - TrajectoryPoint(30, 467.689754885253), - TrajectoryPoint(40, 465.618663319797), - TrajectoryPoint(50, 463.539204598359), - TrajectoryPoint(60, 461.456156906346), - TrajectoryPoint(70, 459.358814578742), - TrajectoryPoint(80, 457.261472251139), - TrajectoryPoint(90, 455.147626991193), - TrajectoryPoint(100, 453.032015978972), - TrajectoryPoint(110, 450.904644445322), - TrajectoryPoint(120, 448.770368161546), - TrajectoryPoint(130, 446.628828002124), - TrajectoryPoint(140, 444.475477882792), - TrajectoryPoint(150, 442.319095057522), - TrajectoryPoint(160, 440.146250068972), - TrajectoryPoint(170, 437.97340508042), - TrajectoryPoint(180, 435.781543214765), - TrajectoryPoint(190, 433.588769335547), - TrajectoryPoint(200, 431.380166966152), - TrajectoryPoint(210, 429.167016641793), - TrajectoryPoint(220, 426.940879549478), - TrajectoryPoint(230, 424.706891118391), - TrajectoryPoint(240, 422.4623850352), - TrajectoryPoint(250, 420.207082123903), - TrajectoryPoint(260, 417.943330423789), - TrajectoryPoint(270, 415.666221309441), - TrajectoryPoint(280, 413.382302540208), - TrajectoryPoint(290, 411.08287947831), - TrajectoryPoint(300, 408.777824722146), - TrajectoryPoint(310, 406.455563237102), - TrajectoryPoint(320, 404.128353285884), - TrajectoryPoint(330, 401.782711421941), - TrajectoryPoint(340, 399.432273752213), - TrajectoryPoint(350, 397.062691282078), - TrajectoryPoint(360, 394.68789681321), - TrajectoryPoint(370, 392.293794401449), - TrajectoryPoint(380, 389.893454018892), - TrajectoryPoint(390, 387.474232336979), - TrajectoryPoint(400, 385.047093160835), - TrajectoryPoint(410, 382.602131950451), - TrajectoryPoint(420, 380.146873327645), - TrajectoryPoint(430, 377.675530408554), - TrajectoryPoint(440, 375.190759604773), - TrajectoryPoint(450, 372.692369823294), - TrajectoryPoint(460, 370.176617388514), - TrajectoryPoint(470, 367.650491502265), - TrajectoryPoint(480, 365.10220628103), - TrajectoryPoint(490, 362.547629775254), - TrajectoryPoint(500, 359.96517352999), - TrajectoryPoint(510, 357.455093724086), - TrajectoryPoint(520, 355.348197134573), - TrajectoryPoint(530, 353.252393456111), - TrajectoryPoint(540, 351.175078400194), - TrajectoryPoint(550, 349.115878760635), - TrajectoryPoint(560, 347.068068456201), - TrajectoryPoint(570, 345.045800289188), - TrajectoryPoint(580, 343.031547422433), - TrajectoryPoint(590, 341.042113320263), - TrajectoryPoint(600, 339.065240520618), - TrajectoryPoint(610, 337.104510448929), - TrajectoryPoint(620, 335.16489310986), - TrajectoryPoint(630, 333.234438315107), - TrajectoryPoint(640, 331.329820650795), - TrajectoryPoint(650, 329.436465099355), - TrajectoryPoint(660, 327.559156619376), - TrajectoryPoint(670, 325.702428142714), - TrajectoryPoint(680, 323.85557052489), - TrajectoryPoint(690, 322.03120515252), - TrajectoryPoint(700, 320.22034174233), - TrajectoryPoint(710, 318.42156035764), - TrajectoryPoint(720, 316.645977843989), - TrajectoryPoint(730, 314.880556091739), - TrajectoryPoint(740, 313.131088455255), - TrajectoryPoint(750, 311.399977152901), - TrajectoryPoint(760, 309.679234135061), - TrajectoryPoint(770, 307.976559372075), - TrajectoryPoint(780, 306.289002002157), - TrajectoryPoint(790, 304.611889946481), - TrajectoryPoint(800, 302.953480918199), - TrajectoryPoint(810, 301.30831584618), - TrajectoryPoint(820, 299.673558817451), - TrajectoryPoint(830, 298.056926497617), - TrajectoryPoint(840, 296.452799902787), - TrajectoryPoint(850, 294.858947677273), - TrajectoryPoint(860, 293.281672151523), - TrajectoryPoint(870, 291.717086660583), - TrajectoryPoint(880, 290.162563165204), - TrajectoryPoint(890, 288.622314355422), - TrajectoryPoint(900, 287.095672187055), - TrajectoryPoint(910, 285.578817365454), - TrajectoryPoint(920, 284.073367989725), - TrajectoryPoint(930, 282.583007864105), - TrajectoryPoint(940, 281.102112770061), - TrajectoryPoint(950, 279.630758236028), - TrajectoryPoint(960, 278.173573340556), - TrajectoryPoint(970, 276.726908807597), - TrajectoryPoint(980, 275.289399903134), - TrajectoryPoint(990, 273.861933024617), - TrajectoryPoint(1000, 272.447772545876), - TrajectoryPoint(1010, 271.042363211029), - TrajectoryPoint(1020, 269.645713857881), - TrajectoryPoint(1030, 268.259416145023), - TrajectoryPoint(1040, 266.884388927358), - TrajectoryPoint(1050, 265.517689457257), - TrajectoryPoint(1060, 264.159297075147), - TrajectoryPoint(1070, 262.810401456445), - TrajectoryPoint(1080, 261.471973382954), - TrajectoryPoint(1090, 260.141407378488), - TrajectoryPoint(1100, 258.818661167124), - TrajectoryPoint(1110, 257.50374196031), - TrajectoryPoint(1120, 256.19938316929), - TrajectoryPoint(1130, 254.902397498311), - TrajectoryPoint(1140, 253.612727313536), - TrajectoryPoint(1150, 252.330307574502), - TrajectoryPoint(1160, 251.055901535551), - TrajectoryPoint(1170, 249.790004566058), - TrajectoryPoint(1180, 248.530914611193), - TrajectoryPoint(1190, 247.278557822622), - TrajectoryPoint(1200, 246.032855218356), - TrajectoryPoint(1210, 244.79409852499), - TrajectoryPoint(1220, 243.563189267312), - TrajectoryPoint(1230, 242.338504308903), - TrajectoryPoint(1240, 241.119960447176), - TrajectoryPoint(1250, 239.907471011398), - TrajectoryPoint(1260, 238.700946270742), - TrajectoryPoint(1270, 237.500795833456), - TrajectoryPoint(1280, 236.307150610324), - TrajectoryPoint(1290, 235.11906179317), - TrajectoryPoint(1300, 233.936439330976), - TrajectoryPoint(1310, 232.7591912061), - TrajectoryPoint(1320, 231.587223712272), - TrajectoryPoint(1330, 230.420441709896), - TrajectoryPoint(1340, 229.259148539798), - TrajectoryPoint(1350, 228.103232170912), - TrajectoryPoint(1360, 226.952123313007), - TrajectoryPoint(1370, 225.805729230627), - TrajectoryPoint(1380, 224.663956382881), - TrajectoryPoint(1390, 223.526710593903), - TrajectoryPoint(1400, 222.393897208411), - TrajectoryPoint(1410, 221.265421233403), - TrajectoryPoint(1420, 220.141187467015), - TrajectoryPoint(1430, 219.021233023768), - TrajectoryPoint(1440, 217.905588185767), - TrajectoryPoint(1450, 216.793848586491), - TrajectoryPoint(1460, 215.685923056781), - TrajectoryPoint(1470, 214.581720479421), - TrajectoryPoint(1480, 213.481149872129), - TrajectoryPoint(1490, 212.384120462279), - TrajectoryPoint(1500, 211.290541753955), - TrajectoryPoint(1510, 210.20032358792), - TrajectoryPoint(1520, 209.113376195043), - TrajectoryPoint(1530, 208.029610243676), - TrajectoryPoint(1540, 206.94893688144), - TrajectoryPoint(1550, 205.871267771864), - TrajectoryPoint(1560, 204.796515126263), - TrajectoryPoint(1570, 203.724591731232), - TrajectoryPoint(1580, 202.655410972087), - TrajectoryPoint(1590, 201.588886852589), - TrajectoryPoint(1600, 200.524934011226), - TrajectoryPoint(1610, 199.463467734333), - TrajectoryPoint(1620, 198.404403966303), - TrajectoryPoint(1630, 197.347659317119), - TrajectoryPoint(1640, 196.293151067417), - TrajectoryPoint(1650, 195.240797171292), - TrajectoryPoint(1660, 194.190516257014), - TrajectoryPoint(1670, 193.142227625834), - TrajectoryPoint(1680, 192.095851249037), - TrajectoryPoint(1690, 191.051307763377), - TrajectoryPoint(1700, 190.008518465042), - TrajectoryPoint(1710, 188.967405302252), - TrajectoryPoint(1720, 187.927890866627), - TrajectoryPoint(1730, 186.889898383407), - TrajectoryPoint(1740, 185.853351700636), - TrajectoryPoint(1750, 184.818175277385), - TrajectoryPoint(1760, 183.784294171116), - TrajectoryPoint(1770, 182.751634024235), - TrajectoryPoint(1780, 181.720168609434), - TrajectoryPoint(1790, 180.689812288416), - TrajectoryPoint(1800, 179.66044924951), - TrajectoryPoint(1810, 178.632006730962), - TrajectoryPoint(1820, 177.604412501373), - TrajectoryPoint(1830, 176.57759484109), - TrajectoryPoint(1840, 175.55148252326), - TrajectoryPoint(1850, 174.526004794586), - TrajectoryPoint(1860, 173.501115239535), - TrajectoryPoint(1870, 172.476743847208), - TrajectoryPoint(1880, 171.452783953506), - TrajectoryPoint(1890, 170.429166085466), - TrajectoryPoint(1900, 169.405821153207), - TrajectoryPoint(1910, 168.382680428381), - TrajectoryPoint(1920, 167.359680378797), - TrajectoryPoint(1930, 166.336739340616), - TrajectoryPoint(1940, 165.31378142889), - TrajectoryPoint(1950, 164.290738799321), - TrajectoryPoint(1960, 163.267543862616), - TrajectoryPoint(1970, 162.244094930694), - TrajectoryPoint(1980, 161.220331329289), - TrajectoryPoint(1990, 160.196194585778), - TrajectoryPoint(2000, 159.171617585945), - TrajectoryPoint(2010, 158.14646984128), - TrajectoryPoint(2020, 157.1206950169), - TrajectoryPoint(2030, 156.094257982536), - TrajectoryPoint(2040, 155.067091728417), - TrajectoryPoint(2050, 154.038970284744), - TrajectoryPoint(2060, 153.009962311022), - TrajectoryPoint(2070, 151.980000993778), - TrajectoryPoint(2080, 150.94886791541), - TrajectoryPoint(2090, 149.916563606587), - TrajectoryPoint(2100, 148.883079016713), - TrajectoryPoint(2110, 147.848156860492), - TrajectoryPoint(2120, 146.811814586722), - TrajectoryPoint(2130, 145.774061504007), - TrajectoryPoint(2140, 144.734524178334), - TrajectoryPoint(2150, 143.693383873525), - TrajectoryPoint(2160, 142.650473942006), - TrajectoryPoint(2170, 141.605569649245), - TrajectoryPoint(2180, 140.558850193436), - TrajectoryPoint(2190, 139.509842015929), - TrajectoryPoint(2200, 138.458798527447), - TrajectoryPoint(2210, 137.405390288739), - TrajectoryPoint(2220, 136.349620653461), - TrajectoryPoint(2230, 135.29136881595), - TrajectoryPoint(2240, 134.230458681574), - TrajectoryPoint(2250, 133.166895549986), - TrajectoryPoint(2260, 132.100417427986), - TrajectoryPoint(2270, 131.031050298988), - TrajectoryPoint(2280, 129.958562568277), - TrajectoryPoint(2290, 128.882872666284), - TrajectoryPoint(2300, 127.803918477935), - TrajectoryPoint(2310, 126.721359680572), - TrajectoryPoint(2320, 125.635456837382), - TrajectoryPoint(2330, 124.545463115329), - TrajectoryPoint(2340, 123.451804366283), - TrajectoryPoint(2350, 122.354086491803), - TrajectoryPoint(2360, 121.252046620846), - TrajectoryPoint(2370, 120.145847002057), - TrajectoryPoint(2380, 119.035001936047), - TrajectoryPoint(2390, 117.919396404239), - TrajectoryPoint(2400, 116.799071770053), - TrajectoryPoint(2410, 115.673701911932), - TrajectoryPoint(2420, 114.542850038388), - TrajectoryPoint(2430, 113.406658493024), - TrajectoryPoint(2440, 112.264900901334), - TrajectoryPoint(2450, 111.11731252657), - TrajectoryPoint(2460, 109.963336845355), - TrajectoryPoint(2470, 108.803079371893), - TrajectoryPoint(2480, 107.636275642949), - TrajectoryPoint(2490, 106.462649873934), - TrajectoryPoint(2500, 105.281914456613), - TrajectoryPoint(2510, 104.093769419095), - TrajectoryPoint(2520, 102.897901846072), - TrajectoryPoint(2530, 101.693985257039), - TrajectoryPoint(2540, 100.481678939984), - TrajectoryPoint(2550, 99.2606272377635), - TrajectoryPoint(2560, 98.030458784094), - TrajectoryPoint(2570, 96.7907856857777), - TrajectoryPoint(2580, 95.5412026474347), - TrajectoryPoint(2590, 94.28128603465), - TrajectoryPoint(2600, 93.0105928710332), - TrajectoryPoint(2610, 91.7286597642455), - TrajectoryPoint(2620, 90.4350017555611), - TrajectoryPoint(2630, 89.1291110869938), - TrajectoryPoint(2640, 87.8097765047788), - TrajectoryPoint(2650, 86.4770054736807), - TrajectoryPoint(2660, 85.1302076335847), - TrajectoryPoint(2670, 83.7680579887443), - TrajectoryPoint(2680, 82.3901552061626), - TrajectoryPoint(2690, 80.9957986190593), - TrajectoryPoint(2700, 79.5834474013435), - TrajectoryPoint(2710, 78.1528718006597), - TrajectoryPoint(2720, 76.7022861821182), - TrajectoryPoint(2730, 75.2308896339259), - TrajectoryPoint(2740, 73.7376469781135), - TrajectoryPoint(2750, 72.2202534538853), - TrajectoryPoint(2760, 70.6777576179105), - TrajectoryPoint(2770, 69.1084324674704), - TrajectoryPoint(2780, 67.5102590787228), - TrajectoryPoint(2790, 65.8810271113061), - TrajectoryPoint(2800, 64.2183124281507), - TrajectoryPoint(2810, 62.5194514367167), - TrajectoryPoint(2820, 60.7815115819673), - TrajectoryPoint(2830, 59.0005277688878), - TrajectoryPoint(2840, 57.1725121532777), - TrajectoryPoint(2850, 55.2932732404973), - TrajectoryPoint(2860, 53.356806940717), - TrajectoryPoint(2870, 51.3564136402496), - TrajectoryPoint(2880, 49.2847653908511), - TrajectoryPoint(2890, 47.1323658813152), - TrajectoryPoint(2900, 44.8872122583775), - TrajectoryPoint(2910, 42.5343820041368), - TrajectoryPoint(2920, 40.0551966620442), - TrajectoryPoint(2930, 37.4247238668615), - TrajectoryPoint(2940, 34.607880499359), - TrajectoryPoint(2950, 31.554947121852), - TrajectoryPoint(2960, 28.1902709533103), - TrajectoryPoint(2970, 24.3821827987399), - TrajectoryPoint(2980, 19.8815665988451), - TrajectoryPoint(2990, 14.0365991419119), + TrajectoryPoint(0, 520.294184063234), + TrajectoryPoint(10, 518.414946538402), + TrajectoryPoint(20, 516.531540596889), + TrajectoryPoint(30, 514.648134655376), + TrajectoryPoint(40, 512.753351115348), + TrajectoryPoint(50, 510.85599555496), + TrajectoryPoint(60, 508.95499514257), + TrajectoryPoint(70, 507.04341612669), + TrajectoryPoint(80, 505.131837110809), + TrajectoryPoint(90, 503.209798188292), + TrajectoryPoint(100, 501.2837146377), + TrajectoryPoint(110, 499.354520923721), + TrajectoryPoint(120, 497.413644254132), + TrajectoryPoint(130, 495.472767584544), + TrajectoryPoint(140, 493.520973716375), + TrajectoryPoint(150, 491.565007564028), + TrajectoryPoint(160, 489.6050257748), + TrajectoryPoint(170, 487.633665709448), + TrajectoryPoint(180, 485.662305644097), + TrajectoryPoint(190, 483.678030254603), + TrajectoryPoint(200, 481.690963479211), + TrajectoryPoint(210, 479.697361760704), + TrajectoryPoint(220, 477.694266797092), + TrajectoryPoint(230, 475.69089182426), + TrajectoryPoint(240, 473.671438183907), + TrajectoryPoint(250, 471.651984543554), + TrajectoryPoint(260, 469.62166954984), + TrajectoryPoint(270, 467.585517388993), + TrajectoryPoint(280, 465.544120666829), + TrajectoryPoint(290, 463.490920425014), + TrajectoryPoint(300, 461.437720183199), + TrajectoryPoint(310, 459.367309641638), + TrajectoryPoint(320, 457.296701662606), + TrajectoryPoint(330, 455.213765305676), + TrajectoryPoint(340, 453.125379439739), + TrajectoryPoint(350, 451.029330203747), + TrajectoryPoint(360, 448.922785390415), + TrajectoryPoint(370, 446.8130077794), + TrajectoryPoint(380, 444.687911609113), + TrajectoryPoint(390, 442.562815438825), + TrajectoryPoint(400, 440.419708410528), + TrajectoryPoint(410, 438.27565666423), + TrajectoryPoint(420, 436.117082208266), + TrajectoryPoint(430, 433.953658373463), + TrajectoryPoint(440, 431.77889326178), + TrajectoryPoint(450, 429.595668023612), + TrajectoryPoint(460, 427.403953281962), + TrajectoryPoint(470, 425.200483987734), + TrajectoryPoint(480, 422.991022884931), + TrajectoryPoint(490, 420.766852980428), + TrajectoryPoint(500, 418.538808882724), + TrajectoryPoint(510, 416.293467318492), + TrajectoryPoint(520, 414.045961398579), + TrajectoryPoint(530, 411.778962004246), + TrajectoryPoint(540, 409.511070793455), + TrajectoryPoint(550, 407.221911617999), + TrajectoryPoint(560, 404.932664389251), + TrajectoryPoint(570, 402.620827004959), + TrajectoryPoint(580, 400.308989620667), + TrajectoryPoint(590, 397.974151740577), + TrajectoryPoint(600, 395.639077063919), + TrajectoryPoint(610, 393.28025835688), + TrajectoryPoint(620, 390.920602927094), + TrajectoryPoint(630, 388.537444310739), + TrajectoryPoint(640, 386.152018308858), + TrajectoryPoint(650, 383.743927673277), + TrajectoryPoint(660, 381.33147787576), + TrajectoryPoint(670, 378.897842517697), + TrajectoryPoint(680, 376.457048329888), + TrajectoryPoint(690, 373.997233980638), + TrajectoryPoint(700, 371.526703174466), + TrajectoryPoint(710, 369.040052969811), + TrajectoryPoint(720, 366.538317100055), + TrajectoryPoint(730, 364.024150488043), + TrajectoryPoint(740, 361.4896599589), + TrajectoryPoint(750, 358.947271540907), + TrajectoryPoint(760, 356.417227500053), + TrajectoryPoint(770, 353.894491009387), + TrajectoryPoint(780, 351.412045807433), + TrajectoryPoint(790, 348.946574367567), + TrajectoryPoint(800, 346.509703921125), + TrajectoryPoint(810, 344.101117619968), + TrajectoryPoint(820, 341.708876329502), + TrajectoryPoint(830, 339.356592352521), + TrajectoryPoint(840, 337.017271162977), + TrajectoryPoint(850, 334.711223082175), + TrajectoryPoint(860, 332.427589689822), + TrajectoryPoint(870, 330.163016162411), + TrajectoryPoint(880, 327.934014483037), + TrajectoryPoint(890, 325.719248472955), + TrajectoryPoint(900, 323.534230503796), + TrajectoryPoint(910, 321.372759271611), + TrajectoryPoint(920, 319.226305179532), + TrajectoryPoint(930, 317.116224131128), + TrajectoryPoint(940, 315.021366302633), + TrajectoryPoint(950, 312.947015400351), + TrajectoryPoint(960, 310.902220095605), + TrajectoryPoint(970, 308.87246288339), + TrajectoryPoint(980, 306.866137554785), + TrajectoryPoint(990, 304.884372217977), + TrajectoryPoint(1000, 302.917723321331), + TrajectoryPoint(1010, 300.974954225157), + TrajectoryPoint(1020, 299.05407270038), + TrajectoryPoint(1030, 297.148176588026), + TrajectoryPoint(1040, 295.264672886738), + TrajectoryPoint(1050, 293.402230636737), + TrajectoryPoint(1060, 291.55447543835), + TrajectoryPoint(1070, 289.726159666884), + TrajectoryPoint(1080, 287.919509734049), + TrajectoryPoint(1090, 286.127119890393), + TrajectoryPoint(1100, 284.350147207932), + TrajectoryPoint(1110, 282.596521875624), + TrajectoryPoint(1120, 280.856634948092), + TrajectoryPoint(1130, 279.130619723112), + TrajectoryPoint(1140, 277.423978363436), + TrajectoryPoint(1150, 275.733706416913), + TrajectoryPoint(1160, 274.056665038965), + TrajectoryPoint(1170, 272.392897727885), + TrajectoryPoint(1180, 270.749280500709), + TrajectoryPoint(1190, 269.118315262753), + TrajectoryPoint(1200, 267.499914636565), + TrajectoryPoint(1210, 265.894633357531), + TrajectoryPoint(1220, 264.306920776038), + TrajectoryPoint(1230, 262.731056889096), + TrajectoryPoint(1240, 261.166996890985), + TrajectoryPoint(1250, 259.614674769877), + TrajectoryPoint(1260, 258.078179081881), + TrajectoryPoint(1270, 256.553204533479), + TrajectoryPoint(1280, 255.039225340795), + TrajectoryPoint(1290, 253.536145680198), + TrajectoryPoint(1300, 252.045088130273), + TrajectoryPoint(1310, 250.566888186248), + TrajectoryPoint(1320, 249.098860696351), + TrajectoryPoint(1330, 247.640891153056), + TrajectoryPoint(1340, 246.192854780853), + TrajectoryPoint(1350, 244.755261447908), + TrajectoryPoint(1360, 243.329243506392), + TrajectoryPoint(1370, 241.912458537199), + TrajectoryPoint(1380, 240.504773978814), + TrajectoryPoint(1390, 239.106050846009), + TrajectoryPoint(1400, 237.716144640574), + TrajectoryPoint(1410, 236.335551763655), + TrajectoryPoint(1420, 234.964558851151), + TrajectoryPoint(1430, 233.601728018534), + TrajectoryPoint(1440, 232.246915570894), + TrajectoryPoint(1450, 230.899974633552), + TrajectoryPoint(1460, 229.560755729474), + TrajectoryPoint(1470, 228.229107300791), + TrajectoryPoint(1480, 226.904945109916), + TrajectoryPoint(1490, 225.589023960936), + TrajectoryPoint(1500, 224.280081629326), + TrajectoryPoint(1510, 222.977972718581), + TrajectoryPoint(1520, 221.682550951651), + TrajectoryPoint(1530, 220.393669493705), + TrajectoryPoint(1540, 219.11118124117), + TrajectoryPoint(1550, 217.834939079917), + TrajectoryPoint(1560, 216.564796115293), + TrajectoryPoint(1570, 215.300605876437), + TrajectoryPoint(1580, 214.042222497161), + TrajectoryPoint(1590, 212.789500875467), + TrajectoryPoint(1600, 211.542604423018), + TrajectoryPoint(1610, 210.301059606955), + TrajectoryPoint(1620, 209.064692550815), + TrajectoryPoint(1630, 207.833367330528), + TrajectoryPoint(1640, 206.606948996915), + TrajectoryPoint(1650, 205.385303665127), + TrajectoryPoint(1660, 204.168298591501), + TrajectoryPoint(1670, 202.955802238966), + TrajectoryPoint(1680, 201.747684332069), + TrajectoryPoint(1690, 200.543815902558), + TrajectoryPoint(1700, 199.344069326423), + TrajectoryPoint(1710, 198.148318353167), + TrajectoryPoint(1720, 196.956438128065), + TrajectoryPoint(1730, 195.768305208064), + TrajectoryPoint(1740, 194.583797571931), + TrajectoryPoint(1750, 193.402794625217), + TrajectoryPoint(1760, 192.22517720053), + TrajectoryPoint(1770, 191.050827553586), + TrajectoryPoint(1780, 189.879629355459), + TrajectoryPoint(1790, 188.711467681412), + TrajectoryPoint(1800, 187.546308144123), + TrajectoryPoint(1810, 186.384041507529), + TrajectoryPoint(1820, 185.224474047124), + TrajectoryPoint(1830, 184.067494971789), + TrajectoryPoint(1840, 182.912994874151), + TrajectoryPoint(1850, 181.760865699702), + TrajectoryPoint(1860, 180.611000714724), + TrajectoryPoint(1870, 179.463294473178), + TrajectoryPoint(1880, 178.3176427827), + TrajectoryPoint(1890, 177.173942669809), + TrajectoryPoint(1900, 176.032145035965), + TrajectoryPoint(1910, 174.892220814964), + TrajectoryPoint(1920, 173.753932487395), + TrajectoryPoint(1930, 172.6171809299), + TrajectoryPoint(1940, 171.481868084714), + TrajectoryPoint(1950, 170.347896919647), + TrajectoryPoint(1960, 169.215171388028), + TrajectoryPoint(1970, 168.083732180641), + TrajectoryPoint(1980, 166.953337645433), + TrajectoryPoint(1990, 165.823886456441), + TrajectoryPoint(2000, 164.695285661031), + TrajectoryPoint(2010, 163.567443804621), + TrajectoryPoint(2020, 162.440357731978), + TrajectoryPoint(2030, 161.313824954195), + TrajectoryPoint(2040, 160.187755090781), + TrajectoryPoint(2050, 159.062058396399), + TrajectoryPoint(2060, 157.936673955488), + TrajectoryPoint(2070, 156.811466338663), + TrajectoryPoint(2080, 155.686340216569), + TrajectoryPoint(2090, 154.561203476435), + TrajectoryPoint(2100, 153.435940810059), + TrajectoryPoint(2110, 152.310469187034), + TrajectoryPoint(2120, 151.184701498792), + TrajectoryPoint(2130, 150.058461468977), + TrajectoryPoint(2140, 148.931719407349), + TrajectoryPoint(2150, 147.804390811462), + TrajectoryPoint(2160, 146.676232543227), + TrajectoryPoint(2170, 145.547284052143), + TrajectoryPoint(2180, 144.417398898088), + TrajectoryPoint(2190, 143.286377397274), + TrajectoryPoint(2200, 142.154272476736), + TrajectoryPoint(2210, 141.020781629889), + TrajectoryPoint(2220, 139.885932782102), + TrajectoryPoint(2230, 138.749568383057), + TrajectoryPoint(2240, 137.611500633411), + TrajectoryPoint(2250, 136.471770576951), + TrajectoryPoint(2260, 135.329997503738), + TrajectoryPoint(2270, 134.186381550112), + TrajectoryPoint(2280, 133.040404297991), + TrajectoryPoint(2290, 131.89235365306), + TrajectoryPoint(2300, 130.741659803416), + TrajectoryPoint(2310, 129.58859634525), + TrajectoryPoint(2320, 128.432658650093), + TrajectoryPoint(2330, 127.273973825415), + TrajectoryPoint(2340, 126.112248808443), + TrajectoryPoint(2350, 124.947302215647), + TrajectoryPoint(2360, 123.779228641372), + TrajectoryPoint(2370, 122.607346310855), + TrajectoryPoint(2380, 121.431979146028), + TrajectoryPoint(2390, 120.252815897183), + TrajectoryPoint(2400, 119.069416207378), + TrajectoryPoint(2410, 117.881944679586), + TrajectoryPoint(2420, 116.690157071466), + TrajectoryPoint(2430, 115.493452450706), + TrajectoryPoint(2440, 114.292021692098), + TrajectoryPoint(2450, 113.085628214861), + TrajectoryPoint(2460, 111.87398785109), + TrajectoryPoint(2470, 110.65655441975), + TrajectoryPoint(2480, 109.433400268975), + TrajectoryPoint(2490, 108.204247056575), + TrajectoryPoint(2500, 106.968804022675), + TrajectoryPoint(2510, 105.72676747895), + TrajectoryPoint(2520, 104.477820252616), + TrajectoryPoint(2530, 103.221631083338), + TrajectoryPoint(2540, 101.95775003417), + TrajectoryPoint(2550, 100.685966430244), + TrajectoryPoint(2560, 99.4059076019508), + TrajectoryPoint(2570, 98.117183985821), + TrajectoryPoint(2580, 96.8193883694775), + TrajectoryPoint(2590, 95.5119140453772), + TrajectoryPoint(2600, 94.1944219657191), + TrajectoryPoint(2610, 92.8664407737286), + TrajectoryPoint(2620, 91.527476168995), + TrajectoryPoint(2630, 90.1770104909934), + TrajectoryPoint(2640, 88.8145013729992), + TrajectoryPoint(2650, 87.4388625143585), + TrajectoryPoint(2660, 86.0497239163172), + TrajectoryPoint(2670, 84.6466237849786), + TrajectoryPoint(2680, 83.2282571102531), + TrajectoryPoint(2690, 81.7940085324056), + TrajectoryPoint(2700, 80.3431796002916), + TrajectoryPoint(2710, 78.8741954702452), + TrajectoryPoint(2720, 77.3865961026145), + TrajectoryPoint(2730, 75.8788037580769), + TrajectoryPoint(2740, 74.3494746580016), + TrajectoryPoint(2750, 72.7976315626961), + TrajectoryPoint(2760, 71.2214477204037), + TrajectoryPoint(2770, 69.6187445155037), + TrajectoryPoint(2780, 67.988110377873), + TrajectoryPoint(2790, 66.3273393800244), + TrajectoryPoint(2800, 64.6340107713119), + TrajectoryPoint(2810, 62.9054633740486), + TrajectoryPoint(2820, 61.1383567634864), + TrajectoryPoint(2830, 59.3289754686274), + TrajectoryPoint(2840, 57.4741292060343), + TrajectoryPoint(2850, 55.5680988333586), + TrajectoryPoint(2860, 53.6065079276512), + TrajectoryPoint(2870, 51.5816078307811), + TrajectoryPoint(2880, 49.4862737645788), + TrajectoryPoint(2890, 47.3112540551699), + TrajectoryPoint(2900, 45.0438862715074), + TrajectoryPoint(2910, 42.6706539435747), + TrajectoryPoint(2920, 40.1715944479075), + TrajectoryPoint(2930, 37.5224648495147), + TrajectoryPoint(2940, 34.687731795077), + TrajectoryPoint(2950, 31.6182763081882), + TrajectoryPoint(2960, 28.238111478929), + TrajectoryPoint(2970, 24.4160835520797), + TrajectoryPoint(2980, 19.9026353740619), + TrajectoryPoint(2990, 14.0462376221463), TrajectoryPoint(3000, 0), }; Trajectory t_closed[] = { @@ -7181,12 +7183,6 @@ Trajectory t_open[] = { Trajectory{0.0, t8_open, 301}, Trajectory{0.0, t9_open, 301}, Trajectory{0.0, t10_open, 301}, }; -// ============================================= -// WARNING: GEMINI ROCCARASO TRAJECTORIES -// REMOVE THESE!!! -// ============================================= - -TrajectorySet Main::Data::ABK::CLOSED_TRAJECTORY_SET{t_closed, 11}; -TrajectorySet Main::Data::ABK::OPEN_TRAJECTORY_SET{t_open, 11}; - +TrajectorySet Main::Data::ABK::CLOSED_TRAJECTORY_SET(t_closed, 11); +TrajectorySet Main::Data::ABK::OPEN_TRAJECTORY_SET(t_open, 11); #endif \ No newline at end of file diff --git a/src/boards/Main/StateMachines/MEAController/MEAController.cpp b/src/boards/Main/StateMachines/MEAController/MEAController.cpp index 5ddb2efc7fcb33545370a470fd70200147b883d7..527e80cf1b2b2d7b9975b02ac99adbd7512e8124 100644 --- a/src/boards/Main/StateMachines/MEAController/MEAController.cpp +++ b/src/boards/Main/StateMachines/MEAController/MEAController.cpp @@ -75,7 +75,7 @@ MEA::Config computeMEAConfig() float d = 0.15f; config.crossSection = Constants::PI * (d / 2) * (d / 2); - config.ae = 0.0028594f; + config.ae = 0.00285943f; config.p0 = 100093.7492f; config.cdCorrectionFactor = Config::MEA::CD_CORRECTION_FACTOR; diff --git a/src/boards/common/ReferenceConfig.h b/src/boards/common/ReferenceConfig.h index 3923b98e653424a7dc63c7a43c9657860d3f5b28..02a7288313f6d1af5bfa00407e1da4aca5b3bf5f 100644 --- a/src/boards/common/ReferenceConfig.h +++ b/src/boards/common/ReferenceConfig.h @@ -42,7 +42,7 @@ static const Boardcore::ReferenceValues defaultReferenceValues = { Boardcore::Constants::MSL_TEMPERATURE, }; -const Eigen::Vector3f nedMag(0.5939, -0.0126, 0.8044); +const Eigen::Vector3f nedMag(0.59448, -0.0093, 0.80406); #elif defined(ROCCARASO)