协作机械臂matlab代码

0 0 0 0 0 0 -0.000516771 -0.000775157 -0.00378966 -0.0151586 -0.0236853 -0.0947414 -0.00103354 -0.00155031 -0.00757931 -0.0303172 -0.0473707 -0.189483 -0.00103354 -0.00155031 -0.00757931 -0.0303172 -0.0473707 -0.189482 -0.00103354 -0.00155031 -0.00757931 -0.0303172 -0.0473706 -0.189481 -0.00103354 -0.00155031 -0.00757931 -0.0303172 -0.0473705 -0.18948 -0.00103354 -0.00155031 -0.00757931 -0.0303172 -0.0473705 -0.189479 -0.00103354 -0.00155031 -0.0075793 -0.0303171 -0.0473704 -0.189477 -0.00103354 -0.00155031 -0.0075793 -0.0303171 -0.0473702 -0.189475 -0.00103354 -0.00155031 -0.0075793 -0.030317 -0.0473701 -0.189473 -0.00103354 -0.00155031 -0.00757929 -0.0303169 -0.0473699 -0.189471 -0.00103354 -0.00155031 -0.00757929 -0.0303169 -0.0473698 -0.189468 -0.00103354 -0.00155031 -0.00757928 -0.0303168 -0.0473696 -0.189465 -0.00103354 -0.00155031 -0.00757928 -0.0303167 -0.0473694 -0.189461 -0.00103354 -0.00155031 -0.00757927 -0.0303166 -0.0473691 -0.189457 -0.00103354 -0.00155031 -0.00757927 -0.0303165 -0.0473689 -0.189453 -0.00103354 -0.00155031 -0.00757926 -0.0303164 -0.0473686 -0.189449 -0.00103354 -0.00155031 -0.00757925 -0.0303163 -0.0473683 -0.189444 -0.00103354 -0.00155031 -0.00757924 -0.0303161 -0.047368 -0.18944 -0.00103354 -0.00155031 -0.00757923 -0.030316 -0.0473677 -0.189434 -0.00103354 -0.00155031 -0.00757923 -0.0303159 -0.0473673 -0.189429 -0.00103354 -0.00155031 -0.00757922 -0.0303157 -0.047367 -0.189423 -0.00103354 -0.00155031 -0.00757921 -0.0303156 -0.0473666 -0.189417 -0.00103354 -0.00155031 -0.0075792 -0.0303154 -0.0473662 -0.18941 -0.00103354 -0.00155031 -0.00757919 -0.0303152 -0.0473658 -0.189404 -0.00103354 -0.00155031 -0.00757917 -0.030315 -0.0473653 -0.189397 -0.00103354 -0.00155031 -0.00757916 -0.0303149 -0.0473649 -0.189389 -0.00103354 -0.00155031 -0.00757915 -0.0303147 -0.0473644 -0.189382 -0.00103354 -0.0015503 -0.00757914 -0.0303145 -0.0473639 -0.189374 -0.00103354 -0.0015503 -0.00757912 -0.0303142 -0.0473634 -0.189365 -0.00103354 -0.0015503 -0.00757911 -0.030314 -0.0473628 -0.189357 -0.00103354 -0.0015503 -0.0075791 -0.0303138 -0.0473623 -0.189348 -0.00103353 -0.0015503 -0.00757908 -0.0303136 -0.0473617 -0.189339 -0.00103353 -0.0015503 -0.00757907 -0.0303133 -0.0473611 -0.18933 -0.00103353 -0.0015503 -0.00757905 -0.0303131 -0.0473605 -0.18932 -0.00103353 -0.0015503 -0.00757904 -0.0303128 -0.0473599 -0.18931 -0.00103353 -0.0015503 -0.00757902 -0.0303126 -0.0473592 -0.1893 -0.00103353 -0.0015503 -0.007579 -0.0303123 -0.0473586 -0.189289 -0.00103353 -0.0015503 -0.00757898 -0.030312 -0.0473579 -0.189278 -0.00103353 -0.0015503 -0.00757897 -0.0303117 -0.0473572 -0.189267 -0.00103353 -0.0015503 -0.00757895 -0.0303114 -0.0473565 -0.189255 -0.00103353 -0.00155029 -0.00757893 -0.0303111 -0.0473557 -0.189243 -0.00103353 -0.00155029 -0.00757891 -0.0303108 -0.047355 -0.189231 -0.00103353 -0.00155029 -0.00757889 -0.0303105 -0.0473542 -0.189219 -0.00103353 -0.00155029 -0.00757887 -0.0303102 -0.0473534 -0.189206 -0.00103353 -0.00155029 -0.00757885 -0.0303098 -0.0473526 -0.189193 -0.00103353 -0.00155029 -0.00757883 -0.0303095 -0.0473518 -0.18918 -0.00103353 -0.00155029 -0.00757881 -0.0303091 -0.0473509 -0.189166 -0.00103352 -0.00155029 -0.00757878 -0.0303088 -0.04735 -0.189152 -0.00103352 -0.00155029 -0.00757876 -0.0303084 -0.0473492 -0.189138 -0.00103352 -0.00155028 -0.00757874 -0.0303081 -0.0473482 -0.189124 -0.00103352 -0.00155028 -0.00757871 -0.0303077 -0.0473473 -0.189109 -0.00103352 -0.00155028 -0.00757869 -0.0303073 -0.0473464 -0.189094 -0.00103352 -0.00155028 -0.00757866 -0.0303069 -0.0473454 -0.189078 -0.00103352 -0.00155028 -0.00757864 -0.0303065 -0.0473444 -0.189063 -0.00103352 -0.00155028 -0.00757861 -0.0303061 -0.0473434 -0.189047 -0.00103352 -0.00155028 -0.00757859 -0.0303057 -0.0473424 -0.18903 -0.00103352 -0.00155028 -0.00757856 -0.0303052 -0.0473414 -0.189014 -0.00103352 -0.00155027 -0.00757853 -0.0303048 -0.0473403 -0.188997 -0.00103352 -0.00155027 -0.00757851 -0.0303044 -0.0473392 -0.18898 -0.00103351 -0.00155027 -0.00757848 -0.0303039 -0.0473382 -0.188962 -0.00103351 -0.00155027 -0.00757845 -0.0303035 -0.047337 -0.188944 -0.00103351 -0.00155027 -0.00757842 -0.030303 -0.0473359 -0.188926 -0.00103351 -0.00155027 -0.00757839 -0.0303025 -0.0473348 -0.188908 -0.00103351 -0.00155027 -0.00757836 -0.030302 -0.0473336 -0.188889 -0.00103351 -0.00155026 -0.00757833 -0.0303016 -0.0473324 -0.18887 -0.00103351 -0.00155026 -0.0075783 -0.0303011 -0.0473312 -0.188851 -0.00103351 -0.00155026 -0.00757827 -0.0303006 -0.04733 -0.188831 -0.00103351 -0.00155026 -0.00757824 -0.0303001 -0.0473287 -0.188812 -0.0010335 -0.00155026 -0.00757821 -0.0302995 -0.0473275 -0.188791 -0.0010335 -0.00155026 -0.00757817 -0.030299 -0.0473262 -0.188771 -0.0010335 -0.00155025 -0.00757814 -0.0302985 -0.0473249 -0.18875 -0.0010335 -0.00155025 -0.00757811 -0.0302979 -0.0473236 -0.188729 -0.0010335 -0.00155025 -0.00757807 -0.0302974 -0.0473222 -0.188708 -0.0010335 -0.00155025 -0.00757804 -0.0302968 -0.0473209 -0.188686 -0.0010335 -0.00155025 -0.007578 -0.0302963 -0.0473195 -0.188664 -0.0010335 -0.00155024 -0.00757797 -0.0302957 -0.0473181 -0.188642 -0.0010335 -0.00155024 -0.00757793 -0.0302951 -0.0473167 -0.188619 -0.00103349 -0.00155024 -0.00757789 -0.0302945 -0.0473153 -0.188596 -0.00103349 -0.00155024 -0.00757786 -0.0302939 -0.0473138 -0.188573 -0.00103349 -0.00155024 -0.00757782 -0.0302933 -0.0473124 -0.18855 -0.00103349 -0.00155024 -0.00757778 -0.0302927 -0.0473109 -0.188526 -0.00103349 -0.00155023 -0.00757774 -0.0302921 -0.0473094 -0.188502 -0.00103349 -0.00155023 -0.0075777 -0.0302915 -0.0473078 -0.188478 -0.00103349 -0.00155023 -0.00757766 -0.0302909 -0.0473063 -0.188453 -0.00103348 -0.00155023 -0.00757762 -0.0302902 -0.0473047 -0.188428 -0.00103348 -0.00155023 -0.00757758 -0.0302896 -0.0473032 -0.188403 -0.00103348 -0.00155022 -0.00757754 -0.0302889 -0.0473016 -0.188377 -0.00103348 -0.00155022 -0.0075775 -0.0302883 -0.0472999 -0.188352 -0.00103348 -0.00155022 -0.00757746 -0.0302876 -0.0472983 -0.188325 -0.00103348 -0.00155022 -0.00757742 -0.0302869 -0.0472967 -0.188299 -0.00103348 -0.00155021 -0.00757737 -0.0302862 -0.047295 -0.188272 -0.00103347 -0.00155021 -0.00757733 -0.0302855 -0.0472933 -0.188245 -0.00103347 -0.00155021 -0.00757729 -0.0302848 -0.0472916 -0.188218 -0.00103347 -0.00155021 -0.00757724 -0.0302841 -0.0472898 -0.18819 -0.00103347 -0.00155021 -0.0075772 -0.0302834 -0.0472881 -0.188162 -0.00103347 -0.0015502 -0.00757715 -0.0302827 -0.0472863 -0.188134 -0.00103347 -0.0015502 -0.00757711 -0.030282 -0.0472845 -0.188106 -0.00103347 -0.0015502 -0.00757706 -0.0302812 -0.0472827 -0.188077 -0.00103346 -0.0015502 -0.00757701 -0.0302805 -0.0472809 -0.188048 -0.00103346 -0.00155019 -0.00757697 -0.0302797 -0.0472791 -0.188018 -0.00103346 -0.00155019 -0.00757692 -0.030279 -0.0472772 -0.187989 -0.00103346 -0.00155019 -0.00757687 -0.0302782 -0.0472753 -0.187959 -0.00103346 -0.00155019 -0.00757682 -0.0302774 -0.0472734 -0.187928 -0.00103346 -0.00155018 -0.00757677 -0.0302766 -0.0472715 -0.187898 -0.00103345 -0.00155018 -0.00757672 -0.0302758 -0.0472696 -0.187867 -0.00103345 -0.00155018 -0.00757667 -0.030275 -0.0472676 -0.187836 -0.00103345 -0.00155018 -0.00757662 -0.0302742 -0.0472657 -0.187804 -0.00103345 -0.00155017 -0.00757657 -0.0302734 -0.0472637 -0.187772 -0.00103345 -0.00155017 -0.00757652 -0.0302726 -0.0472617 -0.18774 -0.00103345 -0.00155017 -0.00757647 -0.0302718 -0.0472596 -0.187708 -0.00103344 -0.00155017 -0.00757642 -0.0302709 -0.0472576 -0.187675 -0.00103344 -0.00155016 -0.00757636 -0.0302701 -0.0472555 -0.187642 -0.00103344 -0.00155016 -0.00757631 -0.0302692 -0.0472535 -0.187609 -0.00103344 -0.00155016 -0.00757626 -0.0302684 -0.0472514 -0.187576 -0.00103344 -0.00155015 -0.0075762 -0.0302675 -0.0472492 -0.187542 -0.00103343 -0.00155015 -0.00757615 -0.0302666 -0.0472471 -0.187508 -0.00103343 -0.00155015 -0.00757609 -0.0302657 -0.0472449 -0.187473 -0.00103343 -0.00155015 -0.00757604 -0.0302648 -0.0472428 -0.187438 -0.00103343 -0.00155014 -0.00757598 -0