ros-controls / ros2_control_demos

This repository aims at providing examples to illustrate ros2_control and ros2_controllers
https://control.ros.org
Apache License 2.0
412 stars 187 forks source link

Publish correct joint velocities in r6bot example 7 #430

Closed ecmjohnson closed 9 months ago

ecmjohnson commented 9 months ago

Resolves #427 by copying joint velocities into the trajectory point's velocity field. This makes no functional difference for the r6bot controller when both position and velocity are provided as shown by @christophfroehlich here.

Tested by echoing the /r6bot_controller/joint_trajectory topic. Prior to the change, both velocities and positions were always the same:

...
- positions:
  - 0.2526216532445078
  - -0.21062744421529653
  - -0.3485843399000512
  - -0.13795689568475478
  - -1.2928197138013211e-16
  - 0.25262165324450775
  velocities:
  - 0.2526216532445078
  - -0.21062744421529653
  - -0.3485843399000512
  - -0.13795689568475478
  - -1.2928197138013211e-16
  - 0.25262165324450775
  accelerations: []
  effort: []
  time_from_start:
    sec: 1
    nanosec: 924242424
...

After the change, the velocities and positions differ:

...
- positions:
  - 0.2526216532445078
  - -0.21062744421529653
  - -0.3485843399000512
  - -0.13795689568475478
  - -1.2928197138013211e-16
  - 0.25262165324450775
  velocities:
  - 0.37845782334674916
  - 0.47486669652093844
  - 0.719777222778079
  - 0.24491052625714027
  - -8.847089727481716e-17
  - 0.37845782334674904
  accelerations: []
  effort: []
  time_from_start:
    sec: 1
    nanosec: 924242424
...

No difference in the example is observed.

saikishor commented 9 months ago

@ecmjohnson The changes explain themself, however, out of curiosity, did you get this message when the robot is moving? or when it is steady?. I'm asking because the velocities are non-zero

ecmjohnson commented 9 months ago

@ecmjohnson The changes explain themself, however, out of curiosity, did you get this message when the robot is moving? or when it is steady?. I'm asking because the velocities are non-zero

@saikishor These are the commanded velocities published in the trajectory_msgs::msg::JointTrajectory message by the send_trajectory node. I think they should be non-zero even if they will be overwritten by the positions

saikishor commented 9 months ago

@ecmjohnson I'm just asking if the copy of message you have in the description after the fix is during the execution of the trajectory or not?. Because of course it doesn't make sense that your initial or final state of the trajectory is with non-zero velocities.

If this is the case, the resulting velocities could be due to the planner we are using.

Thank you

ecmjohnson commented 9 months ago

@saikishor Sorry, I must be misunderstanding something. The send_trajectory publishes a trajectory_msgs::msg::JointTrajectory which will be executed by the controller, so I guess in this case the message would be sent prior to execution of the trajectory.

The single point I included from the trajectory may be confusing. I included a single point (the last from before ros2 topic echo truncated) just to show that the velocities field is no longer identical to the positions field. The full message published by the send_trajectory node after these changes has neither 0 velocities at either start or end point, and also exceeds the double total_time = 3.0;:

