✨ feat(fanuc): 打通飞拍轨迹完整执行链路
* 增加 J519 稠密发送采样校验与保姿回发逻辑 * 调整 saveTrajectory 导出与 sequence buffer 行为 * 补充 10010 解析脚本、ICSP 说明和回归测试
This commit is contained in:
@@ -1 +1,303 @@
|
||||
{"robot": {"use_do": true, "io_addr": [7, 8], "io_keep_cycles": 2, "acc_limit": 1, "jerk_limit": 1, "adapt_icsp_try_num": 5}, "flying_shots": {"20251015": {"traj_waypoints": [[1.047438621520996, -0.0002488955215085298, -0.0014060207176953554, 0.009022523649036884, 0.010111905634403229, 0.009573347866535187], [0.7661270499229431, -0.04437164217233658, -0.13630111515522003, -0.41718506813049316, 0.010093353688716888, 0.009594489820301533], [0.7661266326904297, 0.2170650213956833, -0.13630135357379913, -0.4171852171421051, 0.010093353688716888, 0.009594779461622238], [1.0311520099639893, -0.062108494341373444, -0.1363297700881958, 0.30276036262512207, 0.15847623348236084, 0.00956842489540577], [1.4012629985809326, -0.05120057240128517, -0.13633012771606445, 0.3027600347995758, 0.15847666561603546, 0.00956842489540577], [1.0567246675491333, 0.01165649201720953, -0.01786380261182785, -0.015170873142778873, 0.02149667963385582, 0.009576244279742241]], "shot_flags": [false, true, true, true, true, true], "offset_values": [0, 0, 0, 0, 0, 0], "addr": [[], [2, 4], [3, 4], [2, 4], [3, 4], [2, 4]]}, "TEST20251214": {"traj_waypoints": [[1.056731, 0.011664811, -0.017892333, -0.01516874, 0.021492079, 0.009567846], [0.8067416, 0.011661344, -0.11788314, -0.01516874, 0.021492079, 0.009567846], [0.60675246, -0.03833516, -0.11788314, 0.034831185, -0.22849938, -0.24043223], [0.7667507, 0.20164281, -0.11788314, 0.034831185, -0.22849938, -0.24043223], [0.7667507, 0.20164281, -0.11788314, 0.034831185, -0.22849938, -0.14043556], [1.1667324, 0.05164983, -0.11789217, 0.23482007, 0.021492079, -0.14043556], [1.056731, 0.011664811, -0.017892333, -0.01516874, 0.021492079, 0.009567846]], "shot_flags": [false, true, true, true, true, true, false], "offset_values": [0, 0, 0, 0, 0, 0, 0], "addr": [[], [], [3, 4, 2], [3, 4, 2], [3, 4, 2], [3, 4, 2], []]}, "UTTC_MS11": {"traj_waypoints": [[1.056731, 0.011664811, -0.017892333, -0.01516874, 0.021492079, 0.009567846], [0.8532358, 0.03837953, -0.19235304, 0.0071595116, 0.109054826, 0.040055145], [0.96600056, 0.20607172, -0.12233179, -1.2394339, 0.10493033, 1.2958988], [0.9618476, 0.15288207, -0.14867093, -0.7176314, 0.1764264, 0.73228663], [0.76189893, -0.028442925, -0.30919823, 0.10463613, 0.5615024, -0.39399016], [1.1271763, 0.074403025, -0.27347943, -0.5227772, 0.52098846, 0.79633313], [1.0555661, 0.4026262, -0.08746306, 0.6301835, 0.09644133, -0.5463328], [1.2300354, 0.28612664, -0.23486805, -0.4868128, 0.25369516, 0.55347764], [1.2144431, -0.29855102, -0.15202847, -1.0205934, 0.13317892, 1.1246506], [1.2840607, -0.11222197, -0.16805042, -2.248135, 0.2560587, 2.4434967], [1.3189346, -0.25620222, -0.12730704, -2.285038, 0.30872014, 2.4765089], [1.502615, -0.25304365, -0.23878741, -1.2194318, 0.46674785, 1.5533328], [1.07723, -0.07387611, -0.1707704, -1.8916591, 0.38677844, 2.061968], [1.3920237, 0.08098731, -0.2672306, -0.9780007, 0.4561093, 0.9102286], [1.9016331, 0.023924276, -0.58633333, -0.8441697, 0.76730615, 1.4842151], [1.9300697, -0.06738541, -0.56542397, -0.892083, 0.77194446, 1.5293273], [2.0611632, -0.30327517, -0.54225636, -1.0395275, 0.8505439, 1.6429617], [1.0921186, -0.40034482, -0.1803499, 1.3524796, 0.6210477, -1.2159473], [1.0521278, -0.40034503, -0.1803492, 1.3524843, 0.6210471, -1.2159531], [1.056731, 0.011664811, -0.017892333, -0.01516874, 0.021492079, 0.009567846]], "shot_flags": [false, true, true, true, true, true, true, true, true, true, true, true, true, true, true, true, true, false, true, false], "offset_values": [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0], "addr": [[], [2, 4], [3, 4, 2], [3, 4, 2], [4, 2], [4, 2], [3, 4], [3, 4], [4, 2], [4, 2], [4, 2], [4, 2], [4, 2], [4, 3], [4, 2], [4, 2], [4, 2], [4, 2], [4, 3], []]}, "5U": {"traj_waypoints": [[-0.95982397, 0.6331447, -1.0055008, 0.79858834, 1.1564041, -0.4260437], [-0.98353565, 0.66203266, -0.9758351, 0.8320198, 1.1455917, -0.45941326]], "shot_flags": [false, false], "offset_values": [0, 0], "addr": [[], []]}}}
|
||||
{
|
||||
"robot": {
|
||||
"use_do": true,
|
||||
"io_addr": [
|
||||
7,
|
||||
8
|
||||
],
|
||||
"io_keep_cycles": 2,
|
||||
"acc_limit": 1,
|
||||
"jerk_limit": 1,
|
||||
"adapt_icsp_try_num": 5,
|
||||
"planning_speed_scale": 0.74227,
|
||||
"smooth_start_stop_timing": false
|
||||
},
|
||||
"flying_shots": {
|
||||
"UTTC_MS11": {
|
||||
"traj_waypoints": [
|
||||
[
|
||||
1.056731,
|
||||
0.011664811,
|
||||
-0.017892333,
|
||||
-0.01516874,
|
||||
0.021492079,
|
||||
0.009567846
|
||||
],
|
||||
[
|
||||
0.8532358,
|
||||
0.03837953,
|
||||
-0.19235304,
|
||||
0.0071595116,
|
||||
0.109054826,
|
||||
0.040055145
|
||||
],
|
||||
[
|
||||
0.96600056,
|
||||
0.20607172,
|
||||
-0.12233179,
|
||||
-1.2394339,
|
||||
0.10493033,
|
||||
1.2958988
|
||||
],
|
||||
[
|
||||
0.9618476,
|
||||
0.15288207,
|
||||
-0.14867093,
|
||||
-0.7176314,
|
||||
0.1764264,
|
||||
0.73228663
|
||||
],
|
||||
[
|
||||
0.76189893,
|
||||
-0.028442925,
|
||||
-0.30919823,
|
||||
0.10463613,
|
||||
0.5615024,
|
||||
-0.39399016
|
||||
],
|
||||
[
|
||||
1.1271763,
|
||||
0.074403025,
|
||||
-0.27347943,
|
||||
-0.5227772,
|
||||
0.52098846,
|
||||
0.79633313
|
||||
],
|
||||
[
|
||||
1.0555661,
|
||||
0.4026262,
|
||||
-0.08746306,
|
||||
0.6301835,
|
||||
0.09644133,
|
||||
-0.5463328
|
||||
],
|
||||
[
|
||||
1.2300354,
|
||||
0.28612664,
|
||||
-0.23486805,
|
||||
-0.4868128,
|
||||
0.25369516,
|
||||
0.55347764
|
||||
],
|
||||
[
|
||||
1.2144431,
|
||||
-0.29855102,
|
||||
-0.15202847,
|
||||
-1.0205934,
|
||||
0.13317892,
|
||||
1.1246506
|
||||
],
|
||||
[
|
||||
1.2840607,
|
||||
-0.11222197,
|
||||
-0.16805042,
|
||||
-2.248135,
|
||||
0.2560587,
|
||||
2.4434967
|
||||
],
|
||||
[
|
||||
1.3189346,
|
||||
-0.25620222,
|
||||
-0.12730704,
|
||||
-2.285038,
|
||||
0.30872014,
|
||||
2.4765089
|
||||
],
|
||||
[
|
||||
1.502615,
|
||||
-0.25304365,
|
||||
-0.23878741,
|
||||
-1.2194318,
|
||||
0.46674785,
|
||||
1.5533328
|
||||
],
|
||||
[
|
||||
1.07723,
|
||||
-0.07387611,
|
||||
-0.1707704,
|
||||
-1.8916591,
|
||||
0.38677844,
|
||||
2.061968
|
||||
],
|
||||
[
|
||||
1.3920237,
|
||||
0.08098731,
|
||||
-0.2672306,
|
||||
-0.9780007,
|
||||
0.4561093,
|
||||
0.9102286
|
||||
],
|
||||
[
|
||||
1.9016331,
|
||||
0.023924276,
|
||||
-0.58633333,
|
||||
-0.8441697,
|
||||
0.76730615,
|
||||
1.4842151
|
||||
],
|
||||
[
|
||||
1.9300697,
|
||||
-0.06738541,
|
||||
-0.56542397,
|
||||
-0.892083,
|
||||
0.77194446,
|
||||
1.5293273
|
||||
],
|
||||
[
|
||||
2.0611632,
|
||||
-0.30327517,
|
||||
-0.54225636,
|
||||
-1.0395275,
|
||||
0.8505439,
|
||||
1.6429617
|
||||
],
|
||||
[
|
||||
1.0921186,
|
||||
-0.40034482,
|
||||
-0.1803499,
|
||||
1.3524796,
|
||||
0.6210477,
|
||||
-1.2159473
|
||||
],
|
||||
[
|
||||
1.0521278,
|
||||
-0.40034503,
|
||||
-0.1803492,
|
||||
1.3524843,
|
||||
0.6210471,
|
||||
-1.2159531
|
||||
],
|
||||
[
|
||||
1.056731,
|
||||
0.011664811,
|
||||
-0.017892333,
|
||||
-0.01516874,
|
||||
0.021492079,
|
||||
0.009567846
|
||||
]
|
||||
],
|
||||
"shot_flags": [
|
||||
false,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
true,
|
||||
false,
|
||||
true,
|
||||
false
|
||||
],
|
||||
"offset_values": [
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0,
|
||||
0
|
||||
],
|
||||
"addr": [
|
||||
[],
|
||||
[
|
||||
2,
|
||||
4
|
||||
],
|
||||
[
|
||||
3,
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
3,
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
3,
|
||||
4
|
||||
],
|
||||
[
|
||||
3,
|
||||
4
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
3
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
2
|
||||
],
|
||||
[
|
||||
4,
|
||||
3
|
||||
],
|
||||
[]
|
||||
]
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user