烟台开发区网站建设,个人网站备案 照片,一起做网店普宁池尾,芜湖建设路小学网站文章目录 openpnp - SlotSchultzFeeder source code bugfix概述笔记openpnp源码调试环境排查思路开git分支查到的问题 - 1查到的问题 - 2查到的问题 - 3针对以上问题进行的逻辑修正D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\wizards\G… 文章目录 openpnp - SlotSchultzFeeder source code bugfix概述笔记openpnp源码调试环境排查思路开git分支查到的问题 - 1查到的问题 - 2查到的问题 - 3针对以上问题进行的逻辑修正D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\wizards\GcodeDriverConsole.javaD:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\GcodeDriver.javaD:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\GcodeAsyncDriver.javaD:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\feeder\wizards\SlotSchultzFeederConfigurationWizard.javaD:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\GcodeDriver.javaD:\my_openpnp\openpnp_github\src\main\java\org\openpnp\Main.java备注END openpnp - SlotSchultzFeeder source code bugfix 概述 我的openpnp设备接入的飞达是西门子二手飞达, 用openpnp提供的SlotSchultzFeeder. 发现原版openpnp有个问题(bug): 接入多个西门子飞达时, 因为要调整飞达参数(或仅仅就想确认一下参数), 切换到不同飞达时, 大概率会弹框报错. 报错的项目有多种(最多4种: 飞达ID取不到, 飞达送料数取不到, 步长取不到, 飞达状态取不到). 如果不使用openpnp, 而使用串口助手, 怎么发指令给mage2560控制底板, 飞达都可以正常控制, 回包都正常. 其实这个问题早发现了, 因为当时没到要大规模使用西门子二手飞达这步, 只要能通讯, 就说明飞达正常. 也没想去解决. 现在要将西门子二手飞达都挂上了, 要是时不时弹框报错, 那手工干预不起啊(这种骚扰顶不住, 这不成了被openpnp和飞达设备耍了么?) 现在必须要解决这个问题. 开始怀疑是mega2560控制板通讯处理有问题, 查了一下. 确实有问题. 但是不是编程逻辑的问题, 而是arduino库的问题. mega2560的arduino库, 无法做到能快速正确的处理多个连续(100ms之内)的串口命令. 这可能也不是arduino库的问题, 随便哪个MCU, 串口发送的包间隔速度小于MCU的处理单条串口命令的总时间, 都不能保证每一个命令都处理正确. 观察了一下openpnp的日志, 发现openpnp会在同一时间(10ms~20ms之内), 连续发送2条串口命令给飞达控制板. 这哪个MCU也扛不住啊. 用串口助手试了一下, 循环发送命令, 只要发送间隔200ms, 没有一次会让飞达控制板出错. 这就对了, 不能狂发命令给MCU啊. 这就需要改openpnp源码了, 将在同一时间连续不停的发送2条命令的地方找到, 简单处理一下, 在每条命令发送之前, 都至少需要间隔250ms以上才行. 间隔就用java自带的sleep处理一下. 对java不熟, 不想没事找事. 这次被openpnp逼的实在没招了. 非得自己动手才有吃的. 还好是维护性质的, 查引起bug的原因, 改点逻辑, 这个咱能搞. 笔记 openpnp源码调试环境 这个环境早就做了实验笔记(openpnp - 软件调试环境搭建), 在本地的环境还没动, 可以直接照着笔记实验, 开心. 真机智, 早就预料到了会有改openpnp源码那一天. 排查思路 根据日志和报错提示, 在工程中用字符串搜索大法 断点法. 让报错时, 停在断点上, 那就说明找对了地方. 用的IDE是, 挺好用的. 开git分支 我现在用的openpnp发布版本是 openpnp-dev-2022-0801 openpnp dev 代码的git url 为 : https://github.com/openpnp/openpnp.git, 先迁出到本地. 最新的代码日期为2023/3/15 openpnp-dev-2022-0801 对应的安装包为 OpenPnP-windows-x64-develop_2022-08-01_18-07-09.2a36a8d.exe 在git记录中查到2022-8-1上午, 是2022-8-1最后的实现代码. 在2022-8-1最后提交的代码处做了本地分支, 命名为openpnp_dev_2022_0801 在这个分支上做自己的修改. 查到的问题 - 1 openpnp的sendcommand函数, 参数只有回包超时时间, 而没有发送前需要sleep的时间. 这就导致发送者只要发送命令, 立刻就会被执行. 如果连续执行多条命令, 就会引起下位机处理不过来, 上位机也会处理错(因为接收是异步处理, 回包格式也不能区分出是哪个包, 就会错将不是自己的命令回包, 当作自己的, 这样从回包中取到的值的目标就错了, e.g. 飞达参数填错了位置). 查到的问题 - 2 确有连续狂发命令的地方. 在切换飞达条目时, 飞达界面上的4个数据(飞达ID, 飞达送料数, 步长, 飞达状态), 都不是存起来显示的, 而是切到新飞达条目, 就立刻取数据. 这就导致在飞达列表中切换到不同飞达条码时, 大概率会是mega2560处理不过来, 导致没回包, 或回包出错(e.g. 连发送的命令都没识别完整, 估计是被覆盖了, 因为缓冲区就64个字节, 有4个命令输入的缓冲区, 其实就一个缓冲区就够了, 主要是上位机发送的命令间隔太短了, 超出了下位机的通讯处理速度(下位机mage2560要将上位机命令转换为西门子飞达的实际通讯指令, 等飞达回包, 再转换为上位机能理解的回包, 这些都需要时间啊), 总是会出错, 这是跑不了的, 只是概率大小问题. 查到的问题 - 3 使用不同家做的冰沙主板时, 明明主板是好的, 串口也没问题, 但是有时要2~3次或者更多次才能和主板连接上. 最坏的情况是一直连不上主板(遇到过, 什么时候能连接上主板通讯, 都是靠运气) 准备给冰沙主板发连接命令时, 也要sleep之后, 才发给主板. 针对以上问题进行的逻辑修正 就按照git提交记录来, 不分先后. D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\wizards\GcodeDriverConsole.java driver.sendCommand(cmd, 5000, 300); // 参数3原来是没有的, 现在为发送前的sleep时间D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\GcodeDriver.java sendGcode(command, timeout, 0); // 如果确认这里只发一条, 且时机前后不会再发送其他串口指令, 发送前sleep时间就可以设置为0, 这个需要改完来验证.// 相关发送命令的函数都加上发送前sleep的参数protected void sendGcode(String gCode, long timeout, long time_sleep_before_send) throws Exception {if (gCode null) {return;}for (String command : gCode.split(\n)) {command command.trim();if (command.length() 0) {continue;}sendCommand(command, timeout, time_sleep_before_send);}}public void sendCommand(String command) throws Exception {sendCommand(command, timeoutMilliseconds, 0);}public void sendCommand(String command, long timeout, long time_sleep_before_send) throws Exception {// An error may have popped up in the meantime. Check and bail on it, before sending the next command. bailOnError();if (command null) {return;}Logger.debug([{}] {}, {}, {}, getCommunications().getConnectionName(), command, timeout, time_sleep_before_send);// 发送前sleep的实现, 就用Thread.sleep简单处理一下.if (time_sleep_before_send 0){Thread.sleep(time_sleep_before_send);}command preProcessCommand(command);D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\GcodeAsyncDriver.java Overridepublic void sendCommand(String command, long timeout, long time_sleep_before_send) throws Exception {if (waitedForCommands) {// We had a wait for commands and caller had the last chance to receive responses.waitedForCommands false;// If the caller did not get them, clear them now.responseQueue.clear();}bailOnError();if (command null) {return;}Logger.debug({} commandQueue.offer({}, {})..., getCommunications().getConnectionName(), command, timeout);if (time_sleep_before_send 0){Thread.sleep(time_sleep_before_send);} D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\feeder\wizards\SlotSchultzFeederConfigurationWizard.java 这个实现中, 有连发4条命令的地方, 封装一个私有函数, 用来ms延时 private void my_delay_ms(long ms){try {Thread.sleep(ms);}catch(InterruptedException e){// nothing, only catch// java: unreported exception java.lang.InterruptedException; must be caught or declared to be thrown}} public SlotSchultzFeederConfigurationWizard(SlotSchultzFeeder feeder) { // 这里是在飞达列表中切换会来的函数, 主要是填界面参数, 如果是在飞达设备中的参数, 从飞达中取出来, 再填入界面. // ...statusText new JTextField();statusText.setColumns(50);panelActuator.add(statusText, 8, 20);if(Configuration.get().getMachine().isEnabled()){// 命令不能并发, 下位机处理不过来.// openpnp原始实现连发了4条指令给飞达, 导致飞达处理不过来// 修正后, 在执行命令之前, 都sleep 300ms, 看日志, 249ms估计也可以.my_delay_ms(300); // add by lsgetIdActuatorAction.actionPerformed(null);my_delay_ms(300); // add by lsgetFeedCountActuatorAction.actionPerformed(null);my_delay_ms(300); // add by lspitchActuatorAction.actionPerformed(null);my_delay_ms(300); // add by lsstatusActuatorAction.actionPerformed(null);}for (Bank bank : SlotSchultzFeeder.getBanks()) {bankCb.addItem(bank);}// ...D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\machine\reference\driver\GcodeDriver.java public synchronized void connect() throws Exception {disconnectRequested false;getCommunications().connect();connected false;connectThreads();// Wait a bit while the controller starts upThread.sleep(connectWaitTimeMilliseconds);// Consume any startup messagestry {while (!receiveResponses().isEmpty()) {}}catch (Exception e) {}// Disable the machinesetEnabled(false);// Send startup Gcode// 加了参数3(发送前sleep的时间), 可能是connectThreads()和这里的发送命令有冲突, e.g. connectThreads()还没有关掉串口之类的// 要不就没法解释清楚为啥有时openpnp抛出串口被占用, 或者链接不上的情况.sendGcode_Ex(getCommand(null, CommandType.CONNECT_COMMAND), 200);connected true;}Overridepublic void setEnabled(boolean enabled) throws Exception {if (enabled !connected) {connect();}if (connected) {if (enabled) {// Assume a freshly re-enabled machine has no pending moves anymore.motionPending false;sendGcode_Ex(getCommand(null, CommandType.ENABLE_COMMAND), 200); // 在可能会在连续发送命令的时机, 加上发送前的sleep}else {try {sendGcode_Ex(getCommand(null, CommandType.DISABLE_COMMAND), 200);// 在可能会在连续发送命令的时机, 加上发送前的sleepdrainCommandQueue(getTimeoutAtMachineSpeed());}catch (Exception e) {// When the connection is lost, we have IO errors. We should still be able to go on// disabling the machine.Logger.warn(e);}}}if (connected !enabled) {if (isInSimulationMode() || !connectionKeepAlive) {disconnect();}}super.setEnabled(enabled);}// actutor执行的地方, 都有可能是连续发送命令的组合, 都加上睡完发送参数值Overridepublic void actuate(Actuator actuator, boolean on) throws Exception {String command getCommand(actuator, CommandType.ACTUATE_BOOLEAN_COMMAND);command substituteVariable(command, Id, actuator.getId());command substituteVariable(command, Name, actuator.getName());if (actuator instanceof ReferenceActuator) {command substituteVariable(command, Index, ((ReferenceActuator)actuator).getIndex());}command substituteVariable(command, BooleanValue, on);command substituteVariable(command, True, on ? on : null);command substituteVariable(command, False, on ? null : on);sendGcode_Ex(command, 200); // param2, sleep then sendSimulationModeMachine.simulateActuate(actuator, on, true);}Overridepublic void actuate(Actuator actuator, double value) throws Exception {String command getCommand(actuator, CommandType.ACTUATE_DOUBLE_COMMAND);command substituteVariable(command, Id, actuator.getId());command substituteVariable(command, Name, actuator.getName());if (actuator instanceof ReferenceActuator) {command substituteVariable(command, Index, ((ReferenceActuator)actuator).getIndex());}command substituteVariable(command, DoubleValue, value);command substituteVariable(command, IntegerValue, (int) value);sendGcode_Ex(command, 200); // param2, sleep then sendSimulationModeMachine.simulateActuate(actuator, value, true);}Overridepublic void actuate(Actuator actuator, String value) throws Exception {String command getCommand(actuator, CommandType.ACTUATE_STRING_COMMAND);command substituteVariable(command, Id, actuator.getId());command substituteVariable(command, Name, actuator.getName());if (actuator instanceof ReferenceActuator) {command substituteVariable(command, Index, ((ReferenceActuator)actuator).getIndex());}command substituteVariable(command, StringValue, value);sendGcode_Ex(command, 200); // param2, sleep then send}Overridepublic String actuatorRead(Actuator actuator, Object parameter) throws Exception {/** The logic here is a little complicated. This is the only driver method that is* not fire and forget. In this case, we need to know if the command was serviced or not* and throw an Exception if not.*/String command getCommand(actuator, CommandType.ACTUATOR_READ_COMMAND);String regex getCommand(actuator, CommandType.ACTUATOR_READ_REGEX);if (command ! null regex ! null) {command substituteVariable(command, Id, actuator.getId());command substituteVariable(command, Name, actuator.getName());if (actuator instanceof ReferenceActuator) {command substituteVariable(command, Index, ((ReferenceActuator)actuator).getIndex());}if (parameter ! null) {if (parameter instanceof Double) { // Backwards compatibilityDouble doubleParameter (Double) parameter;command substituteVariable(command, DoubleValue, doubleParameter);command substituteVariable(command, IntegerValue, (int) doubleParameter.doubleValue());}command substituteVariable(command, Value, parameter);}sendGcode_Ex(command, 200); // actor相关的命令, 都加上睡后发送// 原始的实现为了方便调用, 只加了回包超时参数, 现在加入一个新参数time_sleep_before_sendprotected void sendGcode_Ex(String gCode, long time_sleep_before_send) throws Exception {sendGcode_Ex(gCode, timeoutMilliseconds, time_sleep_before_send);}protected void sendGcode_Ex(String gCode, long timeout, long time_sleep_before_send) throws Exception {if (gCode null) {return;}for (String command : gCode.split(\n)) {command command.trim();if (command.length() 0) {continue;}sendCommand(command, timeout, time_sleep_before_send);}}public void sendCommand(String command) throws Exception {sendCommand(command, timeoutMilliseconds, 0);}public void sendCommand(String command, long timeout, long time_sleep_before_send) throws Exception {// An error may have popped up in the meantime. Check and bail on it, before sending the next command. bailOnError();if (command null) {return;}Logger.debug([{}] {}, {}, {}, getCommunications().getConnectionName(), command, timeout, time_sleep_before_send);if (command M610N3){Logger.debug(bp);}if (time_sleep_before_send 0){Thread.sleep(time_sleep_before_send);}// ... D:\my_openpnp\openpnp_github\src\main\java\org\openpnp\Main.java 改过的程序, 给个新版本号, 和官方实现区分开. public class Main {public static String getVersion() {String version Main.class.getPackage().getImplementationVersion();if (version null) {// 没看清getImplementationVersion()从哪取的版本信息, 先硬写一个临时版本号version INTERNAL BUILD - base 2022-8-1 last, ls 2023_1026_0608PM;}return version;}备注 用IEDA带着程序跑起来(调试状态, run状态), openpnp控制设备都好使. 此时, 在添加好的飞达列表中的飞达之间切换, 会卡大概1秒钟, 然后就会正常显示飞达信息. 这个1秒多时间的卡, 如果是自动贴片的时候(e.g. 自动取料时, 如果换了一个飞达供料, 也可能会重新取飞达参数, 遇到过在自动贴片过程中, 弹出取不到飞达ID的情况), 根本感觉不到. 问题已经解决了, 暂时未发现不良影响 剩下的是事情就是将修改完的程序发布给自己用, 脱离IDE的环境. 这个也做完实验了, 确定可以简易发布给自己其他计算机用. 这个在下一篇笔记中记录, 和修改源码没关系. 也是为了自己以后好按照关键字来找笔记, e.g. 在oepnpnp栏目搜索包含打包关键字的笔记, 就能找到如何发布openpnp程序给自己用. END