Compare commits
70 Commits
wavelogger
...
b01f8dc19c
Author | SHA1 | Date | |
---|---|---|---|
b01f8dc19c | |||
d2794b2de7 | |||
0d814d384d | |||
82ae2681bb | |||
8b49d3b6e4 | |||
2f782c9693 | |||
73230a7133 | |||
97cb4fe1d4 | |||
bdccf3da47 | |||
370fa051ae | |||
e1866758b7 | |||
1cefe4a16b | |||
dd0873637f | |||
5ab03d23f2 | |||
9088b90e34 | |||
9d252cc36f | |||
3010cb8931 | |||
da5ddcea0a | |||
cf9d51b475 | |||
f4a70a0034 | |||
cdbe1c40c6 | |||
5ed38b4b2a | |||
27877e2b64 | |||
edda9defdd | |||
485dffdd0b | |||
d35858e14e | |||
718db9ec45 | |||
d76ee3d223 | |||
a66a55bcd3 | |||
fe27dbf91f | |||
dee07b77bb | |||
70e6c269fe | |||
71b2d9d42e | |||
2508be7b35 | |||
6d03f4f281 | |||
40ddef1c39 | |||
fa5a9f0f89 | |||
9fa42fb3e1 | |||
2fbe500d1d | |||
7b25b91c37 | |||
fc56d81e9c | |||
524af160d8 | |||
aedac4c90c | |||
4e4d760db4 | |||
ad4b6ae8d6 | |||
fc3d5482f8 | |||
ac71522cc2 | |||
611d848b41 | |||
802ccd8e97 | |||
61fa840e53 | |||
79797a3bdd | |||
7143a19fa1 | |||
a75775c869 | |||
6604f0ba06 | |||
a4009eb17c | |||
295894a843 | |||
ff4b0cc04c | |||
8975d8a37c | |||
14f269b570 | |||
2917f4ae97 | |||
d04d90f1a7 | |||
284dabee76 | |||
0646ae13de | |||
c3dbb2cff0 | |||
780fed29af | |||
4ba8af842c | |||
a0fe9b5939 | |||
2f2f0d430d | |||
78a79e4aa0 | |||
a1b45bf941 |
6
.gitignore
vendored
6
.gitignore
vendored
@ -4,3 +4,9 @@ aio/.idea/
|
||||
aio/code/__pycache__/
|
||||
aio/package/
|
||||
aio/venv
|
||||
aio/__pycache__/
|
||||
aio/code/automatic_test/__pycache__/
|
||||
aio/code/data_process/__pycache__/
|
||||
aio/assets/templates/c_msg.log
|
||||
aio/code/durable_action/__pycache__/
|
||||
aio/assets/templates/durable/
|
490
aio/README.md
490
aio/README.md
@ -1,91 +1,113 @@
|
||||
### 程序功能
|
||||
### 一、程序功能
|
||||
|
||||
自动化测试数据处理工具,减少人工处理时长,提高测试数据处理的效率和准确度:
|
||||
1. 制动数据,单轴数据处理3min以内
|
||||
2. 电机电流数据,全部轴数据处理1min以内
|
||||
3. ISO激光数据整理,1min以内
|
||||
4. wavelogger波形处理,几乎不花费时间
|
||||
|
||||
### 使用方法
|
||||
1. 制动数据,单轴数据处理 3min 以内
|
||||
2. 电机电流数据,全部轴数据处理 1min 以内
|
||||
3. ISO 激光数据整理,1min 以内
|
||||
4. wavelogger 波形处理,几乎不花费时间
|
||||
5. 制动自动化测试
|
||||
6. 电机电流自动化测试
|
||||
7. 耐久工程曲线指标采集(仅适用于六轴)
|
||||
|
||||
点击可执行程序 AIO.exe,然后选择功能,根据提示填写必要参数,点击运行即可
|
||||
|
||||
### 第三方库
|
||||
---
|
||||
|
||||
### 二、使用方法
|
||||
|
||||
点击可执行程序 AIO.exe,然后选择功能,根据提示填写必要参数,红色标签提示是必填项,蓝色标签提示是可选项,然后点击运行即可
|
||||
|
||||
> 需要注意的是,可选项填写的不合适,有可能导致数据错误,或者无法运行!!
|
||||
|
||||
---
|
||||
|
||||
### 三、第三方库
|
||||
|
||||
```text
|
||||
参考requirements.txt
|
||||
```
|
||||
|
||||
### 打包方法
|
||||
|
||||
```
|
||||
pyinstaller.exe -F --version-file file_version_info.txt -i .\icon.ico .\aio.py -p .\brake.py -p .\current.py
|
||||
pyinstaller --noconfirm --onedir --windowed --add-data "C:/Users/Administrator/AppData/Local/Programs/Python/Python312/Lib/site-packages/customtkinter;customtkinter/" --version-file ..\assets\file_version_info.txt -i ..\assets\icon.ico ..\code\aio.py -p ..\code\brake.py -p ..\code\iso.py -p ..\code\current.py -p ..\code\wavelogger.py
|
||||
参考 requirements.txt
|
||||
```
|
||||
|
||||
---
|
||||
|
||||
### 注意事项
|
||||
### 四、打包方法
|
||||
|
||||
#### 制动数据
|
||||
```
|
||||
pyinstaller.exe -F --version-file file_version_info.txt -i .\icon.ico .\aio.py -p .\brake.py -p .\current.py
|
||||
pyinstaller --noconfirm --onedir --windowed --add-data "C:/Users/Administrator/AppData/Local/Programs/Python/Python312/Lib/site-packages/customtkinter;customtkinter/" --version-file ..\assets\file_version_info.txt -i ..\assets\icon.ico ..\code\aio.py -p ..\code\data_process\brake.py -p ..\code\data_process\iso.py -p ..\code\data_process\current.py -p ..\code\data_process\wavelogger.py
|
||||
```
|
||||
|
||||
---
|
||||
|
||||
### 五、注意事项
|
||||
|
||||
#### 1) 制动数据
|
||||
|
||||
```text
|
||||
1. 数据文件存储存储规则
|
||||
数据文件,就是我们拍急停的时候,采集到的 .data 文件,正方向拍三次急停,会采集到三个 .data 文件,存储在同一个文件夹内,即每组(三个 .data 文件)文件必须存储在同一个文件夹内,数据文件的命名无要求,
|
||||
数据文件,就是我们拍急停的时候,采集到的 .data 文件,根据规则选择某个方向拍三次急停,会采集到三个 .data 文件,存储在同一个文件夹内,即每组(三个 .data 文件)文件必须存储在同一个文件夹内,数据文件的命名无要求
|
||||
|
||||
2. 文件夹命名规则
|
||||
采集到的 .data 文件没有命名要求,但是对于文件夹的命名是有要求的,必须是如下格式:
|
||||
dXX_speedXX_reachXX 或者 loadXX_reachXX_speedXX
|
||||
对采集到的 .data 文件没有命名要求,但是对于其存储的文件夹的命名是有要求的,必须是如下格式:
|
||||
reachXX_loadXX_speedXX
|
||||
XX代表不同条件下的测试数值,比如:
|
||||
d100_speed33_reach66,指的是,负载100%,速度33%,臂展66%
|
||||
reach100_load66_speed33,指的是,臂展100%,负载66%,速度33%
|
||||
|
||||
3. 结果文件命名规则
|
||||
所谓结果文件,就是处理数据的那个 excle 文件,该文件名字的前缀必须是 loadXX_XXXXXXXXX.xlsx,比如:
|
||||
load33_自研_制动性能测试.xlsx
|
||||
load66_自研_制动性能测试.xlsx
|
||||
load100_自研_制动性能测试.xlsx
|
||||
所谓结果文件,就是处理数据的那个 excle 文件,该文件名字的前缀必须是 reachXX_XXXXXXXXX.xlsx,比如:
|
||||
reach33_自研_制动性能测试.xlsx
|
||||
reach66_自研_制动性能测试.xlsx
|
||||
reach100_自研_制动性能测试.xlsx
|
||||
|
||||
!!结果文件可以是没有数据的,也可以是之前有数据的,只要保证第 6 点中的那几个数据准确即可
|
||||
!!结果文件可以是没有数据的,也可以是之前有数据的,只要保证输入参数的正确性即可
|
||||
|
||||
4. 数据存储的组织结
|
||||
..../j1/load100_speed33_reach100
|
||||
..../j1/load100_speed66_reach100
|
||||
..../j1/reach100_load66_speed33
|
||||
..../j1/reach100_load66_speed66
|
||||
....
|
||||
..../j1/load100_speed100_reach100
|
||||
..../j1/load100_speed33_reach100/2024_05_16_09_18_52.data
|
||||
..../j1/load100_speed33_reach100/2024_05_16_09_19_52.data
|
||||
..../j1/load100_speed33_reach100/2024_05_16_09_20_52.data
|
||||
..../j1/load33_自研_制动性能测试.xlsx
|
||||
..../j1/load66_自研_制动性能测试.xlsx
|
||||
..../j1/load100_自研_制动性能测试.xlsx
|
||||
..../j1/reach100_load33_speed33
|
||||
..../j1/reach100_load100_speed33/2024_05_16_09_18_52.data
|
||||
..../j1/reach100_load100_speed33/2024_05_16_09_19_52.data
|
||||
..../j1/reach100_load100_speed33/2024_05_16_09_20_52.data
|
||||
..../j1/reach33_自研_制动性能测试.xlsx
|
||||
..../j1/reach66_自研_制动性能测试.xlsx
|
||||
..../j1/reach100_自研_制动性能测试.xlsx
|
||||
..../j1/configs.xlsx
|
||||
|
||||
5. 文件的打开与关闭
|
||||
a. 在执行程序之前,需要关闭所有相关 excle 文件
|
||||
b. 在执行程序之中,不允许打开相关 excle 文件
|
||||
c. 在执行程序之后,需要逐个打开结果文件,并保存一次
|
||||
|
||||
6. 参数一致性检查
|
||||
执行程序前,需要确定 configs.xlsx 中设定的减速比/最大角速度/额定电流的值是正确的
|
||||
6. 数据准确性检查
|
||||
执行完程序之后,可以在日志输出框中看到全部文件的处理过程,对于有问题的文件,会用特殊颜色进行标识,需要注意观察
|
||||
|
||||
7. 数据准确性检查
|
||||
执行完程序之后,需要对结果文件的数据准确性做核对,通过我自己的数据观察,误差基本在10ms以内,也即10个数据点,误差较大的情况可自行调整
|
||||
7. configs.xlsx配置文件
|
||||
需要运行前需要手动修改该文件,并确保配置参数的正确性,测试时按照第 4 点中的位置存放
|
||||
|
||||
8. 其他
|
||||
程序运行主要的耗时集中在打开,保存和关闭结果文件,第一次打开的时候会比较慢,是因为 excel 在做首次公式的计算,保存关闭之后,再打开会比较快一些,另外,如果在运行出错并重复运行程序的时候无响应,或者出现异常,请打开任务管理器,关闭一切和excel相关的进程,重新运行即可
|
||||
程序运行主要的耗时集中在打开,保存和关闭结果文件,第一次打开的时候会比较慢,另外还需要注意采集的数据长度和结果文件中预设的数据长度是否一致,若采集的数据长度大于预设的数据长度,则需要补齐数据
|
||||
```
|
||||
|
||||
#### 电机电流
|
||||
#### 2) 电机电流
|
||||
|
||||
1. 单独使用max/avg功能时,对于文件命名同第二点,存放数据的文件夹,只允许有 .data 或者 .csv 文件,且每次只能处理rc相同的轴的数据
|
||||
2. cycle功能只处理单文件单轴数据,可以批量处理所有轴,但要确保遵守如下规则:
|
||||
a. 数据整理文件以 .xlsx 为后缀
|
||||
b. 其他文件
|
||||
A. 单轴:j1_xxxxx.data/csv
|
||||
B. 保持:j1_hold_xxxx.data/csv
|
||||
C. 所有文件放在同一个文件夹即可
|
||||
d. 界面输入rc参数时,需要输入所有轴的数据
|
||||
1. 单独使用 max/avg 功能时,要求文件命名以 "jx_" 开头,例如 j1_2024_06_18_09_09_11.data,只允许有 .data 或者 .csv 文件,以及configs.xlsx配置表,可同时处理所有轴的数据
|
||||
2. cycle 功能支持处理单轴数据以及场景电机电流的数据,可以批量处理所有轴,但要确保遵守如下规则:
|
||||
|
||||
#### ISO数据
|
||||
- 包含电机电流结果汇总文件(excel)
|
||||
- 单轴文件:jx_xxxxx.data/csv
|
||||
- 保持电流:jx_hold_xxxx.data/csv
|
||||
- 场景文件:factory_53.8_2024_06_18_09_01_26.data(需手动拆分)
|
||||
- 配置文件:configs.xlsx
|
||||
- 所有文件放在同一个文件夹即可
|
||||
- 界面输入rc参数时,需要输入所有轴的数据,即使只处理个别轴的数据
|
||||
|
||||
3. configs.xlsx配置文件:需要运行前需要手动修改该文件,并确保配置参数的正确性
|
||||
|
||||
> 程序运行主要的耗时集中在打开,保存和关闭结果文件
|
||||
> 需要注意采集的数据长度和结果文件中预设的数据长度是否一致,若采集的数据长度大于预设的数据长度,则需要补齐数据
|
||||
> 和制动数据统一,后续将仅支持对hw_joint_vel_feedback的解析和处理,不再支持device_servo_vel_feedback
|
||||
|
||||
#### 3) iso 数据
|
||||
|
||||
所有文件放在同一个文件夹即可,命名规则如下:
|
||||
a. ISO.pdf
|
||||
@ -93,13 +115,57 @@ pyinstaller --noconfirm --onedir --windowed --add-data "C:/Users/Administrator/A
|
||||
c. ISO-V100.pdf
|
||||
d. iso-results.xlsx
|
||||
|
||||
#### wavelogger波形数据
|
||||
> 目前仅能处理 6 轴数据
|
||||
|
||||
#### 4) wavelogger 波形数据
|
||||
|
||||
1. 需要提前将 .xdt 波形数据转换成 .csv 文件
|
||||
2. 组织目录下只允许有 .csv 文件,对文件夹无要求
|
||||
3. 运行结束后,会生成 result.xlsx 文件,结果按照 .csv 文件名存放
|
||||
4. 采集数据时,不同轮次数据时间间隔最好大于 2 倍的周期时间,否则会出现采集的轮数不正确的情况,但数据是完整的
|
||||
|
||||
#### 5) 制动自动化测试
|
||||
|
||||
只需要提前将如下文件放在指定路径下即可:
|
||||
1. zip 工程文件
|
||||
2. excel 制动结果处理文件
|
||||
3. excel configs.xlsx 配置文件
|
||||
|
||||
> **需要注意的点**
|
||||
|
||||
1. 修改该文件点位信息
|
||||
2. 修改“编程”→“工具列表”中的工具信息,制动只允许使用tool33/tool66/tool100/inertia这四个工具,不可重命名
|
||||
3. 除了调试行,其他行请勿修改,包括增加空行等,尤其是有特别注释的地方
|
||||
4. stop0_related半静态任务,需要注意DO0_0的命名,不同控制柜,可能不一样
|
||||
5. 需要导入 autotest.xml 寄存器文件,以及新建modbus总线设备,命名为autotest,其他默认即可
|
||||
6. 其他无需修改,如有其他需求,可联系fanmingfu@rokae.com沟通
|
||||
7. 需要额外硬件接线,详细参考configs.xlsx中急停接线图sheet页,其中DO0_0视硬件情况,可能为其他名称
|
||||
8. 运行自动化程序之前,确保机器处于正常状态,无故障,未触发急停
|
||||
9. 运行过程中,如果是因为机器问题无法达到额定百分比速度,会在日志输出框提示,注意观察
|
||||
10. 由于xCore系统问题,运行过程中可能会出现机器人宕机问题,如果遇到,可以手动重启控制柜,重新运行
|
||||
11. 务必正确填写configs.xlsx中的Target页面,A1单元格可以选择正负方向急停
|
||||
12. 工程文件可以手动重命名,按照机型存档,或者导出用于自动化测试
|
||||
|
||||
#### 6) 电机电流自动化测试
|
||||
|
||||
只需要提前将如下文件放在指定路径下即可:
|
||||
1. zip 工程文件
|
||||
2. excel 电机电流结果处理文件,一份模板即可
|
||||
3. excel configs.xlsx 配置文件
|
||||
|
||||
> **需要注意的点**
|
||||
|
||||
基本同第五点,针对五轴以及以下的机型,缺失轴数据可以填写其他有效轴任意一轴的点位信息
|
||||
|
||||
|
||||
#### 7) 耐久工程曲线指标采集
|
||||
|
||||
可实现固定周期指定曲线指标的采集,用于长时间观察指标的变化情况,输入文件:
|
||||
- configs.xlsx,执行之前需要手动修改好configs.xlsx中的参数,以及间隔时间
|
||||
- target.zip,需要确认工程点位和动作无问题后,保存导出
|
||||
|
||||
> 重新运行时,必须突出软件,重新运行
|
||||
|
||||
#### 其他
|
||||
customtkinter的tabview组件不支持修改字体大小,可以参考 [Changing Font of a Tabview](https://github.com/TomSchimansky/CustomTkinter/issues/2296) 进行手动修改源码实现:
|
||||
a. 运行 `pip show customtkinter`,获取到库的路径
|
||||
@ -113,7 +179,7 @@ RELEASE CHANGES
|
||||
|
||||
|
||||
已知问题:
|
||||
1. office套件下运行好像有问题,WPS无问题,集中在just_open函数的实现上
|
||||
1. -
|
||||
|
||||
v0.0.1(2024/05/18)
|
||||
Draft
|
||||
@ -188,42 +254,308 @@ v0.1.4(2024/06/06)
|
||||
6. 支持工业/协作两条产品线的电机电流数据处理,包括单轴,场景,max/avg计算
|
||||
|
||||
v0.1.5(2024/06/12)
|
||||
1. [aio.py]: 主界面切换不同功能时保持placehold一致
|
||||
2. [brake.py]: 由于制动采集模板和内容的更改,适配了新的数据,更新了算法
|
||||
3. [aio.py]: 新增tabview组件,区分数据处理和自动化测试功能
|
||||
4. [aio.py]: 重新调整界面配色
|
||||
5. [aio.py]: 修改了write2textbox函数,定制化显示每一行的颜色,针对每一行可自定义输出内容颜色
|
||||
6. [brake.py/iso.py/current.py]: 由于第 5 点的更改,同时修改了其他文件相关引用的部分
|
||||
7. [aio.py]: 更改label/entry/optionmenu等控件的生成方式,使用循环实现,更加简洁和容易维护
|
||||
8. [aio.py]: 修改customtkinter库中C:\Users\Administrator\AppData\Local\Programs\Python\Python312\Lib\site-packages\customtkinter\windows\widgets\ctk_tabview.py文件,参考https://github.com/TomSchimansky/CustomTkinter/issues/2296,实现修改tabview组件的字体大小
|
||||
9. [aio.py]: 修改menu_main->menu_main_dp,menu_sub->menu_sub_dp,为后续其他tab功能按钮做扩展,是针对第三点做出的相应调整
|
||||
10. [layout.xlsx]: 添加了各个功能的流程图
|
||||
1. [aio.py] 主界面切换不同功能时保持placehold一致
|
||||
2. [brake.py] 由于制动采集模板和内容的更改,适配了新的数据,更新了算法
|
||||
3. [aio.py] 新增tabview组件,区分数据处理和自动化测试功能
|
||||
4. [aio.py] 重新调整界面配色
|
||||
5. [aio.py] 修改了write2textbox函数,定制化显示每一行的颜色,针对每一行可自定义输出内容颜色
|
||||
6. [brake.py/iso.py/current.py] 由于第 5 点的更改,同时修改了其他文件相关引用的部分
|
||||
7. [aio.py] 更改label/entry/optionmenu等控件的生成方式,使用循环实现,更加简洁和容易维护
|
||||
8. [aio.py] 修改customtkinter库中C:\Users\Administrator\AppData\Local\Programs\Python\Python312\Lib\site-packages\customtkinter\windows\widgets\ctk_tabview.py文件,参考https://github.com/TomSchimansky/CustomTkinter/issues/2296,实现修改tabview组件的字体大小
|
||||
9. [aio.py] 修改menu_main->menu_main_dp,menu_sub->menu_sub_dp,为后续其他tab功能按钮做扩展,是针对第三点做出的相应调整
|
||||
10. [layout.xlsx] 添加了各个功能的流程图
|
||||
|
||||
v0.1.5.1(2024/06/12)
|
||||
1. [current.py]: 修改cycle功能中,数据清理范围为70000行,并将threshold从2调整为5
|
||||
2. [current.py]: 修改位置超限提示,使更清楚了解问题原因
|
||||
3. [current.py]: 修改find_point函数中错误提示,增加定位信息
|
||||
4. [README.md]: 精简打包命令
|
||||
5. [requirements.txt]: 新增必要库配置文件
|
||||
1. [current.py] 修改cycle功能中,数据清理范围为70000行,并将threshold从2调整为5
|
||||
2. [current.py] 修改位置超限提示,使更清楚了解问题原因
|
||||
3. [current.py] 修改find_point函数中错误提示,增加定位信息
|
||||
4. [README.md] 精简打包命令
|
||||
5. [requirements.txt] 新增必要库配置文件
|
||||
|
||||
v0.1.5.2(2024/06/13)
|
||||
1. [brake.py/aio.py]: 将sto修改为estop
|
||||
2. [brake.py]: 修改了速度计算逻辑,新版本的vel列数据遵循如下规则,av = vel * 180 / pi,根据av再计算speed
|
||||
3. [brake.py]: 将threshold修改为常量50
|
||||
4. [brake.py]: 提高了输出提示语的明确性,删除了不必要的省略号
|
||||
5. [brake.py]: 更正了之前的数据copy错误,重新优化了estop处是否达到指定百分比的判定逻辑
|
||||
2. [brake.py] 修改了速度计算逻辑,新版本的vel列数据遵循如下规则,av = vel * 180 / pi,根据av再计算speed
|
||||
3. [brake.py] 将threshold修改为常量50
|
||||
4. [brake.py] 提高了输出提示语的明确性,删除了不必要的省略号
|
||||
5. [brake.py] 更正了之前的数据copy错误,重新优化了estop处是否达到指定百分比的判定逻辑
|
||||
|
||||
v0.1.5.3(2024/06/14)
|
||||
1. [aio.py]: 修改w_param为84,适配14寸电脑屏幕
|
||||
2. [brake.py]: 将判定合规逻辑修改为角速度超过指定角速度的95%
|
||||
3. [README.md]: 稍作修改,包括打包方式,功能特性等
|
||||
1. [aio.py] 修改w_param为84,适配14寸电脑屏幕
|
||||
2. [brake.py] 将判定合规逻辑修改为角速度超过指定角速度的95%
|
||||
3. [README.md] 稍作修改,包括打包方式,功能特性等
|
||||
|
||||
v0.1.6.0(2024/06/15)
|
||||
1. [aio.py]: 新增wavelogger处理界面
|
||||
2. [wavelogger.py]: 新增精度数据处理模块
|
||||
1. [aio.py] 新增wavelogger处理界面
|
||||
2. [wavelogger.py] 新增精度数据处理模块
|
||||
|
||||
v0.1.6.1(2024/06/16)
|
||||
1. [wavelogger.py]: bugfix single_file_proc函数中,修改_start起始点的计算逻辑
|
||||
2. [wavelogger.py]: bugfix find_point函数中,当判断条件为临界值 2.0 的时候,针对forward和backward两种情况,对row_target做与判断逻辑相同的处理,目的是避免形成死循环
|
||||
1. [wavelogger.py] bugfix single_file_proc函数中,修改_start起始点的计算逻辑
|
||||
2. [wavelogger.py] bugfix find_point函数中,当判断条件为临界值 2.0 的时候,针对forward和backward两种情况,对row_target做与判断逻辑相同的处理,目的是避免形成死循环
|
||||
|
||||
v0.1.6.2(2024/06/16)
|
||||
1. [current.py] 修改了max/avg相关功能中对于返回值的处理逻辑,并在输出框以行的形式打印出来
|
||||
|
||||
v0.1.6.3(2024/06/18)
|
||||
1. [current.py] 适配电机电流中速度使用hw_joint_vel_feedback的数据,取消对device_servo_vel_feedback的支持,后续所有涉及到速度相关的数据均已前者为准,现已完成对单轴和场景的适配
|
||||
|
||||
> !!WARNING:目前版本的电机电流程序还支持DriverMaster采集的数据处理,等明确后,将不再支持,也即所有的电机电流数据(工业+协作),都是用诊断曲线来采集
|
||||
|
||||
v0.1.7.0(2024/06/19)-未发布
|
||||
1. [openapi.py] 初步搭建起框架,完成了新老协议的封包/解包/异步采集日志的操作(未充分测试,但基本无问题)
|
||||
2. [openapi.py] 修改了封包的规则,使之更加明晰,封包操作没有实现分包功能,目前看实际场景用不到
|
||||
|
||||
v0.1.7.0(2024/06/21)-未发布
|
||||
1. [openapi.py] 定义 MAX_FRAME_SIZE 常量(1024),替换socket接收以及响应数据处理相关部分
|
||||
2. [openapi.py] 使用 int.to_bytes 和 int.from_bytes 替换 binascii 模块的功能
|
||||
3. [aio.py] 修改了Data Process中初始化的动作,使得初始化时的状态统一成程序刚启动时的样子
|
||||
|
||||
v0.1.7.0(2024/06/23)-未发布
|
||||
1. [aio.py] 增加了tabview的点击行为函数,每次点击tab都会初始化
|
||||
2. [aio.py] 增加了Automatic Test界面元素,包括如下,并完成了功能框架的搭建
|
||||
- 标签:文件/角速度/减速比
|
||||
- 按钮:急停及恢复
|
||||
- 输入框:文件路径/角速度/减速比
|
||||
- OptionMenu:负载
|
||||
- 进度条
|
||||
3. [openapi.py] 增加心跳检测函数,并开启线程执行;取消在该文件中生成实例
|
||||
4. [aio.py] 完成detect_network,并在main函数开启线程
|
||||
5. 将templates文件夹移动到assets内
|
||||
|
||||
v0.1.7.0(2024/06/24)-未发布
|
||||
1. [openapi.py] 建联部分做容错逻辑,并将读写文件做自适应处理
|
||||
2. [aio.py] 将读写文件做自适应处理,引入openapi模块并生成实例,做心跳检测,将socket超时时间修改为3s
|
||||
|
||||
v0.1.7.0(2024/06/25)-未发布
|
||||
1. [aio.py] 取消了在本文件中开启openapi线程的做法,并修改如下:
|
||||
- 通过包的方式导入其他模块
|
||||
- 使用current_path来规避文件路径问题
|
||||
- 声名了 self.hr 变量,用来接收openapi的实例化
|
||||
- 修改了对于segment button的错误调用
|
||||
- 设定progress bar的长度是10
|
||||
- 完善了segmented_button_callback函数
|
||||
- 在detect_network函数中增加heartbeat初始化
|
||||
- tabview_click函数中新增textbox清屏功能,以及实例化openapi,并做检测
|
||||
2. [openapi.py] 取消了初始化中无限循环检测,因为阻塞了aio主界面进程!!!socket也无法多次连接!!!浪费了好多时间!!!很生气!!!!
|
||||
- 通过tabview切换来实现重新连接,并保留了异常处理部分
|
||||
- 将所有的 __xxxx 函数都替换成 xxxx 函数,去掉了 __
|
||||
- 使用current_path来规避文件路径问题
|
||||
3. [do_brake.py] 初步完成了机器状态收集的功能,还需要完善
|
||||
- 使用current_path来规避文件路径问题
|
||||
- 新增validate_resp函数,校验数据
|
||||
- 完善了调用接口
|
||||
|
||||
> **关于HMI接口**
|
||||
> - 封包解包顺序:帧长度二字节/包长度四字节/协议二字节/预留二字节,\x04\x00:\x00\x00\tR:\x02:\x00
|
||||
> - 帧长度和包长度没有必然关系,单帧的时候是帧长度减去包长度等于6,包长度指的是所有内容的长度
|
||||
> - HMI内部每次发送1024个字节,进行分包,内容长度规则是:第一帧1024-6=1018(帧大小减去包头长度),第二帧(包含)及之后的帧,帧长度即是数据长度
|
||||
|
||||
v0.1.7.0(2024/06/26)-初步可用
|
||||
1. [aio.py] 在detect_network函数中需改查询时间间隔是1s,在tabview_click中增加textbox配置normal的语句
|
||||
2. [do_brake.py -> btn_functions.py] 新增执行相应函数,并在get_state函数中设置无示教器模式
|
||||
3. [openapi.py] 新增sock_conn函数,并做连接时的异常处理,新增类参数w2t
|
||||
4. [aio.py] 修改customtkinter库中C:\Users\Administrator\AppData\Local\Programs\Python\Python312\Lib\site-packages\customtkinter\windows\widgets\ctk_tabview.py文件,参考https://github.com/TomSchimansky/CustomTkinter/issues/2296,实现修改tabview组件的字体大小,使用原生字体,同时将segmented button字体修改为原生,为了解决segmented button在禁用和启用时,屏幕抖动的问题,并将大小修改为16
|
||||
5. [aio.py] 修改了segmented_button_callback的实现逻辑,使代码更简洁
|
||||
6. [aio.py] 修改了在tabview_click函数中对于实例化HmiRequest的动作,使每次切换标签都会重新实例化,也就是每次都会重新连接,修复显示不正确的问题
|
||||
7. [openapi.py] 新增了socket关闭的函数,并增加msg_id为None的处理逻辑
|
||||
8. [btn_functions.py] 完善了状态获取的功能,新增告警获取以及功能切换的逻辑
|
||||
9. [aio.py] 修改了版本
|
||||
10. [current.py] max/avg功能结束之前会将结果数据追加写入源文件,avg算法更改为average+3×std
|
||||
11. [wavelogger.py] 算法更改为 average+3×std
|
||||
|
||||
v0.1.7.1.0(2024/06/29)
|
||||
1. [APIs: aio.py]
|
||||
- 对于automatic test删除了输入框,使用configs.xlsx配置文件作为参数输入
|
||||
- 完善initialization/param_check/func_start_callback函数中对于automatic test的处理
|
||||
- 将textbox组件一直设置为normal状态,不再频繁切换disabled
|
||||
- 将所有的f_h文件对象修改为f_hb,并将connection_state修改为c_state
|
||||
- 在detect_network函数中,实例化HmiRequest,并在无限循环中检测心跳是否正常,如异常,则销毁hr,重新生成
|
||||
- 取消在tabview切换时,检测心跳的逻辑,这样做无法保证实时性
|
||||
2. [APIs: openapi.py]
|
||||
- 将sock_conn函数移出__init__,单独作为连接函数存在
|
||||
- 新增全局变量self.t_bool,控制所有的线程中无限循环的启停,也就是可以人为的退出线程
|
||||
- 移除close_sock函数
|
||||
- heartbeat函数中新增打印所有消息的代码,调试时打开,平常关闭
|
||||
- execution函数中,新增对overview.set_autoload和overview.reload的支持
|
||||
- execution函数中,对send动作增加异常处理逻辑
|
||||
3. [APIs: do_brake.py]
|
||||
- 新增文件,处理制动测试流程,建立连接,导入project,pp2main,run,采集并处理曲线数据,本地修改RL程序,推送至控制器等
|
||||
- 目前完成:
|
||||
- 文件合规性检查
|
||||
- 导入工程并设置为运行工程
|
||||
4. [APIs: current.py] 修改scenario/single电机电流最大长度为150s
|
||||
5. 在本文件中更新关于制动自动化测试的相关内容
|
||||
6. [t_change_ui: aio.py/brake.py/current.py] 整体修改了操作界面,删除了大部分的配置输入框,改用 configs.xlsx 配置文件替代,并优化了max/avg功能中写入结果数据的方式
|
||||
|
||||
v0.1.7.1.1(2024/06/29)
|
||||
1. [APIs: aio.py]
|
||||
- 修改detect_network函数中sleep语句放到最后,重新生成HmiRequest实例中增加sleep(4),这个停顿时间一定是比openapi中heartbeat函数的sleep要长1s以上才能正常工作
|
||||
- 修改write2textbox函数,新增默认参数tab_name,只有当该值与当前tab一致时,函数才会有输出
|
||||
- 第二条改动影响到了automatic_test文件夹下所有的文件
|
||||
2. [APIs: openapi.py]
|
||||
- 规定了所有的网络异常均由heartbeat函数来定义,其他异常不做中断处理
|
||||
- execution函数中合并了case条件
|
||||
- 增加了N多指令,多为诊断曲线和rl程序相关
|
||||
- 日志保留条数修改为20000
|
||||
3. [APIs: do_brake.py]
|
||||
- 实现自动推送工程到xCore并自动运行
|
||||
- 初步实现了Modbus发送消息和检测状态
|
||||
4. [APIs: do_current.py]
|
||||
- 将do_brake.py的内容完全拷贝到此文件,待修改
|
||||
|
||||
v0.1.7.2(2024/06/30)
|
||||
1. 初步完成NB4h_R580_3BH7.zip工程的设计
|
||||
2. 重新研究了解包操作,重新实现了一版
|
||||
3. 修改openapi.pi中excution为execution函数
|
||||
4. 增加了解包原理性文档
|
||||
|
||||
v0.1.7.3(2024/07/01)
|
||||
1. [APIs: openapi.py]
|
||||
- 继续完善封包解包操作,并优化了所有调试信息,默认打开状态,直到bug数量明显减少
|
||||
- 修复了两个bug,删除了一个多余的break,另一个是补齐了self.broke的重置
|
||||
2. [APIs: do_current.py] 使用原工程的工程名进行move操作,语义更加明确
|
||||
|
||||
> 目前看openapi.py封包解包没有任何问题了,但是所有的调试信息都默认打开,以便可以第一时间保留现场
|
||||
> 打开诊断,跑了10多分钟,共计解包没有报错,应该是没有问题了
|
||||
|
||||
v0.1.7.4(2024/07/02)
|
||||
1. [APIs: openapi.py]
|
||||
- 增加了modbus的python实现
|
||||
- heartbeat函数修改发送间隔为1s
|
||||
- 清除了绝大部分调试性输出,发现太多的这种输出也会导致心跳丢包...,不清楚这个原理是什么
|
||||
- 在get_response函数中的while self.pkg > 0循环中,删除了else语句,因为它永不会被执行到
|
||||
- 在get_response函数中,修复一个bug,在flag==0的else语句中,补齐了index==6的情况
|
||||
2. [APIs: do_current.py]
|
||||
- 完成了六个轴的电机电流动作的执行,以及数据采集
|
||||
- 完成了对应的RL程序的编写
|
||||
3[APIs: aio.py]
|
||||
- 引入modbus实例化,并以参数的形式,传递给相应的tabview
|
||||
- 新增pre_warning函数,在做自动化测试之前,确保所有条件皆具备
|
||||
|
||||
v0.1.7.5(2024/07/03)
|
||||
1. [APIs: aio.py]
|
||||
- 增加触发急停和恢复急停功能逻辑
|
||||
2. [APIs: do_current.py]
|
||||
- 重新调整运行顺序,增加数据处理的逻辑(惯量负载逻辑暂不实现,等待软件部解决了修改工程之后不生效的问题再考虑)
|
||||
3. [APIs: btn_functions.py]
|
||||
- 增加触发急停和恢复急停的modbus实现,仅适用于自动化测试
|
||||
|
||||
v0.1.7.6(2024/07/04)
|
||||
1. [APIs: aio.py]
|
||||
- Automatic Test逻辑中增加选择current时,需要选负载类型的逻辑
|
||||
2. [APIs: do_current.py]
|
||||
- 单轴/场景电机电流的采集已完成
|
||||
3. [APIs: openapi.py]
|
||||
- 增加了modbus读取浮点数的功能
|
||||
- 优化了get_from_id的逻辑
|
||||
4. [autotest.xml]: 新增了scenario_time只写寄存器
|
||||
|
||||
v0.1.8.0(2024/07/04)
|
||||
1. [APIs: do_current.py]: 完成了堵转电流和惯量负载电机电流的采集和处理,至此,电机电流的自动化工作基本完成
|
||||
|
||||
v0.1.8.1(2024/07/05)
|
||||
1. [APIs: do_brake.py]: 完成了制动性能测试框架的搭建,可以顺利执行完整的测试程序,但是未实现急停和数据处理
|
||||
2. [APIs: aio.py]: 修改了do_brake主函数的参数
|
||||
3. 增加工程文件target.zip
|
||||
|
||||
v0.1.8.2(2024/07/08)
|
||||
1. [APIs: do_brake.py]: 完成了制动性能测试逻辑,只不过制动信号传递生效延迟不可控,暂时pending
|
||||
2. [APIs: do_current.py]: 修改曲线数据时序,主要是value data取反即可,解决了波形锯齿明细的问题
|
||||
3. [APIs: openapi.py]: modbus新增了触发急停信号的寄存器 stop0_signal,并重写了解除急停,socket新增了register.set_value协议
|
||||
|
||||
v0.1.9.0(2024/07/10)
|
||||
1. 完成了制动性能的自动化采集
|
||||
2. 完善了modbus浮点数读写相关的功能
|
||||
3. 修改了target.zip工程,该工程目前适配电机电流和制动性能
|
||||
|
||||
v0.1.9.1(2024/07/12)
|
||||
1. [APIs: do_brake.py]
|
||||
- 修改正负方向拍急停的逻辑,基本原理为:运行之前发送正负方向信号pon给RL,RL根据信号以及速度正负号运作
|
||||
- 由于上述修改,正负方向急停准确率可达100%
|
||||
2. [APIs: aio.py]
|
||||
- 修改write2textbox的输出逻辑,实现更加灵活的自定义输出,同时修改相关部分
|
||||
3. [APIs: openapi.py]
|
||||
- modbus类新增指示政府方向急停的信号pon,将modbus类入参中的tab_name删除,并修改tab_name的值为'openapi'
|
||||
- socket类种修改tab_name的值为'openapi'
|
||||
|
||||
v0.1.9.2(2024/07/13)
|
||||
1. [APIs: do_brake.py]
|
||||
- 修改ready_to_go信号的接收逻辑,适配大负载机型
|
||||
2. [APIs: do_current.py]
|
||||
- 修改ready_to_go信号的接收逻辑,适配大负载机型
|
||||
- 调整单轴测试时间为35s,适配大负载机型,调整堵转电流持续时间15s,适当减少测试时间
|
||||
- 将act信号置为False的动作放在初始化,增加程序健壮性
|
||||
- 修改所有输出文件的命名,在扩展名之前加入时间戳
|
||||
- 删除多余的时序矫正语句——item['value'].reverse(),使输出的曲线为平滑的自然顺序
|
||||
3. [current: current.py]
|
||||
- 在find_point函数种,当无法找到正确点位时,继续执行,而不是直接终止执行
|
||||
- max功能计算逻辑矫正,应该是取绝对值的最大值
|
||||
- 整体梳理了trq/trqh的传递路径,现已修正完毕
|
||||
- 减速比rr数据源修改为configs.xlsx
|
||||
4. 在current工程main函数增加 VelSet 100语句
|
||||
|
||||
v0.1.9.3(2024/07/15)
|
||||
1. [APIs: openapi.py]
|
||||
- 修改modbus连接失败报错输出形式,使之只在automatic test页面显示
|
||||
- 将该文件移动至toplevel,为后面扩展做准备
|
||||
- 修改heartbeat文件路径,使后续打包的时候更方便
|
||||
2. [APIs: aio.py]
|
||||
- 修改heartbeat文件路径,使后续打包的时候更方便
|
||||
- 修改write2textbox函数的打印逻辑,先判断网络相关
|
||||
|
||||
v0.1.9.4(2024/07/15)
|
||||
1. [profile: aio.py]:完善durable text相关逻辑
|
||||
2. [profile: do_brake/do_current/btn_functions.py]:删除validate_resp函数,修改execution函数
|
||||
3. [profile: factory_test.py]
|
||||
- 新增耐久/老化测试程序
|
||||
- 实现六轴折线图显示
|
||||
4. [profile: openapi.py]:多次合并遗留问题处理
|
||||
5. templates文件夹组织架构调整
|
||||
|
||||
v0.2.0.0(2024/07/17)
|
||||
1. [profile: aio.py]
|
||||
- 增加velocity相关逻辑
|
||||
- 修改负载信息为曲线信息
|
||||
2. [profile: factory_test.py]
|
||||
- 增加velocity相关逻辑
|
||||
3. [profile: current.py]
|
||||
- 修正减速比获取的规则
|
||||
4. [profile: openapi.py]
|
||||
- HmiRequest模块:日志取消记录move.monitor相关
|
||||
- HmiRequest模块:增加了durable_lock变量,控制文件读写互斥
|
||||
|
||||
v0.2.0.1(2024/07/19)
|
||||
1. [main: aio.py]
|
||||
- 修改了x轴显示,使之为时间刻度
|
||||
- 修改pre_warning函数,增加了durable test的初始化
|
||||
2. [main: factory_test.py]
|
||||
- 增加了数据计算错误的判断逻辑
|
||||
- 增加了历史数据保存的逻辑
|
||||
- 增加了文件读写互斥的逻辑
|
||||
- 修改功能为输出有效电流和最大电流,并将数据结构简化
|
||||
|
||||
v0.2.0.2(2024/07/26)
|
||||
1. [main: current.py]
|
||||
- 修正堵转电流无法正确写入结果文件的问题
|
||||
2. [main: do_brake.py]
|
||||
- 初始速度采集等待时间设置为可通过configs.xlsx配置文件调整的
|
||||
- 初次速度采集停止逻辑修改为tasks.stop指令(未验证)
|
||||
- 急停信号触发前,pending时间设置为固定值10s
|
||||
- 实现正负方向速度采集逻辑
|
||||
- 工程名变更逻辑实现修改为通配符,方便后续根据机型保存文件
|
||||
- 增加超差后写诊断的逻辑,并可以通过configs.xlsx配置文件调整
|
||||
- 程序输出中增加时间戳,方便调试定位日志时间
|
||||
3. [main: do_current.py]
|
||||
- 工程名变更逻辑实现修改为通配符,方便后续根据机型保存文件
|
||||
4. 为工程文件添加更详细的注释
|
||||
5. 补充了do_current/do_brake的流程图
|
||||
6. [main: openapi.py]
|
||||
- 将modbus motor_on/off的实现方法改为高电平脉冲触发
|
||||
7. configs.xlsx配置表新增write_diagnosis/get_init_speed两个参数
|
||||
|
||||
v0.2.0.3(2024/07/27)
|
||||
1. [APIs: do_brake.py]: 精简程序,解决 OOM 问题
|
||||
2. [APIs: do_current.py]: 精简程序,解决 OOM 问题
|
||||
3. [APIs: factory_test.py]: 精简程序,解决 OOM 问题
|
||||
4. [APIsL openapi.py]
|
||||
- 心跳修改为 1 s,因为 OOM 问题的解决依赖于长久的打开曲线开关,此时对于 hr.c_msg 的定时清理是个挑战,将心跳缩短,有利于清理日志后,避免丢失心跳
|
||||
- 新增 diagnosis.save 命令,但是执行时,有问题,待解决
|
1067
aio/assets/autotest.xml
Normal file
1067
aio/assets/autotest.xml
Normal file
File diff suppressed because it is too large
Load Diff
BIN
aio/assets/configs.xlsx
Normal file
BIN
aio/assets/configs.xlsx
Normal file
Binary file not shown.
@ -6,8 +6,8 @@ VSVersionInfo(
|
||||
ffi=FixedFileInfo(
|
||||
# filevers and prodvers should be always a tuple with four items: (1, 2, 3, 4)
|
||||
# Set not needed items to zero 0.
|
||||
filevers=(0, 1, 6, 1),
|
||||
prodvers=(0, 1, 6, 1),
|
||||
filevers=(0, 2, 0, 3),
|
||||
prodvers=(0, 2, 0, 3),
|
||||
# Contains a bitmask that specifies the valid bits 'flags'r
|
||||
mask=0x3f,
|
||||
# Contains a bitmask that specifies the Boolean attributes of the file.
|
||||
@ -31,12 +31,12 @@ VSVersionInfo(
|
||||
'040904b0',
|
||||
[StringStruct('CompanyName', 'Rokae - https://www.rokae.com/'),
|
||||
StringStruct('FileDescription', 'All in one automatic toolbox'),
|
||||
StringStruct('FileVersion', '0.1.6.1 (2024-06-16)'),
|
||||
StringStruct('FileVersion', '0.2.0.3 (2024-07-27)'),
|
||||
StringStruct('InternalName', 'AIO.exe'),
|
||||
StringStruct('LegalCopyright', '© 2024-2024 Manford Fan'),
|
||||
StringStruct('OriginalFilename', 'AIO.exe'),
|
||||
StringStruct('ProductName', 'AIO'),
|
||||
StringStruct('ProductVersion', '0.1.6.1 (2024-06-16)')])
|
||||
StringStruct('ProductVersion', '0.2.0.3 (2024-07-27)')])
|
||||
]),
|
||||
VarFileInfo([VarStruct('Translation', [1033, 1200])])
|
||||
]
|
||||
|
Binary file not shown.
BIN
aio/assets/target_brake_current.zip
Normal file
BIN
aio/assets/target_brake_current.zip
Normal file
Binary file not shown.
BIN
aio/assets/target_durable.zip
Normal file
BIN
aio/assets/target_durable.zip
Normal file
Binary file not shown.
1
aio/assets/templates/heartbeat
Normal file
1
aio/assets/templates/heartbeat
Normal file
@ -0,0 +1 @@
|
||||
1
|
5
aio/assets/templates/json/controller.heart.json
Normal file
5
aio/assets/templates/json/controller.heart.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "controller.heart"
|
||||
}
|
5
aio/assets/templates/json/device.get_params.json
Normal file
5
aio/assets/templates/json/device.get_params.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "device.get_params"
|
||||
}
|
8
aio/assets/templates/json/diagnosis.get_params.json
Normal file
8
aio/assets/templates/json/diagnosis.get_params.json
Normal file
@ -0,0 +1,8 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "robot",
|
||||
"command": "diagnosis.get_params",
|
||||
"data": {
|
||||
"version": "1.4.1"
|
||||
}
|
||||
}
|
12
aio/assets/templates/json/diagnosis.open.json
Normal file
12
aio/assets/templates/json/diagnosis.open.json
Normal file
@ -0,0 +1,12 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "robot",
|
||||
"command": "diagnosis.open",
|
||||
"data": {
|
||||
"open": false,
|
||||
"display_open": false,
|
||||
"overrun": false,
|
||||
"turn_area": false,
|
||||
"delay_motion": false
|
||||
}
|
||||
}
|
8
aio/assets/templates/json/diagnosis.save.json
Normal file
8
aio/assets/templates/json/diagnosis.save.json
Normal file
@ -0,0 +1,8 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "robot",
|
||||
"command": "diagnosis.save",
|
||||
"data": {
|
||||
"save": true
|
||||
}
|
||||
}
|
10
aio/assets/templates/json/diagnosis.set_params.json
Normal file
10
aio/assets/templates/json/diagnosis.set_params.json
Normal file
@ -0,0 +1,10 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "robot",
|
||||
"command": "diagnosis.set_params",
|
||||
"data": {
|
||||
"display_pdo_params": [],
|
||||
"frequency": 50,
|
||||
"version": "1.4.1"
|
||||
}
|
||||
}
|
5
aio/assets/templates/json/overview.get_autoload.json
Normal file
5
aio/assets/templates/json/overview.get_autoload.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "project",
|
||||
"command": "overview.get_autoload"
|
||||
}
|
5
aio/assets/templates/json/overview.get_cur_prj.json
Normal file
5
aio/assets/templates/json/overview.get_cur_prj.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "project",
|
||||
"command": "overview.get_cur_prj"
|
||||
}
|
9
aio/assets/templates/json/overview.reload.json
Normal file
9
aio/assets/templates/json/overview.reload.json
Normal file
@ -0,0 +1,9 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "project",
|
||||
"command": "overview.reload",
|
||||
"data": {
|
||||
"prj_path": "",
|
||||
"tasks": []
|
||||
}
|
||||
}
|
8
aio/assets/templates/json/overview.set_autoload.json
Normal file
8
aio/assets/templates/json/overview.set_autoload.json
Normal file
@ -0,0 +1,8 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "project",
|
||||
"command": "overview.set_autoload",
|
||||
"data": {
|
||||
"autoload_prj_path": ""
|
||||
}
|
||||
}
|
11
aio/assets/templates/json/register.set_value.json
Normal file
11
aio/assets/templates/json/register.set_value.json
Normal file
@ -0,0 +1,11 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "fieldbus",
|
||||
"command": "register.set_value",
|
||||
"data": {
|
||||
"name": "",
|
||||
"type": "bool",
|
||||
"bias": 0,
|
||||
"value": 0
|
||||
}
|
||||
}
|
8
aio/assets/templates/json/rl_task.pp_to_main.json
Normal file
8
aio/assets/templates/json/rl_task.pp_to_main.json
Normal file
@ -0,0 +1,8 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "project",
|
||||
"command": "rl_task.pp_to_main",
|
||||
"data": {
|
||||
"tasks": []
|
||||
}
|
||||
}
|
8
aio/assets/templates/json/rl_task.run.json
Normal file
8
aio/assets/templates/json/rl_task.run.json
Normal file
@ -0,0 +1,8 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "project",
|
||||
"command": "rl_task.run",
|
||||
"data": {
|
||||
"tasks": []
|
||||
}
|
||||
}
|
8
aio/assets/templates/json/rl_task.stop.json
Normal file
8
aio/assets/templates/json/rl_task.stop.json
Normal file
@ -0,0 +1,8 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "project",
|
||||
"command": "rl_task.stop",
|
||||
"data": {
|
||||
"tasks": []
|
||||
}
|
||||
}
|
5
aio/assets/templates/json/state.get_state.json
Normal file
5
aio/assets/templates/json/state.get_state.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "state.get_state"
|
||||
}
|
5
aio/assets/templates/json/state.get_tp_mode.json
Normal file
5
aio/assets/templates/json/state.get_tp_mode.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "state.get_tp_mode"
|
||||
}
|
8
aio/assets/templates/json/state.set_tp_mode.json
Normal file
8
aio/assets/templates/json/state.set_tp_mode.json
Normal file
@ -0,0 +1,8 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "state.set_tp_mode",
|
||||
"data": {
|
||||
"tp_mode": "with"
|
||||
}
|
||||
}
|
5
aio/assets/templates/json/state.switch_auto.json
Normal file
5
aio/assets/templates/json/state.switch_auto.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "state.switch_auto"
|
||||
}
|
5
aio/assets/templates/json/state.switch_manual.json
Normal file
5
aio/assets/templates/json/state.switch_manual.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "state.switch_manual"
|
||||
}
|
5
aio/assets/templates/json/state.switch_motor_off.json
Normal file
5
aio/assets/templates/json/state.switch_motor_off.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "state.switch_motor_off"
|
||||
}
|
5
aio/assets/templates/json/state.switch_motor_on.json
Normal file
5
aio/assets/templates/json/state.switch_motor_on.json
Normal file
@ -0,0 +1,5 @@
|
||||
{
|
||||
"id": "xxxxxxxxxxx",
|
||||
"module": "system",
|
||||
"command": "state.switch_motor_on"
|
||||
}
|
38
aio/assets/unpackage_logic.txt
Normal file
38
aio/assets/unpackage_logic.txt
Normal file
@ -0,0 +1,38 @@
|
||||
b'\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340\x01o429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17\n\t\t\t]\n\t\t}\n\t],\n\t"module" : "robot"\n}\x04\x00\x00\x00-h\x02\x00{\n\t"command" : "diagnosis.result",\n\t"data" : \n\t[\n\t\t{\n\t\t\t"channel" : 0,\n\t\t\t"name" : "hw_joint_vel_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0'
|
||||
b'.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 1,\n\t\t\t"name" : "hw_joint_vel_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t6.7411265092630715e-06,\n\t\t\t\t0.00049929277011941824,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0027270103772138884,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t0.00012044146029883355,\n\t\t\t\t-0.0022272681986605192,\n\t\t\t\t-0.0027270103772138884,\n\t\t\t\t0.0020686270214758614,\n\t\t\t\t-0.0027270103772138884,\n\t\t\t\t0.0020686270214758614,\n\t\t\t\t1.3482253018526145e-06,\n\t\t\t\t-0.002697798\x04\x008290070812,\n\t\t\t\t0.00050648330506263212,\n\t\t\t\t-0.0,\n\t\t\t\t0.0020753681479851243,\n\t\t\t\t2.8762139772855775e-05,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t3.5952674716069715e-05,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t0.0001496530085056402,\n\t\t\t\t0.0001276319952420475,\n\t\t\t\t-0.0027252127434780845,\n\t\t\t\t6.7411265092630715e-06,\n\t\t\t\t-0.0026977988290070812,\n\t\t\t\t8.5387602450665581e-06,\n\t\t\t\t0.0020686270214758614,\n\t\t\t\t0.00206862702147'
|
||||
b'58614,\n\t\t\t\t-0.0,\n\t\t\t\t7.1905349432139438e-06,\n\t\t\t\t1.3482253018526145e-06,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t2.8762139772855775e-05,\n\t\t\t\t-0.0,\n\t\t\t\t6.7411265092630715e-06,\n\t\t\t\t-0.0,\n\t\t\t\t0.00049929277011941824,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 2,\n\t\t\t"name" : "hw_joint_vel_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t1.1984224905356572e-06,\n\t\t\t\t0.00010705907582118537,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0024236097500266104,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0024240092241901226,\n\t\t\x04\x00\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t0.0018387795746452099,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t0.00010705907582118537,\n\t\t\t\t-0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 3,\n\t\t\t"name" : "hw_joint_vel_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t'
|
||||
b'-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.00021840051467521813,\n\t\t\t\t-0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 4,\n\t\t\t"name" : "hw_joint_vel_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t-0.0,\n\t\t\t\t-0.0\x04\x00,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n'
|
||||
b'\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 5,\n\t\t\t"name" : "hw_joint_vel_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-\x04\x000.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0,\n\t\t\t\t-0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 0,\n\t\t\t"name" : "device_servo_trq_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t'
|
||||
b'\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 1,\n\t\t\t"name" : "device_servo_trq_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0\x04\x00.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 2,\n\t\t\t"name" : "device_servo_trq_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.'
|
||||
b'0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 3,\n\t\t\t"name" : "device_servo_trq_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\x04\x00\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 4,\n\t\t\t"name" : "device_servo_trq_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n'
|
||||
b'\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 5,\n\t\t\t"name" : "device_servo_trq_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.\x04\x000,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 0,\n\t\t\t"name" : "device_safety_estop",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n'
|
||||
b'\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 1,\n\t\t\t"name" : "device_safety_estop",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1\x04\x00.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 2,\n\t\t\t"name" : "device_safety_estop",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.'
|
||||
b'0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 3,\n\t\t\t"name" : "device_safety_estop",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t\x04\x001.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0,\n\t\t\t\t1.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 4,\n\t\t\t"name" : "device_safety_estop",\n\t\t\t"value" : '
|
||||
b'\n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0\n\t\t\t]\n\t\t},\n\t\t{\n\t\t\t"channel" : 5,\n\t\t\t"name" : "device_safety_estop",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5\x04\x00.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429'
|
||||
b'065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.55163404\x01n29065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17\n\t\t\t]\n\t\t}\n\t],\n\t"module" : "robot"\n}\x04\x00\x00\x00-\x8f\x02\x00{\n\t"command"'
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
\x04\x00\x00\x00-h\x02\x00
|
||||
|
||||
pkg_size = 11624
|
||||
|
||||
10240 + 402 + 1004 - 20 - 2(首个帧头) = 11624
|
||||
|
||||
第一帧有效 - 402
|
||||
b'{\n\t"command" : "diagnosis.result",\n\t"data" : \n\t[\n\t\t{\n\t\t\t"channel" : 0,\n\t\t\t"name" : "hw_joint_vel_feedback",\n\t\t\t"value" : \n\t\t\t[\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0.0,\n\t\t\t\t0'
|
||||
|
||||
中间有 10 帧,共计 10240 个字节,也有 10 个 \x04\x00,共计 20 个字节
|
||||
|
||||
最后一帧有效 - 1004
|
||||
b'065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.55163404\x01n29065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17,\n\t\t\t\t-5.5516340429065717e-17\n\t\t\t]\n\t\t}\n\t],\n\t"module" : "robot"\n}'
|
||||
|
||||
|
||||
|
||||
b'\x00\\\x00\x00\x00V\x02\x00{\n\t"data" : \n\t{\n\t\t"name" : "xCore"\n\t},\n\t"id" : "controller.heart-1719734550.9790015"\n}'
|
||||
|
||||
frame size 92
|
||||
package size 86
|
||||
length 86 {\n\t"data" : \n\t{\n\t\t"name" : "xCore"\n\t},\n\t"id" : "controller.heart-1719734550.9790015"\n}'
|
@ -1 +1 @@
|
||||
0.1.6.1 @ 06/16/2024
|
||||
0.2.0.2 @ 07/26/2024
|
File diff suppressed because it is too large
Load Diff
2584
aio/assets/workflow/do_brake.excalidraw
Normal file
2584
aio/assets/workflow/do_brake.excalidraw
Normal file
File diff suppressed because it is too large
Load Diff
1666
aio/assets/workflow/do_current.excalidraw
Normal file
1666
aio/assets/workflow/do_current.excalidraw
Normal file
File diff suppressed because it is too large
Load Diff
1
aio/code/__init__.py
Normal file
1
aio/code/__init__.py
Normal file
@ -0,0 +1 @@
|
||||
__all__ = ['automatic_test', 'data_process']
|
721
aio/code/aio.py
721
aio/code/aio.py
@ -1,43 +1,70 @@
|
||||
from os.path import exists
|
||||
import tkinter
|
||||
from os.path import exists, dirname
|
||||
from os import getcwd
|
||||
from threading import Thread
|
||||
import tkinter.messagebox
|
||||
import customtkinter
|
||||
import brake, current, iso, wavelogger
|
||||
from time import time, strftime, localtime
|
||||
from time import time, strftime, localtime, sleep
|
||||
from urllib.request import urlopen
|
||||
from socket import setdefaulttimeout
|
||||
from matplotlib.backends.backend_tkagg import FigureCanvasTkAgg
|
||||
from data_process import *
|
||||
from automatic_test import *
|
||||
from durable_action import *
|
||||
import openapi
|
||||
import matplotlib.pyplot as plt
|
||||
from matplotlib import use
|
||||
from pandas import DataFrame, read_excel
|
||||
|
||||
use('Agg')
|
||||
heartbeat = f'{dirname(__file__)}/../assets/templates/heartbeat'
|
||||
durable_data_current_xlsx = f'{dirname(__file__)}/../assets/templates/durable/durable_data_current.xlsx'
|
||||
durable_data_current_max_xlsx = f'{dirname(__file__)}/../assets/templates/durable/durable_data_current_max.xlsx'
|
||||
customtkinter.set_appearance_mode("System") # Modes: "System" (standard), "Dark", "Light"
|
||||
customtkinter.set_default_color_theme("blue") # Themes: "blue" (standard), "green", "dark-blue"
|
||||
customtkinter.set_widget_scaling(1.1) # widget dimensions and text size
|
||||
customtkinter.set_window_scaling(1.1) # window geometry dimensions
|
||||
setdefaulttimeout(10)
|
||||
setdefaulttimeout(3)
|
||||
# global vars
|
||||
btns = {
|
||||
durable_data_current = {
|
||||
'time': list(range(1, 19)),
|
||||
'axis1': [0 for _ in range(18)],
|
||||
'axis2': [0 for _ in range(18)],
|
||||
'axis3': [0 for _ in range(18)],
|
||||
'axis4': [0 for _ in range(18)],
|
||||
'axis5': [0 for _ in range(18)],
|
||||
'axis6': [0 for _ in range(18)],
|
||||
}
|
||||
durable_data_current_max = {
|
||||
'time': list(range(1, 19)),
|
||||
'axis1': [0 for _ in range(18)],
|
||||
'axis2': [0 for _ in range(18)],
|
||||
'axis3': [0 for _ in range(18)],
|
||||
'axis4': [0 for _ in range(18)],
|
||||
'axis5': [0 for _ in range(18)],
|
||||
'axis6': [0 for _ in range(18)],
|
||||
}
|
||||
btns_func = {
|
||||
'start': {'btn': '', 'row': 1, 'text': '开始运行'},
|
||||
'check': {'btn': '', 'row': 2, 'text': '检查参数'},
|
||||
'log': {'btn': '', 'row': 3, 'text': '保存日志'},
|
||||
'end': {'btn': '', 'row': 4, 'text': '结束运行'},
|
||||
}
|
||||
widgits = {
|
||||
widgits_dp = {
|
||||
'path': {'label': '', 'entry': '', 'row': 1, 'col': 2, 'text': '数据文件夹路径'},
|
||||
'av': {'label': '', 'entry': '', 'row': 2, 'col': 2, 'text': '角速度'},
|
||||
'rc': {'label': '', 'entry': '', 'row': 2, 'col': 4, 'text': '额定电流'},
|
||||
'rpm': {'label': '', 'entry': '', 'row': 2, 'col': 6, 'text': '额定转速'},
|
||||
'rr': {'label': '', 'entry': '', 'row': 2, 'col': 8, 'text': '减速比'},
|
||||
'dur': {'label': '', 'entry': '', 'row': 2, 'col': 10, 'text': '周期时间'},
|
||||
'axis': {'label': '', 'optionmenu': '', 'row': 3, 'col': 2, 'text': ''},
|
||||
'vel': {'label': '', 'optionmenu': '', 'row': 3, 'col': 4, 'text': ''},
|
||||
'trq': {'label': '', 'optionmenu': '', 'row': 3, 'col': 6, 'text': ''},
|
||||
'trqh': {'label': '', 'optionmenu': '', 'row': 3, 'col': 8, 'text': ''},
|
||||
'estop': {'label': '', 'optionmenu': '', 'row': 3, 'col': 10, 'text': ''},
|
||||
'rc1': {'label': '', 'entry': '', 'row': 4, 'col': 2, 'text': '额定电流'},
|
||||
'rc2': {'label': '', 'entry': '', 'row': 4, 'col': 4, 'text': '额定电流'},
|
||||
'rc3': {'label': '', 'entry': '', 'row': 4, 'col': 6, 'text': '额定电流'},
|
||||
'rc4': {'label': '', 'entry': '', 'row': 4, 'col': 8, 'text': '额定电流'},
|
||||
'rc5': {'label': '', 'entry': '', 'row': 4, 'col': 10, 'text': '额定电流'},
|
||||
'rc6': {'label': '', 'entry': '', 'row': 4, 'col': 12, 'text': '额定电流'},
|
||||
'dur': {'label': '', 'entry': '', 'row': 2, 'col': 2, 'text': '周期时间'},
|
||||
'vel': {'label': '', 'optionmenu': '', 'row': 2, 'col': 4, 'text': ''},
|
||||
'trq': {'label': '', 'optionmenu': '', 'row': 2, 'col': 6, 'text': ''},
|
||||
'trqh': {'label': '', 'optionmenu': '', 'row': 2, 'col': 8, 'text': ''},
|
||||
'estop': {'label': '', 'optionmenu': '', 'row': 2, 'col': 10, 'text': ''},
|
||||
}
|
||||
widgits_at = {
|
||||
'path': {'label': '', 'entry': '', 'row': 2, 'col': 2, 'text': '数据文件夹路径'},
|
||||
'loadsel': {'label': '', 'optionmenu': '', 'row': 2, 'col': 1, 'text': '负载信息'},
|
||||
}
|
||||
widgits_da = {
|
||||
'path': {'label': '', 'entry': '', 'row': 1, 'col': 2, 'text': '数据文件夹路径'},
|
||||
'curvesel': {'label': '', 'optionmenu': '', 'row': 1, 'col': 1, 'text': '指标选择'},
|
||||
}
|
||||
|
||||
|
||||
@ -46,6 +73,12 @@ class App(customtkinter.CTk):
|
||||
super().__init__()
|
||||
self.my_font = customtkinter.CTkFont(family="Consolas", size=16, weight="bold")
|
||||
self.w_param = 84
|
||||
self.hr = None
|
||||
self.md = None
|
||||
self.canvas = None
|
||||
self.flg = 0
|
||||
self.df_copy = None
|
||||
self.old_curve = None
|
||||
# =====================================================================
|
||||
# configure window
|
||||
self.title("AIO - All in one automatic toolbox")
|
||||
@ -53,7 +86,7 @@ class App(customtkinter.CTk):
|
||||
self.geometry("1200x550+30+30")
|
||||
self.protocol("WM_DELETE_WINDOW", self.func_end_callback)
|
||||
self.config(bg='#E9E9E9')
|
||||
self.grid_rowconfigure(5, weight=1)
|
||||
self.grid_rowconfigure(6, weight=1)
|
||||
self.grid_columnconfigure((1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), weight=1)
|
||||
self.minsize(1200, 550)
|
||||
# =====================================================================
|
||||
@ -64,55 +97,102 @@ class App(customtkinter.CTk):
|
||||
self.label_logo = customtkinter.CTkLabel(self.frame_func, text="Rokae AIO", height=60, font=customtkinter.CTkFont(family="Segoe Script Bold", size=24, weight="bold"), text_color="#4F4F4F")
|
||||
self.label_logo.grid(row=0, column=0, padx=15, pady=15)
|
||||
# create buttons
|
||||
for func in btns:
|
||||
btns[func]['btn'] = customtkinter.CTkButton(self.frame_func, corner_radius=10, text=btns[func]['text'], fg_color='#4F4F4F', font=self.my_font)
|
||||
btns[func]['btn'].grid(row=btns[func]['row'], column=0, sticky='new', padx=10, pady=10, ipadx=5, ipady=5)
|
||||
btns['start']['btn'].configure(command=lambda: self.thread_it(self.func_start_callback))
|
||||
btns['check']['btn'].configure(command=lambda: self.thread_it(self.func_check_callback))
|
||||
btns['log']['btn'].configure(command=lambda: self.thread_it(self.func_log_callback))
|
||||
btns['end']['btn'].configure(command=lambda: self.thread_it(self.func_end_callback))
|
||||
for func in btns_func:
|
||||
btns_func[func]['btn'] = customtkinter.CTkButton(self.frame_func, corner_radius=10, text=btns_func[func]['text'], fg_color='#4F4F4F', font=self.my_font)
|
||||
btns_func[func]['btn'].grid(row=btns_func[func]['row'], column=0, sticky='new', padx=10, pady=10, ipadx=5, ipady=5)
|
||||
btns_func['start']['btn'].configure(command=lambda: self.thread_it(self.func_start_callback))
|
||||
btns_func['check']['btn'].configure(command=lambda: self.thread_it(self.func_check_callback))
|
||||
btns_func['log']['btn'].configure(command=lambda: self.thread_it(self.func_log_callback))
|
||||
btns_func['end']['btn'].configure(command=lambda: self.thread_it(self.func_end_callback))
|
||||
# create version info
|
||||
self.label_version = customtkinter.CTkLabel(self.frame_func, justify='left', text="Vers: 0.1.6.1\nDate: 06/16/2024", font=self.my_font, text_color="#4F4F4F")
|
||||
self.label_version = customtkinter.CTkLabel(self.frame_func, justify='left', text="Vers: 0.2.0.3\nDate: 07/27/2024", font=self.my_font, text_color="#4F4F4F")
|
||||
self.frame_func.rowconfigure(6, weight=1)
|
||||
self.label_version.grid(row=6, column=0, padx=20, pady=20, sticky='s')
|
||||
# =====================================================================
|
||||
# create tabviews
|
||||
self.tabview = customtkinter.CTkTabview(self, width=10000, height=100, anchor='w', fg_color='#E9E9E9', border_width=2, border_color='#CDCDCD')
|
||||
self.tabview = customtkinter.CTkTabview(self, width=10000, height=100, anchor='w', fg_color='#E9E9E9', border_width=2, border_color='#CDCDCD', command=self.tabview_click)
|
||||
self.tabview.grid(row=0, column=1, padx=10, pady=5, sticky="nsew")
|
||||
self.tabview.add("Data Process")
|
||||
self.tabview.add("Automatic Test")
|
||||
# create main menu
|
||||
self.tabview.add("Durable Action")
|
||||
# create main menu for data process
|
||||
self.menu_main_dp = customtkinter.CTkOptionMenu(self.tabview.tab('Data Process'), values=["init", "brake", "current", "iso", "wavelogger"], font=self.my_font, text_color='yellow', button_color='red', fg_color='green', command=self.func_main_callback)
|
||||
self.menu_main_dp.grid(row=1, column=1, sticky='we', padx=5, pady=5)
|
||||
self.menu_main_dp.grid(row=1, column=1, sticky='we', padx=5, pady=10)
|
||||
self.menu_main_dp.set("Start Here!")
|
||||
# create sub menu
|
||||
# create sub menu for data process
|
||||
self.menu_sub_dp = customtkinter.CTkOptionMenu(self.tabview.tab('Data Process'))
|
||||
# =====================================================================
|
||||
# create widgits
|
||||
for widgit in widgits:
|
||||
# create main menu for automatic test
|
||||
self.menu_main_at = customtkinter.CTkOptionMenu(self.tabview.tab('Automatic Test'), values=["init", "brake", "current"], font=self.my_font, text_color='yellow', button_color='red', fg_color='green', command=self.func_main_callback)
|
||||
self.menu_main_at.grid(row=1, column=1, sticky='we', padx=5, pady=5)
|
||||
self.menu_main_at.set("Start Here!")
|
||||
# For data process tab START =====================================================================
|
||||
# create widgits_dp
|
||||
for widgit in widgits_dp:
|
||||
if widgit == 'path':
|
||||
widgits[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Data Process'), text=f'{widgit.upper()}', font=self.my_font)
|
||||
widgits[widgit]['label'].grid(row=widgits[widgit]['row'], column=widgits[widgit]['col'], sticky='e', pady=5)
|
||||
widgits[widgit]['entry'] = customtkinter.CTkEntry(self.tabview.tab('Data Process'), width=670, placeholder_text=widgits[widgit]['text'], font=self.my_font)
|
||||
widgits[widgit]['entry'].grid(row=widgits[widgit]['row'], column=widgits[widgit]['col']+1, columnspan=11, padx=(5, 10), pady=5, sticky='we')
|
||||
widgits[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['av', 'rc', 'rpm', 'rr', 'dur', 'rc1', 'rc2', 'rc3', 'rc4', 'rc5', 'rc6']:
|
||||
widgits[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Data Process'), text=f"{widgit.upper()}", font=self.my_font)
|
||||
widgits[widgit]['label'].grid(row=widgits[widgit]['row'], column=widgits[widgit]['col'], sticky='e', pady=5)
|
||||
widgits[widgit]['entry'] = customtkinter.CTkEntry(self.tabview.tab('Data Process'), width=self.w_param, placeholder_text=f"{widgits[widgit]['text']}", font=self.my_font)
|
||||
widgits[widgit]['entry'].grid(row=widgits[widgit]['row'], column=widgits[widgit]['col']+1, padx=(5, 10), pady=5, sticky='w')
|
||||
widgits[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['axis', 'vel', 'trq', 'trqh', 'estop']:
|
||||
widgits[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Data Process'), text=f"{widgit.upper()}", font=self.my_font)
|
||||
widgits[widgit]['label'].grid(row=widgits[widgit]['row'], column=widgits[widgit]['col'], sticky='e', pady=5)
|
||||
widgits[widgit]['optionmenu'] = customtkinter.CTkOptionMenu(self.tabview.tab('Data Process'), button_color='#708090', fg_color='#778899', values=["1", "2", "3", "4", "5", "6", "7"], width=self.w_param, font=self.my_font)
|
||||
widgits[widgit]['optionmenu'].grid(row=widgits[widgit]['row'], column=widgits[widgit]['col']+1, padx=(5, 10), pady=5, sticky='w')
|
||||
widgits[widgit]['optionmenu'].configure(state='disabled')
|
||||
# =====================================================================
|
||||
widgits_dp[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Data Process'), text=f'{widgit.upper()}', font=self.my_font)
|
||||
widgits_dp[widgit]['label'].grid(row=widgits_dp[widgit]['row'], column=widgits_dp[widgit]['col'], sticky='e', pady=10)
|
||||
widgits_dp[widgit]['entry'] = customtkinter.CTkEntry(self.tabview.tab('Data Process'), width=670, placeholder_text=widgits_dp[widgit]['text'], font=self.my_font)
|
||||
widgits_dp[widgit]['entry'].grid(row=widgits_dp[widgit]['row'], column=widgits_dp[widgit]['col']+1, columnspan=11, padx=(5, 10), pady=5, sticky='we')
|
||||
widgits_dp[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['dur']:
|
||||
widgits_dp[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Data Process'), text=f"{widgit.upper()}", font=self.my_font)
|
||||
widgits_dp[widgit]['label'].grid(row=widgits_dp[widgit]['row'], column=widgits_dp[widgit]['col'], sticky='e', pady=5)
|
||||
widgits_dp[widgit]['entry'] = customtkinter.CTkEntry(self.tabview.tab('Data Process'), width=self.w_param, placeholder_text=f"{widgits_dp[widgit]['text']}", font=self.my_font)
|
||||
widgits_dp[widgit]['entry'].grid(row=widgits_dp[widgit]['row'], column=widgits_dp[widgit]['col']+1, padx=(5, 10), pady=5, sticky='w')
|
||||
widgits_dp[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['vel', 'trq', 'trqh', 'estop']:
|
||||
widgits_dp[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Data Process'), text=f"{widgit.upper()}", font=self.my_font)
|
||||
widgits_dp[widgit]['label'].grid(row=widgits_dp[widgit]['row'], column=widgits_dp[widgit]['col'], sticky='e', pady=5)
|
||||
widgits_dp[widgit]['optionmenu'] = customtkinter.CTkOptionMenu(self.tabview.tab('Data Process'), button_color='#708090', fg_color='#778899', values=["1", "2", "3", "4", "5", "6", "7"], width=self.w_param, font=self.my_font)
|
||||
widgits_dp[widgit]['optionmenu'].grid(row=widgits_dp[widgit]['row'], column=widgits_dp[widgit]['col']+1, padx=(5, 10), pady=5, sticky='w')
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='disabled')
|
||||
# For data process tab END =====================================================================
|
||||
# For automatic test tab START =====================================================================
|
||||
# create buttons
|
||||
self.seg_button = customtkinter.CTkSegmentedButton(self.tabview.tab('Automatic Test'), dynamic_resizing=False, font=customtkinter.CTkFont(size=16, weight='bold'), command=lambda value='机器状态': self.thread_it(self.segmented_button_callback))
|
||||
self.seg_button.grid(row=1, column=2, columnspan=12, padx=(65, 10), pady=(10, 10), sticky="ew")
|
||||
self.seg_button.configure(dynamic_resizing=False, values=["功能切换", "触发急停", "恢复急停", "待定功能", "功能待定", "机器状态", "告警信息"])
|
||||
self.seg_button.set("功能切换")
|
||||
# create progress bar
|
||||
self.progressbar = customtkinter.CTkProgressBar(self.tabview.tab('Automatic Test'))
|
||||
self.progressbar.grid(row=5, column=1, padx=5, pady=5, sticky="ew")
|
||||
self.progressbar.configure(mode="determinnate", width=10)
|
||||
self.progressbar.start()
|
||||
# create widgits_at
|
||||
for widgit in widgits_at:
|
||||
if widgit == 'path':
|
||||
widgits_at[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Automatic Test'), text=f'{widgit.upper()}', font=self.my_font)
|
||||
widgits_at[widgit]['label'].grid(row=widgits_at[widgit]['row'], column=widgits_at[widgit]['col'], sticky='e', padx=(20, 5), pady=5)
|
||||
widgits_at[widgit]['entry'] = customtkinter.CTkEntry(self.tabview.tab('Automatic Test'), width=670, placeholder_text=widgits_at[widgit]['text'], font=self.my_font)
|
||||
widgits_at[widgit]['entry'].grid(row=widgits_at[widgit]['row'], column=widgits_at[widgit]['col']+1, columnspan=11, padx=(5, 10), pady=5, sticky='we')
|
||||
widgits_at[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['loadsel', ]:
|
||||
widgits_at[widgit]['optionmenu'] = customtkinter.CTkOptionMenu(self.tabview.tab('Automatic Test'), button_color='#708090', fg_color='#778899', values=["tool33", "tool66", "tool100", "inertia"], width=self.w_param, font=self.my_font)
|
||||
widgits_at[widgit]['optionmenu'].grid(row=widgits_at[widgit]['row'], column=widgits_at[widgit]['col'], padx=5, pady=5, sticky='we')
|
||||
widgits_at[widgit]['optionmenu'].set(widgits_at[widgit]['text'])
|
||||
widgits_at[widgit]['optionmenu'].configure(state='disabled')
|
||||
# For automatic test tab END =====================================================================
|
||||
# For durable_action tab START =====================================================================
|
||||
# create progress bar
|
||||
self.progressbar_da = customtkinter.CTkProgressBar(self.tabview.tab('Durable Action'))
|
||||
self.progressbar_da.grid(row=2, column=1, padx=5, pady=5, sticky="ew")
|
||||
self.progressbar_da.configure(mode="determinnate", width=self.w_param)
|
||||
self.progressbar_da.start()
|
||||
for widgit in widgits_da:
|
||||
if widgit == 'path':
|
||||
widgits_da[widgit]['label'] = customtkinter.CTkLabel(self.tabview.tab('Durable Action'), text=f'{widgit.upper()}', font=self.my_font)
|
||||
widgits_da[widgit]['label'].grid(row=widgits_da[widgit]['row'], column=widgits_da[widgit]['col'], sticky='e', padx=(20, 5), pady=10)
|
||||
widgits_da[widgit]['entry'] = customtkinter.CTkEntry(self.tabview.tab('Durable Action'), width=670, placeholder_text=widgits_da[widgit]['text'], font=self.my_font)
|
||||
widgits_da[widgit]['entry'].grid(row=widgits_da[widgit]['row'], column=widgits_da[widgit]['col']+1, columnspan=11, padx=(5, 10), pady=10, sticky='we')
|
||||
elif widgit in ['curvesel']:
|
||||
widgits_da[widgit]['optionmenu'] = customtkinter.CTkOptionMenu(self.tabview.tab('Durable Action'), dynamic_resizing=False, button_color='#708090', fg_color='#778899', values=['device_servo_trq_feedback', '[max] device_servo_trq_feedback'], font=self.my_font)
|
||||
widgits_da[widgit]['optionmenu'].grid(row=widgits_da[widgit]['row'], column=widgits_da[widgit]['col'], padx=5, pady=10, sticky='we')
|
||||
widgits_da[widgit]['optionmenu'].set(widgits_da[widgit]['text'])
|
||||
# For durable_action tab END =====================================================================
|
||||
# create textbox
|
||||
self.textbox = customtkinter.CTkTextbox(self, wrap='none', font=customtkinter.CTkFont(family="consolas", size=14), text_color="blue", fg_color='#E9E9E9', border_width=2, border_color='#CDCDCD', border_spacing=5)
|
||||
self.textbox.grid(row=5, column=1, rowspan=2, columnspan=13, ipadx=10, ipady=10, padx=10, pady=(5, 10), sticky='nsew')
|
||||
self.textbox.configure(state='disabled')
|
||||
self.textbox.grid(row=6, column=1, columnspan=13, ipadx=10, ipady=10, padx=10, pady=(5, 10), sticky='nsew')
|
||||
self.textbox.configure(state='normal')
|
||||
# =====================================================================
|
||||
# version check
|
||||
cur_vers = self.label_version.cget("text").replace('\n', ' @ ').replace("Vers: ", '').replace("Date: ", '')
|
||||
@ -120,10 +200,65 @@ class App(customtkinter.CTk):
|
||||
try:
|
||||
new_vers = urlopen(url_vers).read().decode('utf-8')
|
||||
if cur_vers.strip() != new_vers.strip():
|
||||
msg = f"""当前版本:{cur_vers}\n更新版本:{new_vers}\n\n请及时更新 http://10.2.23.150:10003/s/jRfM"""
|
||||
msg = f"""当前版本:{cur_vers}\n更新版本:{new_vers}\n\n请及时前往钉盘更新~~~"""
|
||||
tkinter.messagebox.showwarning(title="版本更新", message=msg)
|
||||
self.destroy()
|
||||
except:
|
||||
tkinter.messagebox.showwarning(title="版本更新", message="连接服务器失败,无法确认当前是否是最新版本......")
|
||||
# functions below ↓ ----------------------------------------------------------------------------------------
|
||||
|
||||
def create_canvas(self, figure):
|
||||
self.canvas = FigureCanvasTkAgg(figure, self.tabview.tab('Durable Action'))
|
||||
self.canvas.draw()
|
||||
self.canvas.get_tk_widget().configure(height=600)
|
||||
self.canvas.get_tk_widget().grid(row=3, column=1, rowspan=3, columnspan=13, padx=20, pady=10, sticky="nsew")
|
||||
|
||||
def create_plot(self):
|
||||
plt.rcParams['font.sans-serif'] = ['SimHei']
|
||||
plt.rcParams['axes.unicode_minus'] = False
|
||||
plt.rcParams['figure.dpi'] = 100
|
||||
plt.rcParams['font.size'] = 14
|
||||
plt.rcParams['lines.marker'] = 'o'
|
||||
|
||||
curvesel = widgits_da['curvesel']['optionmenu'].get()
|
||||
while True:
|
||||
if not self.hr.durable_lock:
|
||||
self.hr.durable_lock = 1
|
||||
if curvesel == 'device_servo_trq_feedback':
|
||||
df = read_excel(durable_data_current_xlsx)
|
||||
_title = 'device_servo_trq_feedback'
|
||||
elif curvesel == '[max] device_servo_trq_feedback':
|
||||
_title = '[max] device_servo_trq_feedback'
|
||||
df = read_excel(durable_data_current_max_xlsx)
|
||||
else:
|
||||
_title = 'device_servo_trq_feedback'
|
||||
df = read_excel(durable_data_current_xlsx)
|
||||
self.hr.durable_lock = 0
|
||||
break
|
||||
else:
|
||||
sleep(1)
|
||||
|
||||
if not df.equals(self.df_copy) or self.flg == 0 or curvesel != self.old_curve:
|
||||
self.flg = 1
|
||||
self.df_copy = df.copy()
|
||||
self.old_curve = widgits_da['curvesel']['optionmenu'].get()
|
||||
figure = plt.figure(frameon=True, facecolor='#E9E9E9')
|
||||
plt.subplots_adjust(left=0.04, right=0.98, bottom=0.1, top=0.95)
|
||||
|
||||
_ = df['time'].to_list()
|
||||
_xticks = [str(_i) for _i in _]
|
||||
ax = figure.add_subplot(1, 1, 1)
|
||||
ax.set_xticks(range(len(_xticks)))
|
||||
ax.set_xticklabels(_xticks)
|
||||
|
||||
df.plot(grid=True, x='time', y='axis1', ax=ax)
|
||||
df.plot(grid=True, x='time', y='axis2', ax=ax)
|
||||
df.plot(grid=True, x='time', y='axis3', ax=ax)
|
||||
df.plot(grid=True, x='time', y='axis4', ax=ax)
|
||||
df.plot(grid=True, x='time', y='axis5', ax=ax)
|
||||
df.plot(grid=True, x='time', y='axis6', ax=ax, title=_title, legend='upper left', rot=30)
|
||||
|
||||
self.create_canvas(figure)
|
||||
|
||||
def thread_it(self, func, *args):
|
||||
""" 将函数打包进线程 """
|
||||
@ -131,97 +266,229 @@ class App(customtkinter.CTk):
|
||||
self.myThread.daemon = True # 主线程退出就直接让子线程跟随退出,不论是否运行完成。
|
||||
self.myThread.start()
|
||||
|
||||
def initialization(self):
|
||||
for widgit in widgits:
|
||||
if widgit in ['path', 'av', 'rc', 'rpm', 'rr', 'dur', 'rc1', 'rc2', 'rc3', 'rc4', 'rc5', 'rc6']:
|
||||
widgits[widgit]['label'].configure(text=f'{widgit.upper()}', text_color='black')
|
||||
widgits[widgit]['entry'].configure(placeholder_text=widgits[widgit]['text'], state='disabled')
|
||||
elif widgit in ['axis', 'vel', 'trq', 'trqh', 'estop']:
|
||||
widgits[widgit]['label'].configure(text=f'{widgit.upper()}', text_color="black")
|
||||
widgits[widgit]['optionmenu'].configure(state='disabled')
|
||||
def segmented_button_callback(self):
|
||||
_btn_funcs = {'trigger_estop': '触发急停', 'reset_estop': '恢复急停', 'get_state': '机器状态', 'warning_info': '告警信息'}
|
||||
value = self.seg_button.get()
|
||||
|
||||
self.menu_sub_dp.grid_forget()
|
||||
self.seg_button.configure(state='disabled')
|
||||
# self.tabview.configure(state='disabled')
|
||||
self.textbox.delete(index1='1.0', index2='end')
|
||||
self.textbox.configure(state='disabled')
|
||||
with open(heartbeat, 'r', encoding='utf-8') as f_h:
|
||||
c_state = f_h.read().strip()
|
||||
|
||||
if c_state == '0' and value != '功能切换':
|
||||
self.write2textbox("无法连接机器人,检查是否已经使用Robot Assist软件连接机器,重试中...", 0, 50, 'red')
|
||||
else:
|
||||
for _func in _btn_funcs:
|
||||
if _btn_funcs[_func] == value:
|
||||
btn_functions.main(self.hr, self.md, _func, self.write2textbox)
|
||||
break
|
||||
|
||||
self.seg_button.configure(state='normal')
|
||||
# self.tabview.configure(state='normal')
|
||||
|
||||
def detect_network(self):
|
||||
df = DataFrame(durable_data_current)
|
||||
df.to_excel(durable_data_current_xlsx, index=False)
|
||||
df = DataFrame(durable_data_current_max)
|
||||
df.to_excel(durable_data_current_max_xlsx, index=False)
|
||||
|
||||
with open(heartbeat, "w", encoding='utf-8') as f_hb:
|
||||
f_hb.write('0')
|
||||
self.hr = openapi.HmiRequest(self.write2textbox)
|
||||
self.md = openapi.ModbusRequest(self.write2textbox)
|
||||
|
||||
while True:
|
||||
if self.tabview.get() == 'Durable Action':
|
||||
self.create_plot()
|
||||
|
||||
with open(heartbeat, 'r', encoding='utf-8') as f_hb:
|
||||
c_state = f_hb.read().strip()
|
||||
pb_color = 'green' if c_state == '1' else 'red'
|
||||
self.progressbar.configure(progress_color=pb_color)
|
||||
self.progressbar_da.configure(progress_color=pb_color)
|
||||
if c_state == '0':
|
||||
self.hr.t_bool = False
|
||||
sleep(3)
|
||||
del self.hr
|
||||
self.hr = openapi.HmiRequest(self.write2textbox)
|
||||
sleep(3)
|
||||
|
||||
def tabview_click(self):
|
||||
self.initialization()
|
||||
tab_name = self.tabview.get()
|
||||
if tab_name == 'Data Process':
|
||||
self.flg = 0
|
||||
self.menu_main_dp.set("Start Here!")
|
||||
elif tab_name == 'Automatic Test':
|
||||
self.flg = 0
|
||||
self.menu_main_at.set("Start Here!")
|
||||
self.seg_button.configure(state='normal')
|
||||
elif tab_name == 'Durable Action':
|
||||
pass
|
||||
|
||||
def initialization(self):
|
||||
tab_name = self.tabview.get()
|
||||
self.textbox.delete(index1='1.0', index2='end')
|
||||
if tab_name == 'Data Process':
|
||||
for widgit in widgits_dp:
|
||||
if widgit in ['path', 'dur']:
|
||||
widgits_dp[widgit]['label'].configure(text=f'{widgit.upper()}', text_color='black')
|
||||
widgits_dp[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_dp[widgit]['entry'].configure(placeholder_text=widgits_dp[widgit]['text'], state='normal')
|
||||
widgits_dp[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['vel', 'trq', 'trqh', 'estop']:
|
||||
widgits_dp[widgit]['label'].configure(text=f'{widgit.upper()}', text_color="black")
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='normal')
|
||||
widgits_dp[widgit]['optionmenu'].set('1')
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='disabled')
|
||||
|
||||
self.menu_sub_dp.grid_forget()
|
||||
elif tab_name == 'Automatic Test':
|
||||
for widgit in widgits_at:
|
||||
if widgit in ['path', ]:
|
||||
widgits_at[widgit]['label'].configure(text=f'{widgit.upper()}', text_color='black')
|
||||
widgits_at[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_at[widgit]['entry'].configure(placeholder_text=widgits_at[widgit]['text'], state='normal')
|
||||
widgits_at[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['loadsel']:
|
||||
widgits_at[widgit]['optionmenu'].configure(state='normal')
|
||||
widgits_at[widgit]['optionmenu'].set(widgits_at[widgit]['text'])
|
||||
widgits_at[widgit]['optionmenu'].configure(state='disabled')
|
||||
self.seg_button.set("功能切换")
|
||||
elif tab_name == 'Durable Action':
|
||||
for widgit in widgits_da:
|
||||
if widgit in ['path', ]:
|
||||
widgits_da[widgit]['label'].configure(text=f'{widgit.upper()}', text_color='black')
|
||||
widgits_da[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_da[widgit]['entry'].configure(placeholder_text=widgits_at[widgit]['text'], state='normal')
|
||||
elif widgit in ['curvesel']:
|
||||
widgits_da[widgit]['optionmenu'].configure(state='normal')
|
||||
widgits_da[widgit]['optionmenu'].set(widgits_da[widgit]['text'])
|
||||
|
||||
def func_main_callback(self, func_name):
|
||||
self.initialization()
|
||||
tab_name = self.tabview.get()
|
||||
if tab_name == 'Data Process':
|
||||
if func_name == 'brake':
|
||||
for widgit in widgits_dp:
|
||||
if widgit in ['path']:
|
||||
widgits_dp[widgit]['label'].configure(text_color='red')
|
||||
widgits_dp[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['vel', 'trq', 'estop']:
|
||||
widgits_dp[widgit]['label'].configure(text_color="red")
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='normal')
|
||||
elif func_name == 'current':
|
||||
self.menu_sub_dp = customtkinter.CTkOptionMenu(self.tabview.tab('Data Process'), values=["max", "avg", "cycle"], font=self.my_font, button_color='red', fg_color='green', command=self.func_sub_callback)
|
||||
self.menu_sub_dp.grid(row=2, column=1, sticky='we', padx=5, pady=5)
|
||||
self.menu_sub_dp.set("--select--")
|
||||
self.menu_sub_dp.configure(text_color='yellow')
|
||||
|
||||
if func_name == 'brake':
|
||||
for widgit in widgits:
|
||||
if widgit in ['path', 'av', 'rr']:
|
||||
widgits[widgit]['label'].configure(text_color='red')
|
||||
widgits[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['axis', 'vel', 'trq', 'estop']:
|
||||
widgits[widgit]['label'].configure(text_color="red")
|
||||
widgits[widgit]['optionmenu'].configure(state='normal')
|
||||
elif func_name == 'current':
|
||||
self.menu_sub_dp = customtkinter.CTkOptionMenu(self.tabview.tab('Data Process'), values=["max", "avg", "cycle"], font=self.my_font, button_color='red', fg_color='green', command=self.func_sub_callback)
|
||||
self.menu_sub_dp.grid(row=2, column=1, sticky='we', padx=5, pady=5)
|
||||
self.menu_sub_dp.set("--select--")
|
||||
self.menu_sub_dp.configure(text_color='yellow')
|
||||
|
||||
for widgit in widgits:
|
||||
if widgit in ['path', 'rc', 'rc1', 'rc2', 'rc3', 'rc4', 'rc5', 'rc6']:
|
||||
color = 'blue' if widgit == 'rc' else 'red'
|
||||
widgits[widgit]['label'].configure(text_color=color)
|
||||
widgits[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['trqh',]:
|
||||
widgits[widgit]['label'].configure(text_color="red")
|
||||
widgits[widgit]['optionmenu'].configure(state='normal')
|
||||
elif func_name == 'iso' or func_name == 'wavelogger':
|
||||
for widgit in widgits:
|
||||
if widgit in ['path',]:
|
||||
widgits[widgit]['label'].configure(text_color='red')
|
||||
widgits[widgit]['entry'].configure(state='normal')
|
||||
else:
|
||||
self.initialization()
|
||||
self.menu_main_dp.set("Start Here!")
|
||||
elif func_name == 'iso' or func_name == 'wavelogger':
|
||||
for widgit in widgits_dp:
|
||||
if widgit in ['path']:
|
||||
widgits_dp[widgit]['label'].configure(text_color='red')
|
||||
widgits_dp[widgit]['entry'].configure(state='normal')
|
||||
else:
|
||||
self.initialization()
|
||||
self.menu_main_dp.set("Start Here!")
|
||||
elif tab_name == 'Automatic Test':
|
||||
if func_name == 'brake':
|
||||
for widgit in widgits_at:
|
||||
if widgit in ['path',]:
|
||||
widgits_at[widgit]['label'].configure(text_color='red')
|
||||
widgits_at[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_at[widgit]['entry'].configure(placeholder_text=widgits_at[widgit]['text'], state='normal')
|
||||
widgits_at[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['loadsel', ]:
|
||||
widgits_at[widgit]['optionmenu'].set(widgits_at[widgit]['text'])
|
||||
widgits_at[widgit]['optionmenu'].configure(state='normal', text_color='red')
|
||||
elif func_name == 'current':
|
||||
for widgit in widgits_at:
|
||||
if widgit in ['path',]:
|
||||
widgits_at[widgit]['label'].configure(text_color='red')
|
||||
widgits_at[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_at[widgit]['entry'].configure(placeholder_text=widgits_at[widgit]['text'], state='normal')
|
||||
widgits_at[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['loadsel', ]:
|
||||
widgits_at[widgit]['optionmenu'].set(widgits_at[widgit]['text'])
|
||||
widgits_at[widgit]['optionmenu'].configure(state='normal', text_color='red')
|
||||
else:
|
||||
self.initialization()
|
||||
self.menu_main_at.set("Start Here!")
|
||||
|
||||
def func_sub_callback(self, func_name):
|
||||
if func_name == "max":
|
||||
for widgit in widgits:
|
||||
if widgit in ['rpm', 'dur']:
|
||||
widgits[widgit]['label'].configure(text_color='black')
|
||||
widgits[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['vel', 'trq']:
|
||||
widgits[widgit]['label'].configure(text_color='black')
|
||||
widgits[widgit]['optionmenu'].configure(state='disabled')
|
||||
elif func_name == 'avg':
|
||||
for widgit in widgits:
|
||||
if widgit in ['rpm', 'dur']:
|
||||
widgits[widgit]['label'].configure(text_color='black')
|
||||
widgits[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['vel', 'trq']:
|
||||
widgits[widgit]['label'].configure(text_color='black')
|
||||
widgits[widgit]['optionmenu'].configure(state='disabled')
|
||||
if func_name == "max" or func_name == "avg":
|
||||
for widgit in widgits_dp:
|
||||
if widgit in ['path']:
|
||||
widgits_dp[widgit]['label'].configure(text_color='red')
|
||||
widgits_dp[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_dp[widgit]['entry'].configure(placeholder_text=widgits_dp[widgit]['text'], state='normal')
|
||||
widgits_dp[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['dur']:
|
||||
widgits_dp[widgit]['label'].configure(text_color='black')
|
||||
widgits_dp[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_dp[widgit]['entry'].configure(placeholder_text=widgits_dp[widgit]['text'], state='normal')
|
||||
widgits_dp[widgit]['entry'].configure(state='disabled')
|
||||
elif widgit in ['vel', 'trqh', 'estop']:
|
||||
widgits_dp[widgit]['label'].configure(text_color='black')
|
||||
widgits_dp[widgit]['optionmenu'].set('1')
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='disabled')
|
||||
elif widgit in ['trq']:
|
||||
widgits_dp[widgit]['label'].configure(text_color='red')
|
||||
widgits_dp[widgit]['optionmenu'].set('1')
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='normal')
|
||||
elif func_name == 'cycle':
|
||||
for widgit in widgits:
|
||||
if widgit in ['rpm', 'dur']:
|
||||
widgits[widgit]['label'].configure(text_color='blue')
|
||||
widgits[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['vel', 'trq']:
|
||||
widgits[widgit]['label'].configure(text_color="red")
|
||||
widgits[widgit]['optionmenu'].configure(state='normal')
|
||||
for widgit in widgits_dp:
|
||||
if widgit in ['path', 'dur']:
|
||||
color = 'blue' if widgit == 'dur' else 'red'
|
||||
widgits_dp[widgit]['label'].configure(text_color=color)
|
||||
widgits_dp[widgit]['entry'].delete(0, tkinter.END)
|
||||
widgits_dp[widgit]['entry'].configure(placeholder_text=widgits_dp[widgit]['text'], state='normal')
|
||||
widgits_dp[widgit]['entry'].configure(state='normal')
|
||||
elif widgit in ['vel', 'trq', 'trqh']:
|
||||
color = 'blue' if widgit == 'trqh' else 'red'
|
||||
widgits_dp[widgit]['label'].configure(text_color=color)
|
||||
widgits_dp[widgit]['optionmenu'].set('1')
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='normal')
|
||||
elif widgit in ['estop']:
|
||||
widgits_dp[widgit]['label'].configure(text_color="black")
|
||||
widgits_dp[widgit]['optionmenu'].set('1')
|
||||
widgits_dp[widgit]['optionmenu'].configure(state='disabled')
|
||||
|
||||
def write2textbox(self, text, wait=0, exitcode=0, color='blue'):
|
||||
def write2textbox(self, text, wait=0, exitcode=0, color='blue', tab_name='Data Process'):
|
||||
self.textbox.tag_add(color, 'insert', 'end')
|
||||
self.textbox.tag_config(tagName=color, foreground=color)
|
||||
tab_name_cur = self.tabview.get()
|
||||
|
||||
if wait != 0:
|
||||
self.textbox.insert(index='end', text=text, tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
elif exitcode != 0:
|
||||
self.textbox.insert(index='end', text=text + '\n', tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
self.textbox.configure(state='disabled')
|
||||
raise Exception(f"Error code: {exitcode}")
|
||||
else:
|
||||
self.textbox.insert(index='end', text=text + '\n', tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
if tab_name == tab_name_cur:
|
||||
if wait != 0:
|
||||
self.textbox.insert(index='end', text=text, tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
elif exitcode != 0:
|
||||
self.textbox.insert(index='end', text=text + '\n', tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
raise Exception(f"Error code: {exitcode}")
|
||||
else:
|
||||
self.textbox.insert(index='end', text=text + '\n', tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
elif tab_name == 'openapi' and tab_name_cur == 'Automatic Test' or tab_name_cur == 'Durable Action':
|
||||
if wait != 0:
|
||||
self.textbox.insert(index='end', text=text, tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
elif exitcode != 0:
|
||||
self.textbox.insert(index='end', text=text + '\n', tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
raise Exception(f"Error code: {exitcode}")
|
||||
else:
|
||||
self.textbox.insert(index='end', text=text + '\n', tags=color)
|
||||
self.textbox.update()
|
||||
self.textbox.see('end')
|
||||
|
||||
def is_float(self, flag, *args):
|
||||
for item in args:
|
||||
@ -237,103 +504,134 @@ class App(customtkinter.CTk):
|
||||
return True
|
||||
|
||||
def check_param(self):
|
||||
func_name = self.menu_main_dp.get()
|
||||
if func_name == 'brake':
|
||||
path = widgits['path']['entry'].get().strip()
|
||||
av = widgits['av']['entry'].get().strip('- ')
|
||||
rr = widgits['rr']['entry'].get().strip('- ')
|
||||
axis = widgits['axis']['optionmenu'].get()
|
||||
vel = widgits['vel']['optionmenu'].get()
|
||||
trq = widgits['trq']['optionmenu'].get()
|
||||
estop = widgits['estop']['optionmenu'].get()
|
||||
tab_name = self.tabview.get()
|
||||
if tab_name == 'Data Process':
|
||||
func_name = self.menu_main_dp.get()
|
||||
if func_name == 'brake':
|
||||
path = widgits_dp['path']['entry'].get().strip()
|
||||
vel = widgits_dp['vel']['optionmenu'].get()
|
||||
trq = widgits_dp['trq']['optionmenu'].get()
|
||||
estop = widgits_dp['estop']['optionmenu'].get()
|
||||
|
||||
c1 = exists(path)
|
||||
c2 = self.is_float('required', av, rr)
|
||||
c3 = True if len({vel, trq, estop}) == 3 else False
|
||||
c1 = exists(path)
|
||||
c2 = True if len({vel, trq, estop}) == 3 else False
|
||||
if c1 and c2:
|
||||
return 1, path, int(vel), int(trq), int(estop)
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
elif func_name == 'current':
|
||||
path = widgits_dp['path']['entry'].get().strip()
|
||||
dur = widgits_dp['dur']['entry'].get().strip()
|
||||
vel = widgits_dp['vel']['optionmenu'].get()
|
||||
trq = widgits_dp['trq']['optionmenu'].get()
|
||||
trqh = widgits_dp['trqh']['optionmenu'].get()
|
||||
sub = self.menu_sub_dp.get()
|
||||
|
||||
if c1 and c2 and c3:
|
||||
return 1, path, float(av), float(rr), int(axis), int(vel), int(trq), int(estop)
|
||||
c1 = exists(path)
|
||||
c2 = sub in ['max', 'avg', 'cycle']
|
||||
c3 = c4 = True
|
||||
if sub == 'cycle':
|
||||
c3 = True if len({vel, trq}) == 2 else False
|
||||
c4 = self.is_float('optional', dur)
|
||||
elif sub == 'max' or sub == 'avg':
|
||||
pass
|
||||
|
||||
if c1 and c2 and c3 and c4:
|
||||
dur = 0 if dur == '' else dur
|
||||
return 2, path, sub, float(dur), int(vel), int(trq), int(trqh)
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
elif func_name == 'iso':
|
||||
path = widgits_dp['path']['entry'].get().strip()
|
||||
if exists(path):
|
||||
return 3, path
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
elif func_name == 'wavelogger':
|
||||
path = widgits_dp['path']['entry'].get().strip()
|
||||
if exists(path):
|
||||
return 4, path
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
elif func_name == 'current':
|
||||
path = widgits['path']['entry'].get().strip()
|
||||
rc = widgits['rc']['entry'].get().strip('- ')
|
||||
rpm = widgits['rpm']['entry'].get().strip()
|
||||
dur = widgits['dur']['entry'].get().strip()
|
||||
rc1 = widgits['rc1']['entry'].get().strip()
|
||||
rc2 = widgits['rc2']['entry'].get().strip()
|
||||
rc3 = widgits['rc3']['entry'].get().strip()
|
||||
rc4 = widgits['rc4']['entry'].get().strip()
|
||||
rc5 = widgits['rc5']['entry'].get().strip()
|
||||
rc6 = widgits['rc6']['entry'].get().strip()
|
||||
vel = widgits['vel']['optionmenu'].get()
|
||||
trq = widgits['trq']['optionmenu'].get()
|
||||
trqh = widgits['trqh']['optionmenu'].get()
|
||||
sub = self.menu_sub_dp.get()
|
||||
|
||||
c1 = exists(path)
|
||||
c2 = sub in ['max', 'avg', 'cycle']
|
||||
c3 = self.is_float('optional', rc, rpm)
|
||||
c4 = self.is_float('required', rc1, rc2, rc3, rc4, rc5, rc6)
|
||||
|
||||
c5 = c6 = True
|
||||
if sub == 'cycle':
|
||||
c5 = True if len({vel, trq}) == 2 else False
|
||||
c6 = self.is_float('optional', dur)
|
||||
|
||||
if c1 and c2 and c3 and c4 and c5 and c6:
|
||||
rcs = []
|
||||
for x in [rc1, rc2, rc3, rc4, rc5, rc6]:
|
||||
rcs.append(float(x))
|
||||
rc = 0 if rc == '' else rc
|
||||
dur = 0 if sub != 'cycle' or dur == '' else dur
|
||||
rpm = 0 if sub != 'cycle' or rpm == '' else rpm
|
||||
rcs.append(float(rc))
|
||||
return 2, path, sub, rcs, int(vel), int(trq), int(trqh), float(dur), float(rpm)
|
||||
elif tab_name == 'Automatic Test':
|
||||
func_name = self.menu_main_at.get()
|
||||
if func_name == 'brake':
|
||||
path = widgits_at['path']['entry'].get().strip()
|
||||
loadsel = widgits_at['loadsel']['optionmenu'].get()
|
||||
c1 = exists(path)
|
||||
c2 = loadsel in ['tool100', 'tool66', 'tool33']
|
||||
if c1 and c2:
|
||||
return 5, path, loadsel
|
||||
else:
|
||||
return 0, 0
|
||||
elif func_name == 'current':
|
||||
path = widgits_at['path']['entry'].get().strip()
|
||||
loadsel = widgits_at['loadsel']['optionmenu'].get()
|
||||
c1 = exists(path)
|
||||
c2 = loadsel in ['tool100', 'inertia']
|
||||
if c1 and c2:
|
||||
return 6, path, loadsel
|
||||
else:
|
||||
return 0, 0
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
elif func_name == 'iso':
|
||||
path = widgits['path']['entry'].get().strip()
|
||||
elif tab_name == 'Durable Action':
|
||||
path = widgits_da['path']['entry'].get().strip()
|
||||
curvesel = widgits_da['curvesel']['optionmenu'].get()
|
||||
c1 = exists(path)
|
||||
if c1:
|
||||
return 3, path
|
||||
c2 = curvesel in ['device_servo_trq_feedback', '[max] device_servo_trq_feedback']
|
||||
if c1 and c2:
|
||||
return 7, path, curvesel
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
elif func_name == 'wavelogger':
|
||||
path = widgits['path']['entry'].get().strip()
|
||||
c1 = exists(path)
|
||||
if c1:
|
||||
return 4, path
|
||||
else:
|
||||
return 0, 0
|
||||
# =======================================================
|
||||
else:
|
||||
return 0, 0
|
||||
|
||||
def func_start_callback(self):
|
||||
self.textbox.configure(state='normal')
|
||||
self.textbox.delete(index1='1.0', index2='end')
|
||||
|
||||
flag, *args = self.check_param()
|
||||
func_dict = {1: brake.main, 2: current.main, 3: iso.main, 4: wavelogger.main}
|
||||
func_dict = {
|
||||
1: brake.main, 2: current.main, 3: iso.main, 4: wavelogger.main, 5: do_brake.main, 6: do_current.main,
|
||||
7: factory_test.main
|
||||
}
|
||||
if flag == 1:
|
||||
func_dict[flag](path=args[0], av=args[1], rr=args[2], axis=args[3], vel=args[4], trq=args[5], estop=args[6], w2t=self.write2textbox)
|
||||
func_dict[flag](path=args[0], vel=args[1], trq=args[2], estop=args[3], w2t=self.write2textbox)
|
||||
elif flag == 2:
|
||||
func_dict[flag](path=args[0], sub=args[1], rcs=args[2], vel=args[3], trq=args[4], trqh=args[5], dur=args[6], rpm=args[7], w2t=self.write2textbox)
|
||||
func_dict[flag](path=args[0], sub=args[1], dur=args[2], vel=args[3], trq=args[4], trqh=args[5], w2t=self.write2textbox)
|
||||
elif flag == 3:
|
||||
func_dict[flag](path=args[0], w2t=self.write2textbox)
|
||||
elif flag == 4:
|
||||
func_dict[flag](path=args[0], w2t=self.write2textbox)
|
||||
elif flag == 5:
|
||||
self.pre_warning()
|
||||
func_dict[flag](path=args[0], hr=self.hr, md=self.md, loadsel=args[1], w2t=self.write2textbox)
|
||||
elif flag == 6:
|
||||
self.pre_warning()
|
||||
func_dict[flag](path=args[0], hr=self.hr, md=self.md, loadsel=args[1], w2t=self.write2textbox)
|
||||
elif flag == 7:
|
||||
self.pre_warning()
|
||||
func_dict[flag](path=args[0], hr=self.hr, md=self.md, w2t=self.write2textbox)
|
||||
else:
|
||||
tkinter.messagebox.showerror(title="参数错误", message="请检查对应参数是否填写正确!", )
|
||||
|
||||
self.textbox.configure(state='disabled')
|
||||
def pre_warning(self):
|
||||
if self.tabview.get() == 'Durable Action':
|
||||
df = DataFrame(durable_data_current)
|
||||
df.to_excel(durable_data_current_xlsx, index=False)
|
||||
df = DataFrame(durable_data_current_max)
|
||||
df.to_excel(durable_data_current_max_xlsx, index=False)
|
||||
|
||||
if tkinter.messagebox.askyesno(title="开始运行", message="确认机器已按照测试规范更新固件,并提按照测试机型前修改好工程?"):
|
||||
pass
|
||||
else:
|
||||
self.write2textbox("请按照测试规范更新机器固件,并在实际运行前确认工程已经修改完毕,以防撞机!!!", 0, 123, 'red', 'Automatic Test')
|
||||
|
||||
def func_check_callback(self):
|
||||
self.textbox.configure(state='normal')
|
||||
self.textbox.delete(index1='1.0', index2='end')
|
||||
|
||||
flag, *args = self.check_param()
|
||||
@ -342,8 +640,6 @@ class App(customtkinter.CTk):
|
||||
else:
|
||||
tkinter.messagebox.showerror(title="参数错误", message="需要检查对应参数是否填写正确!", )
|
||||
|
||||
self.textbox.configure(state='disabled')
|
||||
|
||||
def func_log_callback(self):
|
||||
content = self.textbox.get(index1='1.0', index2='end')
|
||||
if len(content) > 1:
|
||||
@ -367,4 +663,7 @@ class App(customtkinter.CTk):
|
||||
|
||||
if __name__ == "__main__":
|
||||
aio = App()
|
||||
aio.net_detect = Thread(target=aio.detect_network)
|
||||
aio.net_detect.daemon = True
|
||||
aio.net_detect.start()
|
||||
aio.mainloop()
|
||||
|
1
aio/code/automatic_test/__init__.py
Normal file
1
aio/code/automatic_test/__init__.py
Normal file
@ -0,0 +1 @@
|
||||
__all__ = ['btn_functions', 'do_brake', 'do_current']
|
73
aio/code/automatic_test/btn_functions.py
Normal file
73
aio/code/automatic_test/btn_functions.py
Normal file
@ -0,0 +1,73 @@
|
||||
from json import loads
|
||||
from sys import argv
|
||||
|
||||
|
||||
def execution(cmd, hr, w2t, **kwargs):
|
||||
_id = hr.execution(cmd, **kwargs)
|
||||
_msg = hr.get_from_id(_id)
|
||||
if not _msg:
|
||||
w2t(f"无法获取{_id}请求的响应信息", 0, 6, 'red', tab_name='Automatic Test')
|
||||
else:
|
||||
_response = loads(_msg)
|
||||
if not _response:
|
||||
w2t(f"无法获取{id}请求的响应信息", 0, 1, 'red', tab_name='Automatic Test')
|
||||
return _response
|
||||
|
||||
|
||||
def trigger_estop(md, w2t):
|
||||
md.trigger_estop()
|
||||
w2t("触发急停成功,可点击机器状态验证。", 0, 0, 'green', 'Automatic Test')
|
||||
|
||||
|
||||
def reset_estop(md, w2t):
|
||||
md.reset_estop()
|
||||
w2t("恢复急停成功,可点击机器状态验证。", 0, 0, 'green', 'Automatic Test')
|
||||
|
||||
|
||||
def get_state(hr, w2t):
|
||||
# 获取机器状态
|
||||
_response = execution('state.get_state', hr, w2t)
|
||||
stat_desc = {'engine': '上电状态', 'operate': '操作模式', 'rc_state': '控制器状态', 'robot_action': '机器人动作', 'safety_mode': '安全模式', 'servo_mode': '伺服工作模式', 'task_space': '工作任务空间'}
|
||||
for component, state in _response['data'].items():
|
||||
w2t(f"{stat_desc[component]}: {state}", tab_name='Automatic Test')
|
||||
|
||||
# 获取设备伺服信息
|
||||
_response = execution('device.get_params', hr, w2t)
|
||||
dev_desc = {0: '伺服版本', 1: '伺服参数', 2: '安全板固件', 3: '控制器', 4: '通讯总线', 5: '解释器', 6: '运动控制', 8: '力控版本', 9: '末端固件', 10: '机型文件', 11: '环境包'}
|
||||
dev_vers = {}
|
||||
for device in _response['data']['devices']:
|
||||
dev_vers[device['type']] = device['version']
|
||||
for i in sorted(dev_desc.keys()):
|
||||
w2t(f"{dev_desc[i]}: {dev_vers[i]}", tab_name='Automatic Test')
|
||||
|
||||
# 设置示教器模式
|
||||
_response = execution('state.set_tp_mode', hr, w2t, tp_mode='without')
|
||||
|
||||
|
||||
def warning_info(hr, w2t):
|
||||
for msg in hr.c_msg:
|
||||
if 'alarm' in msg.lower():
|
||||
w2t(str(loads(msg)), tab_name='Automatic Test')
|
||||
for msg in hr.c_msg_xs:
|
||||
if 'alarm' in msg.lower():
|
||||
w2t(str(loads(msg)), tab_name='Automatic Test')
|
||||
|
||||
|
||||
def main(hr, md, func, w2t):
|
||||
if hr is None:
|
||||
w2t("无法连接机器人,检查是否已经使用Robot Assist软件连接机器,重试中...", 0, 49, 'red', tab_name='Automatic Test')
|
||||
# func: get_state/
|
||||
match func:
|
||||
case 'trigger_estop':
|
||||
trigger_estop(md, w2t)
|
||||
case 'reset_estop':
|
||||
reset_estop(md, w2t)
|
||||
case 'get_state':
|
||||
get_state(hr, w2t)
|
||||
case 'warning_info':
|
||||
warning_info(hr, w2t)
|
||||
|
||||
|
||||
if __name__ == '__main__':
|
||||
main(*argv[1:])
|
||||
|
338
aio/code/automatic_test/do_brake.py
Normal file
338
aio/code/automatic_test/do_brake.py
Normal file
@ -0,0 +1,338 @@
|
||||
from time import sleep, time, strftime, localtime
|
||||
from sys import argv
|
||||
from os import scandir, mkdir
|
||||
from os.path import exists
|
||||
from paramiko import SSHClient, AutoAddPolicy
|
||||
from json import loads
|
||||
from openpyxl import load_workbook
|
||||
import pandas
|
||||
|
||||
RADIAN = 57.3 # 180 / 3.1415926
|
||||
tab_name = 'Automatic Test'
|
||||
|
||||
|
||||
def traversal_files(path, w2t):
|
||||
if not exists(path):
|
||||
msg = f'数据文件夹{path}不存在,请确认后重试......'
|
||||
w2t(msg, 0, 1, 'red', tab_name)
|
||||
else:
|
||||
dirs = []
|
||||
files = []
|
||||
for item in scandir(path):
|
||||
if item.is_dir():
|
||||
dirs.append(item.path)
|
||||
elif item.is_file():
|
||||
files.append(item.path)
|
||||
|
||||
return dirs, files
|
||||
|
||||
|
||||
def check_files(path, loadsel, data_dirs, data_files, w2t):
|
||||
if len(data_dirs) != 0 or len(data_files) != 5:
|
||||
w2t('初始路径下不允许有文件夹,且初始路径下只能存在如下五个文件,确认后重新运行!', 0, 0, 'red', tab_name)
|
||||
w2t(' 1. configs.xlsx\n 2. reach33/reach66/reach100_xxxx.xlsx\n 3. xxxx.zip', 0, 1, 'red', tab_name)
|
||||
|
||||
config_file = reach33 = reach66 = reach100 = prj_file = None
|
||||
for data_file in data_files:
|
||||
filename = data_file.split('\\')[-1]
|
||||
if filename == 'configs.xlsx':
|
||||
config_file = data_file
|
||||
elif filename.startswith('reach33_') and filename.endswith('.xlsx'):
|
||||
reach33 = data_file
|
||||
elif filename.startswith('reach66_') and filename.endswith('.xlsx'):
|
||||
reach66 = data_file
|
||||
elif filename.startswith('reach100_') and filename.endswith('.xlsx'):
|
||||
reach100 = data_file
|
||||
elif filename.endswith('.zip'):
|
||||
prj_file = data_file
|
||||
else:
|
||||
w2t('初始路径下不允许有文件夹,且初始路径下只能存在如下五个文件,确认后重新运行!', 0, 0, 'red', tab_name)
|
||||
w2t(' 1. configs.xlsx\n 2. reach33/reach66/reach100_xxxx.xlsx\n 3. xxxx.zip', 0, 2, 'red', tab_name)
|
||||
|
||||
if config_file and reach33 and reach66 and reach100 and prj_file:
|
||||
result_dirs = []
|
||||
mkdir(f"{path}\\j1")
|
||||
mkdir(f"{path}\\j2")
|
||||
mkdir(f"{path}\\j3")
|
||||
|
||||
for _reach in ['reach33', 'reach66', 'reach100']:
|
||||
for _load in [f'load{loadsel.removeprefix("tool")}']:
|
||||
for _speed in ['speed33', 'speed66', 'speed100']:
|
||||
dir_name = '_'.join([_reach, _load, _speed])
|
||||
result_dirs.append(dir_name)
|
||||
mkdir(f"{path}\\j1\\{dir_name}")
|
||||
mkdir(f"{path}\\j2\\{dir_name}")
|
||||
if _reach == 'reach100':
|
||||
mkdir(f"{path}\\j3\\{dir_name}")
|
||||
|
||||
w2t("数据目录合规性检查结束,未发现问题......", 0, 0, 'blue', tab_name)
|
||||
return config_file, reach33, reach66, reach100, prj_file, result_dirs
|
||||
else:
|
||||
w2t('初始路径下不允许有文件夹,且初始路径下只能存在如下五个文件,确认后重新运行!', 0, 0, 'red', tab_name)
|
||||
w2t(' 1. configs.xlsx\n 2. reach33/reach66/reach100_xxxx.xlsx\n 3. xxxx.zip', 0, 1, 'red', tab_name)
|
||||
|
||||
|
||||
def prj_to_xcore(prj_file):
|
||||
ssh = SSHClient()
|
||||
ssh.set_missing_host_key_policy(AutoAddPolicy())
|
||||
ssh.connect('192.168.0.160', 22, username='luoshi', password='luoshi2019')
|
||||
sftp = ssh.open_sftp()
|
||||
sftp.put(prj_file, '/tmp/target.zip')
|
||||
cmd = 'cd /tmp; rm -rf target/; mkdir target; unzip -d target/ -q target.zip; '
|
||||
cmd += 'chmod 777 -R target/; rm target.zip'
|
||||
ssh.exec_command(cmd)
|
||||
|
||||
cmd = 'sudo rm -rf /home/luoshi/bin/controller/projects/target; '
|
||||
cmd += 'sudo mv /tmp/target/ /home/luoshi/bin/controller/projects/'
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
|
||||
cmd = 'cd /home/luoshi/bin/controller/; '
|
||||
cmd += 'sudo mv projects/target/_build/*.prj projects/target/_build/target.prj'
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
ssh.close()
|
||||
|
||||
|
||||
def execution(cmd, hr, w2t, **kwargs):
|
||||
_id = hr.execution(cmd, **kwargs)
|
||||
_msg = hr.get_from_id(_id)
|
||||
if not _msg:
|
||||
w2t(f"无法获取{_id}请求的响应信息", 0, 6, 'red', tab_name)
|
||||
else:
|
||||
_response = loads(_msg)
|
||||
if not _response:
|
||||
w2t(f"无法获取{id}请求的响应信息", 0, 1, 'red', tab_name)
|
||||
return _response
|
||||
|
||||
|
||||
def gen_result_file(path, curve_data, axis, _reach, _load, _speed, count):
|
||||
_d2d_vel = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq = {'device_servo_trq_feedback': []}
|
||||
_d2d_stop = {'device_safety_estop': []}
|
||||
for data in curve_data:
|
||||
dict_results = data['data']
|
||||
for item in dict_results:
|
||||
try:
|
||||
item['value'].reverse()
|
||||
except KeyError:
|
||||
continue
|
||||
if item.get('channel', None) == axis-1 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == axis-1 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq['device_servo_trq_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 0 and item.get('name', None) == 'device_safety_estop':
|
||||
_d2d_stop['device_safety_estop'].extend(item['value'])
|
||||
if len(_d2d_trq['device_servo_trq_feedback']) / 1000 > 10:
|
||||
break
|
||||
|
||||
df1 = pandas.DataFrame.from_dict(_d2d_vel)
|
||||
df2 = pandas.DataFrame.from_dict(_d2d_trq)
|
||||
df3 = pandas.DataFrame.from_dict(_d2d_stop)
|
||||
df = pandas.concat([df1, df2, df3], axis=1)
|
||||
_filename = f"{path}\\j{axis}\\reach{_reach}_load{_load}_speed{_speed}\\reach{_reach}_load{_load}_speed{_speed}_{count}.data"
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
|
||||
def run_rl(path, loadsel, hr, md, config_file, result_dirs, w2t):
|
||||
_count = 0
|
||||
display_pdo_params = [
|
||||
{"name": "hw_joint_vel_feedback", "channel": 0},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 1},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 2},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 3},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 4},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 5},
|
||||
{"name": "device_servo_trq_feedback", "channel": 0},
|
||||
{"name": "device_servo_trq_feedback", "channel": 1},
|
||||
{"name": "device_servo_trq_feedback", "channel": 2},
|
||||
{"name": "device_servo_trq_feedback", "channel": 3},
|
||||
{"name": "device_servo_trq_feedback", "channel": 4},
|
||||
{"name": "device_servo_trq_feedback", "channel": 5},
|
||||
{"name": "device_safety_estop", "channel": 0},
|
||||
]
|
||||
wb = load_workbook(config_file, read_only=True)
|
||||
ws = wb['Target']
|
||||
write_diagnosis = float(ws.cell(row=3, column=10).value)
|
||||
get_init_speed = float(ws.cell(row=4, column=10).value)
|
||||
if ws.cell(row=1, column=1).value == 'positive':
|
||||
md.write_pon(1)
|
||||
elif ws.cell(row=1, column=1).value == 'negative':
|
||||
md.write_pon(0)
|
||||
else:
|
||||
w2t("configs.xlsx中Target页面A1单元格填写不正确,检查后重新运行...", 0, 111, 'red', tab_name)
|
||||
|
||||
_response = execution('diagnosis.open', hr, w2t, open=True, display_open=True)
|
||||
_response = execution('diagnosis.set_params', hr, w2t, display_pdo_params=display_pdo_params)
|
||||
for condition in result_dirs:
|
||||
_reach = condition.split('_')[0].removeprefix('reach')
|
||||
_load = condition.split('_')[1].removeprefix('load')
|
||||
_speed = condition.split('_')[2].removeprefix('speed')
|
||||
# if _speed != '100' or _reach != '100':
|
||||
# continue
|
||||
for axis in range(1, 4):
|
||||
md.write_axis(axis)
|
||||
speed_max = 0
|
||||
if axis == 3 and _reach != '100':
|
||||
continue
|
||||
|
||||
w2t(f"-"*90, 0, 0, 'purple', tab_name)
|
||||
|
||||
for count in range(1, 4):
|
||||
_count += 1
|
||||
this_time = strftime("%Y-%m-%d %H:%M:%S", localtime(time()))
|
||||
prj_path = 'target/_build/target.prj'
|
||||
w2t(f"[{this_time} | {_count}/63] 正在执行 {axis} 轴 {condition} 的第 {count} 次制动测试...", 0, 0, 'purple', tab_name)
|
||||
|
||||
# 1. 关闭诊断曲线,触发软急停,并解除,目的是让可能正在运行着的机器停下来,切手动模式并下电
|
||||
md.trigger_estop()
|
||||
md.reset_estop()
|
||||
md.clear_alarm()
|
||||
md.write_act(0)
|
||||
sleep(write_diagnosis) # 软急停超差后,等待写诊断时间,可通过configs.xlsx配置
|
||||
|
||||
while count == 1:
|
||||
# 2. 修改未要执行的场景
|
||||
ssh = SSHClient()
|
||||
ssh.set_missing_host_key_policy(AutoAddPolicy())
|
||||
ssh.connect('192.168.0.160', 22, username='luoshi', password='luoshi2019')
|
||||
if ws.cell(row=1, column=1).value == 'positive':
|
||||
_rl_cmd = f"brake_E(j{axis}_{_reach}_p, j{axis}_{_reach}_n, p_speed, p_tool)"
|
||||
elif ws.cell(row=1, column=1).value == 'negative':
|
||||
_rl_cmd = f"brake_E(j{axis}_{_reach}_n, j{axis}_{_reach}_p, p_speed, p_tool)"
|
||||
else:
|
||||
w2t("configs.xlsx中Target页面A1单元格填写不正确,检查后重新运行...", 0, 111, 'red', tab_name)
|
||||
_rl_speed = f"VelSet {_speed}"
|
||||
_rl_tool = f"tool p_tool = tool{loadsel.removeprefix('tool')}"
|
||||
cmd = 'cd /home/luoshi/bin/controller/; '
|
||||
cmd += 'sudo sed -i "/brake_E/d" projects/target/_build/brake/main.mod; '
|
||||
cmd += f'sudo sed -i "/DONOTDELETE/i {_rl_cmd}" projects/target/_build/brake/main.mod; '
|
||||
cmd += 'sudo sed -i "/VelSet/d" projects/target/_build/brake/main.mod; '
|
||||
cmd += f'sudo sed -i "/MoveAbsJ/i {_rl_speed}" projects/target/_build/brake/main.mod; '
|
||||
cmd += 'sudo sed -i "/tool p_tool/d" projects/target/_build/brake/main.mod; '
|
||||
cmd += f'sudo sed -i "/VelSet/i {_rl_tool}" projects/target/_build/brake/main.mod; '
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
|
||||
# 3. reload工程后,pp2main,并且自动模式和上电,最后运行程序
|
||||
_response = execution('overview.reload', hr, w2t, prj_path=prj_path, tasks=['brake', 'stop0_related'])
|
||||
_response = execution('rl_task.pp_to_main', hr, w2t, tasks=['brake', 'stop0_related'])
|
||||
_response = execution('state.switch_auto', hr, w2t)
|
||||
_response = execution('state.switch_motor_on', hr, w2t)
|
||||
_response = execution('rl_task.run', hr, w2t, tasks=['brake', 'stop0_related'])
|
||||
_t_start = time()
|
||||
while True:
|
||||
if md.read_ready_to_go() == 1:
|
||||
md.write_act(True)
|
||||
break
|
||||
else:
|
||||
if (time() - _t_start) // 20 > 1:
|
||||
w2t("20s内未收到机器人的运行信号,需要确认RL程序编写正确并正常执行...", 0, 111, 'red', tab_name)
|
||||
else:
|
||||
sleep(1)
|
||||
# 4. 打开诊断曲线,并执行采集,之后触发软急停,关闭曲线采集,找出最大速度,传递给RL程序,最后清除相关记录
|
||||
sleep(get_init_speed) # 获取实际最大速度,可通过configs.xlsx配置
|
||||
_response = execution('rl_task.stop', hr, w2t, tasks=['brake'])
|
||||
# sleep(1)
|
||||
# 找出最大速度
|
||||
_c_msg = hr.c_msg.copy()
|
||||
for _msg in _c_msg:
|
||||
if 'diagnosis.result' in _msg:
|
||||
dict_results = loads(_msg)['data']
|
||||
for item in dict_results:
|
||||
if item.get('channel', None) == axis-1 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_ = RADIAN * sum(item['value']) / len(item['value'])
|
||||
if ws.cell(row=1, column=1).value == 'positive':
|
||||
speed_max = max(_, speed_max)
|
||||
elif ws.cell(row=1, column=1).value == 'negative':
|
||||
speed_max = min(_, speed_max)
|
||||
print(f"speed max = {speed_max}")
|
||||
speed_max = abs(speed_max)
|
||||
speed_target = float(ws.cell(row=3, column=axis+1).value) * float(_speed) / 100
|
||||
if speed_max < speed_target*0.95 or speed_max > speed_target*1.05:
|
||||
w2t(f"Axis: {axis}-{count} | Speed: {speed_max} | Shouldbe: {speed_target}", 0, 0, 'indigo', tab_name)
|
||||
|
||||
md.write_speed_max(speed_max)
|
||||
|
||||
hr.c_msg_xs.clear()
|
||||
if len(hr.c_msg) > 240:
|
||||
del hr.c_msg[240:]
|
||||
|
||||
if speed_max < 10:
|
||||
md.clear_alarm()
|
||||
w2t("未获取到正确的速度,即将重新获取...", 0, 0, 'red', tab_name)
|
||||
continue
|
||||
else:
|
||||
break
|
||||
|
||||
# 5. 清除软急停,重新运行程序,并打开曲线发送继续运动信号,当速度达到最大值时,通过DO触发急停
|
||||
md.reset_estop() # 其实没必要
|
||||
md.clear_alarm()
|
||||
|
||||
_response = execution('overview.reload', hr, w2t, prj_path=prj_path, tasks=['brake', 'stop0_related'])
|
||||
_response = execution('rl_task.pp_to_main', hr, w2t, tasks=['brake', 'stop0_related'])
|
||||
_response = execution('state.switch_auto', hr, w2t)
|
||||
_response = execution('state.switch_motor_on', hr, w2t)
|
||||
_response = execution('rl_task.run', hr, w2t, tasks=['brake', 'stop0_related'])
|
||||
for i in range(3):
|
||||
if md.read_ready_to_go() == 1:
|
||||
md.write_act(1)
|
||||
break
|
||||
else:
|
||||
sleep(1)
|
||||
else:
|
||||
w2t("未收到机器人的运行信号,需要确认RL程序编写正确并正常执行...", 0, 111, 'red', tab_name)
|
||||
|
||||
sleep(10) # 排除从其他位姿到零点位姿,再到轴极限位姿的时间
|
||||
md.write_probe(1)
|
||||
_t_start = time()
|
||||
while True:
|
||||
if md.read_brake_done() == 1:
|
||||
sleep(1) # 保证速度归零
|
||||
md.write_probe(0)
|
||||
break
|
||||
else:
|
||||
if (time() - _t_start) > 30:
|
||||
w2t(f"30s内未触发急停,该条数据无效,需要确认RL/Python程序编写正确并正常执行,或者判别是否是机器本体问题,比如正负方向速度是否一致...", 0, 0, 'red', tab_name)
|
||||
md.write_probe(0)
|
||||
break
|
||||
else:
|
||||
sleep(1)
|
||||
|
||||
# 6. 保留数据并处理输出
|
||||
curve_data = []
|
||||
_c_msg = hr.c_msg.copy()
|
||||
for _msg in _c_msg:
|
||||
if 'diagnosis.result' in _msg:
|
||||
curve_data.insert(0, loads(_msg))
|
||||
else:
|
||||
hr.c_msg_xs.clear()
|
||||
if len(hr.c_msg) > 240:
|
||||
del hr.c_msg[240:]
|
||||
gen_result_file(path, curve_data, axis, _reach, _load, _speed, count)
|
||||
else:
|
||||
w2t(f"\n{loadsel.removeprefix('tool')}%负载的制动性能测试执行完毕,如需采集其他负载,须切换负载类型,并更换其他负载,重新执行。", 0, 0, 'green', tab_name)
|
||||
|
||||
|
||||
def main(path, hr, md, loadsel, w2t):
|
||||
_s_time = time()
|
||||
data_dirs, data_files = traversal_files(path, w2t)
|
||||
config_file, reach33, reach66, reach100, prj_file, result_dirs = check_files(path, loadsel, data_dirs, data_files, w2t)
|
||||
prj_to_xcore(prj_file)
|
||||
run_rl(path, loadsel, hr, md, config_file, result_dirs, w2t)
|
||||
_e_time = time()
|
||||
time_total = _e_time - _s_time
|
||||
w2t(f"处理总时长:{time_total // 3600:02.0f} h {time_total % 3600 // 60:02.0f} m {time_total % 60:02.0f} s", 0, 0, 'green', tab_name)
|
||||
|
||||
|
||||
if __name__ == '__main__':
|
||||
main(*argv[1:])
|
409
aio/code/automatic_test/do_current.py
Normal file
409
aio/code/automatic_test/do_current.py
Normal file
@ -0,0 +1,409 @@
|
||||
import os
|
||||
from time import sleep, time
|
||||
from sys import argv
|
||||
from os import scandir
|
||||
from os.path import exists
|
||||
from paramiko import SSHClient, AutoAddPolicy
|
||||
from json import loads
|
||||
import pandas
|
||||
|
||||
display_pdo_params = [
|
||||
{"name": "hw_joint_vel_feedback", "channel": 0},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 1},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 2},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 3},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 4},
|
||||
{"name": "hw_joint_vel_feedback", "channel": 5},
|
||||
{"name": "device_servo_trq_feedback", "channel": 0},
|
||||
{"name": "device_servo_trq_feedback", "channel": 1},
|
||||
{"name": "device_servo_trq_feedback", "channel": 2},
|
||||
{"name": "device_servo_trq_feedback", "channel": 3},
|
||||
{"name": "device_servo_trq_feedback", "channel": 4},
|
||||
{"name": "device_servo_trq_feedback", "channel": 5},
|
||||
]
|
||||
|
||||
def traversal_files(path, w2t):
|
||||
if not exists(path):
|
||||
msg = f'数据文件夹{path}不存在,请确认后重试......'
|
||||
w2t(msg, 0, 1, 'red', tab_name='Automatic Test')
|
||||
else:
|
||||
dirs = []
|
||||
files = []
|
||||
for item in scandir(path):
|
||||
if item.is_dir():
|
||||
dirs.append(item.path)
|
||||
elif item.is_file():
|
||||
files.append(item.path)
|
||||
|
||||
return dirs, files
|
||||
|
||||
|
||||
def check_files(path, loadsel, data_dirs, data_files, w2t):
|
||||
if len(data_dirs) != 0 or len(data_files) != 3:
|
||||
w2t('初始路径下不允许有文件夹,且初始路径下只能存在如下三个文件,确认后重新运行!', 0, 0, 'red', tab_name='Automatic Test')
|
||||
w2t(' 1. configs.xlsx\n 2. T_电机电流.xlsx\n 3. xxxx.zip', 0, 1, 'red', tab_name='Automatic Test')
|
||||
|
||||
config_file = current_file = prj_file = None
|
||||
for data_file in data_files:
|
||||
filename = data_file.split('\\')[-1]
|
||||
if filename == 'configs.xlsx':
|
||||
config_file = data_file
|
||||
elif filename == 'T_电机电流.xlsx':
|
||||
current_file = data_file
|
||||
elif filename.endswith('.zip'):
|
||||
prj_file = data_file
|
||||
else:
|
||||
w2t('初始路径下不允许有文件夹,且初始路径下只能存在如下三个文件,确认后重新运行!', 0, 0, 'red', tab_name='Automatic Test')
|
||||
w2t(' 1. configs.xlsx\n 2. T_电机电流.xlsx\n 3. xxxx.zip', 0, 1, 'red', tab_name='Automatic Test')
|
||||
|
||||
if config_file and current_file and prj_file:
|
||||
w2t("数据目录合规性检查结束,未发现问题......", tab_name='Automatic Test')
|
||||
if loadsel == 'tool100':
|
||||
os.mkdir(f"{path}\\single")
|
||||
os.mkdir(f"{path}\\s_1")
|
||||
os.mkdir(f"{path}\\s_2")
|
||||
os.mkdir(f"{path}\\s_3")
|
||||
elif loadsel == 'inertia':
|
||||
os.mkdir(f"{path}\\inertia")
|
||||
return config_file, current_file, prj_file
|
||||
else:
|
||||
w2t('初始路径下不允许有文件夹,且初始路径下只能存在如下三个文件,确认后重新运行!', 0, 0, 'red', tab_name='Automatic Test')
|
||||
w2t(' 1. configs.xlsx\n 2. T_电机电流.xlsx\n 3. xxxx.zip', 0, 1, 'red', tab_name='Automatic Test')
|
||||
|
||||
|
||||
def prj_to_xcore(prj_file):
|
||||
ssh = SSHClient()
|
||||
ssh.set_missing_host_key_policy(AutoAddPolicy())
|
||||
ssh.connect('192.168.0.160', 22, username='luoshi', password='luoshi2019')
|
||||
sftp = ssh.open_sftp()
|
||||
sftp.put(prj_file, '/tmp/target.zip')
|
||||
cmd = 'cd /tmp; rm -rf target/; mkdir target; unzip -d target/ -q target.zip; '
|
||||
cmd += 'chmod 777 -R target/; rm target.zip'
|
||||
ssh.exec_command(cmd)
|
||||
|
||||
cmd = 'sudo rm -rf /home/luoshi/bin/controller/projects/target; '
|
||||
cmd += 'sudo mv /tmp/target/ /home/luoshi/bin/controller/projects/'
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
|
||||
cmd = 'cd /home/luoshi/bin/controller/; '
|
||||
cmd += 'sudo mv projects/target/_build/*.prj projects/target/_build/target.prj'
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
ssh.close()
|
||||
|
||||
|
||||
def execution(cmd, hr, w2t, **kwargs):
|
||||
_id = hr.execution(cmd, **kwargs)
|
||||
_msg = hr.get_from_id(_id)
|
||||
if not _msg:
|
||||
w2t(f"无法获取{_id}请求的响应信息", 0, 7, 'red', tab_name='Automatic Test')
|
||||
else:
|
||||
_response = loads(_msg)
|
||||
if not _response:
|
||||
w2t(f"无法获取{id}请求的响应信息", 0, 1, 'red', tab_name='Automatic Test')
|
||||
return _response
|
||||
|
||||
|
||||
def data_proc_regular(path, filename, channel, scenario_time):
|
||||
if channel in list(range(6)):
|
||||
with open(filename, 'r', encoding='utf-8') as f_obj:
|
||||
lines = f_obj.readlines()
|
||||
_d2d_vel = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq = {'device_servo_trq_feedback': []}
|
||||
for line in lines:
|
||||
data = eval(line.strip())['data']
|
||||
for item in data:
|
||||
try:
|
||||
item['value'].reverse()
|
||||
except KeyError:
|
||||
continue
|
||||
if item.get('channel', None) == channel and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == channel and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq['device_servo_trq_feedback'].extend(item['value'])
|
||||
|
||||
df1 = pandas.DataFrame.from_dict(_d2d_vel)
|
||||
df2 = pandas.DataFrame.from_dict(_d2d_trq)
|
||||
df = pandas.concat([df1, df2], axis=1)
|
||||
_filename = f'{path}\\single\\j{channel+1}_single_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
elif channel in list(range(6, 9)):
|
||||
with open(filename, 'r', encoding='utf-8') as f_obj:
|
||||
lines = f_obj.readlines()
|
||||
_d2d_vel_0 = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq_0 = {'device_servo_trq_feedback': []}
|
||||
_d2d_vel_1 = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq_1 = {'device_servo_trq_feedback': []}
|
||||
_d2d_vel_2 = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq_2 = {'device_servo_trq_feedback': []}
|
||||
_d2d_vel_3 = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq_3 = {'device_servo_trq_feedback': []}
|
||||
_d2d_vel_4 = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq_4 = {'device_servo_trq_feedback': []}
|
||||
_d2d_vel_5 = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq_5 = {'device_servo_trq_feedback': []}
|
||||
for line in lines:
|
||||
data = eval(line.strip())['data']
|
||||
for item in data:
|
||||
try:
|
||||
item['value'].reverse()
|
||||
except KeyError:
|
||||
continue
|
||||
if item.get('channel', None) == 0 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel_0['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 0 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq_0['device_servo_trq_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 1 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel_1['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 1 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq_1['device_servo_trq_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 2 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel_2['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 2 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq_2['device_servo_trq_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 3 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel_3['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 3 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq_3['device_servo_trq_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 4 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel_4['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 4 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq_4['device_servo_trq_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 5 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel_5['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == 5 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq_5['device_servo_trq_feedback'].extend(item['value'])
|
||||
|
||||
df_01 = pandas.DataFrame.from_dict(_d2d_vel_0)
|
||||
df_02 = pandas.DataFrame.from_dict(_d2d_trq_0)
|
||||
df = pandas.concat([df_01, df_02], axis=1)
|
||||
_filename = f'{path}\\s_{channel-5}\\j1_s_{channel-5}_{scenario_time}_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
df_01 = pandas.DataFrame.from_dict(_d2d_vel_1)
|
||||
df_02 = pandas.DataFrame.from_dict(_d2d_trq_1)
|
||||
df = pandas.concat([df_01, df_02], axis=1)
|
||||
_filename = f'{path}\\s_{channel-5}\\j2_s_{channel-5}_{scenario_time}_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
df_01 = pandas.DataFrame.from_dict(_d2d_vel_2)
|
||||
df_02 = pandas.DataFrame.from_dict(_d2d_trq_2)
|
||||
df = pandas.concat([df_01, df_02], axis=1)
|
||||
_filename = f'{path}\\s_{channel-5}\\j3_s_{channel-5}_{scenario_time}_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
df_01 = pandas.DataFrame.from_dict(_d2d_vel_3)
|
||||
df_02 = pandas.DataFrame.from_dict(_d2d_trq_3)
|
||||
df = pandas.concat([df_01, df_02], axis=1)
|
||||
_filename = f'{path}\\s_{channel-5}\\j4_s_{channel-5}_{scenario_time}_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
df_01 = pandas.DataFrame.from_dict(_d2d_vel_4)
|
||||
df_02 = pandas.DataFrame.from_dict(_d2d_trq_4)
|
||||
df = pandas.concat([df_01, df_02], axis=1)
|
||||
_filename = f'{path}\\s_{channel-5}\\j5_s_{channel-5}_{scenario_time}_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
df_01 = pandas.DataFrame.from_dict(_d2d_vel_5)
|
||||
df_02 = pandas.DataFrame.from_dict(_d2d_trq_5)
|
||||
df = pandas.concat([df_01, df_02], axis=1)
|
||||
_filename = f'{path}\\s_{channel-5}\\j6_s_{channel-5}_{scenario_time}_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
elif channel in list(range(9, 15)):
|
||||
with open(filename, 'r', encoding='utf-8') as f_obj:
|
||||
lines = f_obj.readlines()
|
||||
_d2d_vel = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq = {'device_servo_trq_feedback': []}
|
||||
for line in lines:
|
||||
data = eval(line.strip())['data']
|
||||
for item in data:
|
||||
try:
|
||||
item['value'].reverse()
|
||||
except KeyError:
|
||||
continue
|
||||
if item.get('channel', None) == channel-9 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == channel-9 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq['device_servo_trq_feedback'].extend(item['value'])
|
||||
|
||||
df1 = pandas.DataFrame.from_dict(_d2d_vel)
|
||||
df2 = pandas.DataFrame.from_dict(_d2d_trq)
|
||||
df = pandas.concat([df1, df2], axis=1)
|
||||
_filename = f'{path}\\single\\j{channel-8}_hold_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
|
||||
def data_proc_inertia(path, filename, channel):
|
||||
with open(filename, 'r', encoding='utf-8') as f_obj:
|
||||
lines = f_obj.readlines()
|
||||
_d2d_vel = {'hw_joint_vel_feedback': []}
|
||||
_d2d_trq = {'device_servo_trq_feedback': []}
|
||||
for line in lines:
|
||||
data = eval(line.strip())['data']
|
||||
for item in data:
|
||||
try:
|
||||
item['value'].reverse()
|
||||
except KeyError:
|
||||
continue
|
||||
if item.get('channel', None) == channel+3 and item.get('name', None) == 'hw_joint_vel_feedback':
|
||||
_d2d_vel['hw_joint_vel_feedback'].extend(item['value'])
|
||||
elif item.get('channel', None) == channel+3 and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq['device_servo_trq_feedback'].extend(item['value'])
|
||||
|
||||
df1 = pandas.DataFrame.from_dict(_d2d_vel)
|
||||
df2 = pandas.DataFrame.from_dict(_d2d_trq)
|
||||
df = pandas.concat([df1, df2], axis=1)
|
||||
_filename = f'{path}\\inertia\\j{channel+4}_inertia_{time()}.data'
|
||||
df.to_csv(_filename, sep='\t', index=False)
|
||||
|
||||
|
||||
def gen_result_file(path, loadsel, disc, number, scenario_time):
|
||||
filename = path + f'\\data.txt'
|
||||
with open(filename, 'w', encoding='utf-8') as f_obj:
|
||||
for line in disc[number][1]:
|
||||
f_obj.write(str(line)+'\n')
|
||||
|
||||
if loadsel == 'tool100':
|
||||
data_proc_regular(path, filename, number, scenario_time)
|
||||
elif loadsel == 'inertia':
|
||||
data_proc_inertia(path, filename, number)
|
||||
|
||||
|
||||
def run_rl(path, hr, md, loadsel, w2t):
|
||||
c_regular = [
|
||||
"scenario(0, j1_p, j1_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(0, j2_p, j2_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(0, j3_p, j3_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(0, j4_p, j4_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(0, j5_p, j5_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(0, j6_p, j6_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(1, j6_p, j6_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(2, j6_p, j6_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(3, j6_p, j6_n, p_speed, p_tool, i_tool)",
|
||||
"scenario(4, j1_hold, j1_hold, p_speed, p_tool, i_tool)",
|
||||
"scenario(4, j2_hold, j2_hold, p_speed, p_tool, i_tool)",
|
||||
"scenario(4, j3_hold, j3_hold, p_speed, p_tool, i_tool)",
|
||||
"scenario(4, j4_hold, j4_hold, p_speed, p_tool, i_tool)",
|
||||
"scenario(4, j5_hold, j5_hold, p_speed, p_tool, i_tool)",
|
||||
"scenario(4, j6_hold, j6_hold, p_speed, p_tool, i_tool)",
|
||||
]
|
||||
c_inertia = [
|
||||
"scenario(5, j4_p_inertia, j4_n_inertia, p_speed, p_tool, i_tool)",
|
||||
"scenario(5, j5_p_inertia, j5_n_inertia, p_speed, p_tool, i_tool)",
|
||||
"scenario(5, j6_p_inertia, j6_n_inertia, p_speed, p_tool, i_tool)",
|
||||
]
|
||||
disc_regular = {
|
||||
0: ['一轴', []], 1: ['二轴', []], 2: ['三轴', []], 3: ['四轴', []], 4: ['五轴', []], 5: ['六轴', []],
|
||||
6: ['场景一', []], 7: ['场景二', []], 8: ['场景三', []], 9: ['一轴保持', []], 10: ['二轴保持', []],
|
||||
11: ['三轴保持', []], 12: ['四轴保持', []], 13: ['五轴保持', []], 14: ['六轴保持', []]
|
||||
}
|
||||
disc_inertia = {0: ['四轴惯量', []], 1: ['五轴惯量', []], 2: ['六轴惯量', []]}
|
||||
if loadsel == 'tool100':
|
||||
conditions = c_regular
|
||||
disc = disc_regular
|
||||
elif loadsel == 'inertia':
|
||||
conditions = c_inertia
|
||||
disc = disc_inertia
|
||||
|
||||
# preparation 触发软急停,并解除,目的是让可能正在运行着的机器停下来
|
||||
_response = execution('diagnosis.open', hr, w2t, open=True, display_open=True)
|
||||
_response = execution('diagnosis.set_params', hr, w2t, display_pdo_params=display_pdo_params)
|
||||
# _response = execution('diagnosis.save', hr, w2t, save=True) # 这条命令有问题
|
||||
md.trigger_estop()
|
||||
md.reset_estop()
|
||||
|
||||
for condition in conditions:
|
||||
number = conditions.index(condition)
|
||||
w2t(f"正在执行{disc[number][0]}测试......", 0, 0, 'purple', 'Automatic Test')
|
||||
|
||||
# 1. 将act重置为False,并修改未要执行的场景
|
||||
md.write_act(False)
|
||||
ssh = SSHClient()
|
||||
ssh.set_missing_host_key_policy(AutoAddPolicy())
|
||||
ssh.connect('192.168.0.160', 22, username='luoshi', password='luoshi2019')
|
||||
cmd = 'cd /home/luoshi/bin/controller/; '
|
||||
cmd += 'sudo sed -i "/scenario/d" projects/target/_build/current/main.mod; '
|
||||
cmd += f'sudo sed -i "/DONOTDELETE/i {condition}" projects/target/_build/current/main.mod'
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
|
||||
# 2. reload工程后,pp2main,并且自动模式和上电
|
||||
prj_path = 'target/_build/target.prj'
|
||||
_response = execution('overview.reload', hr, w2t, prj_path=prj_path, tasks=['current'])
|
||||
_response = execution('rl_task.pp_to_main', hr, w2t, tasks=['current'])
|
||||
_response = execution('state.switch_auto', hr, w2t)
|
||||
_response = execution('state.switch_motor_on', hr, w2t)
|
||||
|
||||
# 3. 开始运行程序,单轴运行35s
|
||||
_response = execution('rl_task.run', hr, w2t, tasks=['current'])
|
||||
_t_start = time()
|
||||
while True:
|
||||
if md.read_ready_to_go() == 1:
|
||||
md.write_act(True)
|
||||
break
|
||||
else:
|
||||
if (time() - _t_start) // 20 > 1:
|
||||
w2t("20s内未收到机器人的运行信号,需要确认RL程序编写正确并正常执行...", 0, 111, 'red', 'Automatic Test')
|
||||
else:
|
||||
sleep(1)
|
||||
|
||||
# 4. 打开诊断曲线,并执行采集
|
||||
sleep(10) # 保证程序已经运行起来,其实主要是为了保持电流的采集而设定
|
||||
scenario_time = 0
|
||||
if number < 6:
|
||||
sleep(35)
|
||||
elif number > 8:
|
||||
sleep(15)
|
||||
else:
|
||||
_t_start = time()
|
||||
while True:
|
||||
scenario_time = md.read_scenario_time()
|
||||
if float(scenario_time) > 1:
|
||||
w2t(f"场景{number-5}的周期时间:{scenario_time}", 0, 0, 'green', 'Automatic Test')
|
||||
break
|
||||
else:
|
||||
if (time()-_t_start)//60 > 3:
|
||||
w2t(f"未收到场景{number-5}的周期时间,需要确认RL程序编写正确并正常执行...", 0, 111, 'red', 'Automatic Test')
|
||||
else:
|
||||
sleep(5)
|
||||
sleep(1) # 一定要延迟一秒再读一次scenario time寄存器,因为一开始读取的数值不准确
|
||||
scenario_time = md.read_scenario_time()
|
||||
sleep(float(scenario_time)*0.2) # 再运行周期的20%即可
|
||||
|
||||
# 5.停止程序运行,保留数据并处理输出
|
||||
_response = execution('rl_task.stop', hr, w2t, tasks=['current'])
|
||||
_c_msg = hr.c_msg.copy()
|
||||
for _msg in _c_msg:
|
||||
if 'diagnosis.result' in _msg:
|
||||
disc[number][1].insert(0, loads(_msg))
|
||||
else:
|
||||
hr.c_msg_xs.clear()
|
||||
if len(hr.c_msg) > 240:
|
||||
del hr.c_msg[240:]
|
||||
gen_result_file(path, loadsel, disc, number, scenario_time)
|
||||
else:
|
||||
if loadsel == 'tool100':
|
||||
w2t("单轴和场景电机电流采集完毕,如需采集惯量负载,须切换负载类型,并更换惯量负载,重新执行。", 0, 0, 'green', 'Automatic Test')
|
||||
elif loadsel == 'inertia':
|
||||
w2t("惯量负载电机电流采集完毕,如需采集单轴/场景/保持电机电流,须切换负载类型,并更换偏置负载,重新执行。", 0, 0, 'green', 'Automatic Test')
|
||||
|
||||
|
||||
def main(path, hr, md, loadsel, w2t):
|
||||
data_dirs, data_files = traversal_files(path, w2t)
|
||||
config_file, current_file, prj_file = check_files(path, loadsel, data_dirs, data_files, w2t)
|
||||
prj_to_xcore(prj_file)
|
||||
run_rl(path, hr, md, loadsel, w2t)
|
||||
|
||||
|
||||
if __name__ == '__main__':
|
||||
main(*argv[1:])
|
1
aio/code/data_process/__init__.py
Normal file
1
aio/code/data_process/__init__.py
Normal file
@ -0,0 +1 @@
|
||||
__all__ = ['brake', 'current', 'iso', 'wavelogger']
|
@ -27,78 +27,46 @@ class GetThreadResult(Thread):
|
||||
return None
|
||||
|
||||
|
||||
def data_process(result_file, raw_data_dirs, av, rr, axis, vel, trq, w2t, estop):
|
||||
# 功能:完成一个结果文件的数据处理
|
||||
# 参数:结果文件,数据目录,以及预读取的参数
|
||||
# 返回值:-
|
||||
file_name = result_file.split('\\')[-1]
|
||||
w2t(f"正在打开文件 {file_name} 需要 1min 左右", 1, 0, 'orange')
|
||||
def traversal_files(path, w2t):
|
||||
# 功能:以列表的形式分别返回指定路径下的文件和文件夹,不包含子目录
|
||||
# 参数:路径
|
||||
# 返回值:路径下的文件夹列表 路径下的文件列表
|
||||
if not exists(path):
|
||||
msg = f'数据文件夹{path}不存在,请确认后重试......'
|
||||
w2t(msg, 0, 1, 'red')
|
||||
else:
|
||||
dirs = []
|
||||
files = []
|
||||
for item in scandir(path):
|
||||
if item.is_dir():
|
||||
dirs.append(item.path)
|
||||
elif item.is_file():
|
||||
files.append(item.path)
|
||||
|
||||
global stop
|
||||
stop = 0
|
||||
t_excel = GetThreadResult(load_workbook, args=(result_file, ))
|
||||
t_wait = Thread(target=w2t_local, args=('.', 1, w2t))
|
||||
t_excel.start()
|
||||
t_wait.start()
|
||||
t_excel.join()
|
||||
wb_result = t_excel.get_result()
|
||||
stop = 1
|
||||
sleep(1.1)
|
||||
w2t('')
|
||||
|
||||
prefix = result_file.split('\\')[-1].split('_')[0]
|
||||
for raw_data_dir in raw_data_dirs:
|
||||
if raw_data_dir.split('\\')[-1].split('_')[0] == prefix:
|
||||
now_doing_msg(raw_data_dir, 'start', w2t)
|
||||
_, data_files = traversal_files(raw_data_dir, w2t)
|
||||
# 数据文件串行处理模式---------------------------------
|
||||
# count = 1
|
||||
# for data_file in data_files:
|
||||
# now_doing_msg(data_file, 'start', w2t)
|
||||
# single_file_process(data_file, wb_result, count, av, rr, axis, vel, trq, w2t, estop)
|
||||
# count += 1
|
||||
# now_doing_msg(data_file, 'done', w2t)
|
||||
# ---------------------------------------------------
|
||||
# 数据文件并行处理模式---------------------------------
|
||||
threads = [Thread(target=single_file_process, args=(data_files[0], wb_result, 1, av, rr, axis, vel, trq, w2t, estop)),
|
||||
Thread(target=single_file_process, args=(data_files[1], wb_result, 2, av, rr, axis, vel, trq, w2t, estop)),
|
||||
Thread(target=single_file_process, args=(data_files[2], wb_result, 3, av, rr, axis, vel, trq, w2t, estop))]
|
||||
[t.start() for t in threads]
|
||||
[t.join() for t in threads]
|
||||
# ---------------------------------------------------
|
||||
now_doing_msg(raw_data_dir, 'done', w2t)
|
||||
|
||||
now_doing_msg(result_file, 'done', w2t)
|
||||
w2t(f"正在保存文件 {file_name} 需要 1min 左右", 1, 0, 'orange')
|
||||
stop = 0
|
||||
t_excel = Thread(target=wb_result.save, args=(result_file, ))
|
||||
t_wait = Thread(target=w2t_local, args=('.', 1, w2t))
|
||||
t_excel.start()
|
||||
t_wait.start()
|
||||
t_excel.join()
|
||||
stop = 1
|
||||
sleep(1.1)
|
||||
w2t('\n')
|
||||
return dirs, files
|
||||
|
||||
|
||||
def check_files(raw_data_dirs, result_files, w2t):
|
||||
def check_files(path, raw_data_dirs, result_files, w2t):
|
||||
# 功能:检查数据文件以及结果文件的合规性
|
||||
# 参数:数据文件夹,结果文件
|
||||
# 返回值:-
|
||||
if len(result_files) != 3:
|
||||
msg = "结果文件数目错误,结果文件有且只有三个,请确认!"
|
||||
if len(result_files) != 4:
|
||||
for result_file in result_files:
|
||||
w2t(result_file)
|
||||
w2t(msg, 0, 2, 'red')
|
||||
w2t("需要有四个文件,包括三个结果文件,以及一个配置文件,请确认!", 0, 2, 'red')
|
||||
|
||||
for result_file in result_files:
|
||||
if result_file.endswith('configs.xlsx'):
|
||||
result_files.remove(result_file)
|
||||
break
|
||||
else:
|
||||
w2t("未找到配置文件,请确认!", 0, 8, 'red')
|
||||
|
||||
prefix = []
|
||||
for result_file in result_files:
|
||||
prefix.append(result_file.split('\\')[-1].split('_')[0])
|
||||
if not sorted(prefix) == sorted(['reach33', 'reach66', 'reach100']):
|
||||
wd = result_files[0].split('\\')
|
||||
del wd[-1]
|
||||
wd = '\\'.join(wd)
|
||||
msg = f"""请关闭所有相关数据文件,并检查工作目录 {wd} 下,有且只允许有类似如下三个文件:
|
||||
msg = f"""请关闭所有相关数据文件,并检查工作目录 {path} 下,有且只允许有类似如下三个文件:
|
||||
1. reach33_XXX制动性能测试.xlsx
|
||||
2. reach66_XXX制动性能测试.xlsx
|
||||
3. reach100_XX制动性能测试.xlsx"""
|
||||
@ -127,6 +95,20 @@ def check_files(raw_data_dirs, result_files, w2t):
|
||||
w2t("数据目录合规性检查结束,未发现问题......")
|
||||
|
||||
|
||||
def get_configs(configfile, w2t):
|
||||
axis = configfile.split('\\')[-2][-1]
|
||||
if axis not in ['1', '2', '3']:
|
||||
w2t("被处理的根文件夹命名必须是 [Jj][123] 的格式", 0, 9, 'red')
|
||||
else:
|
||||
axis = int(axis)
|
||||
|
||||
_wb = load_workbook(configfile, read_only=True)
|
||||
_ws = _wb['Target']
|
||||
rr = float(_ws.cell(row=2, column=axis+1).value)
|
||||
av = float(_ws.cell(row=3, column=axis+1).value)
|
||||
|
||||
return av, rr
|
||||
|
||||
def now_doing_msg(docs, flag, w2t):
|
||||
# 功能:输出正在处理的文件或目录
|
||||
# 参数:文件或目录,start 或 done 标识
|
||||
@ -153,20 +135,6 @@ def w2t_local(msg, wait, w2t):
|
||||
break
|
||||
|
||||
|
||||
def single_file_process(data_file, wb_result, count, av, rr, axis, vel, trq, w2t, estop):
|
||||
# 功能:完成单个数据文件的处理
|
||||
# 参数:如上
|
||||
# 返回值:-
|
||||
df = read_csv(data_file, sep='\t')
|
||||
|
||||
conditions = sorted(data_file.split('\\')[-2].split('_')) # ['loadxx', 'reachxx', 'speedxx']
|
||||
result_sheet_name = find_result_sheet_name(conditions, count)
|
||||
ws_result = wb_result[result_sheet_name]
|
||||
|
||||
row_start, row_end = find_row_start(data_file, df, conditions, av, rr, axis, vel, w2t, estop)
|
||||
copy_data_to_result(df, ws_result, row_start, row_end, vel, trq, estop)
|
||||
|
||||
|
||||
def copy_data_to_result(df, ws_result, row_start, row_end, vel, trq, estop):
|
||||
# 功能:将数据文件中有效数据拷贝至结果文件对应的 sheet
|
||||
# 参数:如上
|
||||
@ -193,26 +161,13 @@ def copy_data_to_result(df, ws_result, row_start, row_end, vel, trq, estop):
|
||||
ws_result.cell(row=_row, column=3).value = None
|
||||
|
||||
|
||||
def find_result_sheet_name(conditions, count):
|
||||
# 功能:获取结果文件准确的sheet页名称
|
||||
# 参数:臂展和速度的列表
|
||||
# 返回值:结果文件对应的sheet name
|
||||
# 33%负载_33%速度_1 - ['loadxx', 'reachxx', 'speedxx']
|
||||
load = conditions[0].removeprefix('load')
|
||||
speed = conditions[2].removeprefix('speed')
|
||||
result_sheet_name = f"{load}%负载_{speed}%速度_{count}"
|
||||
|
||||
return result_sheet_name
|
||||
|
||||
|
||||
def find_row_start(data_file, df, conditions, av, rr, axis, vel, w2t, estop):
|
||||
def find_row_start(data_file, df, conditions, av, rr, vel, estop, w2t):
|
||||
# 功能:查找数据文件中有效数据的行号,也即最后一个速度下降的点位
|
||||
# 参数:如上
|
||||
# 返回值:速度下降点位,最后的数据点位
|
||||
ratio = float(conditions[2].removeprefix('speed'))/100
|
||||
av_max = av * ratio
|
||||
row_max = df.index[-1]
|
||||
# threshold = 30 if axis == 2 and conditions[0].removeprefix('load') == '100' else 10
|
||||
threshold = 0.95
|
||||
|
||||
for _row in range(row_max, -1, -1):
|
||||
@ -238,26 +193,89 @@ def find_row_start(data_file, df, conditions, av, rr, axis, vel, w2t, estop):
|
||||
return row_start, row_end
|
||||
|
||||
|
||||
def traversal_files(path, w2t):
|
||||
# 功能:以列表的形式分别返回指定路径下的文件和文件夹,不包含子目录
|
||||
# 参数:路径
|
||||
# 返回值:路径下的文件夹列表 路径下的文件列表
|
||||
if not exists(path):
|
||||
msg = f'数据文件夹{path}不存在,请确认后重试......'
|
||||
w2t(msg, 0, 1, 'red')
|
||||
else:
|
||||
dirs = []
|
||||
files = []
|
||||
for item in scandir(path):
|
||||
if item.is_dir():
|
||||
dirs.append(item.path)
|
||||
elif item.is_file():
|
||||
files.append(item.path)
|
||||
def find_result_sheet_name(conditions, count):
|
||||
# 功能:获取结果文件准确的sheet页名称
|
||||
# 参数:臂展和速度的列表
|
||||
# 返回值:结果文件对应的sheet name
|
||||
# 33%负载_33%速度_1 - ['loadxx', 'reachxx', 'speedxx']
|
||||
load = conditions[0].removeprefix('load')
|
||||
speed = conditions[2].removeprefix('speed')
|
||||
result_sheet_name = f"{load}%负载_{speed}%速度_{count}"
|
||||
|
||||
return dirs, files
|
||||
return result_sheet_name
|
||||
|
||||
|
||||
def main(path, av, rr, axis, vel, trq, estop, w2t):
|
||||
def single_file_process(data_file, wb_result, count, av, rr, vel, trq, estop, w2t):
|
||||
# 功能:完成单个数据文件的处理
|
||||
# 参数:如上
|
||||
# 返回值:-
|
||||
df = read_csv(data_file, sep='\t')
|
||||
|
||||
conditions = sorted(data_file.split('\\')[-2].split('_')) # ['loadxx', 'reachxx', 'speedxx']
|
||||
result_sheet_name = find_result_sheet_name(conditions, count)
|
||||
ws_result = wb_result[result_sheet_name]
|
||||
|
||||
row_start, row_end = find_row_start(data_file, df, conditions, av, rr, vel, estop, w2t)
|
||||
copy_data_to_result(df, ws_result, row_start, row_end, vel, trq, estop)
|
||||
|
||||
|
||||
def data_process(result_file, raw_data_dirs, av, rr, vel, trq, estop, w2t):
|
||||
# 功能:完成一个结果文件的数据处理
|
||||
# 参数:结果文件,数据目录,以及预读取的参数
|
||||
# 返回值:-
|
||||
file_name = result_file.split('\\')[-1]
|
||||
w2t(f"正在打开文件 {file_name} 需要 1min 左右", 1, 0, 'orange')
|
||||
|
||||
global stop
|
||||
stop = 0
|
||||
t_excel = GetThreadResult(load_workbook, args=(result_file, ))
|
||||
t_wait = Thread(target=w2t_local, args=('.', 1, w2t))
|
||||
t_excel.start()
|
||||
t_wait.start()
|
||||
t_excel.join()
|
||||
wb_result = t_excel.get_result()
|
||||
stop = 1
|
||||
sleep(1.1)
|
||||
w2t('')
|
||||
|
||||
prefix = result_file.split('\\')[-1].split('_')[0]
|
||||
for raw_data_dir in raw_data_dirs:
|
||||
if raw_data_dir.split('\\')[-1].split('_')[0] == prefix:
|
||||
now_doing_msg(raw_data_dir, 'start', w2t)
|
||||
_, data_files = traversal_files(raw_data_dir, w2t)
|
||||
# 数据文件串行处理模式---------------------------------
|
||||
# count = 1
|
||||
# for data_file in data_files:
|
||||
# now_doing_msg(data_file, 'start', w2t)
|
||||
# single_file_process(data_file, wb_result, count, av, rr, vel, trq, estop, w2t)
|
||||
# count += 1
|
||||
# now_doing_msg(data_file, 'done', w2t)
|
||||
# ---------------------------------------------------
|
||||
# 数据文件并行处理模式---------------------------------
|
||||
threads = [
|
||||
Thread(target=single_file_process, args=(data_files[0], wb_result, 1, av, rr, vel, trq, estop, w2t)),
|
||||
Thread(target=single_file_process, args=(data_files[1], wb_result, 2, av, rr, vel, trq, estop, w2t)),
|
||||
Thread(target=single_file_process, args=(data_files[2], wb_result, 3, av, rr, vel, trq, estop, w2t))
|
||||
]
|
||||
[t.start() for t in threads]
|
||||
[t.join() for t in threads]
|
||||
# ---------------------------------------------------
|
||||
now_doing_msg(raw_data_dir, 'done', w2t)
|
||||
|
||||
now_doing_msg(result_file, 'done', w2t)
|
||||
w2t(f"正在保存文件 {file_name} 需要 1min 左右", 1, 0, 'orange')
|
||||
stop = 0
|
||||
t_excel = Thread(target=wb_result.save, args=(result_file, ))
|
||||
t_wait = Thread(target=w2t_local, args=('.', 1, w2t))
|
||||
t_excel.start()
|
||||
t_wait.start()
|
||||
t_excel.join()
|
||||
stop = 1
|
||||
sleep(1.1)
|
||||
w2t('\n')
|
||||
|
||||
|
||||
def main(path, vel, trq, estop, w2t):
|
||||
# 功能:执行处理所有数据文件
|
||||
# 参数:initialization函数的返回值
|
||||
# 返回值:-
|
||||
@ -266,7 +284,8 @@ def main(path, av, rr, axis, vel, trq, estop, w2t):
|
||||
|
||||
try:
|
||||
# threads = []
|
||||
check_files(raw_data_dirs, result_files, w2t)
|
||||
check_files(path, raw_data_dirs, result_files, w2t)
|
||||
av, rr = get_configs(path + '\\configs.xlsx', w2t)
|
||||
|
||||
prefix = []
|
||||
for raw_data_dir in raw_data_dirs:
|
||||
@ -277,8 +296,8 @@ def main(path, av, rr, axis, vel, trq, estop, w2t):
|
||||
continue
|
||||
else:
|
||||
now_doing_msg(result_file, 'start', w2t)
|
||||
data_process(result_file, raw_data_dirs, av, rr, axis, vel, trq, w2t, estop)
|
||||
# threads.append(Thread(target=data_process, args=(result_file, raw_data_dirs, AV, RR, RC, AXIS)))
|
||||
data_process(result_file, raw_data_dirs, av, rr, vel, trq, estop, w2t)
|
||||
# threads.append(Thread(target=data_process, args=(result_file, raw_data_dirs, av, rr, vel, trq, estop, w2t)))
|
||||
# [t.start() for t in threads]
|
||||
# [t.join() for t in threads]
|
||||
except Exception as Err:
|
||||
@ -295,4 +314,4 @@ def main(path, av, rr, axis, vel, trq, estop, w2t):
|
||||
|
||||
if __name__ == "__main__":
|
||||
stop = 0
|
||||
main(path=argv[1], av=argv[2], rr=argv[3], axis=argv[4], vel=argv[5], trq=argv[6], estop=argv[7], w2t=argv[8])
|
||||
main(*argv[1:])
|
@ -6,7 +6,7 @@ from pandas import read_csv, concat, set_option
|
||||
from re import match
|
||||
from threading import Thread
|
||||
from time import sleep
|
||||
from csv import reader
|
||||
from csv import reader, writer
|
||||
|
||||
|
||||
class GetThreadResult(Thread):
|
||||
@ -63,81 +63,112 @@ def initialization(path, sub, w2t):
|
||||
|
||||
for data_file in data_files:
|
||||
filename = data_file.split('\\')[-1]
|
||||
if sub != 'cycle':
|
||||
if data_file.endswith('configs.xlsx'):
|
||||
count += 1
|
||||
elif sub == 'cycle' and data_file.endswith('.xlsx'):
|
||||
count += 1
|
||||
else:
|
||||
if not (match('j[1-7].*\\.data', filename) or match('j[1-7].*\\.csv', filename)):
|
||||
print(f"不合规 {data_file}")
|
||||
msg = f"所有文件必须以 jx_ 开头,以 .data/csv 结尾(x取值1-7),请检查后重新运行。"
|
||||
w2t(msg, 0, 6, 'red')
|
||||
else:
|
||||
if filename.endswith('.xlsx'):
|
||||
count += 1
|
||||
elif not (match('j[1-7].*\\.data', filename) or match('j[1-7].*\\.csv', filename)):
|
||||
msg = f"所有文件必须以 jx_ 开头,以 .data/csv 结尾(x取值1-7),请检查后重新运行。"
|
||||
w2t(msg, 0, 7, 'red')
|
||||
|
||||
if sub == 'cycle' and count != 1:
|
||||
w2t("未找到电机电流数据处理excel表格,确认后重新运行!", 0, 5, 'red')
|
||||
if not ((sub == 'cycle' and count == 2) or (sub != 'cycle' and count == 1)):
|
||||
w2t("使用max/avg功能时,需要有配置文件表格;使用cycle功能时,需要有电机电流数据处理和配置文件两个表格,确认后重新运行!", 0, 5, 'red')
|
||||
|
||||
return data_files
|
||||
|
||||
|
||||
def current_max(data_files, rcs, trqh, w2t):
|
||||
current = {1: 0, 2: 0, 3: 0, 4: 0, 5: 0, 6: 0, 7: 0}
|
||||
def current_max(data_files, rcs, trq, w2t):
|
||||
current = {1: [], 2: [], 3: [], 4: [], 5: [], 6: [], 7: []}
|
||||
for data_file in data_files:
|
||||
if data_file.endswith('.data'):
|
||||
df = read_csv(data_file, sep='\t')
|
||||
elif data_file.endswith('.csv'):
|
||||
df = read_csv(data_file, sep=',', encoding='gbk', header=8)
|
||||
else:
|
||||
continue
|
||||
|
||||
cols = len(df.columns)
|
||||
axis = int(data_file.split('\\')[-1].split('_')[0].removeprefix('j'))
|
||||
rca = rcs[axis-1]
|
||||
|
||||
col = df.columns.values[trqh-1]
|
||||
c_max = df[col].max()
|
||||
col = df.columns.values[trq-1]
|
||||
c_max = df[col].abs().max()
|
||||
|
||||
scale = 1 if data_file.endswith('.csv') else 1000
|
||||
_ = abs(c_max/scale*rca)
|
||||
current[axis] = _
|
||||
current[axis].append(_)
|
||||
w2t(f"{data_file}: {_:.4f}")
|
||||
|
||||
w2t("【MAX】数据处理完毕......")
|
||||
with open(data_file, 'a+') as f_data:
|
||||
sep = '\t' if data_file.endswith('.data') else ','
|
||||
csv_writer = writer(f_data, delimiter=sep)
|
||||
csv_writer.writerow([''] * (cols-1) + [_])
|
||||
|
||||
for axis, cur in current.items():
|
||||
if not cur:
|
||||
continue
|
||||
else:
|
||||
w2t(f"{axis}轴数据:", 1, 0, 'purple')
|
||||
for value in cur:
|
||||
w2t(f"{value:.4f} ", 1, 0, 'purple')
|
||||
w2t('')
|
||||
w2t("\n【MAX】数据处理完毕......")
|
||||
return current
|
||||
|
||||
|
||||
def current_avg(data_files, rcs, trqh, w2t):
|
||||
current = {1: 0, 2: 0, 3: 0, 4: 0, 5: 0, 6: 0, 7: 0}
|
||||
def current_avg(data_files, rcs, trq, w2t):
|
||||
current = {1: [], 2: [], 3: [], 4: [], 5: [], 6: [], 7: []}
|
||||
for data_file in data_files:
|
||||
if data_file.endswith('.data'):
|
||||
df = read_csv(data_file, sep='\t')
|
||||
elif data_file.endswith('.csv'):
|
||||
df = read_csv(data_file, sep=',', encoding='gbk', header=8)
|
||||
else:
|
||||
continue
|
||||
|
||||
cols = len(df.columns)
|
||||
axis = int(data_file.split('\\')[-1].split('_')[0].removeprefix('j'))
|
||||
rca = rcs[axis-1]
|
||||
|
||||
col = df.columns.values[trqh - 1]
|
||||
col = df.columns.values[trq-1]
|
||||
c_std = df[col].std()
|
||||
c_avg = df[col].mean()
|
||||
|
||||
scale = 1 if data_file.endswith('.csv') else 1000
|
||||
_ = (abs(c_avg)+c_std)/scale*rca
|
||||
current[axis] = _
|
||||
_ = (abs(c_avg)+c_std*3)/scale*rca
|
||||
current[axis].append(_)
|
||||
w2t(f"{data_file}: {_:.4f}")
|
||||
|
||||
w2t("【AVG】数据处理完毕......")
|
||||
with open(data_file, 'a+') as f_data:
|
||||
sep = '\t' if data_file.endswith('.data') else ','
|
||||
csv_writer = writer(f_data, delimiter=sep)
|
||||
csv_writer.writerow([''] * (cols-1) + [_])
|
||||
|
||||
for axis, cur in current.items():
|
||||
if not cur:
|
||||
continue
|
||||
else:
|
||||
w2t(f"{axis}轴数据:", 1, 0, 'purple')
|
||||
for value in cur:
|
||||
w2t(f"{value:.4f} ", 1, 0, 'purple')
|
||||
w2t('')
|
||||
w2t("\n【AVG】数据处理完毕......")
|
||||
return current
|
||||
|
||||
|
||||
def current_cycle(dur, data_files, rcs, vel, trq, trqh, rpm, w2t):
|
||||
def current_cycle(dur, data_files, rcs, rrs, vel, trq, trqh, rpms, w2t):
|
||||
result = None
|
||||
hold = []
|
||||
single = []
|
||||
for data_file in data_files:
|
||||
filename = data_file.split('\\')[-1]
|
||||
if data_file.endswith('.xlsx'):
|
||||
if data_file.endswith('.xlsx') and not data_file.endswith('configs.xlsx'):
|
||||
result = data_file
|
||||
elif match('j[1-7]_hold_.*\\.data', filename) or match('j[1-7]_hold_.*\\.csv', filename):
|
||||
hold.append(data_file)
|
||||
else:
|
||||
elif match('j[1-7]_.*\\.data', filename) or match('j[1-7]_.*\\.csv', filename):
|
||||
single.append(data_file)
|
||||
|
||||
w2t(f"正在打开文件 {result},需要 10s 左右", 1, 0, 'orange')
|
||||
@ -158,14 +189,14 @@ def current_cycle(dur, data_files, rcs, vel, trq, trqh, rpm, w2t):
|
||||
for axis, cur_value in avg.items():
|
||||
try:
|
||||
shtname = f"J{axis}"
|
||||
wb[shtname]["J4"].value = float(cur_value)
|
||||
wb[shtname]["J4"].value = float(cur_value[0])
|
||||
except:
|
||||
pass
|
||||
|
||||
if dur == 0:
|
||||
p_single(wb, single, vel, trq, rpm, w2t)
|
||||
p_single(wb, single, vel, trq, rpms, rrs, w2t)
|
||||
else:
|
||||
p_scenario(wb, single, vel, trq, rpm, dur, w2t)
|
||||
p_scenario(wb, single, vel, trq, rpms, rrs, dur, w2t)
|
||||
|
||||
w2t(f"正在保存文件 {result},需要 10s 左右", 1, 0, 'orange')
|
||||
stop = 0
|
||||
@ -206,20 +237,22 @@ def find_point(data_file, pos, flag, df, _row_s, _row_e, w2t, exitcode, threshol
|
||||
w2t(f"[{pos}] {data_file}数据有误,需要检查,无法找到有效起始点或结束点...", 0, exitcode, 'red')
|
||||
|
||||
|
||||
def p_single(wb, single, vel, trq, rpm, w2t):
|
||||
def p_single(wb, single, vel, trq, rpms, rrs, w2t):
|
||||
# 1. 先找到第一个速度为零的点,数据从后往前找,一开始就是零的情况不予考虑
|
||||
# 2. 记录第一个点的位置,继续向前查找第二个速度为零的点,同理,一开始为零的点不予考虑
|
||||
# 3. 记录第二个点的位置,并将其中的数据拷贝至对应位置
|
||||
for data_file in single:
|
||||
rpm = 1 if rpm == 0 else rpm
|
||||
scale = 1000 if data_file.endswith('.csv') else 1
|
||||
axis = int(data_file.split('\\')[-1].split('_')[0].removeprefix('j'))
|
||||
shtname = f"J{axis}"
|
||||
rpm = rpms[axis-1] if data_file.endswith('.csv') else 1
|
||||
scale = 1000 if data_file.endswith('.csv') else 1
|
||||
ws = wb[shtname]
|
||||
|
||||
addition = 1
|
||||
set_option("display.precision", 2)
|
||||
if data_file.endswith('.data'):
|
||||
df = read_csv(data_file, sep='\t')
|
||||
rr = rrs[axis-1]
|
||||
addition = 180 / 3.1415926 * 60 / 360 * rr
|
||||
elif data_file.endswith('.csv'):
|
||||
df = read_csv(data_file, sep=',', encoding='gbk', header=8)
|
||||
csv_reader = reader(open(data_file))
|
||||
@ -233,8 +266,9 @@ def p_single(wb, single, vel, trq, rpm, w2t):
|
||||
ws["H11"] = cycle
|
||||
|
||||
col_names = list(df.columns)
|
||||
df_1 = df[col_names[vel-1]].multiply(rpm)
|
||||
df_1 = df[col_names[vel-1]].multiply(rpm*addition)
|
||||
df_2 = df[col_names[trq-1]].multiply(scale)
|
||||
print(df_1.abs().max())
|
||||
df = concat([df_1, df_2], axis=1)
|
||||
|
||||
_step = 5 if data_file.endswith('.csv') else 50
|
||||
@ -275,7 +309,7 @@ def p_single(wb, single, vel, trq, rpm, w2t):
|
||||
data.append(df.iloc[row, 1])
|
||||
|
||||
i = 0
|
||||
for row in ws.iter_rows(min_row=2, min_col=2, max_row=70000, max_col=3):
|
||||
for row in ws.iter_rows(min_row=2, min_col=2, max_row=150000, max_col=3):
|
||||
for cell in row:
|
||||
try:
|
||||
_ = f"{data[i]:.2f}"
|
||||
@ -285,18 +319,20 @@ def p_single(wb, single, vel, trq, rpm, w2t):
|
||||
cell.value = None
|
||||
|
||||
|
||||
def p_scenario(wb, single, vel, trq, rpm, dur, w2t):
|
||||
def p_scenario(wb, single, vel, trq, rpms, rrs, dur, w2t):
|
||||
for data_file in single:
|
||||
cycle = 0.001
|
||||
rpm = 1 if rpm == 0 else rpm
|
||||
scale = 1000 if data_file.endswith('.csv') else 1
|
||||
axis = int(data_file.split('\\')[-1].split('_')[0].removeprefix('j'))
|
||||
shtname = f"J{axis}"
|
||||
rpm = rpms[axis-1] if data_file.endswith('.csv') else 1
|
||||
scale = 1000 if data_file.endswith('.csv') else 1
|
||||
ws = wb[shtname]
|
||||
|
||||
addition = 1
|
||||
set_option("display.precision", 2)
|
||||
if data_file.endswith('.data'):
|
||||
df = read_csv(data_file, sep='\t')
|
||||
rr = rrs[axis-1]
|
||||
addition = 180 / 3.1415926 * 60 / 360 * rr
|
||||
elif data_file.endswith('.csv'):
|
||||
df = read_csv(data_file, sep=',', encoding='gbk', header=8)
|
||||
csv_reader = reader(open(data_file))
|
||||
@ -310,7 +346,7 @@ def p_scenario(wb, single, vel, trq, rpm, dur, w2t):
|
||||
ws["H11"] = cycle
|
||||
|
||||
col_names = list(df.columns)
|
||||
df_1 = df[col_names[vel-1]].multiply(rpm)
|
||||
df_1 = df[col_names[vel-1]].multiply(rpm*addition)
|
||||
df_2 = df[col_names[trq-1]].multiply(scale)
|
||||
df = concat([df_1, df_2], axis=1)
|
||||
|
||||
@ -325,7 +361,7 @@ def p_scenario(wb, single, vel, trq, rpm, dur, w2t):
|
||||
data.append(df.iloc[row, 1])
|
||||
|
||||
i = 0
|
||||
for row in ws.iter_rows(min_row=2, min_col=2, max_row=70000, max_col=3):
|
||||
for row in ws.iter_rows(min_row=2, min_col=2, max_row=150000, max_col=3):
|
||||
for cell in row:
|
||||
try:
|
||||
_ = f"{data[i]:.2f}"
|
||||
@ -335,17 +371,40 @@ def p_scenario(wb, single, vel, trq, rpm, dur, w2t):
|
||||
cell.value = None
|
||||
|
||||
|
||||
# =======================================
|
||||
def get_configs(configfile, w2t):
|
||||
_wb = load_workbook(configfile, read_only=True)
|
||||
_ws = _wb['Target']
|
||||
rcs = []
|
||||
rrs = []
|
||||
rpms = []
|
||||
for i in range(2, 9):
|
||||
try:
|
||||
rpms.append(float(_ws.cell(row=4, column=i).value))
|
||||
except:
|
||||
rpms.append(0.0)
|
||||
|
||||
try:
|
||||
rcs.append(float(_ws.cell(row=6, column=i).value))
|
||||
except:
|
||||
rcs.append(0.0)
|
||||
|
||||
try:
|
||||
rrs.append(float(_ws.cell(row=2, column=i).value))
|
||||
except:
|
||||
rrs.append(0.0)
|
||||
|
||||
return rpms, rcs, rrs
|
||||
|
||||
|
||||
def main(path, sub, rcs, vel, trq, trqh, dur, rpm, w2t):
|
||||
def main(path, sub, dur, vel, trq, trqh, w2t):
|
||||
data_files = initialization(path, sub, w2t)
|
||||
rpms, rcs, rrs = get_configs(path + '\\configs.xlsx', w2t)
|
||||
if sub == 'max':
|
||||
current_max(data_files, rcs, trqh, w2t)
|
||||
current_max(data_files, rcs, trq, w2t)
|
||||
elif sub == 'avg':
|
||||
current_avg(data_files, rcs, trqh, w2t)
|
||||
current_avg(data_files, rcs, trq, w2t)
|
||||
elif sub == 'cycle':
|
||||
current_cycle(dur, data_files, rcs, vel, trq, trqh, rpm, w2t)
|
||||
current_cycle(dur, data_files, rcs, rrs, vel, trq, trqh, rpms, w2t)
|
||||
else:
|
||||
pass
|
||||
|
@ -136,7 +136,7 @@ def single_file_proc(ws, data_file, df, low, high, cycle, w2t):
|
||||
_row_lt = find_point('forward', _step, 'c'+str(_row), data_file, 'lt', df, _row, w2t)
|
||||
_start = int(_row_gt + (_row_lt - _row_gt - 50) / 2)
|
||||
_end = _start + 50
|
||||
value = df.iloc[_start:_end, 2].mean() + df.iloc[_start:_end, 2].std()
|
||||
value = df.iloc[_start:_end, 2].mean() + 3 * df.iloc[_start:_end, 2].std()
|
||||
_data[count].append(value)
|
||||
else:
|
||||
_row_gt = find_point('forward', _step, 'c'+str(_row), data_file, 'gt', df, _row, w2t)
|
1
aio/code/durable_action/__init__.py
Normal file
1
aio/code/durable_action/__init__.py
Normal file
@ -0,0 +1 @@
|
||||
__all__ = ['factory_test']
|
301
aio/code/durable_action/factory_test.py
Normal file
301
aio/code/durable_action/factory_test.py
Normal file
@ -0,0 +1,301 @@
|
||||
from sys import argv
|
||||
from os.path import exists, dirname
|
||||
from os import scandir
|
||||
from paramiko import SSHClient, AutoAddPolicy
|
||||
from json import loads
|
||||
from time import sleep, time, strftime, localtime
|
||||
from pandas import DataFrame
|
||||
from openpyxl import load_workbook
|
||||
from math import sqrt
|
||||
from numpy import power
|
||||
from csv import writer
|
||||
|
||||
tab_name = 'Durable Action'
|
||||
count = 0
|
||||
durable_data_current_xlsx = f'{dirname(__file__)}/../../assets/templates/durable/durable_data_current.xlsx'
|
||||
durable_data_current_max_xlsx = f'{dirname(__file__)}/../../assets/templates/durable/durable_data_current_max.xlsx'
|
||||
display_pdo_params = [
|
||||
# {"name": "hw_joint_vel_feedback", "channel": 0},
|
||||
# {"name": "hw_joint_vel_feedback", "channel": 1},
|
||||
# {"name": "hw_joint_vel_feedback", "channel": 2},
|
||||
# {"name": "hw_joint_vel_feedback", "channel": 3},
|
||||
# {"name": "hw_joint_vel_feedback", "channel": 4},
|
||||
# {"name": "hw_joint_vel_feedback", "channel": 5},
|
||||
{"name": "device_servo_trq_feedback", "channel": 0},
|
||||
{"name": "device_servo_trq_feedback", "channel": 1},
|
||||
{"name": "device_servo_trq_feedback", "channel": 2},
|
||||
{"name": "device_servo_trq_feedback", "channel": 3},
|
||||
{"name": "device_servo_trq_feedback", "channel": 4},
|
||||
{"name": "device_servo_trq_feedback", "channel": 5},
|
||||
]
|
||||
title = [
|
||||
'time', 'trq-1', 'trq-2', 'trq-3', 'trq-4', 'trq-5', 'trq-6', 'trq-max-1', 'trq-max-2', 'trq-max-3', 'trq-max-4',
|
||||
'trq-max-5', 'trq-max-6'
|
||||
]
|
||||
|
||||
|
||||
def traversal_files(path, w2t):
|
||||
if not exists(path):
|
||||
msg = f'数据文件夹{path}不存在,请确认后重试......'
|
||||
w2t(msg, 0, 1, 'red', tab_name=tab_name)
|
||||
else:
|
||||
dirs = []
|
||||
files = []
|
||||
for item in scandir(path):
|
||||
if item.is_dir():
|
||||
dirs.append(item.path)
|
||||
elif item.is_file():
|
||||
files.append(item.path)
|
||||
|
||||
return dirs, files
|
||||
|
||||
|
||||
def check_files(data_dirs, data_files, w2t):
|
||||
if len(data_dirs) != 0 or len(data_files) != 2:
|
||||
w2t('初始路径下不允许有文件夹,且初始路径下只能存在如下文件,确认后重新运行!\n1. target.zip\n2. configs.xlsx', 0, 10, 'red', tab_name)
|
||||
|
||||
_files = [data_files[0].split('\\')[-1], data_files[1].split('\\')[-1]]
|
||||
_files.sort()
|
||||
if _files != ['configs.xlsx', 'target.zip']:
|
||||
w2t('初始路径下只能存在如下文件,确认后重新运行!\n1. target.zip\n2. configs.xlsx', 0, 10, 'red', tab_name)
|
||||
|
||||
data_files.sort()
|
||||
return data_files
|
||||
|
||||
|
||||
def prj_to_xcore(prj_file):
|
||||
ssh = SSHClient()
|
||||
ssh.set_missing_host_key_policy(AutoAddPolicy())
|
||||
ssh.connect('192.168.0.160', 22, username='luoshi', password='luoshi2019')
|
||||
sftp = ssh.open_sftp()
|
||||
sftp.put(prj_file, '/tmp/target.zip')
|
||||
cmd = 'cd /tmp; rm -rf target/; mkdir target; unzip -d target/ -q target.zip; '
|
||||
cmd += 'chmod 777 -R target/; rm target.zip'
|
||||
ssh.exec_command(cmd)
|
||||
|
||||
cmd = 'sudo rm -rf /home/luoshi/bin/controller/projects/target; '
|
||||
cmd += 'sudo mv /tmp/target/ /home/luoshi/bin/controller/projects/'
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
|
||||
cmd = 'cd /home/luoshi/bin/controller/; '
|
||||
cmd += 'sudo mv projects/target/_build/*.prj projects/target/_build/target.prj'
|
||||
stdin, stdout, stderr = ssh.exec_command(cmd, get_pty=True)
|
||||
stdin.write('luoshi2019' + '\n')
|
||||
stdin.flush()
|
||||
print(stdout.read().decode()) # 必须得输出一下stdout,才能正确执行sudo
|
||||
print(stderr.read().decode()) # 顺便也执行以下stderr
|
||||
ssh.close()
|
||||
|
||||
|
||||
def execution(cmd, hr, w2t, **kwargs):
|
||||
_id = hr.execution(cmd, **kwargs)
|
||||
_msg = hr.get_from_id(_id)
|
||||
if not _msg:
|
||||
w2t(f"无法获取{_id}请求的响应信息", 0, 7, 'red', tab_name=tab_name)
|
||||
else:
|
||||
_response = loads(_msg)
|
||||
if not _response:
|
||||
w2t(f"无法获取{id}请求的响应信息", 0, 1, 'red', tab_name=tab_name)
|
||||
return _response
|
||||
|
||||
|
||||
def run_rl(path, config_file, data_all, hr, md, w2t):
|
||||
# 1. 关闭诊断曲线,触发软急停,并解除,目的是让可能正在运行着的机器停下来,切手动模式并下电
|
||||
_response = execution('diagnosis.open', hr, w2t, open=True, display_open=True)
|
||||
_response = execution('diagnosis.set_params', hr, w2t, display_pdo_params=display_pdo_params)
|
||||
md.trigger_estop()
|
||||
md.reset_estop()
|
||||
md.write_act(False)
|
||||
sleep(1) # 让曲线彻底关闭
|
||||
|
||||
# 2. reload工程后,pp2main,并且自动模式和上电
|
||||
prj_path = 'target/_build/target.prj'
|
||||
_response = execution('overview.reload', hr, w2t, prj_path=prj_path, tasks=['current'])
|
||||
_response = execution('rl_task.pp_to_main', hr, w2t, tasks=['current'])
|
||||
_response = execution('state.switch_auto', hr, w2t)
|
||||
_response = execution('state.switch_motor_on', hr, w2t)
|
||||
|
||||
# 3. 开始运行程序
|
||||
_response = execution('rl_task.run', hr, w2t, tasks=['current'])
|
||||
_t_start = time()
|
||||
while True:
|
||||
if md.read_ready_to_go() == 1:
|
||||
md.write_act(True)
|
||||
break
|
||||
else:
|
||||
if (time() - _t_start) // 20 > 1:
|
||||
w2t("20s内未收到机器人的运行信号,需要确认RL程序编写正确并正常执行...", 0, 111, 'red', tab_name)
|
||||
else:
|
||||
sleep(1)
|
||||
|
||||
# 4. 获取初始数据,周期时间,首次的各轴平均电流值,打开诊断曲线,并执行采集
|
||||
sleep(20) # 初始化 scenario time 为 0
|
||||
_t_start = time()
|
||||
while True:
|
||||
scenario_time = md.read_scenario_time()
|
||||
if float(scenario_time) > 1:
|
||||
w2t(f"场景的周期时间:{scenario_time}s", 0, 0, 'green', tab_name)
|
||||
break
|
||||
else:
|
||||
if (time() - _t_start) // 60 > 3:
|
||||
w2t(f"未收到场景的周期时间,需要确认RL程序编写正确并正常执行...", 0, 111, 'red', tab_name)
|
||||
else:
|
||||
sleep(5)
|
||||
sleep(1) # 一定要延迟一秒再读一次scenario time寄存器,因为一开始读取的数值不准确
|
||||
scenario_time = float(md.read_scenario_time())
|
||||
sleep(scenario_time*0.2)
|
||||
|
||||
# 6. 准备初始数据,关闭诊断曲线,保留数据并处理输出
|
||||
with open(f'{path}\\results.csv', mode='a+', newline='') as f_csv:
|
||||
csv_writer = writer(f_csv)
|
||||
csv_writer.writerow(title)
|
||||
_wb = load_workbook(config_file, read_only=True)
|
||||
_ws = _wb['Target']
|
||||
wait_time = float(_ws.cell(row=2, column=10).value)
|
||||
rcs = []
|
||||
for i in range(6):
|
||||
rcs.append(float(_ws.cell(row=6, column=i + 2).value))
|
||||
|
||||
get_durable_data(path, data_all, scenario_time, wait_time, rcs, hr, md, w2t)
|
||||
|
||||
# 7. 继续运行
|
||||
while True:
|
||||
# 固定间隔,更新一次数据,打开曲线,获取周期内电流,关闭曲线
|
||||
sleep(wait_time+scenario_time+7)
|
||||
# 保留数据并处理输出
|
||||
get_durable_data(path, data_all, scenario_time, wait_time, rcs, hr, md, w2t)
|
||||
|
||||
|
||||
def get_durable_data(path, data, scenario_time, wait_time, rcs, hr, md, w2t):
|
||||
_data_list = []
|
||||
_c_msg = hr.c_msg.copy()
|
||||
for _msg in _c_msg:
|
||||
if 'diagnosis.result' in _msg:
|
||||
_data_list.insert(0, loads(_msg))
|
||||
else:
|
||||
hr.c_msg_xs.clear()
|
||||
if len(hr.c_msg) > 240:
|
||||
del hr.c_msg[240:]
|
||||
|
||||
# with open(f'{path}\\log.txt', 'w', encoding='utf-8') as f_obj:
|
||||
# for _ in _data_list:
|
||||
# f_obj.write(f"{_}\n")
|
||||
|
||||
_d2d_trq = {0: [], 1: [], 2: [], 3: [], 4: [], 5: []}
|
||||
|
||||
for line in _data_list:
|
||||
for item in line['data']:
|
||||
for i in range(6):
|
||||
item['value'].reverse()
|
||||
if item.get('channel', None) == i and item.get('name', None) == 'device_servo_trq_feedback':
|
||||
_d2d_trq[i].extend(item['value'])
|
||||
|
||||
if len(_d2d_trq[0]) / 1000 > scenario_time + 1:
|
||||
this_time = strftime("%Y-%m-%d %H:%M:%S", localtime(time()))
|
||||
next_time = strftime("%Y-%m-%d %H:%M:%S", localtime(time()+wait_time+10+scenario_time)).split()[-1]
|
||||
_df = DataFrame(_d2d_trq)
|
||||
_flg = 0
|
||||
_res = []
|
||||
for i in range(6):
|
||||
def overmax_data(df, index, number, flag):
|
||||
if number > 100:
|
||||
md.trigger_estop()
|
||||
hr.durable_quit = 1
|
||||
df.to_excel(f'{path}\\{this_time}.xlsx')
|
||||
w2t(f"[{this_time}] {flag}-axis-{index} 数据过大错误,需要检查确定。", 0, 10, 'red', tab_name)
|
||||
|
||||
try:
|
||||
_ = sqrt(_df[i].apply(lambda x: power((rcs[i]*x/1000), 2)).sum()/len(_df[i]))
|
||||
except:
|
||||
md.trigger_estop()
|
||||
_df.to_excel(path+"\\err_data.xlsx")
|
||||
w2t(f"{i}calculate error", 0, 11, 'red', tab_name)
|
||||
|
||||
if not _flg:
|
||||
del data[0]['time'][0]
|
||||
data[0]['time'].append(this_time.split()[-1])
|
||||
del data[1]['time'][0]
|
||||
data[1]['time'].append(this_time.split()[-1])
|
||||
_res.append(this_time)
|
||||
_flg = 1
|
||||
|
||||
del data[0][f"axis{i + 1}"][0]
|
||||
overmax_data(_df, i, _, 'trq')
|
||||
data[0][f"axis{i + 1}"].append(_)
|
||||
_res.append(_)
|
||||
|
||||
_ = rcs[i] * _df[i].abs().max() / 1000
|
||||
overmax_data(_df, i, _, 'trq-max')
|
||||
del data[1][f"axis{i + 1}"][0]
|
||||
data[1][f"axis{i + 1}"].append(_)
|
||||
_res.append(_)
|
||||
|
||||
_df_1 = DataFrame(data[0])
|
||||
_df_2 = DataFrame(data[1])
|
||||
with open(f'{path}\\results.csv', mode='a+', newline='') as f_csv:
|
||||
def change_order(res):
|
||||
_time = res[0:1]
|
||||
_trq = []
|
||||
_trq_max = []
|
||||
for _item in res[1::2]:
|
||||
_trq.append(_item)
|
||||
for _item in res[2::2]:
|
||||
_trq_max.append(_item)
|
||||
return _time + _trq + _trq_max
|
||||
|
||||
csv_writer = writer(f_csv)
|
||||
csv_writer.writerow(change_order(_res))
|
||||
|
||||
while True:
|
||||
if not hr.durable_lock:
|
||||
hr.durable_lock = 1
|
||||
_df_1.to_excel(durable_data_current_xlsx, index=False)
|
||||
_df_2.to_excel(durable_data_current_max_xlsx, index=False)
|
||||
hr.durable_lock = 0
|
||||
break
|
||||
else:
|
||||
sleep(1)
|
||||
global count
|
||||
count += 1
|
||||
w2t(f"[{this_time}] 当前次数:{count:09d} | 预计下次数据更新时间:{next_time}", 0, 0, '#008B8B', tab_name)
|
||||
break
|
||||
else:
|
||||
md.trigger_estop()
|
||||
with open(f'{path}\\device_servo_trq_feedback_0.txt', 'w', encoding='utf-8') as f_obj:
|
||||
for _ in _d2d_trq[0]:
|
||||
f_obj.write(f"{_}\n")
|
||||
w2t("采集的数据时间长度不够,需要确认。", 0, 10, 'red', tab_name)
|
||||
|
||||
|
||||
def main(path, hr, md, w2t):
|
||||
durable_data_current = {
|
||||
'time': list(range(1, 19)),
|
||||
'axis1': [0 for _ in range(18)],
|
||||
'axis2': [0 for _ in range(18)],
|
||||
'axis3': [0 for _ in range(18)],
|
||||
'axis4': [0 for _ in range(18)],
|
||||
'axis5': [0 for _ in range(18)],
|
||||
'axis6': [0 for _ in range(18)],
|
||||
}
|
||||
durable_data_current_max = {
|
||||
'time': list(range(1, 19)),
|
||||
'axis1': [0 for _ in range(18)],
|
||||
'axis2': [0 for _ in range(18)],
|
||||
'axis3': [0 for _ in range(18)],
|
||||
'axis4': [0 for _ in range(18)],
|
||||
'axis5': [0 for _ in range(18)],
|
||||
'axis6': [0 for _ in range(18)],
|
||||
}
|
||||
data_all = [durable_data_current, durable_data_current_max]
|
||||
data_dirs, data_files = traversal_files(path, w2t)
|
||||
config_file, prj_file = check_files(data_dirs, data_files, w2t)
|
||||
prj_to_xcore(prj_file)
|
||||
run_rl(path, config_file, data_all, hr, md, w2t)
|
||||
|
||||
|
||||
if __name__ == '__main__':
|
||||
main(*argv[1:])
|
626
aio/code/openapi.py
Normal file
626
aio/code/openapi.py
Normal file
@ -0,0 +1,626 @@
|
||||
from json import load, dumps, loads
|
||||
from socket import socket, setdefaulttimeout, AF_INET, SOCK_STREAM
|
||||
from threading import Thread
|
||||
import selectors
|
||||
from time import time, sleep
|
||||
from os.path import dirname
|
||||
from pymodbus.client.tcp import ModbusTcpClient
|
||||
from pymodbus.payload import BinaryPayloadDecoder, BinaryPayloadBuilder
|
||||
from pymodbus.constants import Endian
|
||||
|
||||
MAX_FRAME_SIZE = 1024
|
||||
setdefaulttimeout(2)
|
||||
current_path = dirname(__file__)
|
||||
heartbeat = f'{current_path}/../assets/templates/heartbeat'
|
||||
|
||||
|
||||
class ModbusRequest(object):
|
||||
def __init__(self, w2t):
|
||||
super().__init__()
|
||||
self.w2t = w2t
|
||||
self.tab_name = 'openapi'
|
||||
self.host = '192.168.0.160'
|
||||
self.port = 502
|
||||
self.interval = 0.3
|
||||
self.c = ModbusTcpClient(self.host, self.port)
|
||||
self.c.connect()
|
||||
|
||||
def motor_off(self):
|
||||
try:
|
||||
self.c.write_register(40002, 0)
|
||||
sleep(self.interval)
|
||||
self.c.write_register(40002, 1)
|
||||
sleep(self.interval)
|
||||
self.c.write_register(40002, 0)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法正常下电,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def motor_on(self):
|
||||
try:
|
||||
self.c.write_register(40003, 0)
|
||||
sleep(self.interval)
|
||||
self.c.write_register(40003, 1)
|
||||
sleep(self.interval)
|
||||
self.c.write_register(40003, 0)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法正常上电,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def trigger_estop(self):
|
||||
try:
|
||||
self.c.write_register(40012, 0)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法触发软急停,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def reset_estop(self):
|
||||
try:
|
||||
self.c.write_register(40012, 1)
|
||||
sleep(self.interval)
|
||||
self.c.write_register(40001, 0)
|
||||
sleep(self.interval)
|
||||
self.c.write_register(40001, 1)
|
||||
sleep(self.interval)
|
||||
self.c.write_register(40001, 0)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法重置软急停,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def clear_alarm(self):
|
||||
try:
|
||||
self.c.write_register(40000, 1)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法清除告警,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def get_cart_vel(self):
|
||||
try:
|
||||
results = self.c.read_holding_registers(40537, 7)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法读取笛卡尔速度,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def get_jnt_vel(self):
|
||||
try:
|
||||
results = self.c.read_holding_registers(40579, 7)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法读取关节速度,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def get_tcp_vel(self):
|
||||
try:
|
||||
results = self.c.read_holding_registers(40607, 7)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法读取TCP速度,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def get_tcp_mag_vel(self):
|
||||
try:
|
||||
results = self.c.read_holding_registers(40621, 1)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法读取TCP合成速度,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def write_act(self, number):
|
||||
try:
|
||||
self.c.write_register(41000, number)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法发送执行信号,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def read_ready_to_go(self):
|
||||
try:
|
||||
results = self.c.read_holding_registers(41001, 1)
|
||||
return results.registers[0]
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法读取准备信号,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def read_scenario_time(self):
|
||||
try:
|
||||
results = self.c.read_holding_registers(41002, 2)
|
||||
result = BinaryPayloadDecoder.fromRegisters(results.registers, byteorder=Endian.BIG, wordorder=Endian.LITTLE)
|
||||
result = f"{result.decode_32bit_float():.3f}"
|
||||
return result
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法读取准备信号,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def write_stop0(self, number):
|
||||
try:
|
||||
self.c.write_register(41004, number)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法通过IO操作stop0急停,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def write_speed_max(self, speed):
|
||||
try:
|
||||
builder = BinaryPayloadBuilder(byteorder=Endian.BIG, wordorder=Endian.LITTLE)
|
||||
builder.add_32bit_float(float(speed))
|
||||
payload = builder.build()
|
||||
self.c.write_registers(41005, payload, skip_encode=True)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法写入速度值,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def read_brake_done(self):
|
||||
try:
|
||||
results = self.c.read_holding_registers(41007, 1)
|
||||
return results.registers[0]
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法读取制动已执行信号,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def write_axis(self, axis):
|
||||
try:
|
||||
builder = BinaryPayloadBuilder(byteorder=Endian.BIG, wordorder=Endian.LITTLE)
|
||||
builder.add_32bit_int(int(axis))
|
||||
payload = builder.to_registers()
|
||||
self.c.write_registers(41008, payload)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法写入速度值,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def write_probe(self, probe):
|
||||
try:
|
||||
self.c.write_register(41010, probe)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法写入速度探测信号,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
def write_pon(self, pon): # positive or negative
|
||||
try:
|
||||
self.c.write_register(41011, pon)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{Err}\n无法写入正负方向信号,连接Modbus失败,需要确认网络是否通畅,或是未正确导入寄存器文件...", 0, 100, 'red', self.tab_name)
|
||||
|
||||
|
||||
class HmiRequest(object):
|
||||
def __init__(self, w2t):
|
||||
super().__init__()
|
||||
self.w2t = w2t
|
||||
self.c = None
|
||||
self.c_xs = None
|
||||
self.c_msg = []
|
||||
self.c_msg_xs = []
|
||||
self.flag = 0
|
||||
self.response = ''
|
||||
self.leftover = 0
|
||||
self.flag_xs = 0
|
||||
self.response_xs = ''
|
||||
self.t_bool = True
|
||||
self.tab_name = 'openapi'
|
||||
self.pkg_size = 0
|
||||
self.broke = 0
|
||||
self.half = 0
|
||||
self.half_length = 0
|
||||
self.index = 0
|
||||
self.reset_index = 0
|
||||
self.durable_lock = 0
|
||||
|
||||
self.sock_conn()
|
||||
self.t_heartbeat = Thread(target=self.heartbeat)
|
||||
self.t_heartbeat.daemon = True
|
||||
self.t_heartbeat.start()
|
||||
self.t_unpackage = Thread(target=self.unpackage, args=(self.c,))
|
||||
self.t_unpackage.daemon = True
|
||||
self.t_unpackage.start()
|
||||
self.t_unpackage_xs = Thread(target=self.unpackage_xs, args=(self.c_xs,))
|
||||
self.t_unpackage_xs.daemon = True
|
||||
self.t_unpackage_xs.start()
|
||||
|
||||
def sock_conn(self):
|
||||
# while True:
|
||||
with open(heartbeat, "r", encoding='utf-8') as f_hb:
|
||||
c_state = f_hb.read().strip()
|
||||
if c_state == '0':
|
||||
try:
|
||||
self.c = socket(AF_INET, SOCK_STREAM)
|
||||
self.c.connect(('192.168.0.160', 5050))
|
||||
# self.c.connect(('192.168.84.129', 5050))
|
||||
self.c.setblocking(False)
|
||||
self.c_xs = socket(AF_INET, SOCK_STREAM)
|
||||
self.c_xs.connect(('192.168.0.160', 6666))
|
||||
# self.c_xs.connect(('192.168.84.129', 6666))
|
||||
self.c_xs.setblocking(False)
|
||||
|
||||
self.w2t("Connection success", 0, 0, 'green', tab_name=self.tab_name)
|
||||
with open(heartbeat, "w", encoding='utf-8') as f_hb:
|
||||
f_hb.write('1')
|
||||
md = ModbusRequest(self.w2t)
|
||||
md.reset_estop()
|
||||
md.clear_alarm()
|
||||
md.write_act(False)
|
||||
md.write_probe(False)
|
||||
md.write_axis(1)
|
||||
except Exception as Err:
|
||||
self.w2t("Connection failed...", 0, 0, 'red', tab_name=self.tab_name)
|
||||
with open(heartbeat, "w", encoding='utf-8') as f_hb:
|
||||
f_hb.write('0')
|
||||
|
||||
def header_check(self, index, data):
|
||||
if index + 8 < len(data):
|
||||
_frame_size = int.from_bytes(data[index:index+2], byteorder='big')
|
||||
_pkg_size = int.from_bytes(data[index+2:index+6], byteorder='big')
|
||||
_protocol = int.from_bytes(data[index + 6:index + 7], byteorder='big')
|
||||
_reserved = int.from_bytes(data[index + 7:index + 8], byteorder='big')
|
||||
|
||||
if _reserved == 0 and _protocol == 2:
|
||||
return index + 8, _frame_size, _pkg_size
|
||||
else:
|
||||
print(data)
|
||||
# print(f"index = {index}")
|
||||
# print(f"reserve = {_reserved}")
|
||||
# print(f"protocol = {_protocol}")
|
||||
# print("head check 数据有误,需要确认")
|
||||
self.w2t("Header Check: 解包数据有误,需要确认!", 0, 1, 'red', tab_name=self.tab_name)
|
||||
else:
|
||||
self.half_length = len(data) - index
|
||||
self.half = data[index:]
|
||||
|
||||
# print(f"in head check half: {self.half}")
|
||||
# print(f"in head check length: {self.half_length}")
|
||||
# print(f"in head check data: {data}")
|
||||
|
||||
self.broke = 100
|
||||
index += MAX_FRAME_SIZE
|
||||
return index, 0, 0
|
||||
|
||||
def heartbeat(self):
|
||||
while self.t_bool:
|
||||
_id = self.execution('controller.heart')
|
||||
_flag = '0' if self.get_from_id(_id) is None else '1'
|
||||
print(f"hb = {_flag}", end=' ')
|
||||
print(f"len(c_msg) = {len(self.c_msg)}", end=' ')
|
||||
print(f"len(c_msg_xs) = {len(self.c_msg_xs)}", end='\n')
|
||||
with open(heartbeat, "w", encoding='utf-8') as f_hb:
|
||||
f_hb.write(_flag)
|
||||
if _flag == '0':
|
||||
self.w2t(f"{_id} 心跳丢失,连接失败,重新连接中...", 0, 7, 'red', tab_name=self.tab_name)
|
||||
t = time()
|
||||
with open(f"{current_path}/../assets/templates/c_msg.log", "w", encoding='utf-8') as f:
|
||||
for msg in self.c_msg:
|
||||
f.write(str(t) + '-' + str(loads(msg)) + '\n')
|
||||
sleep(1)
|
||||
|
||||
|
||||
def msg_storage(self, response, flag=0):
|
||||
# response是解码后的字符串
|
||||
messages = self.c_msg if flag == 0 else self.c_msg_xs
|
||||
if 'move.monitor' in response:
|
||||
pass
|
||||
elif len(messages) < 20000:
|
||||
messages.insert(0, response)
|
||||
else:
|
||||
messages.insert(0, response)
|
||||
while len(messages) > 20000:
|
||||
messages.pop()
|
||||
|
||||
def get_response(self, data):
|
||||
# 流式获取单次请求的响应
|
||||
if self.broke == 100:
|
||||
# print("*****************************************")
|
||||
# print(f"in get_response if broke == 100 half = {self.half}")
|
||||
_half_1 = self.half
|
||||
_half_2 = data[:8-self.half_length]
|
||||
_full = _half_1 + _half_2
|
||||
# print(f"in get_response if broke == 100 _full = {_full}")
|
||||
|
||||
_frame_size = int.from_bytes(_full[:2], byteorder='big')
|
||||
_pkg_size = int.from_bytes(_full[2:6], byteorder='big')
|
||||
_protocol = int.from_bytes(_full[6:7], byteorder='big')
|
||||
_reserved = int.from_bytes(_full[7:8], byteorder='big')
|
||||
if _reserved != 0 or _protocol != 2:
|
||||
print(data)
|
||||
self.w2t("in get_response: 解包数据有误,需要确认!", 0, 1, 'red', tab_name=self.tab_name)
|
||||
|
||||
self.pkg_size = _pkg_size
|
||||
self.index = 8 - self.half_length
|
||||
# print(f"broke == 100 index = {self.index}")
|
||||
# print(f"broke == 100 INIT pkg size = {self.pkg_size}")
|
||||
# print(f"broke == 100 data = {data}")
|
||||
else:
|
||||
if self.reset_index == 1:
|
||||
self.index = 0
|
||||
|
||||
while self.index < len(data):
|
||||
# flag 为 0,则说明是一次新的请求对应的一次新的相应,也就是需要首次解包
|
||||
if self.flag == 0:
|
||||
if self.broke == 100:
|
||||
self.broke = 0
|
||||
else:
|
||||
self.index, _frame_size, self.pkg_size = self.header_check(self.index, data)
|
||||
# print(f"broke == 0 index = {self.index-8}")
|
||||
# print(f"broke == 0 INIT pkg size = {self.pkg_size}")
|
||||
# print(f"broke == 0 data = {data}")
|
||||
if self.index > MAX_FRAME_SIZE:
|
||||
break
|
||||
# 详见解包原理数据.txt,self.pkg_size 永远是除了当前data之外剩余未处理的数据大小
|
||||
if self.pkg_size <= len(data) - self.index:
|
||||
# 说明剩余部分的数据就在当前data内,没有被分割
|
||||
self.response = data[self.index:self.index + self.pkg_size].decode()
|
||||
self.msg_storage(flag=0, response=self.response)
|
||||
self.index += self.pkg_size
|
||||
# print(f"in flag=0 if data = {data}")
|
||||
# print(f"in flag=0 if index = {self.index}")
|
||||
# print(f"in flag=0 if pkg size = {self.pkg_size}")
|
||||
# print(f"in flag=0 if leftover = {self.leftover}")
|
||||
self.flag = 0
|
||||
self.response = ''
|
||||
self.leftover = 0
|
||||
self.pkg_size = 0
|
||||
self.reset_index = 0 if self.index < len(data) else 1
|
||||
elif self.pkg_size > len(data) - self.index:
|
||||
# 执行到这里说明该data是首包,且有有分包的情况发生了也就是该响应数据量稍微比较大
|
||||
# 分散在了相邻的两个及以上的data中,需要flag=1的处理
|
||||
self.flag = 1
|
||||
if self.index+_frame_size-6 <= len(data):
|
||||
self.response = data[self.index:self.index+_frame_size-6].decode()
|
||||
self.index += (_frame_size-6)
|
||||
self.pkg_size -= (_frame_size-6) # 详见解包原理数据.txt,self.pkg_size
|
||||
self.reset_index = 0
|
||||
|
||||
if self.index + 2 < len(data):
|
||||
self.leftover = int.from_bytes(data[self.index:self.index + 2], byteorder='big')
|
||||
self.index += 2
|
||||
self.reset_index = 0
|
||||
else:
|
||||
if self.index + 2 == len(data):
|
||||
self.broke = 1
|
||||
self.half = data[-2:]
|
||||
# print(f"flag = 0 encounter broke == 1 - half = {self.half}")
|
||||
elif self.index + 1 == len(data):
|
||||
self.broke = 2
|
||||
self.half = data[-1:]
|
||||
# print(f"flag = 0 encounter broke == 2 - half = {self.half}")
|
||||
elif self.index == len(data):
|
||||
# print('flag = 0 encounter broke == 3')
|
||||
self.broke = 3
|
||||
|
||||
self.index += MAX_FRAME_SIZE
|
||||
self.reset_index = 1
|
||||
break # 因为 index + 2 的大小超过 MAX_FRAME_SIZE
|
||||
|
||||
elif self.index+_frame_size-6 > len(data):
|
||||
self.response = data[self.index:].decode()
|
||||
self.pkg_size -= (len(data) - self.index) # 详见解包原理数据.txt,self.pkg_size
|
||||
self.leftover = (_frame_size-6-(len(data)-self.index))
|
||||
self.index += MAX_FRAME_SIZE
|
||||
self.reset_index = 1
|
||||
|
||||
# print(f"in flag=0 else data = {data}")
|
||||
# print(f"in flag=0 else index = {self.index}")
|
||||
# print(f"in flag=0 else pkg size = {self.pkg_size}")
|
||||
# print(f"in flag=0 else leftover = {self.leftover}")
|
||||
# break
|
||||
elif self.flag == 1:
|
||||
# 继续处理之前为接收完的数据,处理完之后将flag重置为0
|
||||
# !!!需要注意的是,包头/帧头也是有可能被分割开的!!!但是目前该程序未实现此种情况!!!
|
||||
if self.broke == 1:
|
||||
self.index = 0
|
||||
self.leftover = int.from_bytes(self.half, byteorder='big')
|
||||
self.broke = 0
|
||||
# print(f"broke 1 leftover: {self.leftover}")
|
||||
elif self.broke == 2:
|
||||
self.leftover = int.from_bytes(self.half+data[:1], byteorder='big')
|
||||
self.index = 1
|
||||
self.broke = 0
|
||||
# print(f"broke 2 leftover: {self.leftover}")
|
||||
if self.broke == 3:
|
||||
self.leftover = int.from_bytes(data[:2], byteorder='big')
|
||||
# print(f"broke 3 leftover: {self.leftover}")
|
||||
self.index = 2
|
||||
self.broke = 0
|
||||
while self.pkg_size > 0:
|
||||
if self.index + self.leftover <= len(data):
|
||||
# print(f"in pkg size > 0 loop before if data = {data}")
|
||||
# print(f"in pkg size > 0 loop before if index = {self.index}")
|
||||
# print(f"in pkg size > 0 loop before if pkg size = {self.pkg_size}")
|
||||
# print(f"in pkg size > 0 loop before if leftover = {self.leftover}")
|
||||
if self.leftover < 0 or self.leftover > 1024:
|
||||
self.w2t("", 0, 111, 'red')
|
||||
self.response += data[self.index:self.index + self.leftover].decode()
|
||||
self.pkg_size -= self.leftover
|
||||
if self.pkg_size == 0:
|
||||
self.msg_storage(flag=0, response=self.response)
|
||||
self.index += self.leftover
|
||||
self.flag = 0
|
||||
self.response = ''
|
||||
self.leftover = 0
|
||||
self.pkg_size = 0
|
||||
self.reset_index = 0 if self.index < len(data) else 1
|
||||
# print(f"in pkg size > 0 loop break if data = {data}")
|
||||
# print(f"in pkg size > 0 loop break if index = {self.index}")
|
||||
# print(f"in pkg size > 0 loop break if pkg size = {self.pkg_size}")
|
||||
# print(f"in pkg size > 0 loop break if leftover = {self.leftover}")
|
||||
break
|
||||
|
||||
self.index += self.leftover
|
||||
if self.index + 2 < len(data):
|
||||
self.leftover = int.from_bytes(data[self.index:self.index + 2], byteorder='big')
|
||||
self.index += 2
|
||||
self.reset_index = 0
|
||||
else:
|
||||
# self.leftover = 4096
|
||||
if self.index + 2 == len(data):
|
||||
self.broke = 1
|
||||
self.half = data[-2:]
|
||||
# print(f"flag = 1 encounter broke == 1 - half = {self.half}")
|
||||
elif self.index + 1 == len(data):
|
||||
self.broke = 2
|
||||
self.half = data[-1:]
|
||||
# print(f"flag = 1 encounter broke == 2 - half = {self.half}")
|
||||
elif self.index == len(data):
|
||||
# print('flag = 1 encounter broke == 3')
|
||||
self.broke = 3
|
||||
|
||||
self.index += MAX_FRAME_SIZE
|
||||
self.reset_index = 1
|
||||
break # 因为 index + 2 的大小超过 MAX_FRAME_SIZE
|
||||
# print(f"in pkg size > 0 loop after if data = {data}")
|
||||
# print(f"in pkg size > 0 loop after if index = {self.index}")
|
||||
# print(f"in pkg size > 0 loop after if pkg size = {self.pkg_size}")
|
||||
# print(f"in pkg size > 0 loop after if leftover = {self.leftover}")
|
||||
if self.leftover < 0 or self.leftover > 1024:
|
||||
self.w2t("", 0, 111, 'red')
|
||||
else:
|
||||
# print(f"in pkg size > 0 loop before else data = {data}")
|
||||
# print(f"in pkg size > 0 loop before else index = {self.index}")
|
||||
# print(f"in pkg size > 0 loop before else pkg size = {self.pkg_size}")
|
||||
# print(f"in pkg size > 0 loop before else leftover = {self.leftover}")
|
||||
if self.leftover < 0 or self.leftover > 1024:
|
||||
self.w2t("", 0, 111, 'red')
|
||||
self.response += data[self.index:].decode()
|
||||
self.leftover -= (len(data) - self.index)
|
||||
self.pkg_size -= (len(data) - self.index)
|
||||
self.index += MAX_FRAME_SIZE
|
||||
self.reset_index = 1
|
||||
# print(f"in pkg size > 0 loop after else data = {data}")
|
||||
# print(f"in pkg size > 0 loop after else index = {self.index}")
|
||||
# print(f"in pkg size > 0 loop after else pkg size = {self.pkg_size}")
|
||||
# print(f"in pkg size > 0 loop after else leftover = {self.leftover}")
|
||||
if self.leftover < 0 or self.leftover > 1024:
|
||||
self.w2t("", 0, 111, 'red')
|
||||
break # 该data内数据已经处理完毕,需要跳出大循环,通过break和index
|
||||
# else:
|
||||
# self.msg_storage(flag=0, response=self.response)
|
||||
# self.flag = 0
|
||||
# self.response = ''
|
||||
# self.leftover = 0
|
||||
# self.pkg_size = 0
|
||||
# self.index -= 2
|
||||
# self.reset_index = 0 if (len(data) > self.index > 0) else 1
|
||||
|
||||
def get_response_xs(self, data):
|
||||
if self.flag_xs == 0:
|
||||
if data[-1].decode() == '\r':
|
||||
_responses = data.decode().split('\r')
|
||||
for _response in _responses:
|
||||
self.msg_storage(flag=1, response=_response)
|
||||
|
||||
else:
|
||||
_responses = data.decode().split('\r')
|
||||
for _response in _responses[:-1]:
|
||||
if not _response:
|
||||
break
|
||||
self.msg_storage(flag=1, response=_response)
|
||||
|
||||
self.response_xs = _responses[-1]
|
||||
self.flag_xs = 1
|
||||
else:
|
||||
if data[-1].decode() == '\r':
|
||||
_responses = (self.response_xs.encode() + data).decode().split('\r')
|
||||
for _response in _responses:
|
||||
self.msg_storage(flag=1, response=_response)
|
||||
|
||||
self.response_xs = ''
|
||||
self.flag_xs = 0
|
||||
else:
|
||||
_responses = (self.response_xs.encode() + data).decode().split('\r')
|
||||
for _response in _responses[:-1]:
|
||||
if not _response:
|
||||
break
|
||||
self.msg_storage(flag=1, response=_response)
|
||||
|
||||
self.response_xs = _responses[-1]
|
||||
self.flag_xs = 1
|
||||
|
||||
def get_from_id(self, msg_id, flag=0):
|
||||
for i in range(3):
|
||||
messages = self.c_msg if flag == 0 else self.c_msg_xs
|
||||
for msg in messages:
|
||||
if msg_id is None:
|
||||
return None
|
||||
elif msg_id in msg:
|
||||
return msg
|
||||
sleep(1)
|
||||
else:
|
||||
return None
|
||||
|
||||
def package(self, cmd):
|
||||
_frame_head = (len(cmd) + 6).to_bytes(length=2, byteorder='big')
|
||||
_pkg_head = len(cmd).to_bytes(length=4, byteorder='big')
|
||||
_protocol = int(2).to_bytes(length=1, byteorder='big')
|
||||
_reserved = int(0).to_bytes(length=1, byteorder='big')
|
||||
return _frame_head + _pkg_head + _protocol + _reserved + cmd.encode()
|
||||
|
||||
def package_xs(self, cmd):
|
||||
return f"{dumps(cmd, separators=(',', ':'))}\r".encode()
|
||||
|
||||
def unpackage(self, sock):
|
||||
def to_read(conn, mask):
|
||||
data = conn.recv(MAX_FRAME_SIZE)
|
||||
if data:
|
||||
# print(data)
|
||||
self.get_response(data)
|
||||
else:
|
||||
print('closing', conn)
|
||||
sel.unregister(conn)
|
||||
conn.close()
|
||||
|
||||
sel = selectors.DefaultSelector()
|
||||
sel.register(sock, selectors.EVENT_READ, to_read)
|
||||
|
||||
while self.t_bool:
|
||||
events = sel.select()
|
||||
for key, mask in events:
|
||||
callback = key.data
|
||||
callback(key.fileobj, mask)
|
||||
|
||||
def unpackage_xs(self, sock):
|
||||
def to_read(conn, mask):
|
||||
data = conn.recv(1024) # Should be ready
|
||||
if data:
|
||||
# print(data)
|
||||
self.get_response_xs(data)
|
||||
else:
|
||||
print('closing', conn)
|
||||
sel.unregister(conn)
|
||||
conn.close()
|
||||
|
||||
sel = selectors.DefaultSelector()
|
||||
sel.register(sock, selectors.EVENT_READ, to_read)
|
||||
|
||||
while self.t_bool:
|
||||
events = sel.select()
|
||||
for key, mask in events:
|
||||
callback = key.data
|
||||
callback(key.fileobj, mask)
|
||||
|
||||
def gen_id(self, command):
|
||||
_now = time()
|
||||
_id = f"{command}-{_now}"
|
||||
return _id
|
||||
|
||||
def execution(self, command, flg=0, **kwargs):
|
||||
if flg == 0: # for old protocols
|
||||
req = None
|
||||
try:
|
||||
with open(f'{current_path}/../assets/templates/json/{command}.json', encoding='utf-8',
|
||||
mode='r') as f_json:
|
||||
req = load(f_json)
|
||||
except:
|
||||
self.w2t(f"暂不支持 {command} 功能,或确认该功能存在...", 0, 1, 'red', tab_name=self.tab_name)
|
||||
|
||||
match command:
|
||||
case 'state.set_tp_mode':
|
||||
req['data']['tp_mode'] = kwargs['tp_mode']
|
||||
case 'overview.set_autoload':
|
||||
req['data']['autoload_prj_path'] = kwargs['autoload_prj_path']
|
||||
case 'overview.reload':
|
||||
req['data']['prj_path'] = kwargs['prj_path']
|
||||
req['data']['tasks'] = kwargs['tasks']
|
||||
case 'rl_task.pp_to_main' | 'rl_task.run' | 'rl_task.stop':
|
||||
req['data']['tasks'] = kwargs['tasks']
|
||||
case 'diagnosis.set_params':
|
||||
req['data']['display_pdo_params'] = kwargs['display_pdo_params']
|
||||
case 'diagnosis.open':
|
||||
req['data']['open'] = kwargs['open']
|
||||
req['data']['display_open'] = kwargs['display_open']
|
||||
case 'register.set_value':
|
||||
req['data']['name'] = kwargs['name']
|
||||
req['data']['type'] = kwargs['type']
|
||||
req['data']['bias'] = kwargs['bias']
|
||||
req['data']['value'] = kwargs['value']
|
||||
case 'diagnosis.save':
|
||||
req['data']['save'] = kwargs['save']
|
||||
case _:
|
||||
pass
|
||||
|
||||
req['id'] = self.gen_id(command)
|
||||
# print(f"req = {req}")
|
||||
cmd = dumps(req, separators=(',', ':'))
|
||||
try:
|
||||
self.c.send(self.package(cmd))
|
||||
sleep(0.5)
|
||||
except Exception as Err:
|
||||
self.w2t(f"{cmd}\n请求发送失败...{Err}", 0, 0, 'red', tab_name=self.tab_name)
|
||||
|
||||
return req['id']
|
||||
|
||||
else: # for xService
|
||||
pass
|
Reference in New Issue
Block a user