zoukankan      html  css  js  c++  java
  • Motion control encoder extrapolation

    Flying Saw debug

    Part1 Encoder extrapolation

    Machine introduction

    A tube cutting saw, is working for cut tube to length in line.

    A measuring wheel measures the position of the tube, when cutlength reached the moving table gearon with the measuring wheel. When the table and measuring wheel synchronized, the saw blade start cut. After cut finished or the moving table reach back position, the table pos back to start position.

    This machine is controlled by siemens simotionD motion controller.The program is written by other engineer, after using for several month , user find some problems. I am in charge for on site commissioning.

    max line speed : 80m/min

    Problem1: cut length out of tolarence when accelaration and deceleration

    Appearance:

    When acceleration, actual cut length longer than set length.When deceleration, actual cut length shorter than set length. The length different could bigger than 10mm.

    Analyze:

    If an axis gearing/camming with another axis(or encoder), assume the gearing ratio is 1:1 and every parameter is default value. The slave position will always behind master position, because there is delay in the control loops.

    I check the program, and find the encoder has set position filter. As encoder is the master of the carriage, because there is some ocillation is the tube, using position filter is a good solution. The position filter in this project is 20ms + 20ms.
    Position filter has a good affect that the speed is smooth, and a bad affect that the filtered position is lagged behind the actual position.

    Position delayed  = encoderVelocity x filterTime
    

    Extrapolation

    There is several solution to handle the position difference. Extrapolation is an easy and effective method.

    Extrapolation position 
    = positionBeforeExtrapolation + ExtrapolationVelocity x ExtrapolationTime
    
    Extrapolation velocity = differential(Extrapolation position)
    

    The graph below is extrapolation signal flow. In the middle of graph, is extrapolation time. Before extrapolation ,there is a position filter in position channel , and a velocity filter in velocity channel. These two filter only effective when extrapolation time bigger than 0.

    Extrapolation setting method

    Step 1:

    In the FlyingSaw Axis interconnections, select "Actual value with extrapolation" of encoder.

    Step 2: set extrapolation velocity filter

    I prefer "mean value filter" than the "pt1/pt2" filter.
    velocity filter time could be 0.1 to 0.2s. This filter is very important, a smooth velocity ensured the extrapolation value is stable.

    Step 3:

    how long the extropolation time should be? experience should related to the system delay time. So I can write an equation here.

    extrapolation time ≈ Positionfiltertime + 2*ipo_time 
                       = 20ms + 20ms + 2ms = 42ms  (in this project)
    

    If you are not sure about the filter time, then try a smaller value, like 70% of the calulated value.


    Result

    After implement extrapolation, the cutting accuracy at acceleration and deceleration is much better, length different less than 2mm.

  • 相关阅读:
    20190430-screen、client、offset、scroll等JS中各种宽度距离
    20190423-Vscode与Sass不得不说的秘密(>^ω^<)
    20190422-外部导入CSS样式之link、CSS@import、Sass分音
    20190421-那些年使用过的CSS预处理器(CSS Preprocessor)之Sass and Less
    20190421-那些年使用过的CSS预处理器(CSS Preprocessor)
    20190409-层叠の层叠上下文、层叠水平、层叠顺序、z-index、伪元素层叠
    20190408-规范书写
    20190404-transition、transform转换、animation、媒体查询
    20190402-display展现、float浮动
    20190401-颜色书写
  • 原文地址:https://www.cnblogs.com/lion-zheng/p/6914991.html
Copyright © 2011-2022 走看看