Gitiles
Code Review Sign In
realtimeroboticsgroup.org / RealtimeRoboticsGroup / test / f63bde80e20afb7f74dd12bf62b9a019e1b80e1c / . / y2018 / control_loops / python / arm_bounds.cc
blob: 53389935284b97e3777aad7e1687f5b51c35a864 [file] [log] [blame]
Austin Schuhad596222018-01-31 23:34:03 -0800[diff] [blame]1#include "y2018/control_loops/python/arm_bounds.h"
2
3#include <CGAL/Exact_predicates_inexact_constructions_kernel.h>
4#include <CGAL/Polygon_2_algorithms.h>
5#include <CGAL/squared_distance_2.h>
Tyler Chatowbf0609c2021-07-31 16:13:27 -0700[diff] [blame]6
7#include <cmath>
Austin Schuhad596222018-01-31 23:34:03 -0800[diff] [blame]8#include <iostream>
9
Stephan Pleinesf63bde82024-01-13 15:59:33 -0800[diff] [blame^]10namespace y2018::control_loops {
Austin Schuhad596222018-01-31 23:34:03 -0800[diff] [blame]11
12static BoundsCheck MakeArbitraryArmSpace(::std::vector<Point> points) {
13 for (Point &point : points) {
14 point = Point(M_PI / 2.0 - point.x(), M_PI / 2.0 - point.y());
15 }
16 return BoundsCheck(points);
17}
18
19Vector GetNormal(Point pt, Segment segment) {
20 auto perp_line = segment.supporting_line().perpendicular(pt);
21 if (CGAL::do_intersect(perp_line, segment)) {
22 return Vector(segment.supporting_line().projection(pt), pt);
23 } else {
24 if (CGAL::squared_distance(segment.vertex(0), pt) <
25 CGAL::squared_distance(segment.vertex(1), pt)) {
26 return Vector(segment.vertex(0), pt);
27 } else {
28 return Vector(segment.vertex(1), pt);
29 }
30 }
31}
32
33double BoundsCheck::min_distance(Point pt,
34 ::Eigen::Matrix<double, 2, 1> *norm) const {
35 auto *cell = grid_.GetCell(pt);
36 const auto &points = grid_.points();
37 bool inside = false;
38 double dist = 0;
39 Segment best_segment;
40 if (cell) {
41 if (cell->IsBorderline()) {
42 inside = check_inside(pt, points);
43 } else {
44 inside = cell->IsInside(pt);
45 }
46 dist = cell->Distance(pt, &best_segment);
47 } else {
48 dist = min_dist(pt, points, &best_segment);
49 // TODO(austin): Return norm.
50 }
51 Vector normal = GetNormal(pt, best_segment);
52 norm->x() = normal.x();
53 norm->y() = normal.y();
54
55 norm->normalize();
56
57 if (!inside) {
58 *norm = -(*norm);
59 }
60
61 return inside ? -dist : dist;
62}
63
64BoundsCheck MakeFullArmSpace() {
65 return MakeArbitraryArmSpace({{1.8577014383575772, -1.7353804562372057},
66 {1.8322288438826315, -1.761574570216062},
67 {1.7840339881582052, -1.8122752826851365},
68 {1.7367354460218392, -1.863184376466228},
69 {1.69054633425053, -1.9140647421906793},
70 {1.6456590387358871, -1.9646939485526782},
71 {1.6022412524081968, -2.0148691793459164},
72 {1.5604334435784202, -2.0644108218872432},
73 {1.5203477477575325, -2.1131646494909866},
74 {1.4820681545944325, -2.1610026706370666},
75 {1.4456517763321752, -2.207822815007094},
76 {1.4111309389855604, -2.253547685496041},
77 {1.3785158286698027, -2.298122627340264},
78 {1.3477974448369014, -2.3415133576238922},
79 {1.318950649522341, -2.3837033700108243},
80 {1.2919371475531436, -2.4246912899477153},
81 {1.266708279449626, -2.464488312575651},
82 {1.2432075513427807, -2.5031158147261996},
83 {1.2213728618107609, -2.5406031969824228},
84 {1.2011384131259828, -2.5769859833310096},
85 {1.1824363142639513, -2.61230418457078},
86 {1.165197896140849, -2.64660091671642},
87 {1.149354767212547, -2.6799212560849437},
88 {1.134839641107821, -2.712311307404836},
89 {1.121586968578607, -2.7438174590386177},
90 {1.1095334047223224, -2.774485799309971},
91 {1.09861813993779, -2.8043616692157007},
92 {1.088783119985477, -2.8334893289039758},
93 {1.079973177230731, -2.861911717797479},
94 {1.0721360919151535, -2.8896702908486835},
95 {1.065222599283597, -2.916804915950962},
96 {1.0591863556764607, -2.943353819884641},
97 {1.0539838743128325, -2.969353572295195},
98 {1.049574439440948, -2.9948390990606946},
99 {1.0459200058000553, -3.01984371800932},
100 {1.0429850888932353, -3.044399191310831},
101 {1.0407366503803421, -3.0685357900111128},
102 {1.039143981929867, -3.092282367132034},
103 {1.0381785900853944, -3.1156664365461078},
104 {1.0378140840766794, -3.1387142554815886},
105 {1.038026068010855, -3.1614509090414518},
106 {1.0387920384931424, -3.1839003955494407},
107 {1.0400912884293725, -3.2060857118856374},
108 {1.0419048175385754, -3.2280289382581637},
109 {1.0442152499395827, -3.2497513220895704},
110 {1.047006759060362, -3.2712733608874625},
111 {1.050265000044113, -3.2926148841283163},
112 {1.0539770497854413, -3.3137951343195065},
113 {1.0581313547182551, -3.3348328475243303},
114 {1.0627176864909802, -3.355746333744654},
115 {1.0677271057021644, -3.376553557661551},
116 {1.0731519339297724, -3.397272220341514},
117 {1.0789857343709142, -3.4179198426302158},
118 {1.08522330151719, -3.438513851083329},
119 {1.0918606604276442, -3.4590716674313335},
120 {1.0988950763314502, -3.4796108027504618},
121 {1.1063250755031675, -3.5001489577245133},
122 {1.114150478614587, -3.5207041306442908},
123 {1.1223724480923383, -3.541294735118319},
124 {1.1309935514178655, -3.561939729880535},
125 {1.1400178428208325, -3.5826587636046994},
126 {1.1494509664724388, -3.6034723383075913},
127 {1.1593002851278627, -3.6244019957930833},
128 {1.1695750392617108, -3.6454705327253025},
129 {1.1802865431772855, -3.6667022514168814},
130 {1.191448426478074, -3.6881232554134113},
131 {1.203076931852669, -3.709761801642497},
132 {1.2151912836117884, -3.731648724559698},
133 {1.2278141462274539, -3.753817952785642},
134 {1.2409721988621754, -3.7763071458245956},
135 {1.2546968614661016, -3.7991584885622527},
136 {1.2690252219158191, -3.82241969589366},
137 {1.2840012342034617, -3.846145301494764},
138 {1.2996772887032604, -3.870398337481948},
139 {1.316116303559539, -3.895252562382127},
140 {1.3333945626553043, -3.920795475499501},
141 {1.3516056511178856, -3.9471324882568375},
142 {1.3708660530144583, -3.974392848721103},
143 {1.3913233553973305, -4.002738316267376},
144 {1.4131687110627962, -4.032376331240737},
145 {1.436656614785, -4.063580905628138},
146 {1.4621380338543308, -4.0967276147972065},
147 {1.4901198983671067, -4.132356427437651},
148 {1.5213822452925796, -4.171295431810658},
149 {1.5572408030205178, -4.214938203914619},
150 {1.6002650085871786, -4.266002359325245},
151 {1.657096323745671, -4.331507506063609},
152 {1.7977393629734166, -4.48544594420617},
153 {1.8577014383575772, -4.546720690281509},
154 {1.8577014383575772, -5.497787143782138},
155 {1.2663322229932439, -5.497787143782138},
156 {1.2656247456808565, -5.4967516608259},
157 {1.2287034601894442, -5.445751427768824},
158 {1.1786904071656892, -5.381167803357418},
159 {1.0497616572686415, -5.233423649910944},
160 {0.9097522267255194, -5.096760177110545},
161 {0.8484431816837388, -5.043472544717165},
162 {0.8000049977037023, -5.003989210148714},
163 {0.7581818853313602, -4.9717075285444},
164 {0.7205493452982701, -4.944073122571691},
165 {0.6882849734317291, -4.921474754757885},
166 {0.6882849734317291, -2.40847516476558},
167 {0.8062364039734171, -2.2816832357742984},
168 {0.9846964491122989, -2.0749837238115147},
169 {1.080856081125841, -1.9535526052833936},
170 {1.1403399741223543, -1.8700303125904767},
171 {1.1796460643255697, -1.8073338252603661},
172 {1.206509908068604, -1.7574623871869075},
173 {1.225108933139178, -1.7160975113819317},
174 {1.237917343016644, -1.6806816402603253},
175 {1.2465009152225068, -1.6495957958330445},
176 {1.251901644035212, -1.6217619064422375},
177 {1.2548410275662123, -1.5964327471863136},
178 {1.2558349967266738, -1.5730732293972975},
179 {1.2552624664807475, -1.551289614657788},
180 {1.2534080548485127, -1.5307854126408047},
181 {1.2504896957865235, -1.5113328783804112},
182 {1.2466770509718135, -1.492754008779478},
183 {1.2421041193998992, -1.4749075280685116},
184 {1.236878076935188, -1.457679763958034},
185 {1.231085601347444, -1.4409781183381307},
186 {1.2247974811461413, -1.4247263085140511},
187 {1.2180720288351026, -1.408860841660136},
188 {1.2109576458572935, -1.3933283641188086},
189 {1.2034947755974974, -1.378083641634472},
190 {1.1957174082841977, -1.363088001457586},
191 {1.1876542532510088, -1.3483081171759035},
192 {1.179329661157153, -1.3337150510329991},
193 {1.1707643560768641, -1.3192834919003447},
194 {1.1385726725405734, -1.3512941162901886},
195 {1.1061744838535637, -1.3828092440478137},
196 {1.0736355415504857, -1.4137655512448706},
197 {1.0410203155384732, -1.444102884084807},
198 {1.0083912519665894, -1.4737649313813326},
199 {0.975808099297045, -1.5026998012630925},
200 {0.9433273192311136, -1.5308604887780404},
201 {0.941597772428203, -1.50959779639341},
202 {0.9392183822389457, -1.488861961175901},
203 {0.9362399962318921, -1.4685999567644576},
204 {0.9327074201772598, -1.448764371832554},
205 {0.9286602163651203, -1.4293126388801052},
206 {0.9241333769591611, -1.410206381002334},
207 {0.9191578939466147, -1.3914108561164176},
208 {0.9137612431353617, -1.3728944819981919},
209 {0.9079677963791273, -1.3546284285619337},
210 {0.9017991735984072, -1.3365862662768213},
211 {0.8952745440670551, -1.3187436615861219},
212 {0.888410884742945, -1.3010781117818295},
213 {0.8812232020507231, -1.2835687130679965},
214 {0.8737247224089426, -1.2661959565824437},
215 {0.8659270558807739, -1.2489415479874506},
216 {0.8578403365760008, -1.2317882469234374},
217 {0.8810761292150717, -1.2118184809610988},
218 {0.9041762360363244, -1.1914283310662528},
219 {0.9271196683064211, -1.1706361926784383},
220 {0.949885054142765, -1.1494613527499984},
221 {0.9724507572661958, -1.1279238910069835},
222 {0.9947950004998649, -1.1060445714951375},
223 {1.0168959923240788, -1.0838447258650978},
224 {1.0387320546908576, -1.0613461300367468},
225 {1.0602817502430675, -1.0385708760262022},
226 {1.0815240070740941, -1.0155412408147642},
227 {1.102438239206001, -0.9922795541836177},
228 {1.123004461055328, -0.9688080674301042},
229 {1.1432033942926907, -0.9451488248218312},
230 {1.1630165656794818, -0.9213235395370803},
231 {1.1824263946752058, -0.8973534756890716},
232 {1.2014162698440272, -0.8732593378443982},
233 {1.2199706133398625, -0.8490611692304734},
234 {1.2380749330068292, -0.8247782595916947},
235 {1.2557158618869284, -0.800429063408306},
236 {1.2728811851714203, -0.776031128944234},
237 {1.2895598548592355, -0.7516010383486005},
238 {1.3057419925890068, -0.7271543588072293},
239 {1.3214188812865908, -0.702705604531139},
240 {1.3365829464142562, -0.6782682091832445},
241 {1.351227727719687, -0.6538545081853449},
242 {1.365347842462401, -0.6294757302167044},
243 {1.3789389411433586, -0.6051419971134862},
244 {1.391997656782351, -0.5808623313043475},
245 {1.4045215487801634, -0.5566446698699925},
246 {1.4165090423718034, -0.5324958842910054},
247 {1.4279593646268474, -0.5084218049460658},
248 {1.4388724778869602, -0.4844272494383845},
249 {1.449249011452494, -0.460516053858597},
250 {1.4590901922431447, -0.4366911061340692},
251 {1.468397775065033, -0.4129543806643518},
252 {1.4771739730209745, -0.38930697349737264},
253 {1.485421388504271, -0.36574913735813025},
254 {1.4931429451209484, -0.3422803158986589},
255 {1.5003418207921726, -0.3188991765927855},
256 {1.5070213821985838, -0.2956036417497373},
257 {1.513185120641734, -0.2723909171654731},
258 {1.5188365893149296, -0.24925751796822435},
259 {1.5239793418959948, -0.22619929124396096},
260 {1.5286168722972349, -0.2032114350471563},
261 {1.5327525553319497, -0.1802885134112242},
262 {1.5363895879810432, -0.15742446697009113},
263 {1.5395309308654115, -0.1346126187862511},
264 {1.5421792494481048, -0.11184567494963411},
265 {1.5443368544016174, -0.0891157194637005},
266 {1.5460056404769755, -0.06641420286771664},
267 {1.5471870230984175, -0.043731923953761714},
268 {1.547881871775246, -0.021059003819238205},
269 {1.5480904392645911, 0.0016151486553661097},
270 {1.547812285227133, 0.024301881005710235},
271 {1.5470461928818935, 0.047013352405288866},
272 {1.5457900768723736, 0.06976260156314103},
273 {1.5440408801865422, 0.09256362934244797},
274 {1.5417944575035705, 0.11543149864415554},
275 {1.5390454417383017, 0.13838245474060726},
276 {1.5357870897759938, 0.16143407007284788},
277 {1.5320111023738603, 0.18460541860588778},
278 {1.5277074118667517, 0.20791728625864334},
279 {1.5228639295308124, 0.23139242581719505},
280 {1.5174662420569858, 0.25505586728497265},
281 {1.5114972433117844, 0.27893529808946027},
282 {1.5049366830391921, 0.30306153234932315},
283 {1.4977606078174102, 0.32746909510770755},
284 {1.4899406605544634, 0.35219695697813347},
285 {1.4814431917184283, 0.37728946847450484},
286 {1.4722281161523716, 0.40279756372788583},
287 {1.4622474200998372, 0.4287803341537376},
288 {1.4514431778273647, 0.45530712040457033},
289 {1.4397448652396179, 0.48246034696312606},
290 {1.427065639662639, 0.5103394485717625},
291 {1.4132970536897833, 0.5390664502570618},
292 {1.3983013135749314, 0.5687941401756967},
293 {1.3818995257862978, 0.5997184788509978},
294 {1.3638530549860057, 0.6320982830132342},
295 {1.3438323057823602, 0.6662881915757862},
296 {1.3213606855701236, 0.7027978462604986},
297 {1.2957042956404132, 0.7424084023365868},
298 {1.2656247456808565, 0.786433646353686},
299 {1.2287034601894442, 0.8374338794107618},
300 {1.1786904071656892, 0.902017503822168},
301 {1.0497616572686415, 1.0497616572686426},
302 {0.9097522267255194, 1.1864251300690412},
303 {0.8484431816837388, 1.2397127624624213},
304 {0.8000049977037023, 1.2791960970308718},
305 {0.7581818853313602, 1.3114777786351866},
306 {0.7205493452982701, 1.3391121846078957},
307 {0.6882849734317291, 1.3617105524217008},
308 {0.6882849734317291, 2.356194490192345},
309 {1.3376784164442164, 2.356194490192345},
310 {1.3516056511178856, 2.3360528189227487},
311 {1.3708660530144583, 2.308792458458483},
312 {1.3913233553973305, 2.2804469909122105},
313 {1.4131687110627962, 2.2508089759388485},
314 {1.436656614785, 2.219604401551449},
315 {1.4621380338543308, 2.18645769238238},
316 {1.4901198983671067, 2.1508288797419346},
317 {1.5213822452925796, 2.111889875368928},
318 {1.5572408030205178, 2.0682471032649676},
319 {1.6002650085871786, 2.0171829478543404},
320 {1.657096323745671, 1.9516778011159774},
321 {1.7977393629734166, 1.7977393629734166},
322 {1.8577014383575772, 1.7364646168980775},
323 {1.8577014383575772, -1.7353804562372057}});
324}
325
326BoundsCheck MakeClippedArmSpace() {
327 return MakeArbitraryArmSpace({{1.8577014383575772, -1.7353804562372057},
328 {1.8322288438826315, -1.761574570216062},
329 {1.7840339881582052, -1.8122752826851365},
330 {1.7367354460218392, -1.863184376466228},
331 {1.69054633425053, -1.9140647421906793},
332 {1.6456590387358871, -1.9646939485526782},
333 {1.6022412524081968, -2.0148691793459164},
334 {1.5604334435784202, -2.0644108218872432},
335 {1.5203477477575325, -2.1131646494909866},
336 {1.4820681545944325, -2.1610026706370666},
337 {1.4456517763321752, -2.207822815007094},
338 {1.4111309389855604, -2.253547685496041},
339 {1.3785158286698027, -2.298122627340264},
340 {1.3477974448369014, -2.3415133576238922},
341 {1.318950649522341, -2.3837033700108243},
342 {1.2919371475531436, -2.4246912899477153},
343 {1.266708279449626, -2.464488312575651},
344 {1.2432075513427807, -2.5031158147261996},
345 {1.2213728618107609, -2.5406031969824228},
346 {1.2011384131259828, -2.5769859833310096},
347 {1.1824363142639513, -2.61230418457078},
348 {1.165197896140849, -2.64660091671642},
349 {1.149354767212547, -2.6799212560849437},
350 {1.134839641107821, -2.712311307404836},
351 {1.121586968578607, -2.7438174590386177},
352 {1.1095334047223224, -2.774485799309971},
353 {1.09861813993779, -2.8043616692157007},
354 {1.088783119985477, -2.8334893289039758},
355 {1.079973177230731, -2.861911717797479},
356 {1.0721360919151535, -2.8896702908486835},
357 {1.065222599283597, -2.916804915950962},
358 {1.0591863556764607, -2.943353819884641},
359 {1.0539838743128325, -2.969353572295195},
360 {1.049574439440948, -2.9948390990606946},
361 {1.0459200058000553, -3.01984371800932},
362 {1.0429850888932353, -3.044399191310831},
363 {1.0407366503803421, -3.0685357900111128},
364 {1.039143981929867, -3.092282367132034},
365 {1.0381785900853944, -3.1156664365461078},
366 {1.0378140840766794, -3.1387142554815886},
367 {1.038026068010855, -3.1614509090414518},
368 {1.0387920384931424, -3.1839003955494407},
369 {1.0400912884293725, -3.2060857118856374},
370 {1.0419048175385754, -3.2280289382581637},
371 {1.0442152499395827, -3.2497513220895704},
372 {1.047006759060362, -3.2712733608874625},
373 {1.050265000044113, -3.2926148841283163},
374 {1.0513266200838918, -3.2986722862692828},
375 {0.6882849734317291, -3.2986722862692828},
376 {0.6882849734317291, -2.40847516476558},
377 {0.8062364039734171, -2.2816832357742984},
378 {0.9846964491122989, -2.0749837238115147},
379 {1.080856081125841, -1.9535526052833936},
380 {1.1403399741223543, -1.8700303125904767},
381 {1.1796460643255697, -1.8073338252603661},
382 {1.206509908068604, -1.7574623871869075},
383 {1.225108933139178, -1.7160975113819317},
384 {1.237917343016644, -1.6806816402603253},
385 {1.2465009152225068, -1.6495957958330445},
386 {1.251901644035212, -1.6217619064422375},
387 {1.2548410275662123, -1.5964327471863136},
388 {1.2558349967266738, -1.5730732293972975},
389 {1.2552624664807475, -1.551289614657788},
390 {1.2534080548485127, -1.5307854126408047},
391 {1.2504896957865235, -1.5113328783804112},
392 {1.2466770509718135, -1.492754008779478},
393 {1.2421041193998992, -1.4749075280685116},
394 {1.236878076935188, -1.457679763958034},
395 {1.231085601347444, -1.4409781183381307},
396 {1.2247974811461413, -1.4247263085140511},
397 {1.2180720288351026, -1.408860841660136},
398 {1.2109576458572935, -1.3933283641188086},
399 {1.2034947755974974, -1.378083641634472},
400 {1.1957174082841977, -1.363088001457586},
401 {1.1876542532510088, -1.3483081171759035},
402 {1.179329661157153, -1.3337150510329991},
403 {1.1707643560768641, -1.3192834919003447},
404 {1.1385726725405734, -1.3512941162901886},
405 {1.1061744838535637, -1.3828092440478137},
406 {1.0736355415504857, -1.4137655512448706},
407 {1.0410203155384732, -1.444102884084807},
408 {1.0083912519665894, -1.4737649313813326},
409 {0.975808099297045, -1.5026998012630925},
410 {0.9433273192311136, -1.5308604887780404},
411 {0.941597772428203, -1.50959779639341},
412 {0.9392183822389457, -1.488861961175901},
413 {0.9362399962318921, -1.4685999567644576},
414 {0.9327074201772598, -1.448764371832554},
415 {0.9286602163651203, -1.4293126388801052},
416 {0.9241333769591611, -1.410206381002334},
417 {0.9191578939466147, -1.3914108561164176},
418 {0.9137612431353617, -1.3728944819981919},
419 {0.9079677963791273, -1.3546284285619337},
420 {0.9017991735984072, -1.3365862662768213},
421 {0.8952745440670551, -1.3187436615861219},
422 {0.888410884742945, -1.3010781117818295},
423 {0.8812232020507231, -1.2835687130679965},
424 {0.8737247224089426, -1.2661959565824437},
425 {0.8659270558807739, -1.2489415479874506},
426 {0.8578403365760008, -1.2317882469234374},
427 {0.8810761292150717, -1.2118184809610988},
428 {0.9041762360363244, -1.1914283310662528},
429 {0.9271196683064211, -1.1706361926784383},
430 {0.949885054142765, -1.1494613527499984},
431 {0.9724507572661958, -1.1279238910069835},
432 {0.9947950004998649, -1.1060445714951375},
433 {1.0168959923240788, -1.0838447258650978},
434 {1.0387320546908576, -1.0613461300367468},
435 {1.0602817502430675, -1.0385708760262022},
436 {1.0815240070740941, -1.0155412408147642},
437 {1.102438239206001, -0.9922795541836177},
438 {1.123004461055328, -0.9688080674301042},
439 {1.1432033942926907, -0.9451488248218312},
440 {1.1630165656794818, -0.9213235395370803},
441 {1.1824263946752058, -0.8973534756890716},
442 {1.2014162698440272, -0.8732593378443982},
443 {1.2199706133398625, -0.8490611692304734},
444 {1.2380749330068292, -0.8247782595916947},
445 {1.2557158618869284, -0.800429063408306},
446 {1.2728811851714203, -0.776031128944234},
447 {1.2895598548592355, -0.7516010383486005},
448 {1.3057419925890068, -0.7271543588072293},
449 {1.3214188812865908, -0.702705604531139},
450 {1.3365829464142562, -0.6782682091832445},
451 {1.351227727719687, -0.6538545081853449},
452 {1.365347842462401, -0.6294757302167044},
453 {1.3789389411433586, -0.6051419971134862},
454 {1.391997656782351, -0.5808623313043475},
455 {1.4045215487801634, -0.5566446698699925},
456 {1.4165090423718034, -0.5324958842910054},
457 {1.4279593646268474, -0.5084218049460658},
458 {1.4388724778869602, -0.4844272494383845},
459 {1.449249011452494, -0.460516053858597},
460 {1.4590901922431447, -0.4366911061340692},
461 {1.468397775065033, -0.4129543806643518},
462 {1.4771739730209745, -0.38930697349737264},
463 {1.485421388504271, -0.36574913735813025},
464 {1.4931429451209484, -0.3422803158986589},
465 {1.5003418207921726, -0.3188991765927855},
466 {1.5070213821985838, -0.2956036417497373},
467 {1.513185120641734, -0.2723909171654731},
468 {1.5188365893149296, -0.24925751796822435},
469 {1.5239793418959948, -0.22619929124396096},
470 {1.5286168722972349, -0.2032114350471563},
471 {1.5327525553319497, -0.1802885134112242},
472 {1.5363895879810432, -0.15742446697009113},
473 {1.5395309308654115, -0.1346126187862511},
474 {1.5421792494481048, -0.11184567494963411},
475 {1.5443368544016174, -0.0891157194637005},
476 {1.5460056404769755, -0.06641420286771664},
477 {1.5471870230984175, -0.043731923953761714},
478 {1.547881871775246, -0.021059003819238205},
479 {1.5480904392645911, 0.0016151486553661097},
480 {1.547812285227133, 0.024301881005710235},
481 {1.5470461928818935, 0.047013352405288866},
482 {1.5457900768723736, 0.06976260156314103},
483 {1.5440408801865422, 0.09256362934244797},
484 {1.5417944575035705, 0.11543149864415554},
485 {1.5390454417383017, 0.13838245474060726},
486 {1.5357870897759938, 0.16143407007284788},
487 {1.5320111023738603, 0.18460541860588778},
488 {1.5277074118667517, 0.20791728625864334},
489 {1.5228639295308124, 0.23139242581719505},
490 {1.5174662420569858, 0.25505586728497265},
491 {1.5114972433117844, 0.27893529808946027},
492 {1.5049366830391921, 0.30306153234932315},
493 {1.4977606078174102, 0.32746909510770755},
494 {1.4899406605544634, 0.35219695697813347},
495 {1.4814431917184283, 0.37728946847450484},
496 {1.4722281161523716, 0.40279756372788583},
497 {1.4622474200998372, 0.4287803341537376},
498 {1.4514431778273647, 0.45530712040457033},
499 {1.4397448652396179, 0.48246034696312606},
500 {1.427065639662639, 0.5103394485717625},
501 {1.4132970536897833, 0.5390664502570618},
502 {1.3983013135749314, 0.5687941401756967},
503 {1.3818995257862978, 0.5997184788509978},
504 {1.3638530549860057, 0.6320982830132342},
505 {1.3438323057823602, 0.6662881915757862},
506 {1.3213606855701236, 0.7027978462604986},
507 {1.2957042956404132, 0.7424084023365868},
508 {1.2656247456808565, 0.786433646353686},
509 {1.2287034601894442, 0.8374338794107618},
510 {1.1786904071656892, 0.902017503822168},
511 {1.0497616572686415, 1.0497616572686426},
512 {0.9097522267255194, 1.1864251300690412},
513 {0.8484431816837388, 1.2397127624624213},
514 {0.8000049977037023, 1.2791960970308718},
515 {0.7581818853313602, 1.3114777786351866},
516 {0.7205493452982701, 1.3391121846078957},
517 {0.6882849734317291, 1.3617105524217008},
518 {0.6882849734317291, 2.356194490192345},
519 {1.3376784164442164, 2.356194490192345},
520 {1.3516056511178856, 2.3360528189227487},
521 {1.3708660530144583, 2.308792458458483},
522 {1.3913233553973305, 2.2804469909122105},
523 {1.4131687110627962, 2.2508089759388485},
524 {1.436656614785, 2.219604401551449},
525 {1.4621380338543308, 2.18645769238238},
526 {1.4901198983671067, 2.1508288797419346},
527 {1.5213822452925796, 2.111889875368928},
528 {1.5572408030205178, 2.0682471032649676},
529 {1.6002650085871786, 2.0171829478543404},
530 {1.657096323745671, 1.9516778011159774},
531 {1.7977393629734166, 1.7977393629734166},
532 {1.8577014383575772, 1.7364646168980775},
533 {1.8577014383575772, -1.7353804562372057}});
534}
535
Stephan Pleinesf63bde82024-01-13 15:59:33 -0800[diff] [blame^]536} // namespace y2018::control_loops