Full joint trajectory message after change ``` $ ros2 topic echo -f /r6bot_controller/joint_trajectory header: stamp: sec: 1705349536 nanosec: 403289528 frame_id: '' joint_names: - joint_1 - joint_2 - joint_3 - joint_4 - joint_5 - joint_6 points: - positions: - 0.0 - 0.0 - 0.0 - 0.0 - 0.0 - 0.0 velocities: - -0.5779205116573051 - -0.13651205700757027 - -0.24068439681030246 - -0.10417233980273238 - -2.0729945537922845e-16 - -0.5779205116573052 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 0 - positions: - -0.008756371388747047 - -0.002068364500114701 - -0.003646733285004583 - -0.0015783687848898846 - -3.140900839079219e-18 - -0.008756371388747049 velocities: - -0.5786060750227738 - -0.14181432942611855 - -0.24974339464197653 - -0.10792906521585799 - -1.5265566588595902e-16 - -0.5786060750227738 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 15151515 - positions: - -0.01752313010121332 - -0.004217066461116498 - -0.007430724112913319 - -0.003213657651796824 - -5.453865473714962e-18 - -0.01752313010121332 velocities: - -0.5788735153239294 - -0.14700285450052902 - -0.25856793368355546 - -0.11156507918302619 - 1.3444106938820255e-16 - -0.5788735153239289 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 30303030 - positions: - -0.026293940939454676 - -0.006444382438397241 - -0.011348420077815675 - -0.004904037639418433 - -3.416879573893711e-18 - -0.02629394093945467 velocities: - -0.5787209240181059 - -0.1520879186208527 - -0.2671755897281214 - -0.11508767110726872 - -4.336808689942018e-18 - -0.5787209240181062 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 45454545 - positions: - -0.035062439788213856 - -0.008748744841743494 - -0.015396535073696302 - -0.006647790231952808 - -3.48258879646859e-18 - -0.035062439788213856 velocities: - -0.5781466800537529 - -0.1570798593985302 - -0.2755839830585882 - -0.11850412366005758 - 1.48318857196017e-16 - -0.5781466800537525 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 60606060 - positions: - -0.04382223797084647 - -0.011128742711418194 - -0.019572049968523395 - -0.008443307257105195 - -1.2353333844077267e-18 - -0.04382223797084647 velocities: - -0.5771494532023118 - -0.16198900354046156 - -0.2838106549157336 - -0.1218216513752714 - 5.811323644522304e-17 - -0.5771494532023118 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 75757575 - positions: - -0.052566926655729984 - -0.01358312155294034 - -0.02387221140664057 - -0.010289089853700216 - -3.5482980190434736e-19 - -0.052566926655729984 velocities: - -0.5757282052427922 - -0.166825605404837 - -0.2918729464127455 - -0.12504734100790862 - -3.0444397003392965e-16 - -0.5757282052427919 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 90909090 - positions: - -0.06129008128062077 - -0.016110782240892414 - -0.02829452877653065 - -0.012183746535638225 - -4.967617226660858e-18 - -0.06129008128062077 velocities: - -0.5738821889790144 - -0.17159978648676444 - -0.2997878803925027 - -0.128188093905738 - 1.708702623837155e-16 - -0.5738821889790144 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 106060606 - positions: - -0.06998526596212098 - -0.018710779005843392 - -0.032836769388538266 - -0.014125990382694862 - -2.378673857210623e-18 - -0.06998526596212098 velocities: - -0.5716109450893019 - -0.17632147607146545 - -0.30757204669699034 - -0.1312505706255249 - 2.940356291780688e-16 - -0.5716109450893019 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 121212121 - positions: - -0.07864603785741343 - -0.021382316522077716 - -0.03749695191425024 - -0.016114635392172512 - 2.0764114333661775e-18 - -0.07864603785741343 velocities: - -0.5689142968284204 - -0.18100035328195907 - -0.3152414912916016 - -0.13424113800964252 - 1.5872719805187785e-16 - -0.5689142968284205 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 136363636 - positions: - -0.08726595144572283 - -0.024124746117258913 - -0.04227333814594117 - -0.018148592028682246 - 4.481368979606751e-18 - -0.08726595144572284 velocities: - -0.5657923426217594 - -0.1856457907365931 - -0.32281160966050604 - -0.137165818923913 - 2.654126918244515e-16 - -0.5657923426217596 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 151515151 - positions: - -0.09583856269756767 - -0.026937561128419416 - -0.04716442314079732 - -0.020226862012377896 - 8.50277340118935e-18 - -0.09583856269756769 velocities: - -0.5622454466117446 - -0.19026680001949434 - -0.33029704486272626 - -0.14003024484323184 - 7.025630077706069e-17 - -0.5622454466117439 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 166666666 - positions: - -0.10435743310077593 - -0.02982039143174509 - -0.0521689238205356 - -0.0223485323887905 - 9.56726280690239e-18 - -0.10435743310077593 velocities: - -0.5582742272361371 - -0.19487197915384757 - -0.33771159061178446 - -0.14283961145793672 - 1.1796119636642288e-16 - -0.5582742272361373 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 181818181 - positions: - -0.11281613351344467 - -0.032772997176500354 - -0.05728576610253233 - -0.024512768926031967 - 1.13545536609391e-17 - -0.11281613351344467 velocities: - -0.5538795439369792 - -0.1994694622538182 - -0.34506809971469865 - -0.14559863746088014 - 1.3704315460216776e-16 - -0.5538795439369784 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 196969696 - positions: - -0.12120824781552011 - -0.03579526175610366 - -0.06251407064366413 - -0.026718808887560452 - 1.3430965094305279e-17 - -0.1212082478155201 velocities: - -0.5490624821172908 - -0.20406687151593905 - -0.352378398178535 - -0.1483115266625957 - -1.5959455978986625e-16 - -0.5490624821172905 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 212121212 - positions: - -0.12952737633244876 - -0.03888718405179971 - -0.06785313728273284 - -0.028965953230933116 - 1.1012865703549729e-17 - -0.12952737633244873 velocities: - -0.5438243364800764 - -0.20867127169465963 - -0.3596532052645103 - -0.1509819335698505 - 2.862293735361732e-17 - -0.5438243364800761 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 227272727 - positions: - -0.13776713900638932 - -0.04204886998656728 - -0.07330242827158906 - -0.03125355828502176 - 1.144654657254393e-17 - -0.1377671390063893 velocities: - -0.5381665929005972 - -0.21328912718973353 - -0.36690205974071693 - -0.1536129325509829 - 9.194034422677078e-17 - -0.5381665929005972 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 242424242 - positions: - -0.145921178292762 - -0.04528052342883597 - -0.07886155038887264 - -0.03358102696003665 - 1.2839582091131366e-17 - -0.14592117829276197 velocities: - -0.5320909089980543 - -0.21792626185501335 - -0.3741332525548102 - -0.15620699069979646 - 2.749536709423239e-16 - -0.5320909089980547 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 257575757 - positions: - -0.1539831617624295 - -0.048582436487245265 - -0.0845302360336425 - -0.0359477995463972 - 1.7005546802378696e-17 - -0.15398316176242946 velocities: - -0.5255990935868448 - -0.22258782161919366 - -0.38135376611743604 - -0.15876594449824222 - -5.4643789493269423e-17 - -0.5255990935868446 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 272727272 - positions: - -0.16194678439253318 - -0.05195497923905123 - -0.0903083233990582 - -0.03835334416000693 - 1.617761059793522e-17 - -0.16194678439253316 velocities: - -0.5186930852001816 - -0.227278239989142 - -0.3885692203558131 - -0.16129098036667094 - -1.457167719820518e-16 - -0.5186930852001814 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 287878787 - positions: - -0.16980577053192988 - -0.05539858893585641 - -0.09619573582869173 - -0.04079714689283528 - 1.3969780719419284e-17 - -0.16980577053192986 velocities: - -0.5113749298902344 - -0.2320012064857619 - -0.3957838256647279 - -0.16378261917896572 - 2.168404344971009e-17 - -0.5113749298902341 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 303030303 - positions: - -0.17755387553026677 - -0.05891375873109523 - -0.10219246045997549 - -0.04327870172888021 - 1.429832683229368e-17 - -0.17755387553026675 velocities: - -0.5036467585189897 - -0.23675963804106032 - -0.4030003428494674 - -0.16624070480840653 - 3.434752482434078e-16 - -0.5036467585189895 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 318181818 - positions: - -0.18518488702297875 - -0.0625010259741416 - -0.10829852626072499 - -0.04579750028658334 - 1.95024972602241e-17 - -0.18518488702297872 velocities: - -0.4955107637627785 - -0.24155565336331486 - -0.41022005012196855 - -0.1686643967586533 - -8.847089727481716e-17 - -0.49551076376277825 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 333333333 - positions: - -0.19269262586786934 - -0.06616096011601001 - -0.1145139815656033 - -0.048353021449593234 - 1.8162029119696567e-17 - -0.1926926258678693 velocities: - -0.48696917706104625 - -0.2463905502552589 - -0.41744271717796555 - -0.17105216692270714 - -6.938893903907228e-18 - -0.48696917706104603 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 348484848 - positions: - -0.20007094673243064 - -0.06989415027139273 - -0.1208388712198149 - -0.05094472094842213 - 1.805689436357676e-17 - -0.20007094673243062 velocities: - -0.4780242457464085 - -0.25126478584819867 - -0.4246665863494753 - -0.1734018005012763 - -7.546047120499111e-17 - -0.47802424574640845 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 363636363 - positions: - -0.20731373833464894 - -0.07370119248121393 - -0.1272732134372312 - -0.05357202095601723 - 1.6913553890773866e-17 - -0.20731373833464892 velocities: - -0.46867821059861986 - -0.25617795969321233 - -0.43188836079377935 - -0.17571040110056724 - -6.591949208711867e-17 - -0.46867821059862025 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 378787878 - positions: - -0.21441492334371895 - -0.07758267671898987 - -0.13381697647956117 - -0.056234299760571274 - 1.5914773707635704e-17 - -0.21441492334371892 velocities: - -0.45893328406983397 - -0.2611287996293503 - -0.4391031996475997 - -0.17797440001824963 - 1.3617579286417936e-16 - -0.4589332840698341 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 393939393 - positions: - -0.22136845795083765 - -0.08153917368307094 - -0.14047005526210057 - -0.0589308815790296 - 1.7978043296486906e-17 - -0.22136845795083762 velocities: - -0.4487916294326489 - -0.26611515032839483 - -0.446304720043708 - -0.1801895697153128 - 1.3010426069826053e-17 - -0.4487916294326493 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 409090909 - positions: - -0.2281683311240596 - -0.08557122141531935 - -0.14723224799003554 - -0.06166102657471616 - 1.8175170964211543e-17 - -0.22816833112405957 velocities: - -0.4382553411061313 - -0.27113396439647475 - -0.4534850058572162 - -0.1823510414607416 - 3.3480163086352377e-16 - -0.4382553411061312 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 424242424 - positions: - -0.23480856356506158 - -0.08967931178496291 - -0.15410323292726608 - -0.06442392114230315 - 2.3247922946992205e-17 - -0.23480856356506155 velocities: - -0.4273264264184236 - -0.2761812958951369 - -0.4606346230206588 - -0.18445332712552137 - -5.204170427930421e-18 - -0.42732642641842394 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 439393939 - positions: - -0.24128320638958314 - -0.09386387687428317 - -0.16108254539727607 - -0.06721866852299287 - 2.316907187990235e-17 - -0.24128320638958312 velocities: - -0.41600678906790584 - -0.2812522961286202 - -0.4677426412210935 - -0.18649034509247298 - -3.0704605524789486e-16 - -0.41600678906790534 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 454545454 - positions: - -0.24758633955727868 - -0.0981252753004744 - -0.16816955511274717 - -0.07004427981227276 - 1.8516858921600914e-17 - -0.24758633955727866 velocities: - -0.4042982145483817 - -0.286341211530423 - -0.47479666176930413 - -0.188455450238881 - 7.806255641895632e-18 - -0.40429821454838144 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 469696969 - positions: - -0.25371207008073904 - -0.1024637785054808 - -0.1753634439274336 - -0.07289966542195278 - 1.8635135522235697e-17 - -0.253712070080739 velocities: - -0.3922023578075386 - -0.29144138347125126 - -0.48178285141105814 - -0.19034146793980708 - -7.979727989493313e-17 - -0.39220235780753887 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 484848484 - positions: - -0.2596545300475199 - -0.106879557042924 - -0.18266318410032842 - -0.0757836270574044 - 1.7426085826857922e-17 - -0.25965453004751987 velocities: - -0.37972073341222135 - -0.296545249802385 - -0.48868598183380485 - -0.19214073203141974 - -1.0755285551056204e-16 - -0.3797207334122214 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 500000000 - positions: - -0.26540787449315967 - -0.11137266688841468 - -0.19006751715841638 - -0.07869485027000167 - 1.579649710700092e-17 - -0.2654078744931596 velocities: - -0.36685470849892365 - -0.30164434794386946 - -0.49548947460931203 - -0.1938451266654426 - 5.204170427930421e-18 - -0.3668547084989236 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 515151515 - positions: - -0.2709662791673858 - -0.11594303579665513 - -0.19757493344037566 - -0.0816318976437205 - 1.5875348174090775e-17 - -0.27096627916738575 velocities: - -0.3536054987935183 - -0.3067293193259896 - -0.5021754513040155 - -0.19544613197802568 - 1.1449174941446927e-16 - -0.353605498793518 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 530303030 - positions: - -0.2763239382400149 - -0.1205904497258368 - -0.2051836523995274 - -0.08459320267369058 - 1.7610071650067582e-17 - -0.27632393824001483 velocities: - -0.33997416799065866 - -0.3117899149958712 - -0.5087247884844159 - -0.19693487348854488 - 2.237793284010081e-16 - -0.3399741679906588 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 545454545 - positions: - -0.2814750619974491 - -0.12531453934698636 - -0.21289160374020039 - -0.08757706439321399 - 2.1000667534931342e-17 - -0.28147506199744904 velocities: - -0.32596163079049034 - -0.31681500220878483 - -0.5151171773448171 - -0.19830217513603235 - 7.806255641895632e-17 - -0.3259616307904904 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 560606060 - positions: - -0.2864138745851838 - -0.13011476665318006 - -0.2206964094575461 - -0.090581642804366 - 2.2183433541279165e-17 - -0.28641387458518375 velocities: - -0.3115686598983699 - -0.3217925718366157 - -0.5213311876892875 - -0.19953861585267182 - -7.28583859910259e-17 - -0.3115686598983698 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 575757575 - positions: - -0.29113461185637124 - -0.13499041168100756 - -0.22859536684677773 - -0.09360495516577011 - 2.1079518602021197e-17 - -0.2911346118563712 velocities: - -0.2967958973019963 - -0.32670974644408896 - -0.527344336008754 - -0.20063458956466504 - 7.28583859910259e-17 - -0.29679589730199624 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 590909090 - positions: - -0.29563151939125 - -0.13994055935440286 - -0.23658543254388006 - -0.09664487318947716 - 2.2183433541279165e-17 - -0.29563151939124993 velocities: - -0.28164387014965003 - -0.33155278890720274 - -0.5331331574075842 - -0.20158036850038166 - 2.7755575615628914e-17 - -0.2816438701496501 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 606060606 - positions: - -0.2998988507571538 - -0.14496408645905745 - -0.24466320765611618 - -0.0996991211970587 - 2.260397256575839e-17 - -0.2998988507571537 velocities: - -0.2661130115627918 - -0.33630711147836095 - -0.5386732811517135 - -0.20236616967335241 - -1.7694179454963432e-16 - -0.2661130115627916 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 621212121 - positions: - -0.30393086608386277 - -0.15005964875418412 - -0.25282492403720275 - -0.10276527528301858 - 1.9923036284703326e-17 - -0.30393086608386266 velocities: - -0.2502036867257865 - -0.3409572852391401 - -0.5439395096318566 - -0.2029822243927161 - -1.3357370765021415e-16 - -0.25020368672578647 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 636363636 - positions: - -0.3077218310342535 - -0.15522566822750442 - -0.26106643175889754 - -0.10584076353139307 - 1.7899192229397052e-17 - -0.3077218310342534 velocities: - -0.23391622460450717 - -0.3454870499249003 - -0.5489059005603294 - -0.20341885063542917 - 3.9898639947466563e-17 - -0.23391622460450737 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 651515151 - positions: - -0.3112660162555339 - -0.1604603204990938 - -0.2693831878279934 - -0.10892286732889958 - 1.8503717077085938e-17 - -0.3112660162555338 velocities: - -0.21725095565349029 - -0.34987932415588097 - -0.5535458522478806 - -0.2036665280919993 - -1.9081958235744878e-17 - -0.2172509556534903 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 666666666 - positions: - -0.3145576974017989 - -0.16576152238024353 - -0.27777024619538554 - -0.112008723815142 - 1.821459649775647e-17 - -0.3145576974017988 velocities: - -0.20020825587739982 - -0.35411621616717215 - -0.5578321918369682 - -0.20371597566979588 - 2.1337098754514727e-16 - -0.2002082558773997 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 681818181 - positions: - -0.31759115582418374 - -0.17112691959489765 - -0.2862222491020063 - -0.1150953295071086 - 2.144749024844052e-17 - -0.3175911558241836 velocities: - -0.1827885976160206 - -0.3581790351953621 - -0.5617372663994925 - -0.2035582312041307 - 7.632783294297951e-17 - -0.18278859761602045 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 696969696 - positions: - -0.32036068003048707 - -0.17655387467361525 - -0.2947334198050289 - -0.11817954513141361 - 2.260397256575839e-17 - -0.32036068003048696 velocities: - -0.16499260742172403 - -0.36204830375272656 - -0.5652330368389907 - -0.20318473308626417 - -2.0643209364124004e-16 - -0.16499260742172417 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 712121212 - positions: - -0.3228605680217253 - -0.18203945503350505 - -0.3032975567268318 - -0.12125810169332671 - 1.9476213571194148e-17 - -0.3228605680217252 velocities: - -0.14682113139323152 - -0.3657037711006661 - -0.5682911745689508 - -0.2025874034682852 - 3.642919299551295e-17 - -0.14682113139323136 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 727272727 - positions: - -0.32508513061859245 - -0.187580421262303 - -0.31190802906878556 - -0.12432760780648254 - 2.0028171040823133e-17 - -0.32508513061859234 velocities: - -0.12827530831806422 - -0.36912442832248865 - -0.5708831609688928 - -0.20175873264640398 - -1.457167719820518e-16 - -0.12827530831806427 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 742424242 - positions: - -0.32702869589613887 - -0.19317321563082557 - -0.3205577739319506 - -0.12738455830112502 - 1.7820341162307195e-17 - -0.32702869589613875 velocities: - -0.1093566509568023 - -0.3722885254913414 - -0.572980389647108 - -0.20069186415576667 - 6.765421556309548e-17 - -0.10935665095680241 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 757575757 - positions: - -0.3286856148500298 - -0.19881395086554285 - -0.32923929498720983 - -0.13042534412166695 - 1.884540503447531e-17 - -0.3286856148500297 velocities: - -0.09006713577333733 - -0.37517359153151775 - -0.5745542715621733 - -0.19938068003065537 - -9.540979117872439e-17 - -0.09006713577333747 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 772727272 - positions: - -0.3300502684223531 - -0.204498399222081 - -0.3379446627381518 - -0.13344626351607083 - 1.739980213782797e-17 - -0.33005026842235297 velocities: - -0.07040930137475698 - -0.3777564574796611 - -0.5755763430731173 - -0.19781988559345642 - -5.551115123125783e-17 - -0.07040930137475701 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 787878787 - positions: - -0.3311170760189403 - -0.21022198191116676 - -0.34666551642107785 - -0.1364435345099111 - 1.6558724088869518e-17 - -0.3311170760189402 velocities: - -0.05038635587013378 - -0.38001328396541967 - -0.5760183769991962 - -0.19600509303377675 - -4.5102810375396984e-17 - -0.05038635587013362 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 803030303 - positions: - -0.33188050565333627 - -0.21597975894094584 - -0.3553930675877323 - -0.1394133086467865 - 1.5875348174090775e-17 - -0.33188050565333616 velocities: - -0.030002293286978475 - -0.38191959384711793 - -0.5758524967730598 - -0.193932902925942 - -2.0990154059319366e-16 - -0.030002293286978593 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 818181818 - positions: - -0.3323350858546541 - -0.22176641945378095 - -0.3641181054176272 - -0.14235168596384623 - 1.2695021801466628e-17 - -0.332335085854654 velocities: - -0.00926201909495817 - -0.3834503110550334 - -0.5750512937645085 - -0.191600982709475 - -1.9255430583342559e-16 - -0.009262019094958107 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 833333333 - positions: - -0.33247541947730497 - -0.22757627265158448 - -0.3728310038079985 - -0.14525473115641405 - 9.777532319141998e-18 - -0.33247541947730486 velocities: - 0.011828515223901305 - -0.3845798068099961 - -0.5735879478345544 - -0.18900814102455873 - -1.5265566588595902e-16 - 0.01182851522390143 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 848484848 - positions: - -0.3322961995496701 - -0.2334032394214329 - -0.38152173029034026 - -0.14811849086890735 - 7.464567684506254e-18 - -0.33229619954967 velocities: - 0.033262168753548746 - -0.38528195449494773 - -0.5714363511500802 - -0.18615439665513223 - -5.984795992119984e-17 - 0.033262168753548566 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 863636363 - positions: - -0.33179222729582847 - -0.23924084479256846 - -0.3901798568229172 - -0.15093901203034876 - 6.557780412972924e-18 - -0.33179222729582836 velocities: - 0.05503045922639344 - -0.3855301945576554 - -0.5685712352469497 - -0.18304104068929428 - -1.0581813203458523e-16 - 0.055030459226393706 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 878787878 - positions: - -0.3309584324590649 - -0.24508221137677536 - -0.39879457250847705 - -0.1537123611317017 - 4.9544753821458745e-18 - -0.3309584324590648 velocities: - 0.07712340315496108 - -0.3852976109088606 - -0.5649683012732512 - -0.17967069036439048 - 1.8648277366750676e-16 - 0.07712340315496102 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 893939393 - positions: - -0.3297898960476261 - -0.25092005396630357 - -0.4073546982853445 - -0.15643464431904094 - 7.779971952865673e-18 - -0.329789896047626 velocities: - 0.09952934877792557 - -0.38455702034602884 - -0.5606043532738876 - -0.17604733292785898 - -1.214306433183765e-16 - 0.09952934877792582 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 909090909 - positions: - -0.32828187561159694 - -0.25674667548669794 - -0.41584870363797916 - -0.15910202815128124 - 5.94011372076906e-18 - -0.32828187561159683 velocities: - 0.12223480283825658 - -0.38328107657171145 - -0.5554574342930427 - -0.17217635772133177 - -1.1275702593849246e-17 - 0.12223480283825638 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 924242424 - positions: - -0.32642983314435065 - -0.26255396452566326 - -0.42426472536969195 - -0.1617107608440287 - 5.769269742074374e-18 - -0.32642983314435053 velocities: - 0.14522425249699328 - -0.38144239037972677 - -0.5495069649723274 - -0.16806457459260088 - 4.336808689942018e-18 - 0.14522425249699325 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 939393939 - positions: - -0.324229465682275 - -0.2683333946829318 - -0.43259058847533327 - -0.16425719379240142 - 5.8349789646492535e-18 - -0.3242294656822749 velocities: - 0.16847998400493616 - -0.3790136675435664 - -0.5427338842107573 - -0.16372021666719097 - -1.231653667943533e-16 - 0.16847998400493625 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 954545454 - positions: - -0.32167673865189716 - -0.2740760260093495 - -0.44081382914519324 - -0.16673780313584372 - 3.9688370435226884e-18 - -0.32167673865189705 velocities: - 0.1919819001050341 - -0.37596786585055186 - -0.535120791329467 - -0.1591529254789151 - -1.205632815803881e-16 - 0.19198190010503402 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 969696969 - positions: - -0.31876792198363907 - -0.27977250882526694 - -0.4489217199229124 - -0.16914921109764547 - 2.1421206559410507e-18 - -0.31876792198363896 velocities: - 0.2157073385175465 - -0.37227837257297774 - -0.526652089051542 - -0.15437371647856415 - -9.974659986866641e-17 - 0.21570733851754637 accelerations: [] effort: [] time_from_start: sec: 0 nanosec: 984848484 - positions: - -0.3154996289757975 - -0.2854130902278878 - -0.45690129702975396 - -0.17148820680186613 - 6.308085367188324e-19 - -0.31549962897579736 velocities: - 0.23963089426330872 - -0.36791920344430906 - -0.5173141264683264 - -0.14939492302401775 - -5.724587470723463e-17 - 0.23963089426330889 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 0 - positions: - -0.3118688578505958 - -0.29098762361340763 - -0.46473938985503166 - -0.17375176624162397 - -2.3655320126957113e-19 - -0.3118688578505957 velocities: - 0.26372424900077635 - -0.3628652239055152 - -0.507095341021669 - -0.14423011711615386 - 1.0148132334464322e-16 - 0.2637242490007761 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 15151515 - positions: - -0.3078730358960386 - -0.29648558155137 - -0.4724226525977842 - -0.17593707104641418 - 1.3010426069825988e-18 - -0.3078730358960385 velocities: - 0.2879560109804708 - -0.3570923929958121 - -0.49598639839105285 - -0.13889400539524102 - -1.1882855810441129e-16 - 0.2879560109804704 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 30303030 - positions: - -0.30351006603269814 - -0.30189607235433685 - -0.47993759802795166 - -0.1780415256736148 - -4.993900915690873e-19 - -0.30351006603269803 velocities: - 0.3122915696438139 - -0.35057802977728053 - -0.483980329040272 - -0.13340229926299182 - -2.654126918244515e-16 - 0.3122915696438138 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 45454545 - positions: - -0.29877837558354947 - -0.3072078606842957 - -0.4872706333164406 - -0.18006277263214499 - -4.520794513151686e-18 - -0.29877837558354936 velocities: - 0.336692969297046 - -0.3433011016003251 - -0.4710726600556263 - -0.12777155845530155 - -1.5265566588595902e-16 - 0.3366929692970458 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 60606060 - positions: - -0.2936769669578366 - -0.31240939252672484 - -0.494408097862738 - -0.1819987053360132 - -6.833759147787429e-18 - -0.29367696695783657 velocities: - 0.36111880665685453 - -0.33524253283656513 - -0.45726154080218845 - -0.12201900796562343 - -2.3201926491189795e-16 - 0.36111880665685486 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 75757575 - positions: - -0.28820546988727824 - -0.31748882484243035 - -0.5013363030264075 - -0.1838474781839772 - -1.0349202555543459e-17 - -0.2882054698872782 velocities: - 0.3855241573715142 - -0.32638553193176717 - -0.4425478608422202 - -0.11616232891045304 - 1.5569143196891844e-16 - 0.3855241573715137 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 90909090 - positions: - -0.2823641947755886 - -0.32243406017472986 - -0.5080415736452291 - -0.18560751347049922 - -7.990241465105302e-18 - -0.2823641947755886 velocities: - 0.40986053684619467 - -0.31671593377344454 - -0.42693535850581776 - -0.11021942473237323 - 1.0451708942760263e-16 - 0.4098605368461949 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 106060606 - positions: - -0.27615418664155533 - -0.3272327864440245 - -0.5145102911983475 - -0.18727750475432306 - -6.406649201050716e-18 - -0.27615418664155533 velocities: - 0.43407590081792985 - -0.3062225534417606 - -0.4104307184832855 - -0.10420816504152541 - -3.37403716077489e-16 - 0.43407590081792957 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 121212121 - positions: - -0.2695772790534049 - -0.33187252210223295 - -0.5207289384480942 - -0.1888564163458613 - -1.1518826717376307e-17 - -0.2695772790534049 velocities: - 0.45811469110773967 - -0.2948975464411787 - -0.39304365682552955 - -0.0981461103843509 - -1.5439038936193583e-16 - 0.4581146911077398 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 136363636 - positions: - -0.2626361473699543 - -0.3363406667452811 - -0.5266841453696931 - -0.1903434786244121 - -1.3858075041042002e-17 - -0.2626361473699543 velocities: - 0.48191793179754694 - -0.28273676952425963 - -0.374786991795664 - -0.0920502222714043 - -3.7903707950093235e-16 - 0.4819179317975467 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 151515151 - positions: - -0.2553343605245369 - -0.3406245571926184 - -0.5323627361544759 - -0.1917381789618576 - -1.960106109408643e-17 - -0.2553343605245369 velocities: - 0.5054233807121625 - -0.26974013525573093 - -0.3556766991131101 - -0.08593656385737898 - 1.431146867680866e-17 - 0.505423380712162 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 166666666 - positions: - -0.24767643051374655 - -0.3447115289389174 - -0.5377517770501291 - -0.19304024811121184 - -1.938422065958933e-17 - -0.24767643051374658 velocities: - 0.5285657405093012 - -0.2559119525690377 - -0.3357319502698551 - -0.07981999770081771 - -4.0896105946153227e-16 - 0.5285657405093008 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 181818181 - positions: - -0.23966785868784804 - -0.348588982765721 - -0.5428386247814906 - -0.1942496420157697 - -2.5580600348400426e-17 - -0.23966785868784807 velocities: - 0.5512769328757707 - -0.24126124478924443 - -0.31497513277424605 - -0.07371388798500161 - -3.7491711124548743e-16 - 0.5512769328757708 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 196969696 - positions: - -0.2313151778867 - -0.35224445617161865 - -0.5476109752780701 - -0.19536651910645153 - -3.126116263999872e-17 - -0.23131517788670003 velocities: - 0.5734864382855912 - -0.22580203598977217 - -0.29343185138576566 - -0.0676298153959938 - -2.892651396191326e-16 - 0.5734864382855914 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 212121212 - positions: - -0.2226259894278274 - -0.35566569914116064 - -0.5520569124202787 - -0.1963912132791181 - -3.5643967785743156e-17 - -0.22262598942782744 velocities: - 0.5951217024950706 - -0.20955359617150454 - -0.2711309096373948 - -0.061577313465890515 - -3.9942008034365983e-16 - 0.5951217024950702 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 227272727 - positions: - -0.21360899393547786 - -0.3588407536286077 - -0.5561649565056938 - -0.19732420287708613 - -4.1695787184889516e-17 - -0.2136089939354779 velocities: - 0.6161086094416295 - -0.19254063565520912 - -0.24810427119180614 - -0.055563635536597225 - -1.1731067506293158e-16 - 0.6161086094416296 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 242424242 - positions: - -0.2042740150045441 - -0.36175803598701994 - -0.5599241121298121 - -0.19816607614279214 - -4.347322165553999e-17 - -0.20427401500454412 velocities: - 0.6363720185013809 - -0.17479343931028493 - -0.22438700083379898 - -0.04959356152351401 - -5.345116710353537e-17 - 0.636372018501381 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 257575757 - positions: - -0.19463201472422015 - -0.3644064214311152 - -0.5633239151727484 - -0.19891749374163326 - -4.428308782377538e-17 - -0.19463201472422018 velocities: - 0.6558363621836762 - -0.15634793184303836 - -0.20001718515359548 - -0.04366925331055747 - -2.658463726934457e-16 - 0.6558363621836758 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 272727272 - positions: - -0.1846951001456796 - -0.36677532948934305 - -0.5663544785841665 - -0.19957914909482352 - -4.831106316761547e-17 - -0.18469510014567964 velocities: - 0.6744262983520273 - -0.1372456663608604 - -0.17503583321399113 - -0.0377901668531308 - 1.4495783046131194e-16 - 0.6744262983520264 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 287878787 - positions: - -0.17447651986761858 - -0.36885480928268943 - -0.5690065366631664 - -0.200151727380477 - -4.611473240305014e-17 - -0.17447651986761864 velocities: - 0.692067409027421 - -0.11753372982166112 - -0.14948675770994144 - -0.03195302788828035 - -5.713745448998608e-17 - 0.6920674090274208 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 303030303 - positions: - -0.16399065003386978 - -0.3706356233708964 - -0.5712714875375594 - -0.20063586416666307 - -4.698045141047417e-17 - -0.16399065003386984 velocities: - 0.7086869358316596 - -0.09726456075657372 - -0.12341643731529614 - -0.026151876558722916 - -1.247577887351914e-16 - 0.7086869358316592 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 318181818 - positions: - -0.15325296918793554 - -0.37210932883690506 - -0.5731414335574881 - -0.2010321047205831 - -4.887072093676495e-17 - -0.1532529691879356 velocities: - 0.7242145402539184 - -0.07649567678114977 - -0.09687386106420945 - -0.02037818428306004 - -6.250696574922054e-16 - 0.7242145402539184 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 333333333 - positions: - -0.14228002160833073 - -0.37326835424268007 - -0.5746092193311882 - -0.20134086508850826 - -5.834147332301048e-17 - -0.14228002160833078 velocities: - 0.7385830752675497 - -0.05528931182474727 - -0.069910355733534 - -0.014621043908786588 - -5.220433460517704e-17 - 0.73858307526755 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 348484848 - positions: - -0.1310893689527618 - -0.3741060710885096 - -0.5756684671453327 - -0.20156239605682322 - -5.913244808975558e-17 - -0.13108936895276185 velocities: - 0.7517293534801873 - -0.03371196562574788 - -0.042579397280264525 - -0.00886743165451672 - -5.484978790604167e-16 - 0.7517293534801874 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 363636363 - positions: - -0.11969953026366804 - -0.37461685844647546 - -0.576313609528367 - -0.20169675108189164 - -6.744302201491341e-17 - -0.1196995302636681 velocities: - 0.7635948960567561 - -0.011833870758089435 - -0.014936407451044832 - -0.003102536692956112 - 3.230922474006803e-17 - 0.7635948960567563 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 378787878 - positions: - -0.10812991062644446 - -0.3747961595185677 - -0.5765399187321707 - -0.2017437592136031 - -6.695348830673056e-17 - -0.10812991062644452 velocities: - 0.7741266461877404 - 0.010271614846366461 - 0.012961463272261171 - 0.0026898484258951055 - -9.302454639925628e-17 - 0.7741266461877404 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 393939393 - positions: - -0.0964007190175393 - -0.37464052899059247 - -0.5763435329250153 - -0.20170300393442286 - -6.836295113096172e-17 - -0.09640071901753935 velocities: - 0.7832776309415178 - 0.032528679361561307 - 0.04105556518502434 - 0.008526885823462893 - -2.5955800009302976e-16 - 0.7832776309415184 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 409090909 - positions: - -0.084532876124486 - -0.374147670212387 - -0.5757214789070604 - -0.20157380869467342 - -7.229564810206823e-17 - -0.08453287612448604 velocities: - 0.791007555973279 - 0.05485977971839375 - 0.06928599007643323 - 0.014426210358039301 - -1.4181364416110398e-16 - 0.7910075559732789 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 424242424 - positions: - -0.07254791315519389 - -0.37331646142877495 - -0.5746716911786296 - -0.20135522974985465 - -7.444433968026678e-17 - -0.07254791315519393 velocities: - 0.7972833187698372 - 0.07718640075625889 - 0.09759182183174532 - 0.02040542107548668 - 1.0191500421363742e-17 - 0.7972833187698376 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 439393939 - positions: - -0.06046786287080242 - -0.3721469705082256 - -0.5731930272114819 - -0.20104605670325637 - -7.428992300721582e-17 - -0.060467862870802455 velocities: - 0.8020794278649122 - 0.09942983479484566 - 0.12591139551250896 - 0.02648156071766279 - 1.5612511283791264e-17 - 0.802079427864912 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 454545454 - positions: - -0.048315144266788596 - -0.37064045785981886 - -0.5712852787946258 - -0.20064482093480693 - -7.405336980594626e-17 - -0.04831514426678864 velocities: - 0.8053783177084642 - 0.1215119647269672 - 0.1541825633883881 - 0.032670598661421094 - -2.2811613709095013e-16 - 0.8053783177084646 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 469696969 - positions: - -0.03611244248332701 - -0.36879936748516784 - -0.5689491793493472 - -0.20014981186417932 - -7.75096749133849e-17 - -0.036112442483327054 velocities: - 0.8071705515331253 - 0.14335603353699372 - 0.18234296624596646 - 0.03898693270897299 - -1.1882855810441129e-16 - 0.8071705515331248 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 484848484 - positions: - -0.02388258564191602 - -0.36662730637097096 - -0.5661864071334992 - -0.19955910076252822 - -7.931010761193658e-17 - -0.023882585641916074 velocities: - 0.8074549075234712 - 0.16488738359065647 - 0.21033030812648312 - 0.0454429245358261 - -3.2482697087665713e-16 - 0.8074549075234712 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 500000000 - positions: - -0.011648420376408883 - -0.3641290126802034 - -0.5629995842830979 - -0.1988705716028945 - -8.423172838279502e-17 - -0.011648420376408935 velocities: - 0.8062383467348708 - 0.18603415009983215 - 0.23808263245522596 - 0.05204848235539389 - -4.5536491244391186e-17 - 0.8062383467348707 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 515151515 - positions: - 0.0005673121498770382 - -0.3613103134362666 - -0.5593922716701399 - -0.1980819582338734 - -8.492167521983125e-17 - 0.0005673121498769862 velocities: - 0.8035358643927648 - 0.20672789478549464 - 0.26553859733358876 - 0.058810702548094146 - 1.8648277366750676e-17 - 0.8035358643927648 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 530303030 - positions: - 0.012742097974009839 - -0.35817807260618334 - -0.555368959589328 - -0.1971908869831447 - -8.463912556275927e-17 - 0.012742097974009787 velocities: - 0.7993702292938045 - 0.22690416785831263 - 0.29263774758678857 - 0.06573357972847665 - -1.964574336543734e-16 - 0.7993702292938043 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 545454545 - positions: - 0.024853768114825057 - -0.35474013066893617 - -0.5509350543228615 - -0.19619492365392535 - -8.76157533454013e-17 - 0.024853768114825002 velocities: - 0.7937716188974505 - 0.24650298890027528 - 0.31932078101369965 - 0.07281779211342432 - -1.5525775109992423e-16 - 0.7937716188974502 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 560606060 - positions: - 0.03688061082539249 - -0.3510052368977199 - -0.5460968606711387 - -0.19509162377341893 - -8.996814351358197e-17 - 0.03688061082539243 velocities: - 0.7867771602254877 - 0.2654692399373987 - 0.3455298061874154 - 0.0800605662500169 - -2.745199900733297e-16 - 0.7867771602254879 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 575757575 - positions: - 0.04880147688941503 - -0.3469829756865472 - -0.54086156057739 - -0.19387858489084292 - -9.412753730257182e-17 - 0.048801476889414976 velocities: - 0.778430388783725 - 0.28375296681023876 - 0.37120858912137394 - 0.08745562231113457 - 9.454242944073599e-17 - 0.7784303887837251 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 590909090 - positions: - 0.06059587671947147 - -0.34268368831063445 - -0.5352371880149449 - -0.19255349970431057 - -9.269507625043945e-17 - 0.06059587671947142 velocities: - 0.7687806393175617 - 0.30130958774500244 - 0.39630278615796927 - 0.09499319841296663 - -3.148523108897905e-16 - 0.7687806393175619 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 606060606 - positions: - 0.072244068224283 - -0.33811839152661927 - -0.5292326003458848 - -0.19111420881926564 - -9.746556580937567e-17 - 0.07224406822428296 velocities: - 0.7578823832723538 - 0.31810001068180194 - 0.420760160561446 - 0.10266014987964406 - -2.1597307275911248e-16 - 0.7578823832723532 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 621212121 - positions: - 0.08372713463750049 - -0.3332986943950768 - -0.5228574463979841 - -0.1895587520029074 - -1.0073788509360464e-16 - 0.08372713463750044 velocities: - 0.7457945283411715 - 0.3340906633236134 - 0.4445307805062628 - 0.11044011718264968 - -3.469446951953614e-17 - 0.7457945283411721 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 636363636 - positions: - 0.09502705173357885 - -0.32823671464774934 - -0.5161221315418286 - -0.18788541689407937 - -1.0126355887420368e-16 - 0.0950270517335788 velocities: - 0.7325796954647287 - 0.34925344194627905 - 0.4675671964419517 - 0.11831375449567222 - 1.8214596497756474e-17 - 0.7325796954647285 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 651515151 - positions: - 0.10612674408910505 - -0.3229449958303815 - -0.509037780080587 - -0.18609278425020553 - -1.0098758013938919e-16 - 0.10612674408910498 velocities: - 0.7183034881433831 - 0.3635655866981991 - 0.48982459617644725 - 0.12625900947824825 - -9.80118763926896e-17 - 0.7183034881433831 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 666666666 - positions: - 0.1170101302730957 - -0.3174364263349542 - -0.5016161952900348 - -0.18417976895508056 - -1.0247260856958146e-16 - 0.11701013027309563 velocities: - 0.7030337679910276 - 0.37700949238524045 - 0.5112609364383566 - 0.13425144405311568 - -1.8821749714348357e-16 - 0.7030337679910285 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 681818181 - positions: - 0.12766215706083855 - -0.3117241612988142 - -0.4938698174652112 - -0.182145656166397 - -1.0532438882933121e-16 - 0.1276621570608385 velocities: - 0.6868399491812309 - 0.38957246457390604 - 0.5318370501373078 - 0.14226458556340174 - 1.1275702593849246e-16 - 0.686839949181231 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 696969696 - positions: - 0.13806882295752387 - -0.30582154819920954 - -0.48581168034191863 - -0.1799901321427091 - -1.0361594904238435e-16 - 0.13806882295752382 velocities: - 0.669792322891278 - 0.4012464312680994 - 0.5515167290214884 - 0.15027029775338874 - -3.2699537522162814e-16 - 0.6697923228912778 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 712121212 - positions: - 0.1482171914861796 - -0.29974205681635957 - -0.47745536626583546 - -0.17771330944947594 - -1.0857042442453024e-16 - 0.14821719148617954 velocities: - 0.6519614211264317 - 0.412027620454755 - 0.5702667819128758 - 0.15823916145812117 - -1.5092094240998222e-16 - 0.651961421126432 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 727272727 - positions: - 0.15809539483658008 - -0.2934992140821966 - -0.46881496047927673 - -0.17531574639708017 - -1.1085710537013603e-16 - 0.15809539483658003 velocities: - 0.6334174274889447 - 0.421916213517888 - 0.5880570691645582 - 0.1661408556466697 - -1.5092094240998222e-16 - 0.6334174274889446 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 742424242 - positions: - 0.16769262858641257 - -0.28710654418041043 - -0.4599050048858743 - -0.17279846070546395 - -1.1314378631574183e-16 - 0.1676926285864125 velocities: - 0.6142296406216455 - 0.43091598394568514 - 0.6048605144138149 - 0.17394453046812997 - -1.7694179454963432e-16 - 0.6142296406216452 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 757575757 - positions: - 0.17699913829280114 - -0.2805775141206273 - -0.4507404516371802 - -0.1701629375165529 - -1.158247225967969e-16 - 0.17699913829280106 velocities: - 0.5944659942722642 - 0.43903392996200846 - 0.6206530950849114 - 0.18161916512290344 - -2.896988204881268e-16 - 0.5944659942722644 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 772727272 - positions: - 0.18600619881207786 - -0.2739254848787787 - -0.4413366168631664 - -0.1674111319843877 - -1.2021409866479882e-16 - 0.1860061988120778 velocities: - 0.5741926362479045 - 0.4462799087640399 - 0.6354138134158979 - 0.18913390465185803 - -4.683753385137379e-17 - 0.5741926362479045 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 787878787 - positions: - 0.1947060872400764 - -0.26716366807932357 - -0.43170913484171336 - -0.16454546676238985 - -1.209237582686075e-16 - 0.19470608724007635 velocities: - 0.5534735670026003 - 0.4526662790006282 - 0.649124650036766 - 0.1964583710361379 - -9.020562075079397e-17 - 0.5534735670025999 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 803030303 - positions: - 0.20309205037647943 - -0.26030508809446556 - -0.4218739128714593 - -0.16156882477699383 - -1.2229051009816498e-16 - 0.20309205037647937 velocities: - 0.5323703372550581 - 0.45820755703485266 - 0.6617705023084297 - 0.203562945273577 - -9.71445146547012e-17 - 0.5323703372550579 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 818181818 - positions: - 0.21115826760761666 - -0.25336254935151326 - -0.4118470870789073 - -0.15848453772739418 - -1.2376239668384226e-16 - 0.2111582676076166 velocities: - 0.5109418028867081 - 0.46292009144559265 - 0.6733391097428476 - 0.2104190182972555 - -3.400058012914542e-16 - 0.5109418028867082 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 833333333 - positions: - 0.21889981007559708 - -0.24634860857203458 - -0.40164497935553084 - -0.15529637078349637 - -1.2891399973371278e-16 - 0.21889981007559703 velocities: - 0.4892439344293591 - 0.4668217591746326 - 0.6838209688669353 - 0.21699920969230352 - -9.8879238130678e-17 - 0.48924393442935965 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 848484848 - positions: - 0.2263125969608904 - -0.23927555161484318 - -0.3912840555848197 - -0.15200850396997662 - -1.3041217000842002e-16 - 0.22631259696089034 velocities: - 0.46732967771498535 - 0.4699316857471405 - 0.6932092398719139 - 0.2232775541247738 - 1.491862189340054e-16 - 0.46732967771498546 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 863636363 - positions: - 0.2333933496535417 - -0.2321553745580683 - -0.3807808852837301 - -0.14862551072566185 - -1.2815177275184419e-16 - 0.23339334965354164 velocities: - 0.4452488617180683 - 0.472269991105501 - 0.7014996473122743 - 0.2292296562067726 - -1.682681771697503e-16 - 0.4452488617180682 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 878787878 - positions: - 0.24013954452805789 - -0.2249997686322274 - -0.37015210274869564 - -0.14515233411646833 - -1.307012905877495e-16 - 0.24013954452805783 velocities: - 0.4230481492581202 - 0.4738575618123682 - 0.7086903769928727 - 0.23483281518050486 - -8.673617379884035e-18 - 0.42304814925812034 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 893939393 - positions: - 0.24654936497136273 - -0.21782010860476728 - -0.35941436976395513 - -0.14159426115918794 - -1.3083270903289926e-16 - 0.24654936497136268 velocities: - 0.4007710260275763 - 0.47471584970506925 - 0.7147819710176578 - 0.24006612131258853 - 1.0234868508263162e-16 - 0.4007710260275761 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 909090909 - positions: - 0.2526216532445078 - -0.21062744421529653 - -0.3485843399000512 - -0.13795689568475478 - -1.2928197138013211e-16 - 0.25262165324450775 velocities: - 0.37845782334674916 - 0.47486669652093844 - 0.719777222778079 - 0.24491052625714027 - -8.847089727481716e-17 - 0.37845782334674904 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 924242424 - positions: - 0.2583558626891555 - -0.20343249426800958 - -0.3376786244034137 - -0.13424613013540418 - -1.3062243952065964e-16 - 0.25835586268915545 velocities: - 0.3561457701006805 - 0.4743321835578812 - 0.7236810734420829 - 0.24934888988420179 - -1.1102230246251565e-16 - 0.3561457701006805 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 939393939 - positions: - 0.263752010720984 - -0.19624564300198108 - -0.3267137596542912 - -0.1304681166523102 - -1.3230459561857654e-16 - 0.2637520107209839 velocities: - 0.3338690694604333 - 0.47313450507982013 - 0.7265005112738161 - 0.25336600619399585 - 1.491862189340054e-16 - 0.33386906946043304 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 954545454 - positions: - 0.268810632985536 - -0.18907693837955955 - -0.3157061761501425 - -0.126629237770583 - -1.300441983620007e-16 - 0.2688106329855359 velocities: - 0.31165899621260545 - 0.47129586391304157 - 0.7282444748770733 - 0.2569486109640316 - -3.469446951953614e-17 - 0.3116589962126059 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 969696969 - positions: - 0.2735327389887573 - -0.18193609195663468 - -0.30467216895503535 - -0.1227360769984007 - -1.3056987214259973e-16 - 0.27353273898875724 velocities: - 0.2895440107962125 - 0.4688383874964578 - 0.7289237612183452 - 0.2600853737218874 - 6.938893903907228e-17 - 0.2895440107962128 accelerations: [] effort: [] time_from_start: sec: 1 nanosec: 984848484 - positions: - 0.27791976945536656 - -0.17483248002487017 - -0.2936278695426362 - -0.11879538951776604 - -1.2951852458140166e-16 - 0.2779197694553665 velocities: - 0.26754988645832556 - 0.46578406253511534 - 0.7285509390534839 - 0.2627668765183683 - 1.3704315460216776e-16 - 0.26754988645832567 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 0 - positions: - 0.28197355561382603 - -0.1677751457440351 - -0.28258921895091677 - -0.11481407320688167 - -1.2744211314803547e-16 - 0.281973555613826 velocities: - 0.24569984627395075 - 0.4621546863507875 - 0.7271402681596673 - 0.2649855818088799 - -1.9255430583342559e-16 - 0.24569984627395086 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 15151515 - positions: - 0.28569628055737073 - -0.16077280201144742 - -0.27157194216061875 - -0.11079914014917136 - -1.3035960263036011e-16 - 0.2856962805573707 velocities: - 0.22401470711892826 - 0.4579718330155634 - 0.7247076245650442 - 0.26673579154948124 - 2.463307335887066e-16 - 0.22401470711892837 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 30303030 - positions: - 0.2890904427864454 - -0.15383383484454494 - -0.2605915236066029 - -0.106757688762058 - -1.2662731878810697e-16 - 0.28909044278644536 velocities: - 0.20251302802680732 - 0.45325683238406905 - 0.7212704317744271 - 0.26801359939035835 - 2.7755575615628914e-17 - 0.20251302802680735 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 45454545 - positions: - 0.2921588219989728 - -0.14696630708114994 - -0.2496631837312328 - -0.10269687665008288 - -1.2620677976362774e-16 - 0.29215882199897275 velocities: - 0.1812112606934772 - 0.4480307601986713 - 0.7168475978128004 - 0.2688168376141286 - 4.163336342344337e-17 - 0.1812112606934775 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 60606060 - positions: - 0.2949044471609952 - -0.14017796222965492 - -0.23880185649164493 - -0.09862389426199003 - -1.255759712269089e-16 - 0.2949044471609951 velocities: - 0.16012390021062237 - 0.44231443752191263 - 0.7114594577499505 - 0.2691450202280378 - -6.418476861114186e-17 - 0.16012390021062214 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 75757575 - positions: - 0.2973305668611561 - -0.13347622832780776 - -0.2280221677378578 - -0.09454593941005006 - -1.2654846772101712e-16 - 0.29733056686115605 velocities: - 0.13926363440633086 - 0.436128437845171 - 0.7051277212302577 - 0.26899928338508694 - -5.204170427930421e-18 - 0.139263634406331 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 90909090 - positions: - 0.2994406219279187 - -0.12686822169379 - -0.2173384143858842 - -0.09047019269209419 - -1.2662731878810697e-16 - 0.29944062192791865 velocities: - 0.11864149044542475 - 0.4294931003266874 - 0.6978754244116381 - 0.26838232408495055 - 9.540979117872439e-17 - 0.11864149044542466 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 106060606 - positions: - 0.3012382202680009 - -0.12036075047671899 - -0.2067645443190412 - -0.08640379384232222 - -1.2518171589145964e-16 - 0.30123822026800084 velocities: - 0.09826697759157205 - 0.4224285477215365 - 0.6897268856168507 - 0.26729833789531443 - 8.847089727481716e-17 - 0.09826697759157224 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 121212121 - positions: - 0.3027271138678732 - -0.11396031793548358 - -0.19631413696121014 - -0.08235381902572654 - -1.2384124775093212e-16 - 0.30272711386787315 velocities: - 0.07814822525729742 - 0.4149547076773728 - 0.6807076639188365 - 0.26575295624146344 - 1.734723475976807e-16 - 0.07814822525729781 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 136363636 - positions: - 0.3039111778869232 - -0.10767312539491733 - -0.1860003844775914 - -0.07832725908267406 - -1.2121287884793696e-16 - 0.3039111778869231 velocities: - 0.05829211566672309 - 0.4070913361807191 - 0.6708445198188847 - 0.2637531836381656 - -4.683753385137379e-17 - 0.05829211566672317 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 151515151 - positions: - 0.3047943917606614 - -0.10150507484672462 - -0.17583607357124467 - -0.07433099872452004 - -1.2192253845174565e-16 - 0.30479439176066137 velocities: - 0.038704410629973984 - 0.398858042047235 - 0.6601653771321458 - 0.261307335084911 - 2.5847379792054426e-16 - 0.03870441062997385 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 166666666 - positions: - 0.30538082222475194 - -0.09546177117934228 - -0.16583356785712125 - -0.07037179667777896 - -1.1800626878628287e-16 - 0.3053808222247519 velocities: - 0.019389872078907862 - 0.39027431145500824 - 0.648699285168646 - 0.2584249737136375 - 3.9898639947466563e-17 - 0.019389872078907834 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 181818181 - positions: - 0.3056746081653414 - -0.08954852403608457 - -0.15600479080911145 - -0.06645626677302688 - -1.17401743938594e-16 - 0.30567460816534137 velocities: - 0.0003523761426418512 - 0.3813595316217447 - 0.6364763802893365 - 0.25511684866759193 - -6.938893903907228e-17 - 0.0003523761426418512 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 196969696 - positions: - 0.30567994719780567 - -0.08377034931454298 - -0.14636120928957605 - -0.06259085997503307 - -1.1845309149979206e-16 - 0.3056799471978056 velocities: - -0.018404979350000968 - 0.3721330128247302 - 0.6235278459251846 - 0.2513948331004544 - 7.112366251504909e-17 - -0.018404979350000766 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 212121212 - positions: - 0.3054010838743208 - -0.0781319703323501 - -0.136913817684649 - -0.05878184735229891 - -1.1737546024956404e-16 - 0.30540108387432074 velocities: - -0.03687977396369365 - 0.3626140080566825 - 0.60988587017255 - 0.24727186211586774 - -6.418476861114186e-17 - -0.03687977396369354 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 227272727 - positions: - 0.3048422994203254 - -0.07263781869512764 - -0.1276731226820346 - -0.055035303986906974 - -1.1834795674367225e-16 - 0.30484229942032537 velocities: - -0.05507017029421129 - 0.3528217297014478 - 0.5955836001195345 - 0.24276187041808717 - 1.6479873021779667e-16 - -0.055070170294211025 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 242424242 - positions: - 0.30400790290071616 - -0.06729203491177237 - -0.11864912874082953 - -0.05135709382905717 - -1.1585100628582685e-16 - 0.3040079029007161 velocities: - -0.07297482604001562 - 0.342775362701351 - 0.5806550921149887 - 0.2378797294136379 - 1.5265566588595902e-16 - -0.07297482604001573 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 257575757 - positions: - 0.3029022237182917 - -0.06209846881023674 - -0.10985132431484484 - -0.04775285550460811 - -1.1353804165119111e-16 - 0.3029022237182916 velocities: - -0.09059281235109402 - 0.33249407377333473 - 0.5651352572638257 - 0.23264118349049115 - 7.45931094670027e-17 - -0.0905928123510941 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 272727272 - positions: - 0.3015296053493357 - -0.057060679813671064 - -0.10128866890175657 - -0.04422798908808551 - -1.1240784302290319e-16 - 0.30152960534933565 velocities: - -0.10792353826322733 - 0.32199701631427724 - 0.5490598015181806 - 0.2270627852039035 - -5.204170427930421e-18 - -0.10792353826322734 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 287878787 - positions: - 0.29989440022413527 - -0.05218193714224262 - -0.09296958099996595 - -0.04078764385772334 - -1.1248669408999304e-16 - 0.2998944002241352 velocities: - -0.12496668100039657 - 0.3113033307174652 - 0.532465159832954 - 0.2211618291154889 - 1.6566609195578508e-16 - -0.12496668100039661 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 303030303 - positions: - 0.2980009656635232 - -0.04746522001015981 - -0.08490192706310301 - -0.037436707052943205 - -1.0997660178763267e-16 - 0.29800096566352313 velocities: - -0.14172212191075573 - 0.300432139902328 - 0.5153884239648945 - 0.21495628406256662 - 1.474514954580286e-17 - -0.14172212191075562 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 318181818 - positions: - 0.2958536607860875 - -0.04291321789042757 - -0.0770930115484834 - -0.03417979365805583 - -1.0975319043087808e-16 - 0.29585366078608744 velocities: - -0.15818988779122223 - 0.2894025399384072 - 0.49786726361533035 - 0.20846472367692315 - 1.0061396160665481e-16 - -0.15818988779122223 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 333333333 - positions: - 0.29345684430440233 - -0.03852833092166382 - -0.06954956816037233 - -0.03102123723870851 - -1.082287364671409e-16 - 0.2934568443044023 velocities: - -0.17437009735107126 - 0.27823358572209633 - 0.479939840746099 - 0.20170625502400275 - -3.469446951953614e-18 - -0.17437009735107106 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 348484848 - positions: - 0.2908148731324164 - -0.03431267053193509 - -0.062277752391492046 - -0.027965081859556956 - -1.082813038452008e-16 - 0.29081487313241633 velocities: - -0.19026291256489583 - 0.26694427174073265 - 0.4616447170341864 - 0.19470044529345373 - 5.2909066017292616e-17 - -0.1902629125648958 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 363636363 - positions: - 0.28793210172991796 - -0.030268060354045202 - -0.055283135466731644 - -0.025015075112686445 - -1.0747965132978728e-16 - 0.2879321017299179 velocities: - -0.20586849466904297 - 0.2555535080328796 - 0.44302075457094325 - 0.187467246538064 - 2.2551405187698492e-17 - -0.20586849466904292 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 378787878 - positions: - 0.28481288211372036 - -0.026396037505062177 - -0.04857069979141432 - -0.02217466228635214 - -1.0713796337239791e-16 - 0.2848128821137203 velocities: - -0.22118696456226725 - 0.24408009152554438 - 0.424107010053966 - 0.18002691852842165 - 2.688821387764051e-17 - -0.2211869645622673 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 393939393 - positions: - 0.2814615644688375 - -0.022697854300129685 - -0.042144836002717866 - -0.019446981702588177 - -1.0673056619243366e-16 - 0.28146156446883747 velocities: - -0.23621836738019136 - 0.232542672998054 - 0.4049426228613213 - 0.17239994986326768 - 1.2750217548429532e-16 - -0.23621836738019117 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 409090909 - positions: - 0.2778824982964104 - -0.019174480466825836 - -0.03600934171694027 - -0.016834861250114425 - -1.0479871504873221e-16 - 0.2778824982964103 velocities: - -0.2509626410236161 - 0.22095971998760908 - 0.3855666975360171 - 0.16460697754840806 - 1.5699247457590104e-16 - -0.2509626410236159 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 424242424 - positions: - 0.2740800340384768 - -0.01582660592155903 - -0.030167422057303647 - -0.014340816135744606 - -1.0242004119152158e-16 - 0.27408003403847675 velocities: - -0.2654195884321896 - 0.20934947601235432 - 0.3660181813407146 - 0.15666870532836039 - 2.1076890233118206e-16 - -0.2654195884321895 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 439393939 - positions: - 0.27005852512283757 - -0.012654644163796087 - -0.02462169203698979 - -0.01196704787319369 - -9.922657297438245e-17 - 0.2700585251228375 velocities: - -0.2795888534070504 - 0.1977299165433013 - 0.3463357376659818 - 0.1486058211226805 - 1.1102230246251565e-16 - -0.27958885340705036 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 454545454 - positions: - 0.2658223303742459 - -0.009658736337382432 - -0.01937418086023249 - -0.009715444522850046 - -9.754441687646555e-17 - 0.26582233037424585 velocities: - -0.2934698997983574 - 0.18611870220572793 - 0.3265576161871406 - 0.1404389139814129 - 7.28583859910259e-17 - -0.29346989979835725 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 469696969 - positions: - 0.26137581674093746 - -0.006838756000932009 - -0.01442633819073036 - -0.007587582189798336 - -9.644050193720759e-17 - 0.2613758167409374 velocities: - -0.3070619938857978 - 0.17453312973303636 - 0.30672152076269527 - 0.13218839102965904 - 8.413408858487514e-17 - -0.3070619938857974 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 484848484 - positions: - 0.25672336228812237 - -0.0041943146413405494 - -0.009779042421598615 - -0.005584727780258047 - -9.516574301925494e-17 - 0.2567233622881223 velocities: - -0.32036418979194353 - 0.1629900812306101 - 0.2868644761490913 - 0.12387439491848129 - -2.0816681711721685e-17 - -0.3203641897919431 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 500000000 - positions: - 0.25186935941248684 - -0.001724767956028275 - -0.005432610964794202 - -0.003707843008765906 - -9.548114728761435e-17 - 0.25186935941248684 velocities: - -0.3333753177795317 - 0.1515059723335085 - 0.26702269467045014 - 0.11551672233694163 - -9.454242944073599e-17 - -0.33337531777953155 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 515151515 - positions: - 0.2468182182340091 - 0.0005707770793279142 - -0.0013868125606964722 - -0.001957589640024366 - -9.691360833974672e-17 - 0.2468182182340091 velocities: - -0.34609397529405006 - 0.14009669985925255 - 0.2472314440263868 - 0.10713474416713391 - 5.681219383824043e-17 - -0.34609397529404995 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 530303030 - positions: - 0.2415743701234932 - 0.00269345434992265 - 0.002359118409400298 - -0.00033433594052233715 - -9.60528175240158e-17 - 0.2415743701234932 velocities: - -0.35851852062248235 - 0.12877758956529842 - 0.22752491744517028 - 0.09874732787987198 - 6.461844948013606e-17 - -0.3585185206224828 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 545454545 - positions: - 0.23614227132618287 - 0.004644629949396868 - 0.005806465643418029 - 0.0011618356940211777 - -9.50737501076501e-17 - 0.23614227132618285 velocities: - -0.37064706904733424 - 0.11756334461992327 - 0.20793610739285737 - 0.09037276277293399 - -7.025630077706069e-17 - -0.37064706904733424 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 560606060 - positions: - 0.2305264066436475 - 0.006425892746668433 - 0.00895701272512799 - 0.0025311199784595713 - -9.613823951336315e-17 - 0.23052640664364749 velocities: - -0.38247749138228204 - 0.10646799538523732 - 0.18849668403152575 - 0.08202868864628846 - 1.3834419720915037e-16 - -0.3824774913822821 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 575757575 - positions: - 0.22473129313785536 - 0.0080390441918993 - 0.011813023089242015 - 0.0037739788973427295 - -9.40421153132245e-17 - 0.22473129313785534 velocities: - -0.3940074147816949 - 0.09550485109222584 - 0.16923687958210437 - 0.07373202848987874 - 1.3010426069826053e-18 - -0.3940074147816952 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 590909090 - positions: - 0.2187614838229812 - 0.009486087390266358 - 0.014377218234425415 - 0.004891130844159074 - -9.402240254645205e-17 - 0.21876148382298116 velocities: - -0.40523422572097945 - 0.0846864539606533 - 0.15018537969049617 - 0.06549892572984309 - 3.447762908503904e-17 - -0.4052342257209793 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 606060606 - positions: - 0.21262157131205725 - 0.010769215480579287 - 0.016652754290342024 - 0.0058835388097627575 - -9.350001422698175e-17 - 0.21262157131205722 velocities: - -0.41615507504809474 - 0.07402453628192993 - 0.13136922282122465 - 0.05734468653929474 - 2.3830763751231387e-16 - -0.4161550750480949 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 621212121 - positions: - 0.20631619138708612 - 0.011890799363638831 - 0.018643197060360578 - 0.006752397696721769 - -8.988929244649215e-17 - 0.2063161913870861 velocities: - -0.42676688500869026 - 0.06352998094163798 - 0.11281370861274617 - 0.049283727671108335 - 3.859759734048396e-17 - -0.4267668850086906 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 636363636 - positions: - 0.19985002646271202 - 0.012853374832451529 - 0.020352495675705216 - 0.007499120843253713 - -8.930448036557573e-17 - 0.199850026462712 velocities: - -0.43706635814823613 - 0.05321278581123995 - 0.09454231602503632 - 0.041329530213796324 - 1.573177352276467e-16 - -0.4370663581482362 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 651515151 - positions: - 0.19322780891501148 - 0.01365962916292486 - 0.02178495500941789 - 0.008125325846493052 - -8.692087831667199e-17 - 0.19322780891501146 velocities: - -0.4470499879941332 - 0.04308203238669663 - 0.07657663199564835 - 0.03349459960895158 - 2.458970527197124e-16 - -0.4470499879941328 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 666666666 - positions: - 0.1864543242484337 - 0.014312387229389961 - 0.022945207009351955 - 0.008632819779962015 - -8.319516539667635e-17 - 0.1864543242484337 velocities: - -0.4567140714193425 - 0.03314585899648085 - 0.05893629119788969 - 0.025790432201408683 - -2.2475511035624507e-16 - -0.45671407141934256 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 681818181 - positions: - 0.17953441407541335 - 0.014814597214185125 - 0.02383818111841089 - 0.009023583904225783 - -8.660054585661945e-17 - 0.17953441407541335 velocities: - -0.46605472258652636 - 0.02341143884394052 - 0.04163892736680098 - 0.01822748852286059 - 9.422394505256837e-17 - -0.4660547225865258 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 696969696 - positions: - 0.1724729788847084 - 0.01516931598454786 - 0.02446907395730181 - 0.009299757972753973 - -8.517291032551993e-17 - 0.17247297888470842 velocities: - -0.47506788836814434 - 0.013884963090386431 - 0.024700136528075005 - 0.010815173437688634 - 1.1628068299907035e-17 - -0.4750678883681445 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 712121212 - positions: - 0.16527498057610013 - 0.01537969421319008 - 0.024843318450151433 - 0.009463624236961376 - -8.499672747249104e-17 - 0.16527498057610016 velocities: - -0.48374936513359573 - 0.004571629126738621 - 0.008133452334576088 - 0.0035618232078374543 - 1.124317652867468e-16 - -0.4837493651335952 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 727272727 - positions: - 0.15794544474074262 - 0.015448961321170967 - 0.02496655257643289 - 0.009517591255261944 - -8.32932158772373e-17 - 0.15794544474074265 velocities: - -0.49209481678934114 - -0.004524365875838866 - -0.008049666412779065 - -0.003525300536940147 - 1.8789223649173792e-16 - -0.4920948167893414 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 742424242 - positions: - 0.15048946266817684 - 0.015380410323052197 - 0.024844587933815027 - 0.00946417761076285 - -8.044636380918066e-17 - 0.15048946266817687 velocities: - -0.5000997939522549 - -0.013399826101220456 - -0.023839836106069004 - -0.010440010004848399 - -2.286582381771929e-16 - -0.5000997939522548 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 757575757 - positions: - 0.14291219306283964 - 0.015177382654851886 - 0.024483378295844283 - 0.00930599564099242 - -8.391088256944116e-17 - 0.14291219306283967 velocities: - -0.5077597541302431 - -0.022052552926841367 - -0.0392297366958259 - -0.017177183768984583 - 2.179246366695864e-16 - -0.5077597541302427 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 772727272 - positions: - 0.13521886345480566 - 0.014843253065051258 - 0.023888988345907528 - 0.00904573528085629 - -8.060899413505349e-17 - 0.1352188634548057 velocities: - -0.5150700827777501 - -0.030481335531637958 - -0.05421408835113946 - -0.0237327528195016 - -2.975050761300224e-16 - -0.5150700827777495 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 787878787 - positions: - 0.1274147712915064 - 0.014381414647905228 - 0.023067562764829658 - 0.008686148116924449 - -8.51166468036902e-17 - 0.12741477129150644 velocities: - -0.5220261150871776 - -0.038685936384293525 - -0.0687896167825803 - -0.030103680398286786 - 2.0296264668928643e-16 - -0.5220261150871777 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 803030303 - positions: - 0.11950528469927645 - 0.013795264096628054 - 0.022025295843881472 - 0.008230031747253437 - -8.204145518718585e-17 - 0.11950528469927647 velocities: - -0.5286231583707643 - -0.046667071762924596 - -0.08295500768335524 - -0.03628793592043045 - -8.391724815037804e-17 - -0.5286231583707639 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 818181818 - positions: - 0.11149584290578002 - 0.013088187251735257 - 0.02076840178807306 - 0.007680214536337824 - -8.331292864400977e-17 - 0.11149584290578005 velocities: - -0.5348565148812142 - -0.05442638749283871 - -0.09671085082003977 - -0.042284463327200705 - 1.6306400674181987e-16 - -0.5348565148812146 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 833333333 - positions: - 0.10339195631667071 - 0.012263545016995277 - 0.019303085866557306 - 0.007039540849562056 - -8.084226187519432e-17 - 0.10339195631667074 velocities: - -0.5407215049135595 - -0.061966430119714776 - -0.11005957436859638 - -0.04809314424888163 - 5.4643789493269423e-17 - -0.5407215049135592 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 848484848 - positions: - 0.09519920624222283 - 0.011324659712151113 - 0.01763551655794221 - 0.006310856845791122 - -8.001432567075084e-17 - 0.09519920624222288 velocities: - -0.5462134900255464 - -0.06929061376152554 - -0.12300537014431066 - -0.05371475638278528 - 5.811323644522304e-17 - -0.5462134900255459 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 863636363 - positions: - 0.0869232442721388 - 0.010274801927885574 - 0.01577179882848296 - 0.005496996900597406 - -7.913382208824746e-17 - 0.08692324427213885 velocities: - -0.5513278962094742 - -0.0764031829038508 - -0.13555411041594734 - -0.05915092751209672 - 1.5872719805187785e-16 - -0.5513278962094738 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 878787878 - positions: - 0.07856979129926797 - 0.009117177944493895 - 0.013717948670665576 - 0.004600770726171698 - -7.672886454200689e-17 - 0.07856979129926804 velocities: - -0.5560602368450104 - -0.08330917142027666 - -0.14771325702561106 - -0.06440408560533462 - 9.324138683375338e-17 - -0.5560602368450105 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 893939393 - positions: - 0.07014463619555569 - 0.0078549177714594 - 0.011479869018762377 - 0.003624951247302992 - -7.5316116256647e-17 - 0.07014463619555576 velocities: - -0.5604061352602333 - -0.09001435811251475 - -0.15949176355700714 - -0.06947740544449199 - 5.941427905220564e-17 - -0.5604061352602333 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 909090909 - positions: - 0.061653634146158216 - 0.006491063860663721 - 0.009063327146686511 - 0.0025722632860228105 - -7.441589990737116e-17 - 0.061653634146158286 velocities: - -0.5643613467272474 - -0.09652521907425637 - -0.17089997130714019 - -0.07437475223288326 - 8.543513119185775e-17 - -0.5643613467272476 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 924242424 - positions: - 0.053102704650290836 - 0.005028560541356806 - 0.0064739336420328725 - 0.0014453731006760944 - -7.312142822264604e-17 - 0.0531027046502909 velocities: - -0.5679217797191348 - -0.10284887718881683 - -0.1819494998207379 - -0.07910062263192127 - -1.235990476633475e-16 - -0.567921779719135 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 939393939 - positions: - 0.044497829200000914 - 0.003470244220314127 - 0.0037171230386883586 - 0.0002468788183742569 - -7.499414106603009e-17 - 0.04449782920000098 velocities: - -0.5710835162570862 - -0.10899304907389218 - -0.19265313274403645 - -0.08366008367014433 - -1.1622647289044608e-16 - -0.5710835162570863 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 954545454 - positions: - 0.03584504865065112 - 0.0018188343858612152 - 0.0007981361789302305 - -0.0010206982069309602 - -7.675514823103685e-17 - 0.03584504865065118 velocities: - -0.57384283118017 - -0.11496598978760188 - -0.20302469974592305 - -0.08805870995832077 - -2.6020852139652106e-17 - -0.5738428311801703 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 969696969 - positions: - 0.02715046029943642 - 7.692544968542912e-05 - -0.002277995635401937 - -0.0023549210850873355 - -7.714940356648612e-17 - 0.02715046029943648 velocities: - -0.5761962101755597 - -0.12077643560876869 - -0.21307895524089324 - -0.09230251963212421 - 1.0364972768961422e-16 - -0.5761962101755597 accelerations: [] effort: [] time_from_start: sec: 2 nanosec: 984848484 - positions: - 0.018420214690715822 - -0.0017530205443868237 - -0.0055064646542033495 - -0.00375344410981649 - -7.557895314694651e-17 - 0.018420214690715878 velocities: - -0.5781403664141729 - -0.12643354520155095 - -0.22283145463073695 - -0.09639790942918616 - 2.8622937353617317e-16 - -0.5781403664141724 accelerations: [] effort: [] time_from_start: sec: 3 nanosec: 0 - positions: - 0.00966051216928896 - -0.003668680320167899 - -0.008882698815275121 - -0.00521401849510719 - -7.124214445700449e-17 - 0.009660512169289022 velocities: - -0.5796722556454642 - -0.13194683947035046 - -0.23229842876125528 - -0.10035158929090496 - -1.6306400674181987e-16 - -0.579672255645464 accelerations: [] effort: [] time_from_start: sec: 3 nanosec: 15151515 --- ```
saikishor commented 9 months ago

@ecmjohnson thanks for the information. Fine then the issue is coming from the solver itself. Let's wait for @christophfroehlich to review and then we can merge it

christophfroehlich commented 9 months ago

I had a quick look. The IK solver is called with a twist in tool frame and generates a velocity vector in joint space, which is then integrated to positions. That's why the velocity is not zero in the end: one should probably add another field to the message with the last position (is discarded now) and zero velocity. Maybe the hardware plugin should be improved in a future PR using both position+velocity fields.

saikishor commented 9 months ago

Thank you @christophfroehlich