Modeling and motion control of a pick and place machine ... - DiVA

83 downloads 983 Views 12MB Size Report
Jun 8, 2012 ... To minimize friction related heat generation Micronic Mydata is ..... MY100 A pick and place machine manufactured by Micronic Mydata which ...
Modeling and motion control of a pick and place machine with air bearings

ELISABETH AMANN

Master of Science Thesis Stockholm, Sweden 2012

Modeling and motion control of a pick and place machine with air bearings

Elisabeth Amann

Master of Science Thesis MMK 2012:40 MDA 436 KTH Industrial Engineering and Management Machine Design SE-100 44 STOCKHOLM

Master of Science Thesis MMK 2012:40 MDA 436 Modeling and motion control of a pick and place machine with air bearings

Elisabeth Amann Approved

Examiner

Supervisor

2012-06-08

Jan Wikander

Mikael Hellgren

Commissioner

Contact person

Micronic Mydata AB

Henrik Linde

Abstract To minimize friction related heat generation Micronic Mydata is interested in the option of using air bearings in future surface mounting machines, such as the successors of today's pick and place machine. The axes of interest is the linear motions in the horizontal plane whose objective is to place a component in the correct position on a PCB. The purpose of this thesis is to investigate the characteristics of air bearings and evaluate the achievable motion control performance for a new design with such bearings. For simplicity the smallest axis, the Y-axis which positions the PCB, has been used for testing. A background study has been done researching possible benefits and disadvantages of these bearings compared to the linear guide ball bearings used today. The properties of other parts of the system has also been studied, such as the permanent magnet linear motor used to actuate the motion, in order to design a good controller for the system. For the same reason similar motion control applications have been examined to see what approaches have been used to achieve as good positioning and trajectory following as possible. The information from the background study was used to identify system parameters such as friction and motor ripple which were used when designing a controller. The final version of the controller had a state feedback with integral action, a dual observer consisting of a state observer combined with a perturbation observer and feedforward of friction and motor ripple. The velocity estimation turned out to be problematic and even though it could be proved that a better velocity estimation would give better tracking performance no sufficient replacement for the current observer was found. Since the air bearings almost entirely lack friction disturbances such as erroneous velocity estimates have a larger effect than on the system with ball bearings which is well damped by friction. It has therefore not been possible to reach as good tracking performance with the air bearing design but there is reason to believe that sufficient performance can be achieved with a better velocity estimate.

Examensarbete MMK 2012:40 MDA 436 Modellering och rörelsestyrning av en pick and place maskin med luftlager

Elisabeth Amann Godkänt

Examinator

Handledare

2012-06-08

Jan Wikander

Mikael Hellgren

Uppdragsgivare

Kontaktperson

Micronic Mydata AB

Henrik Linde

Sammanfattning För att minimera värmealstring relaterad till friktion är Micronic Mydata intresserade av att använda luftlager i framtida maskiner, såsom efterföljarna till dagens pick and place maskin MY100. De axlar som man är intresserad av att byta lager på är de linjära rörelserna i det horisontella planet som placerar komponenter på förutbestämda platser på ett kretskort. Syftet med detta arbete är att undersöka egenskaperna hos luftlager och utvärdera vilken precision som går att uppnå i rörelsestyrningen för en ny design med sådana lager. För enkelhetens skull har den kortaste axeln använts i experimenten, Y-axeln, vilken har till uppgift att positionera kretskortet. En bakgrundsstudie har gjorts i vilken möjliga för- och nackdelar med luftlager har jämförts med de linjärskenstyrningar som används i maskinen idag. Egenskaperna även hos andra delar av systemet såsom linjärmotorn som driver rörelsen har också undersökts för att kunna designa en så bra reglering som möjligt. Av samma anledning har liknande tillämpningar för rörelsestyrning undersökts för att se vilka metoder som använts för att uppnå så bra positionering som möjligt. Informationen från bakgrundsstudien användes för att identifiera systemparametrar som friktion och motorrippel vilka användes för att designa regleringen. Den slutliga versionen av regulatorn bestod av en tillståndsåterkoppling med integrerande verkan, en dubbel observatör bestående av en tillståndsobservatör och en störningsobservatör samt framkoppling av friktion och motorrippel. Hastighetsuppskattningen visade sig vara den svåraste delen och även om det kunde bevisas att en bättre uppskattning av hastigheten skulle ge bättre positionering hittades ingen lämplig ersättare för observatören. Eftersom luftlagren är nästan helt friktionsfria får störningar såsom felaktig hastighetsmätning en större effekt än på systemet med kullager som är väl dämpat av friktionen. Det har därför inte varit möjligt att uppnå lika bra positionering med designen med luftlager men det är troligt att tillräckligt bra prestanda skulle kunna uppnås om ett bättre sätt att uppskatta hastigheten kunde hittas.

Acknowledgements I would like to thank several people who have provided valuable advice and support throughout the project: Thanks to Mikael Hellgren, my supervisor at KTH, for valuable input. At Micronic Mydata I would first and foremost like to thank my supervisor Henrik Linde for supporting me in everything from building test rigs to discussing research articles. I would also like to thank the rest of the servo software group: Joel Rundgren, Robert Axelsson, Adrian Marklund and Dan Zemac for valuable discussions. Thanks to Markus Halonen for designing the great test rig with air bearings. ¨ Thanks to Johan Ohlund for arranging all the practical details. Thanks to all the other great people at Micronic Mydata who have helped me throughout the project!

Contents 1 Introduction

1

2 Background 2.1 System overview . . . . . 2.2 Motor . . . . . . . . . . . 2.3 Air bearing setup . . . . . 2.4 Control structure . . . . . 2.5 Requirements and testing 2.5.1 Requirements . . . 2.5.2 Test cases . . . . .

. . . . . . .

. . . . . . .

. . . . . . .

. . . . . . .

. . . . . . .

3 Frame of reference 3.1 Bearings . . . . . . . . . . . . . . . 3.1.1 Air bearings . . . . . . . . . 3.1.2 Linear ball bearings . . . . 3.2 Motor . . . . . . . . . . . . . . . . 3.3 Applications . . . . . . . . . . . . . 3.4 Control strategies . . . . . . . . . . 3.4.1 Nomenclature . . . . . . . . 3.4.2 Pole placement . . . . . . . 3.4.3 State feedback with integral 3.4.4 Observers . . . . . . . . . . 3.4.5 Further development . . . . 3.5 Summary . . . . . . . . . . . . . .

. . . . . . .

. . . . . . .

. . . . . . .

. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . action . . . . . . . . . . . .

4 System identification 4.1 Test rigs . . . . . . . . . . . . . . . . . . 4.2 Bearing dynamics . . . . . . . . . . . . . 4.2.1 Model . . . . . . . . . . . . . . . 4.2.2 Simulation . . . . . . . . . . . . 4.2.3 Testing . . . . . . . . . . . . . . 4.3 Dynamics of Y-wagon with ball bearings 4.3.1 Friction . . . . . . . . . . . . . . 4.3.2 Cogging . . . . . . . . . . . . . . 4.4 Dynamics of Y-wagon with air bearings 4.4.1 Friction . . . . . . . . . . . . . . 4.4.2 Cogging . . . . . . . . . . . . . . 5 Controller design 5.1 Linear model . . . . 5.2 State feedback . . . 5.3 Feedforward . . . . . 5.4 Observer . . . . . . . 5.5 First results . . . . . 5.6 Improvements . . . . 5.6.1 Filtering . . . 5.6.2 Dual observer

. . . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

. . . . . . . . . . . .

. . . . . . . . . . .

. . . . . . . .

. . . . . . .

3 3 5 6 6 7 7 8

. . . . . . . . . . . .

9 9 9 12 13 14 15 15 15 16 16 17 18

. . . . . . . . . . .

19 19 21 21 22 24 26 26 27 29 29 30

. . . . . . . .

31 31 31 32 33 33 34 34 35

5.6.3 5.6.4 5.6.5

Integral observer . . . . . . . . . . . . . . . . . . . . . . . . . . . Comparison . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Choice of controller . . . . . . . . . . . . . . . . . . . . . . . . .

36 36 38

6 Results 6.1 Point-to-point movements . . . . . . . . . . . . . . . . . . . . . . . . . . 6.2 Constant velocity . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.3 Robustness to disturbances . . . . . . . . . . . . . . . . . . . . . . . . .

39 39 40 40

7 Analysis 7.1 Bearings . . . . . . . . . . . . 7.1.1 Air bearings . . . . . . 7.1.2 Stiffness and damping 7.2 Control performance . . . . . 7.2.1 Cogging feedforward . 7.2.2 Perturbation observer

. . . . . .

41 41 41 41 42 42 42

8 Discussion 8.1 Error sources . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8.2 Recommendations . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .

43 43 44

9 Conclusion

45

A Simulations of bearing dynamics

II

B Simulink models

V

. . . . . .

. . . . . .

. . . . . .

C Maple calculations D Bearing comparison measurements

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

. . . . . .

IX XIV

Acronyms CAN Controller Area Network. DSP Digital Signal Processors. IC Integrated Circuit. MEMS Microelectromechanical Systems. PCB Printed Circuit Board. PM Permanent Magnet. RMS Root Mean Square. SMT Surface Mount Technology.

Glossary Conveyor A table placed on the Y-wagon which holds the PCB in place while it is within the machine. It also has slots for different picking tools suitable for different components and for discarded components. MY100 A pick and place machine manufactured by Micronic Mydata which picks electrical components and places them on PCB’s. Observed velocity Velocity estimated by the state observer. Pick head The tool which gets components from the storage units and places them on the PCB. Raw velocity Velocity calculated by differentiating the position measurement, vraw = xk+1 −xk , where x is the position measurement and h the sampling time.. h X-axis The axis of the MY100 machine along which the wagon that holds the pick heads travel. X-wagon The wagon which moves the pick head between the component storages and the PCB. Y-axis The axis of the MY100 machine along which the wagon that holds the PCB travels. Y-wagon The wagon which moves the PCB while it is in the MY100 machine.

1.

Introduction

This chapter will introduce the reader to the background and problem formulation of the thesis as well as the methods used. A brief overview of the report structure will also be given. Company The research in this master thesis has been done on behalf of Micronic Mydata AB, a company which develops, manufactures and markets high precision pattern generators for manufacturing of photomasks and advanced Surface Mount Technology (SMT) equipment for flexible electronics production. The pattern generators are used for manufacturing of screens for e.g. TVs and computers, manufacturing of semiconductor Integrated Circuits (ICs) and for advanced electronic packaging. The surface mounting machines are used for placing electronic components on Printed Circuit Boards (PCBs) and stencil free application of solder paste.

Figure 1.1: The MY100 pick and place machine [1]

Problem The thesis work concerns the MY100 pick and place machine which can be seen in Figure 1.1. The motions in the machine are today driven by linear motors on caged ball linear guides. The company experiences that these guides have disadvantages like high noise level, heat generation, use of lubrication that might drip on the PCB and emission of particles. The heat generated from the bearings and the linear motor causes deflection of the frame which must be compensated with a complicated and expensive solution to get the desired accuracy. An alternative would be to replace the ball bearings with air bearings which do not have these disadvantages. Air bearings are non contact bearings which are fed with pressurized air and thereby provide a thin film on which the load can glide. Since there is no contact between the surfaces these bearings does not generate heat and are silent and free from lubricants. Micronic Mydata’s pattern generators already use air bearings, but the motion is slower, has significantly lower acceleration and the machines are operated in cleanrooms. The company is now interested in investigating whether air bearings would be a feasible solution for future pick and place machines. Purpose The thesis work concerns investigating, testing and evaluating the properties and possibilities of air bearings in the environment and operating conditions of a pick and place machine. The purpose is to investigate if equal performance can be achieved 1

with air bearings as with the current design. Questions of interest are: Can the motion control be as precise with air bearings as with the current design? How will the mechanical properties of the bearings, such as stiffness and damping, affect the motion control? Delimitations The project is limited to the motion control of the linear motors. The design of a test rig with air bearings has been done by the company and is outside the scope of this project. The mechanical properties of the bearings have only been evaluated with respect to how they can affect the motion control, not how the durability of the machine will be influenced. Limitations As it was not feasible to redesign an entire machine, a test rig consisting of one of the axes was used. This means that it has been used in a protected environment without any of the disturbances that are normally present in the machine. Also the limited time of the project has not allowed for any long term testing and it is thus not known how the performance varies over time. Method Two test rigs have been provided by Micronic Mydata, one with the same design as the current pick and place machine and one that has been redesigned for air bearings. The methods which have been used to evaluate the air bearings are: 1. Gathering of knowledge about air bearings and how these are used in precise motion control applications by literature reviews and interviews with Micronic Mydata personnel. 2. Modeling of the current system and the version with air bearings in Simulink. The models have been verified on the test rigs by using the log function of the pick and place machine software. 3. A controller has been designed for the new system in Matlab/Simulink and the theoretical performance of the two systems has been compared. 4. The controller has been implemented in the existing servo code and the performance of the test rig with air bearings has been tested. 5. Based on the test results conclusions has been drawn about the possibility of using air bearings in future pick and place machines. An alternative to using the machine software would have been to use dSpace which would have allowed for easier integration between the model and the measurements. This was not used since it was not available until late in the project, and since it was desired to see that the control algorithms could be implemented with the computational power available in the MY100. Report structure The report starts by giving an overview of the system that the tests were performed on and what requirements were posed on the air bearing design in Chapter 2. After that the frame of reference (Chapter 3) consisting of the theory present on air bearings and motion control of linear servo motors with and without air bearings is presented. A description of the mathematical models, simulation models and the test rigs in Chapter 4 is followed by the design of the controller in Chapter 5. The results are accounted for in Chapter 6 and an analysis of the tests with regard to the frame of reference is presented in Chapter 7. Finally in Chapter 8 a discussion of the advantages and disadvantages of the air bearings is held and recommendations are be given on the possibilities of using air bearings in future pick and place machines. 2

2.

Background

This chapter gives an overview of the system that has been examined and describes the important components. First the MY100 machine is described with focus on the parts that was used for testing in this project. Some of the important factors which have been fixed throughout the project are described, such as the linear motor and the design of the air bearing test rig. To give the reader an understanding of the starting point for the controller design also the structure of the controller used in the current machine is explained. Finally the requirements on the system are listed, as well as methods for testing them.

2.1

System overview

The machine of interest is the MY100 pick and place machine. The machine works with a split axis motion where the axes can be seen in Figure 2.1. The Y-wagon positions the PCB along the Y-axis and the X-wagon carries the pick head which gets components and places them on the PCB along the X-axis. The capacity of the fastest machine with two X-wagons is up to 50 000 components per hour, so the movements are quite fast with accelerations up to 35 m/s2 and speeds up to 4.5 m/s.

Figure 2.1: Directions of movement in the MY100 machine [2]

The tests were performed on the Y-axis movement since it was more convenient in size for building test rigs, but the essential components such as the motor is the same for both X and Y. The following part of this section will therefore give an overview of the Y-axis and how it communicates with the rest of the system. A sketch of the important units can be seen in Figure 2.2. The central computer runs a software designed by Micronic Mydata called TPSys, which controls all the parts of the machine and decides which movements should be done. This computer communicates with the different nodes via Controller Area Network (CAN). A node can be for example a motor controller card, like in this case the controller for the Y-axis. 3

Central computer CAN command encoder position data Controller card

voltage

Servo drive

current

Motor

force

Y-wagon

Y-axis MY100

Figure 2.2: Overwiew of the system

The controller card, called the CMOT (CAN Motor controller card), is located nearby the Y-axis. The CMOT contains hardware for communicating with the central computer over CAN and for controlling the movement of the Y-wagon. The node receives a command, typically a position that the Y-wagon should move to, and calculates the reference trajectories for the movement and implements a position feedback loop. The desired output current is converted to an analog voltage of ±10V which is sent to the servo amplifier. The servo amplifier is used to maintain the desired current fed to the linear motor which moves the Y-wagon along the axis. It takes in the analog voltage control signal from the CMOT and uses this as reference in an internal feedback loop based on motor parameters which controls the current. This is done by a 16 bit Digital Signal Processors (DSP). The output on the phases is a PWM signal. To align the phases correctly the amplifier must know the position of the motor relative the magnets which is why the encoder signal is fed back. The motor is a brushless linear motor where the coils move along a permanent magnet rail. This is an important part of the system and will be explained in more detail later in this chapter.

Figure 2.3: Drawing of the Y-module (source: Micronic Mydata)

The Y-wagon is as mentioned earlier responsible for positioning the PCBs. The PCB is held in place by a conveyor, mounted on top of the wagon, which is responsible for 4

keeping the board still and transporting it in and out of the MY100 when the machine is standing in a production line. The motor is mounted underneath the wagon which is mounted on linear guides. The bearings are preloaded by the magnetic force between the motor and the magnet rail. A drawing of the entire Y-module can be seen in Figure 2.3. Position measurement The position is measured by a linear incremental encoder with a resolution of 0.5 µm [22]. The redhead is mounted on the Y-wagon and the linear scale on the frame of the Y-module. The TTL(transistor-transistor logic)-pulses are counted by a counter on the CMOT which is sampled with a period of 420 µs. The encoder signal is also read by the servo amplifier as described earlier.

2.2

Motor

The motor used can be seen in Figure 2.4 and is a Permanent Magnet (PM) synchronous brushless linear motor where the coil set is moving along a rail with skewed magnets. All the motor parameters from the data sheet [23] can be seen in Table 2.1.

Figure 2.4: The linear motor used in the MY100, Anorad LCK-S-3-P-NC [23]

Table 2.1: Motor characteristics. All specifications are ±10%, for stand still conditions multiply continuous current and force by 0.9 [23].

Parameter Continuous force (FcT max ) Peak force (Fp ) 1s on. Force constant (Kf ) Back EMF (Ke ) Motor constant (Km = √FPcc ) Max power dissipation (PcT max ) Continuous current (IcT max ) Peak current (Ip1 ) 1s on Resistance p-p (R25 ) @ 25◦ C Inductance (L) p-p Maximum applied bus voltage (VDC Electrical time constant (τe ) Electrical cycle length (Ec ) Maximal coil temperature (tmax ) Magnetic attraction (Fa ) Thermal resistance (Rth ) Coil mass

Unit N N N/Apk Vp / m/s √ N/ W

W Apk (Arms ) Apk (Arms ) Ω mH V ms mm ◦C N ◦ C/W kg

Value 304 738 38.3 45.3 23.3 170 7.9(5.6) 25.0(17.7) 2.6 20.0 325 7.7 60 125 3416 0.59 4.0

An interesting thing to note is that the force constant is nonlinear (typically up to 5

75%) above the maximum continuous current. The motor has three phases configured in a Y-winding and essentially works like an unrolled rotary PM synchronous motor, described in [18]. A force is generated by driving a current through the windings where the magnetic field from the permanent magnets has the largest magnitude. The force can be written as F = BIL where B is the magnetic flux density in Tesla, I is the current in Ampere and L is the length of the wire in meters. Since the desired current through the different windings is dependent on the relative position of the moving coil set the encoder position of the Y-wagon is fed back to the servo amplifier which produces sine shaped current with a 120◦ offset between the phases.

2.3

Air bearing setup

The air bearing design was done by the company and is outside the scope of the thesis. A simple drawing of the Y-wagon with air bearings is shown in Figure 2.5. The bearings (shaded in the figure) are m attached to the wagon with ball joints to take up force in the normal direction of the bearing but allow movement caused by irregularities in the rail. The bearings are also fixed to prevent rotation around the z-axis. The picture shows a cross section of the Y-wagon with bearings and motor, there are two bearings on the left side of the wagon and four on the right side. The bearings run on a flat rail on the left side and a triangular on the right side. The magnetic attraction force between the coil and the permanent magnets of the motor, which is around 3500 N, keeps the wagon fixed vertically and the triangular rail controls the horizontal position. The lift generated by the pressurized air fed to the air bearings is large enough to keep the bearings flying some microns above the rails. The moving coil of the motor is mounted underneath the Y-wagon and the rail of permanent magnets is mounted between the bearing rails.

y-wagon motor z y

x Figure 2.5: Principle drawing of the Y-wagon with air bearings

2.4

Control structure Fz



40 The starting point of the controller design was the structure that is used in the curFn which can be seen in Figure 2.6. A trajectory planner, denoted rent MY100 machines, Fx in the figure, generates third order trajectories, which means that jerk, ”References” acceleration, velocity and position is defined for the entire movement. The box denoted ”System” is the servo drive, motor and Y-wagon from Figure 2.2 and the measured output y is the position of the Y-wagon. The control signal u is the sum of the feedforward control signal uf f and the controller’s control signal uc . The feedforward block calculates the current needed to get the desired acceleration aref and compensates for static and dynamic friction. The controller compensates for model errors by regulating the position and velocity errors, ep and ev to zero. Since only the position is measured an observer is implemented to estimate the velocity of the wagon. 6

uf f

Feedforward

References

aref vref pref



ev ep

Controller

uc

u

System

y



p

vobs Observer

Figure 2.6: Schematic of the controller used in the MY100 today

2.5

Requirements and testing

The goal of this project has been to see if the performance of the a machine with air bearings can be at least as good as the MY100 is today. The scope was narrowed down to the motion control of the system. To compare performance concrete requirements were necessary, which is why the following list was compiled by tests on a MY100 and interviews with people involved in developing the machine.

2.5.1

Requirements

1. The test rig with air bearings should have equal or better performance as the one with ball bearings in the following cases (a) Tracking of the acceleration trajectory (b) Tracking of the velocity trajectory (c) Tracking of the position trajectory (d) Overshoot in µm — current performance is around 8 µm (e) Settling time in ms — current performance is around 25 ms 2. Normal operation of the Y-axis should be possible, which means movement along trajectories with the specifications below. This should be done with normal load on the Y-wagon, corresponding to the most common conveyor T4 which weighs approximately 30 kg. (a) Accelerations up to 10 m/s2 (b) Velocities up to 2 m/s (c) Nominal smoothing time of 0.015 s → jerk of 32 · 103 m/s3 1 3. It is also desirable to simulate movement of the X-wagon, which means that the load is decreased to around 10 kg with the following requirements for the trajectories: (a) Accelerations up to 35 m/s2 or, due to limitation in travel distance, as high as possible below that 7

(b) Velocities up to 4.5 m/s or, due to limitation in travel distance, as high as possible below that (c) Maintain constant velocity of 1.8 m/s (±0.1m/s) after braking from a higher velocity. This is done when the pick head travels over a camera which inspects that the component is aligned correctly before it is placed on the PCB 4. The wagon should remain at the same position at standstill while exposed to typical disturbance forces present in the MY100, such as vibrations caused by movements from other axes

2.5.2

Test cases

Suitable tests for the requirements in Section 2.5.1 are described below. The list numbering corresponds to that in the earlier mentioned section. 1. The comparison with the linear bearing rig can be performed by plotting data from typical cases (below) for both rigs and compare them (a) – (c) Can be compared by largest absolute error and RMS of the deviation (d) – (e) Can be compared by direct measurements in the plot 2. The performance specification can be tested by making sure that the criteria in (1) are fulfilled at maximum jerk, acceleration and velocity 3. Can be tested by running typical cases (below) 4. Induce vibrations in the rig while regulating at a certain position

Typical cases For testing a list of interesting movements of the MY100 has been compiled. These correspond to the work that is usually done by the machine or are considered hard and is thus a good way of testing the performance of the controller. • Short point to point movement (20-100 mm). This is a normal movement for the y-axis. • Long point to point movement (entire axis). This is a normal movement for the x-axis. • Constant speed (low speeds also: about 20 mm/s). This is hard since there will be fewer encoder ticks per sampling time. • ”Cat ear” movement: fast-slow-fast. This kind of movement is used by the x-axis when passing the camera. It is important that the speed is kept constant since the picture will be useless if the speed is too high.

8

3.

Frame of reference

This chapter gives an overview of the relevant theory present about the area. The focus of this project is on the controller and the dynamics of the motor, wagon and frame. Neither the servo drive, nor the software for the central computer were altered and are thus not discussed in further detail. The focus is on the dynamics of the motor and bearings, both the ball and the air bearings, and motion control applications where similar motors and bearings have been used. Different control approaches are examined, starting from state feedback with a Luenberger observer and continuing to more advanced designs such as the perturbation observer.

3.1

Bearings

The main focus of the project is the performance of air bearings and since the bearings are the major difference between the test rigs it is interesting to investigate the properties of both kinds of bearings further. The problem formulation states that the desired advantage is the lack of friction but the question is whether this is only positive. It is also desirable to examine if there are other significant differences that might affect the performance of the machine, such as stiffness and damping of the bearings.

3.1.1

Air bearings

Air bearings are non-contact bearings where the bearing is separated from the guideway or shaft by a thin air film. There are two kinds, aerodynamic and aerostatic bearings, where the air film in the aerodynamic one is generated by the relative motion between the surfaces whereas the aerostatic one needs an external pressure source. In the case of the aerostatic bearing, the air is supplied through a valve and led out towards the guideway either by orifices or by a porous material [6]. The bearings used in this project were aerostatic linear porous media bearings so this is the kind that will be considered in the background study. The parameters of the bearings used in the test rig can be seen in Table 3.1. Table 3.1: Characteristics of the air bearings used in the test rig: New Way S124002 [21].

Parameter Size Viable pressure range Fly height Flow Ideal load Stiffness

Unit mm×mm bar µm NLPM N N/µm

Value 40×80 4-5.5 5 1.8 623 58

A picture of the bearings used in the test rig can be seen in Figure 3.1. The pressurized air is provided through the hole on the side of the bearing and the bearing is mounted with a ball joint from the top. It is important to use this kind of mounting where the bearing is fixed only radially so that is can adapt to unevenness in the guide material. Despite this adaptability it is important to have a smooth surface to fly on, no abrupt changes can be tolerated as this would cause the bearing to hit the guide. A slow incline or decline can be tolerated though. The manufacturer recommends guide surfaces like 9

granite, hard coated aluminum, ceramics, glass, stainless steel and plated steel with a suggested surface finish of 0.4 Ra [21]. The material used for the air supply is porous carbon. This should give the bearing a uniform pressure distribution, compared to traditional orifice type air bearings which have a pressure gradient across the air gap. According to the manufacturer this soft carbon material will also help protect the bearings at air failure since they can be moved along the support surface without damaging it.

Figure 3.1: The air bearings used in the test rig [21]

Possible advantages of the air bearings were described briefly in the introduction. The manufacturer of the air bearings used in the test rig state the following advantages [3]: • No static friction — since the bearings are non contact there will be no static friction and thus no positioning problems caused by the stick-slip effect. This gives an application with air bearings almost infinite resolution. • Zero wear — since there is no contact there will be no wear on the bearings. This gives both reduced maintenance and more consistent machine characteristics since the bearings do not change over time. • Smooth and silent motion — movement of the balls in a rolling element bearing give rise to both velocity ripple (although at nanometer level) and noise, which is eliminated with air bearings which have no contact with the guideway and no moving parts. • Higher speed and acceleration — since there are no moving parts with inertia in the air bearings, speed and acceleration can be significantly higher. • No lubrication means no contamination to the rest of the system. • No unwanted motion. Difference in size between the balls in a rolling element bearing give rise to unwanted and unpredictable motion in all directions. This is avoided with air bearings since there are no internal parts that can give rise to these motions. The possible cause of movement of the air bearings, height variations in the rails, is constant and can be compensated for in software. • Radial positioning — the air cushion of the air bearing adapts to small flatness deviations in the rail giving a smooth motion. The momentum of the balls on the other hand will amplify the unwanted motion and further damage the rail. 10

Given only this information the air bearings sound ideal, but it is important to bear in mind that this is marketing material with the sole purpose to sell air bearings. There are also disadvantages such as that the low flying height require a clean surface in order not to get stuck. The main problem would be fat or fluids since this is not easily pushed away by the bearing. There is also a case of instability called pneumatic hammer which will be described soon. The axial and radial characteristics will now be described further with respect to independent research that has been done in the field. Axial characteristics: The axial characteristic of interest is the friction, or lack thereof. Air bearings are often said to be frictionless which is not entirely true. From the research of Fujii [16], who investigated the frictional characteristics of air bearings, it can be concluded that there should only be viscous friction from the bearings. This friction was assumed to arise due to Couette flow, which is the laminar flow of a viscous fluid in the space between two parallel plates where one is moving relative to the other. According to the article the viscous friction can be calculated as in Equation (3.1). Fviscous = µair ·

S ·v h

(3.1)

where µair is the coefficient of viscosity of air, S is the surface area of the bearing, h is the thickness of the air film and v is the velocity of the bearing. For the air bearings of the Y-wagon this would approximately be Fviscous = 0.0185 · 10−3 P a · s ·

0.0032m2 · vm/s = 0.0118N s/m · v 0.000005m

which is at most (at 2 m/s) 0.0236 N per bearing or 0.1417 N for all six bearings. The viscosity coefficient of air is assumed to be approximately 1.85 · 10−5 Pa·s at room temperature. Radial characteristics: The radial characteristics of the bearings will determine how the system reacts to forces in other directions than along the Y-axis. The air film under the bearing has a stiffness that depends on the surface area of the bearing and a damping that depends also on the resistance of the air channels through the bearing, i.e. a porous media bearing has higher damping than an orifice bearing. The stiffness of the air bearings is given in the data sheet to be 58 N/µm [21], where the manufacturer describes that it has been measured experimentally by applying a known force to the bearing and measuring the change in flying height [21]. The damping on the other hand is not as easily defined and since porous media bearings is a relatively new phenomenon most literature concerns orifice bearings. Slocum et al. describes an estimation of the damping of rectangular porous air bearings shown in Equation (3.2) where w is the width of the bearing, L is the length, h is the flying height and µeff is the effective viscosity which is calculated according to Equation (3.3). This is based on the theory of squeeze film damping, a damping which arises when two close similar surfaces move towards or away from each other, and is governed by Reynold’s equation. Research has mostly been done on Microelectromechanical Systems (MEMS) but the results have been applied also to air bearings since the film thickness is similar.  w  µeff w3 L w b = 0.991 − 0.578 · , ≤1 L h3 L µ µeff = 1 + 9.64(λ/h)1.159

(3.2) (3.3)

The value of λ is stated in the article to be approximately 0.1µm for air and the viscosity is around 1.85 · 10−5 Pa·s. This gives a damping coefficient of approximately 477 kNs/m 11

for a 40x80 mm bearing and a flying height of 5µm. The experimental results of the article show however that the squeeze film approximation is not entirely true due to reflow through the porous material and suggests a reduction factor of 4.4 for the width and length of the bearing. This would give a damping coefficient of only 1.3 kNs/m. This is of course only valid for the particular setup in the article and cannot be assumed to hold for the test rig used in this project. Pneumatic hammer Pneumatic hammer is a state of instability where the bearing is vibrating radially, which is due to that the bearing cannot find a stable flying height. If the air is restricted by a gap that is slightly too small to allow equilibrium it will increase air pressure and push the bearing upward to widen the gap. This makes it easier for the air to escape and thus the pressure decreases and the bearing falls down again. This cycle repeats infinitely since there is no equilibrium point to be found. The manufacturer claims that the porous media bearings should however have a larger resistance to change in air flow due to the millions of tiny passageways on the face and therefore it should be difficult to change the air volume in the gap quickly, giving a naturally stable bearing [5].

3.1.2

Linear ball bearings

In a linear ball bearing the bearing slides against the balls which are then led back through a groove in the bearing. In the bearing used in the machine a ball cage is used to separate the balls and eliminate the friction between them [25].

Figure 3.2: The caged ball guide used in the machine today [26]

Axial characteristics The friction of the bearings consists of a static component referred to as seal resistance and a dynamic component that originates from the viscous force of the lubricant. The bearings used today have a seal resistance, which is the force needed to bring them in motion, of 3.5 N each. The static friction force, Ff , of rolling element bearings could be described as in Equation (3.4): Ff = µ · P + (Fsr · n)

(3.4)

where P is the load in N, µ is the coefficient of friction, Fsr is the seal resistance and n is the number of bearings in the system. According to the manufacturer of the bearings µ should be approximately 0.002-0.003. The viscous friction depends on factors as the lubrication of the bearing must be tested for the actual conditions [25]. Assuming a load of 3500 N this would give a static friction force of 21 N to 24.5 N. 12

Radial characteristics The stiffness of the ball bearings is essentially determined by the stiffness of the material used in the balls and the preload of the bearings. A greater preload will give a larger contact area due to deformation of the balls and thus an increased stiffness. A similar guide to the one in MY100 is tested in [11] and found to have a stiffness of approximately 42 N/µm without preload. According to the manufacturer of the bearings used in MY100 the effect of a preload gives up to 2.8 times increased rigidity [25], which would mean an approximate stiffness of up to 117 N/µm for the bearings. Given this information it is reasonable to assume that the ball bearings have a stiffness slightly above the one of the air bearings but still in the same range. The damping is harder to predict, in [24] it is described as very small and hard to measure since the damping of other parts of the structure will drown the damping of the bearings in the measurements. The damping is said to be due to friction inside the bearing and the lubrication. An attempt to measure damping in axial ball bearings was done in [14] and the value was about 10 kNs/m for a particular bearing which is significantly smaller than the value predicted for the air bearings (477 kNs/m) but larger than the value achieved after scaling of the bearing dimensions (1.3 kNs/m). In conclusion can be said that there is nothing indicating that this kind of air bearings would have inferior radial properties to the ball bearings.

3.2

Motor

The dynamics of the linear motor is essential when creating a model of the system. Several articles have been written about modeling and control of linear motors. Yao and Xu [27] modeled an iron core brushless DC linear motor from the Anorad LCK series (same series as the motor in the MY100) with the equation seen in (3.5) m¨ xL = Fm − B x˙ L − ff ric (x˙ L ) − fdis (t, xL , x˙ L )

(3.5)

Where xL is the displacement, m is the translating mass, FM is the force generated by the motor, B is the combined damping and viscous friction on the load, ff ric is a combination of stiction and Coulomb friction and fdis represents external disturbances. A simplified model is mentioned as commonly used, shown in Equation (3.6) Fm = KF i L

d i + Ri + KE x˙ L = u dt

(3.6)

Yao and Xu assumed that the simplified model might not describe the dynamics of an iron-core linear motor good enough since these motors also exhibit force ripple and cogging force. The cogging force is due to the magnetic attraction between the iron cores of the translator and the permanent magnets and is only dependent of the relative position between them. The magnetic attraction varies along the axis and the iron core will thus want to align at certain positions. The cogging force is periodic if the magnets are identical and equally pitched. The force ripple is described as a position dependent periodic variation of the force constant Kf . The enhanced model of the motor is described as Fm = KF (xL )i + fcogging (xL ) KF (xL ) = KF 0 + KF x (xL )

(3.7)

Bascetta et al. [7] also described a model of the force ripple in a permanent magnet linear synchronous motor. Opposed to the assumption in Equation (3.7) it is stated that 13

the aligning force of the motor (Fm in Equation (3.6) and (3.7)) is independent of the relative position of the slider and the magnets. Two main groups of forces are presented in the article; those which are functions of the current and those which are independent of the current. To the former group belongs: • Variations of the reluctance due to variations of the self inductance in the phase windings give variations in the motor force. • If the amplitude of the three phases are not exactly equal there will be a periodic disturbance of the overall force. • Imperfections in the current and back EMF waveforms. The current independent force is called cogging and is due to the attraction between the iron core of the slider and the permanent magnet rail. The slider will want to align at certain positions, seeking a path of minimum reluctance. Skewing the permanent magnets reduces but does not eliminate this force. The period of the disturbances will be proportional to the period of the permanent magnets, Ec [m], and the frequency of the cogging force is stated to be fcogging =

3.3

2π x˙ Ec

(3.8)

Applications

This section will describe different applications where air bearings are used today and which advantages and disadvantages that have been experienced in previous research. New Way Air Bearings which manufacture the bearings used in the test rig mention markets where they have delivered solutions on their website [4]. • Computed tomography where rotating x-ray assemblies scan patients use air bearings due to that a higher rotating speed that can be obtained and that a low noise level is desired in medical applications. • The Flat Panel Display industry use air bearings due to their cleanliness and increased precision in motion control. • In metrology and precision machine tools the air bearings are used due to the precision gained from the lack of friction. There are also examples in research where the implementation of air bearings has been investigated. The most common objective is to get rid of the stick-slip effect that regular bearings have due to friction and thus increase the precision, many focus on achieving nanometer precision. In [13] an air bearing application for high precision machine tools is implemented. It is stated in the article that the air bearings have the advantages of high stiffness and damping perpendicular to the direction of movement and no frictional effects like stick-slip. However the lack of friction in the feed direction leads to the absence of damping which according to the authors is a setback for the traditional cascaded control strategy commonly used. It is also said that modern linear roller guideways show no damping either and that the reasoning in the article is valid for those as well. Simulations are shown where the PID controller gives permanent oscillations when regulating at a desired position. A state space approach is suggested since it allows for almost arbitrary pole placement. In [15] Slocum et al. use a test rig with an open face linear motor (like the one used in the MY100) and porous media air bearings was built. The objective was that the 14

iron core motor could cause excessive loading and premature failure of rolling element bearings. Experiments were done to measure damping with the conclusion that it was better than for typical rolling element bearings but not as good as for hydrostatic bearings. Tests were implemented for a grinding application with satisfactory results, the process was said to be ”very smooth and quiet” and the machine was stiff enough to grind a part chatter free and remove stock better than a similar production machine. The focus of [9] is to compensate motor ripple and experiments are performed on two test rigs: one with air bearings and one with rolling element guideways. The motor used was also here an open face linear motor. It is stated that the test setup with rolling element bearings is more rigid than the one with air bearings and thus allows for a higher controller bandwidth and higher accelerations without excitation of resonance frequencies.

3.4

Control strategies

This section describes different approaches to designing a controller for the system. First the nomenclature that is used throughout the thesis is defined. A traditional state feedback controller with an observer is explained and the feedback is later extended with integral action. Finally some common strategies for dealing with the nonlinearities of iron core linear motors are investigated.

3.4.1

Nomenclature

The system definitions will be described in the state space as the controller preferably can be designed as state feedback [13]. In continuous time the system description will be the one in Equation (3.9) and the Laplace variable s is used for derivation. x˙ = Ax + Bu y = Cx + Du

(3.9)

The discrete time description will be the one in Equation (3.10) which is the definition given in [29] to define a time invariant system with periodic sampling time h. Differentiation is done with the Z-transform variable z. x(kh + h) = Φx(kh) + Γu(kh) y(kh) = Cx(kh) + Du(kh)

(3.10)

The conversion between the systems is done as in Equation (3.11), for a more detailed explanation see [29, pp. 32-37]. Φ = eAh Z h Γ= eAs dsB

(3.11)

0

Feedback gains will be denoted L and observer gains K.

3.4.2

Pole placement

The basic state feedback approach is described in [29, ch. 4]. The state feedback is calculated to place the poles in the desired position by setting the input to u = −Lx 15

which gives the state space system x˙ = (Φ − ΓL)x y = Cx The poles of the closed loop system are determined by the eigenvalues of the matrix Φ − ΓL and can thus be chosen arbitrarily by setting the values of the matrix L, given that the system is reachable. The reachability of the system can be determined by examining the controllability matrix (3.12). If the matrix has full rank n it is possible to find a control sequence such that any an arbitrary state can be reached from any initial state in finite time [29, p. 94]. Wc =

3.4.3

Γ ΦΓ · · · Φn−1 Γ



(3.12)

State feedback with integral action

An improved method of state feedback, with integral action, is described in [12]. The motive for introducing the integral term is that the traditional state feedback controller would introduce a steady state error which could be eliminated with integral control. The state vector is therefore extended with the integrated position error xN (t). This gives the continuous time system shown in Equation (3.13), where r(t) is the position reference.          0 B x(t) A 0 x(t) ˙ r(t) u(t) + + = 1 0 xN (t) −C 0 x˙ N (t)    x y= C 0 (3.13) xN The control law is described as in Equation(3.14) u(t) = Lx(t) + Le xN = −

L −Le





x xN

 (3.14)

Given this augmented system pole discretization and pole placement can be done as described earlier. It is concluded in the article that this kind of controller is superior to the traditional state feedback controller in terms of primarily eliminated steady state error but also diminished overshoot.

3.4.4

Observers

Since the velocity is not measured an observer can be used to estimate it. The estimated state vector x ˆ can be calculated with a full order observer as in equation (3.15). x ˆ(k + 1|k) = Φˆ x(k|k − 1) + Γu(k) + K (y(k) − C x ˆ(k|k − 1))

(3.15)

If the estimation error is denoted x ˜=x−x ˆ this error is described by Equation (3.16). x ˜(k + 1) = (Φ − KC) x ˜(k)

(3.16)

which means that the error will be stable if the matrix Φ − KC has all eigenvalues, or poles, within the unit circle. The observer poles can be placed in the same way as the 16

controller poles described earlier, as long as the observability matrix in Equation (3.17) has full rank [29, p. 99].   C  CΦ    Wo =  (3.17)  ..   . CΦn−1

The observer is typically chosen to be faster than the controller. It can be shown that if both the observer and the state feedback are stable the combination of them will also be stable and they can therefore be designed independently given that the system can be considered linear and time invariant [17, p. 200].

3.4.5

Further development

Starting in this basic technique of state feedback with observed states, many researchers try to find a way to compensate for the nonlinearities of the linear motor. One of the commonly used strategies is identification and feedforward of the motor ripple [9, 7] where the hardest part is the identification. Since cogging is position dependent the frequency will be well within the bandwidth of the controller at slow speeds. This is utilized in [7] where the cogging is identified by what is referred to as ”closed loop position dependent identification”. Essentially the motor is run at a slow and constant speed along the entire axis and the variations in the control signal is measured. Braembussche [9] use a test rig with air bearings and assume that since there is zero friction motor ripple will be the only force acting on the motor. The measurement is done by holding the motor at a known position and measuring the force with a force cell while gradually increasing the input voltage to the motor from 0 to 10 V. This is done at several positions to get the force variations along the axis. Another approach to taking care of the nonlinearities is to handle model uncertainties with the dual observer described in [10]. This consists not only of the state observer described earlier but also of a perturbation observer. A disturbance w is added to the system so that the state space description now looks like x(k + 1) =Φx(k) + Γu(k) + ΓD w(k) y(k) =Cx(k) + Du(k)

(3.18) (3.19)

This adds a term to the observer described in Equation (3.15) which now can be written as in Equation (3.20). x ˆ(k + 1|k) = Φˆ x(k|k − 1) + Γu(k) + K (y(k) − C x ˆ(k|k − 1)) + ΓD w(k) ˆ

(3.20)

the disturbance is estimated as w(k) ˆ = Qweq (k) where weq is calculated from Equation (3.18) as in Equation (3.21) where Γ+ is the D Moore-Penrose pseudo inverse of ΓD and Q is a low pass filter. weq (k) = Γ+ (ˆ x(k + 1) − Φˆ x(k) − Γu(k)) D

(3.21)

The purpose of the disturbance observer is to make the state observer more robust and to compensate for the disturbances in the controller. It is concluded that the perturbation observer eliminated bias effects in the estimated velocity which arise due to model uncertainties and thus greatly enhance the control system performance. The trajectory tracking performance was significantly improved compared to using only the state observer. 17

3.5

Summary

To summarize the frame of reference the air bearings are said to have many advantages, such as higher precision, silent movement and no wear. The radial properties are interesting to research further to see if there is any risk that the bearings will oscillate, but if the theory holds there is reason to believe that the damping and stiffness of the air bearings are sufficient. The motor properties have been investigated and it seems that the most problematic part is the motor ripple which is why this will be examined further. Some control strategies have been proposed and will be tested on the Y-axis later on.

18

4.

System identification

This chapter concerns the identification of different system parameters. The first section deals with the bearing dynamics to get an idea of if and how these will affect the performance of the positioning. The second section deals with the dynamics of the entire Y-wagon to create a model which can be used to design and test a controller. Since much is similar in the air bearing design and the MY100 as it is today the starting point has been to model and perform tests on a test rig consisting of a Y-wagon with the current machine design. A mathematical model of the system was created and implemented in Simulink. This could then be verified at the test rig by closed loop parameter identification and open loop step responses. This aided the creation of a model for the air bearing system and thus the controller design.

4.1

Test rigs

Two test rigs have been used, both are based on the Y-axis of the machine: one Y-wagon with frame identical to the one used in the MY100 machine and one modified version where air bearings are used. The difference was only in the guide rails and the wagon, the motor and the frame were identical in the two rigs. They were driven by the same software and hardware which control the Y-axis in the MY100, described in Section 2.1, but as the Y-module was used outside the machine the CAN commands were sent from a standalone computer. As the same setup was used for both test rigs and the focus has been to compare the performance between the rigs not so much effort has been put into investigating the performance of the particular hardware.

Figure 4.1: The test ball bearing test rig (right) and the air bearing test rig (left)

19

To simulate real conditions weights were added on top of the wagons to resemble the most common conveyor, T4 which weighs approximately 30 kg. Since the bolt that the weights were mounted on with the air bearing design was too short to fit more plates the air bearing test rig was only loaded with 20 kg. The ball bearing test rig was however loaded with 30 kg. This should not be an issue as the mass was changed in the software to fit the actual Y-wagon in both cases. The test rigs were propped up on steel profiles since the cable chain travels underneath the frame of the Y-axis. The frame was fixed between a wall and some weights to make it as stable as possible. A picture of the test rigs can be seen in Figure 4.1. It turned out that the bearings were dimensioned for a lower force than they were actually exposed to so the motor had to be mounted at a flying height above the recommended to decrease the attraction force between the coils and the magnets. The pressure was also increased to 6 bar to give increased lift power. A close-up of the wagon with air bearings can be seen in Figure 4.2.

Figure 4.2: Close-up of the Y-wagon with air bearings

To ensure that the test rig was reliable comparisons were made between the ball bearing test rig and a MY100 machine. Movements with different lengths were made and the reference tracking of the two Y-wagons were compared. An example of this can be seen in Figure 4.3 which is zoomed in at where the position reference stabilizes at the desired position.

Figure 4.3: Comparison of the MY100 machine and the ball bearing test rig. The x-axis shows time in seconds and the y-axis shows position in meters

20

It can be seen that both the machine and the test rig has a small overshoot. The main difference is that the overshoot of the test rig has a second bump which is not present in the machine. The initial idea was that this was caused by movements in the test rig due to the resultant force when the wagon braked but this could not be verified. The movement of the test rig was measured with a dial indicator to be maximum 0.1 mm when the Y-wagon moved with full stroke length, which can be considered sufficient for the testing. The likely cause of the behavior will be explained in detail later.

4.2

Bearing dynamics

As described in Chapter 3, the air bearings are probably not as rigid as the ball bearings so it is interesting to investigate how lateral and vertical forces will affect the wagon, as well as torque due to offsets in the center of mass. These forces might give rise to dislocations and oscillations in the wagon and disturbances to the encoder. m

4.2.1

Model

A model of the damping of a porous media air bearing has been presented in Equation (3.2) (p. 11), and the stiffness of the bearings is 58kN/m as seen in Table 3.1 (p. 9). The bearing was modeled as a mass-spring-damper system. To get the dynamics of the wagon it is desired to calculate the equivalent stiffness and damping for all six bearings. The forces acting on the Y-wagon can be a vertical force Fz , caused by gravity, magnetic y-wagon attraction or disturbances, or a horizontal force Fx , caused by vibrations in the machine. The forces can be divided in two components where the one parallel to the bearing will motor z be absorbed by the structure holding the bearing in place and the normal force will be absorbed by the air film ofy thex bearing. A sketch of the geometry can be seen in Figure 4.4.

Fz

40◦

Fn Fx

Figure 4.4: For a horizontal disturbance force Fx or a vertical force (gravity, magnetic attraction or disturbances) Fz acting on the Y-wagon it is the component Fn that will be absorbed by the air film of the bearing

The component Fn will be the one causing displacement of the bearing. Thus the stiffness and damping can be scaled according to Equation (4.1) which shows stiffness, although the same equations hold for damping. 1 kz = k · cos(40◦ ) kx = k · sin(40◦ )

(4.1)

This gives an equivalent mass-spring-damper system shown in Figure 4.5.

21

dx,tot m kx,tot kz,tot

dz,tot

Figure 4.5: Equivalent mass-spring-damper model of the Y-wagon

2dx The dampings and stiffnesses were estimated as shown in Equation (4.2), once again shown only for k but valid for d also. Fmotor 2kx rb kz,tot = 2k + 4k z rF kx,tot = 4kx (4.2) L ϕ 2dx The model in Figure 4.5 is represented by the equations in (4.3) m¨ z = F − dz,tot z˙ − kz,tot z m¨ x = F − dx,tot x˙ − kx,tot x

2kx

(4.3)

W Any offset of the motor force from the center of mass will give rise to a torque which will rotate the x and z axis. A sketch of the Y-wagon seen from above is shown in Figure 4.6. The force equation is shown in Equation (4.4), where J is the moment of inertia, calculated as in Equation(4.5). J ϕ¨ = Fmotor rF − 4dx rb2 ϕ˙ − 4kx rb2 ϕ m L2 + B 2 J= 12

4.2.2

(4.4)

 (4.5)

Simulation

The step responses for x, z and ϕ have been simulated in Matlab. The simulations were done both with a damping corresponding to the theoretical damping in Equation (3.2) (p. 11) and for a damping where the dimensions of the bearings were divided by a factor of 4.4 corresponding to the discussion in Section 3.1.1. Translation Simulations in x and z were done for a unit step, i.e. 1N. The transfer function from force to displacement in z is shown in Equation (4.6) and was derived from the Laplace transform of Equation (4.3). The corresponding transfer function has been used also for the displacement in x but with dx,tot and kx,tot .2 Z(s) = 22

1 F (s) ms2 + dz,tot s + kz,tot

(4.6)

kx,tot kz,tot

dz,tot

2dx

Fmotor

2kx

rb rF

L

ϕ

2dx

2kx W

Figure 4.6: Sketch of the Y-wagon with with applied motor force seen from above

The results for the simulations can be found in Appendix A, the z-direction can be seen in Figure A.1 and the x-direction can be seen in Figure A.2. The theoretical damping would result in no oscillations whatsoever whereas the scaled damping would give significant oscillations. An illustration of the behavior can be seen in Figure 4.7. Step response in z

−9

7

3

6

2.5

5

2 1.5

3 2

0.5

1

0.01

0.02 0.03 Time (seconds)

0.04

0.05

(a) Actual bearing dimensions

x 10

4

1

0 0

Step response in z

−9

x 10

Displacement [m]

Displacement [m]

3.5

2

0 0

0.01

0.02

0.03 0.04 Time (seconds)

0.05

0.06

0.07

(b) Scaled bearing dimensions

Figure 4.7: Simulations of a unit step (1N) in the z-direction for different dampings

Rotation Rotation around the z and x axis will give rise to an offset of the encoder which could possibly cause faulty readings. The effect will be larger around the z direction which is shown in Figure 4.6 due to that the distance from the encoder to the center of mass is larger here. Simulations have been done in Matlab with the transfer function from force to angle in Equation (4.7). rF F (s) (4.7) Φ(s) = 2 Js + 4dx rb2 s + 4kx rb2 The force was chosen to the maximum used force during movement along the y-axis, i.e. at 10 m/s2 . Like the translational simulations both the theoretical damping and the scaled one were simulated and the plots can be found in Appendix A, Figure A.3. The simulations showed that the offset angle would be in the order of tenths of milli-degrees. The offset of the encoder in the y-direction was then calculated as in Equation 4.8 where renc is the distance from the center of mass to the encoder. ∆y = renc sin (∆ϕ)

(4.8) 23

This gave that the maximum offset of the motor force from the center of mass can be 10 cm in order for ∆y to be less than 2 µm which is the mechanical resolution of the encoder.

4.2.3

Testing

To measure the stiffness and damping of the air bearings tests were performed by applying a force in the z-direction and measuring the step response in position of the Y-wagon. The force was applied by pressing down on the center of the wagon with a dynamometer to get a known force and then rapidly removing the pressure to get the step response. Measurements were done with capacitive sensors with a measuring range of 0-200 µm and the measured point was right above the flat rail bearings. To prevent motion in the Y-direction the wagon was secured by clamps. The test setup can be seen in Figure 4.8. The step responses of a step of approximately 100 N and 200 N can be seen in Figure

Figure 4.8: The test setup for measuring step responses in the z-direction

4.9. The capacitive sensors had analog output which is why there is some noise in the measurements. In the simulation the force was halved as it is assumed to spread evenly between the two sides of the wagon and the stiffness and damping 2k and 2d were used to represent the two bearings. No scaling factor was used for the bearing dimensions and it seems like the stiffness and damping corresponds well to the theoretical values. It must however be kept in mind that this is the step response for the entire wagon so the dynamics might differ from the actual bearings since the coupling is not entirely stiff. Another error source is the frame which might sag somewhat, but precautions were made by measuring as close to the supporting steel profiles as possible where very little movement of the frame could be detected.

24

−7

12

Step response in z

x 10

Displacement [m]

10 8 6 4 2 0 −0.05

0

0.05

0.1

Time (seconds) (a) 200 N step response, the red line is the simulated step and the blue is the measured one

Step response in z −7

6

x 10

Displacement [m]

5 4 3 2 1 0 −1 −0.05

0 Time (seconds) 0.05

0.1

(b) 100 N step response, the red line is the simulated step and the blue is the measured one

Figure 4.9: Step responses in the z-direction, i.e. when a force is applied on top of the Y-wagon

25

4.3

Dynamics of Y-wagon with ball bearings

Starting from the equations in Section 3.2, the motor and Y-wagon can be described by the following equation: m¨ x = Kf · i − Ff ric (x) ˙ − Fcog (x) − Fdis

(4.9)

where the linear displacement is denoted x, Ff ric is combined static and dynamic friction, Fcog is the cogging force and Fdis is a collective term for other disturbances. The servo amplifier has been regarded as an ideal current source and the electrical properties of the motor will thus not be modeled. The motor force constant Kf was regarded as constant even though the motor at maximum acceleration is operated above the region where the relation between current and force is linear. The disturbances were considered unknown so the interesting forces to investigate has been friction and cogging.

4.3.1

Friction

The friction force Ff ric (x) ˙ has been modeled as Coulomb friction plus viscous friction which gives the model in Equation (4.10). ( Fstatic , if x˙ = 0 Ff ric (x) ˙ = (4.10) Fkinetic + D · x, ˙ if x˙ 6= 0 The challenge was to identify the parameters Fstatic , Fkinetic and D. The following methods have been used for doing this: Static friction The static friction was tested in two ways: 1. By measuring the force that is required to move the wagon with a dynamometer. The power supply was completely turned off so that no current ran through the motor. 2. By applying a slowly increasing current to the motor and see what value was required to move the wagon. Due to the cogging force there were variations along the axis but Fstatic was determined to be approximately 40 N. Kinetic and viscous friction The combination of kinetic and viscous friction will give rise to a force during movement. Since the viscous friction is proportional to the speed the two parameters were measured by running the wagon at various constant speeds and plot the mean current versus the speed. The tests were done in both directions and for all speeds divisible by 100 ranging from 100 mm/s to 2000 mm/s, giving a total of 40 measurements.The mean current was plotted agains the current and a first order polynomial was fitted to the data points, both for positive and negative speeds. The polynomials for the positive and negative speeds is shown in Equation (4.11). The difference is very small and might depend on measurement errors. The alternative that the frame is slanting was ruled out by measuring with a spirit-level. ( Ff ric = 10.91x˙ + 27.92, if x˙ > 0 Ff ric (x) ˙ = (4.11) Ff ric = 9.87x˙ − 26.34, if x˙ < 0 26

The friction was estimated as the mean value of these two, i.e. Ff ric = 10.34x˙ ± 27.13 A plot of the estimated friction along with the measured data is shown in Figure 4.10. In addition to the measurements between 0.1 m/s and 2 m/s measurements were made with an interval of 0.01 m/s between 0.01 mm/s and 0.09 mm/s which captures the Stribeck effect. Friction force 60

40

Force [N]

20

0

−20

−40

−60 −2

−1.5

−1

−0.5

0 0.5 Velocity [m/s]

1

1.5

2

Figure 4.10: Measured (asterisks) and estimated (line) friction force

4.3.2

Cogging

The closed loop cogging identification from Section 3.4.5 was used to investigate the cogging force. The same data as in the friction identification was used but the mean current at the constant speed phase of the movement was subtracted from the current measurements and the residual current times the motor force constant was plotted against position which can be seen as the blue lines in Figure 4.11. Force variations at constant speed 50 40 30

Force [N]

20 10 0 −10 −20 −30 −40 −50 0.2

0.4

0.6

0.8 Position [m]

1

1.2

Figure 4.11: Measured cogging force, the blue line is the measured force variation and the red line is the modeled one

27

2π A theoretical cogging frequency was stated in [7] to be E · x˙ which is shown as the red c sine curve in the figure. The figure shows an apparent correlation between the measured force variation and the theoretical cogging force. The equation which generated the sine curve was also used as the inverse estimation of the cogging force and is shown in Equation (4.12). 2π Fcog = 10 sin( · x + 0.5) (4.12) Ec

The Y-wagon was modeled in Simulink to be able to compare the model with the test rig. The model can be seen in Appendix B, Figure B.1. The friction model described in Equation (4.10) as well as the cogging force described in Equation (4.12) has been implemented in the model. There is also a limitation in how much voltage the servo amplifier can supply. The model has been compared to the test rig by making a step in the current. For low currents the cogging is clearly visible which can be seen in the comparison between model and test rig shown in Figure 4.12. 0.4 0.35

velocity [m/s]

0.3 0.25 0.2 0.15 0.1 0.05 0

0

0.5

1 time [s]

1.5

2

1.5

2

(a) Simulink model 0.4 0.35

velocity [m/s]

0.3 0.25 0.2 0.15 0.1 0.05 0

0

0.5

1 time [s]

(b) Test rig

Figure 4.12: Step response for a step of 700 mA for the model (a) and the test rig (b)

28

4.4

Dynamics of Y-wagon with air bearings

The model of the Y-wagon with air bearings starts from Equation (4.9) just like the model of the Y-wagon with ball bearings. To as far as possible eliminate errors from the models the same parameter identification tests were done as in the previous section.

4.4.1

Friction

The friction measurements can be seen in Figure 4.13. The values are far above the theoretical zero static friction, which should depend mainly on the cable chain. It will be called friction throughout the report for simplicity but it is implied that this really means the collected forces from the cable chain. Friction force 15

10

Force [N]

5

0

−5

−10

−15

−20 −2

−1.5

−1

−0.5

0 0.5 Velocity [m/s]

1

1.5

2

Figure 4.13: Measured (asterisks) and estimated (line) friction force with air bearings

It is interesting that both the values and the shape of the curves are different in the positive and the negative direction. This likely depends on that the negative direction corresponds to pulling the cable chain out of its’ holder, which also includes lifting it. This should require more force than pushing the chain back and allowing it to fall down into the holder again. As opposed to the friction of the ball bearing test rig there is no stick-slip effect but the force steadily decreases as the velocity is lowered. The friction coefficients can be seen in Equation (4.13). ( Ff ric = 2.56x˙ + 7.39, if x˙ > 0 Ff ric (x) ˙ = Ff ric = 4.54x˙ − 9.74, if x˙ < 0

(4.13)

29

4.4.2

Cogging

The measured cogging force can be seen in Figure 4.14. Here the controller was slower than the one used for measuring cogging with the ball bearings so the signal is less noisy and it is possible to see not only the cogging frequency in Equation (4.12) but also the second harmonic of this. The resulting cogging force can be seen in Equation (4.14) Fcog = 5 sin(

2π 2π · x + 1.8) + 6 sin( · x + 2.0) Ec Ec

(4.14)

Force variations at constant speed 50 40 30

Force [N]

20 10 0 −10 −20 −30 −40 −50 0.3

0.4

0.5

0.6

0.7 0.8 Position [m]

0.9

1

1.1

Figure 4.14: Measured cogging force with air bearings, the blue line is the measured force variation and the red line is the modeled one

30

5.

Controller design

This chapter describes the design of the controller, observer and feedforward for the test rig with air bearings. A basic controller was implemented initially to investigate the properties of the system and see where further work had to be done. As it turned out the velocity estimation was the largest error source and different approaches to this has been tested such as dual observer, integral observer and filtering of the raw velocity obtained from differentiating the measured position. The evaluation of these different methods leads to a final choice of controller which will be used for the comparison with the ball bearing test rig.

5.1

Linear model

To design a controller for the system a linear state space model has been used. A very simple linear model of the motor and wagon is shown in Equation (5.1) m¨ x = Kf · i − Dx˙

(5.1)

where D is the viscous friction. This can be expressed in the state space as        0 0 1 x˙ 1 x1 = u + Kf D x˙ 2 x2 0 −m m  y= 1 0 x where the state x1 is the position, x2 is the velocity and u represents the current. Since the system is sampled a discrete model is desired rather than a continuous one. For the air bearings the viscous friction D has been shown to be close to zero so to simplify the calculations it was set to zero. This gave a double integrator system which has the discrete equivalent shown in Equation (5.2).   1 h Φ= 0 1   Γ=

5.2

2

1 Kf h 2 m Kf h m

  

(5.2)

State feedback

The controller has been designed with state feedback with integral action described in Section 3.4.3. The augmented system, where the integrated position error has been added, has the continuous representation shown in Equation (5.3), the viscous friction is assumed to be zero.        0 x˙ 1 0 1 0 x1  x˙ 2  =  0 0 0  x2  +  Kf  u m x˙ N −1 0 0 xN 0  y= 1 0 0 (5.3) 31

When the system is discretized the following representation is obtained:   1 h 0 1 0 Φaug =  0 1 2 −h − 2 h 1  K h2  1 2

Γaug

f

m Kf h   m 3 1 Kf h −6 m

 =

The controllability matrix in Equation (3.12) is shown in Equation (5.4) and can be shown to have full rank, which means that the system is reachable.   h

2 Kf h   Wc = · 1 m  2 − h6

3h 2

5h 2

1

1 2

2

− 7h6

− 19h 6

   

(5.4)

The poles were placed experimentally to be as fast as possible without giving rise to chattering in the control signal. As a starting point the poles p1 = −70 · 2π, p2 = −50 · 2π, p3 = −20 · 2π were used. Maple calculations of the discretization and pole placement can be found in Appendix C.

5.3

Feedforward

A feedforward current has been used, consisting of acceleration, friction and cogging feedforward. The acceleration component has been implemented simply as the force needed to accelerate the mass of the Y-wagon. The friction component consisted of a static part and a dynamic part which depended on the velocity. The cogging component has consisted of the identified cogging force in Equation (4.14). To minimize the computation time of the control sequence the sine was implemented by a lookup table. To verify the values of the friction and cogging measurements the Y-wagon was run with only feedforward force. Velocity with only feedforward control 0.25 with cogging ff reference velocity without cogging ff

Velocity [m/s]

0.2

0.15

0.1

0.05

0

1

2

3

4

5

6 Time [s]

7

8

9

10

11

Figure 5.1: Comparison of the velocity with no feedback with (blue) and without (red) cogging feedforward. The green line is the velocity reference.

The red line in Figure 5.1 shows the velocity when applying feedforward of acceleration 32

and friction. Large oscillations can be seen due to cogging which could be expected, but there are also slow variations in the force along the axis which probably can be traced back to the cable chain. When moving in the negative direction, i.e. pulling the cable chain out, the force is largest when the cable chain has to be lifted upwards from the holder. In the positive direction the force is largest right before the chain starts to fall back into the holder and at the end of the axis. The blue line in Figure 5.1 shows the velocity when applying a feedforward based on the cogging estimate in Equation 4.14. The amplitude and phase of the cogging force was tuned until the oscillations were almost gone as can be seen in the figure and the resulting force can be seen in Equation (5.5). The forces airing from the cable chain have not been included in the feedforward which is why the wagon accelerates at first and then slows down too early at the end of the movement. 2π 2π Fcog = 2 sin( · x + 1.8) + 4 sin( · x + 2.0) (5.5) Ec Ec

5.4

Observer

Initially a traditional Luenberger observer was implemented, as the one described in Section 3.4.4. The observability matrix from Equation (3.17) is shown in Equation (5.6) and has full rank, thus the system is observable.   1 0 (5.6) Wo = 1 h The poles of the observer were placed to have slightly faster dynamics than the closed loop poles, but slow enough to not cause chatter in the output. The poles were chosen as p1 = −100 · 2π, p2 = −100 · 2π. As neither the cable chain nor the cogging force were included in the observer model the feedforward current for these were subtracted from the current that is fed to the observer. The Simulink model used to simulate the closed loop system can be found in Appendix B, Figure B.2.

5.5

First results

As controller design is an iterative process point to point movements of the controller described above were evaluated to see where further development was needed. The tracking performance was acceptable bearing in mind that the controller had not yet been tuned but there was a significant undershoot in the position step as can be seen in Figure 5.2. 1.300050 reference pos faster poles slower poles

1.300040 1.300030

Position [m]

1.300020 1.300010 1.300000 1.299990 1.299980 1.299970 1.299960 1.299950 1.55

1.6

1.65 Time [s]

1.7

1.75

Figure 5.2: Position step with slower (larger undershoot, regulating slowly) and faster (less undershoot, oscillating) closed loop poles

33

The dynamics of the undershoot seemed independent of the controller dynamics as can be seen when comparing the step response for slower and faster poles in the state feedback. The same kind of undershoot although with a lower amplitude could also be seen at the ball bearing test rig so the alternative that the air bearings would somehow cause this could be ruled out. . To investigate the effect of the observer steps were made with velocity derived directly from measured position (raw velocity) instead of observed velocity and the result is shown in Figure 5.3.

1.100050

Position [m]

reference pos measured pos

1.100000

1.099950

0.66

0.68

0.7 0.72 Time [s]

0.74

0.76

Figure 5.3: Position step regulating at differentiated velocity

The undershoot was now completely gone and the dynamics looked more as they could be expected to. Unfortunately it is not possible to regulate at this velocity in a real application as it is noisy and gives too much chatter on the control signal, resulting in a screaming sound from the motor.

5.6

Improvements

Based on the results in the previous section the velocity measurement is the area with the greatest potential of improvement. This section therefore deals with different methods to improve this measurement either by filtering or by additions to the observer and finally leads to a choice of the controller used for comparing performance of the two test rigs.

5.6.1

Filtering

As regulating on differentiated velocity yielded positive results an approach from [19] was tried. Essentially more samples are used for the differentiation when the velocity is lower to filter out the noise and when the velocity is higher the calculated velocity is equal to the raw velocity used in Figure 5.3. This method proved to give less noise on the control signal but the delay added by the filter caused oscillations at lower speeds. The behavior otherwise was similar to the differentiated velocity and the poles were adjusted to get a good step response which can be seen in Figure 5.4. Even though there are small oscillations it also shows that it is possible to get significantly better 34

1.300050 reference pos measured pos

1.300040 1.300030

Position [m]

1.300020 1.300010 1.300000 1.299990 1.299980 1.299970 1.299960 1.299950 0.47

0.48

0.49

0.5

0.51

0.52 0.53 Time [s]

0.54

0.55

0.56

Figure 5.4: Position step using filtered velocity

control performance if the velocity measurement is improved. As can be seen in the figure overshoot is now only 9 µm but it settles rather slowly and it takes around 50 ms before it is within 1 µm of the desired position.

5.6.2

Dual observer

In an attempt to improve the observed velocity a dual observer, as described in Section 3.4.4, was implemented in order to decrease the sensitivity to modeling errors. The structure of the control system with this observer can be seen in Figure 5.5.

uf f

Feedforward

References

aref vref pref



ev ep

Controller

uc −

u

System

y



p

vobs

Disturbance observer

w ˆ

State observer

Figure 5.5: Schematic of the controller with the disturbance observer

To simplify the calculations the filter Q has been chosen as a first order low pass filter, seen in Equation (5.7). This filter has been discretized with Tustin’s approximation which maps the left half-s-plane to the unit disc in the z-plane [29, pp.294–295]. ωc Q= (5.7) s + ωc 35

5.6.3

Integral observer

Another technique used to cope with errors in the observer caused by model errors is adding an integrator to the observer as described in [8]. The purpose of this is to eliminate static errors in the observed states. The observer can then be written as in Equation (5.8). x ˆ(k + 1|k) = Φˆ x(k|k − 1) + Γu(k) + K (y(k) − C x ˆ(k|k − 1)) + Ki α(k) α(k + 1) = α(k) + y(k) − C x ˆ(k|k − 1)

(5.8)

The gain Ki was chosen experimentally as  Ki =

5.6.4

 1 100

Comparison

To examine the effects of adding the integral and the dual observer point to point movements for these configurations were logged and compared to a benchmark which had neither of the mentioned features. Also the cogging feedforward was tested to see what influence it had on the tracking performance. The movements were made in both directions and in the speeds 2, 0.5 and 0.1 m/s and standing still at a specified position to exclude that the differences were coincidental or velocity dependent. The comparison was based on both the Root Mean Square (RMS) value and the peak value of the position error and can be seen in Table 5.1-5.4. As it turned our that there were very little difference between the errors due to change in direction so the mean value of both directions is shown in the tables. Table 5.1: Comparison between the different control strategies proposed for the air bearing test rig. The table shows RMS and peak position errors while following a reference trajectory with a constant speed of 2 m/s.

RMS error[µm] Peak error[µm]

Benchmark 4.4 8

Cogging ff. 4.0 7

Dual observer 4.2 8

Integral observer 3.9 8

Table 5.2: Comparison between the different control strategies proposed for the air bearing test rig. The table shows RMS and peak position errors while following a reference trajectory with a constant speed of 0.5 m/s.

RMS error[µm] Peak error[µm]

Benchmark 2.2 5

Cogging ff. 1.4 2

Dual observer 2.3 5

Integral observer 3.4 7

Table 5.3: Comparison between the different control strategies proposed for the air bearing test rig. The table shows RMS and peak position errors while following a reference trajectory with a constant speed of 0.1 m/s.

RMS error[µm] Peak error[µm]

36

Benchmark 1.0 3

Cogging ff. 0.8 2

Dual observer 1.0 3

Integral observer 1.5 4

Table 5.4: Comparison between the different control strategies proposed for the air bearing test rig. The table shows RMS and peak position errors while regulating at standstill at a specified position.

RMS error[µm] Peak error[µm]

Benchmark 0.69 1.5

Cogging ff. 0.68 1.5

Dual observer 0.65 1.5

Integral observer 0.37 1.0

As can be seen the impact of the different additions to the controller vary with speed and operating condition. For all the movements except the 2 m/s one the integral observer gave worse tracking performance than the reference run, but it had significantly better performance when regulating at standstill. The disturbance observer showed little difference from the reference, perhaps due to that the parameters giving static errors were close enough to their actual values not to give any large bias in the velocity measurement. A test on the ball bearing rig where the static friction coefficient had been set too high can be seen in Figure 5.6.

−0.296 with dual observer reference without dual observer

−0.297

Velocity [m/s]

−0.298

−0.299

−0.3

−0.301

−0.302

0

0.1

0.2

0.3

0.4 0.5 Time [s]

0.6

0.7

0.8

0.9

Figure 5.6: Comparison with and without dual observer when wrong value of friction is used.

The figure shows the estimated velocity with and without the dual observer and a bias can be seen for the velocity estimation done without the dual observer. For clarity the raw velocity has been left out of the figure but it was aligned with the reference just like the velocity estimated with the dual observer. It can also be seen that the variations of the velocity estimated by the dual observer is smaller after settling at the constant velocity at 0.1 s which is also reflected in the position error which has an RMS value of 0.59 µm without and 0.47 µm with the dual observer during constant velocity (0.3 m/s). The cogging feedforward had the greatest impact on the position error during constant velocity which can be seen for the movement in 0.5 m/s. It is reasonable to assume that the slower movement, 0.1 m/s, is slow enough for the feedback to handle the cogging force variations. The lack of improvement for the faster movement, 2 m/s, might depend on that the delay from calculating cogging force to outputting it to the motor is too long. 37

Overall can be seen that at standstill it is the frequency of the deviations that is the problem and not the amplitude of them which is almost the same for all alternatives. For the movements at constant velocity the difference lies more in the amplitude. Besides from the constant velocity and standstill tests overshoot and settling time was also examined but there were very little difference between the alternatives.

5.6.5

Choice of controller

Finally a controller was chosen for the comparison with the ball bearing test rig. The goal was to get as short settling time and as little overshoot as possible since the most important requirement is that the Y-wagon settles at the desired position as soon as possible so that the component can be mounted accurately. The continuous controller poles were chosen as: T pc = −70 −50 −40 · 2π and the observer poles were chosen slightly faster: T po = −100 −100 · 2π The cogging feedforward from Equation (5.5) was used as it had proven to give improved tracking performance. The dual observer was chosen over the integral observer as the integral one gave too large tracking errors during movements, and it was possible to get sufficient performance when at standstill also with the other observers. The dual observer was used as it had proven to improve the velocity estimation when the parameters were incorrect. The Simulink model used to simulate the closed loop system with disturbance observer can be found in Appendix B, Figure B.3 and B.4.

38

6.

Results

To compare the performance of the air bearing test rig and the ball bearing one tests were performed with the typical cases described in Section 2.5.2. During the project it was discovered that the motor force constant Kf that was used in the code was incorrectly set to the peak-to-peak value instead of the RMS value which gave the behavior seen in Figure 4.3 (p. 20). To give a fair comparison between the bearing alternatives the parameters have been corrected also for the ball bearing test rig and the comparison was made between the test rigs rather than with the machine performance. The poles of the ball bearing test rig was placed at the same locations as in the machine which for the state feedback was T pc = −100 −30 −80 · 2π and for the observer po = −100 −100.1

T

· 2π

No cogging feedforward or disturbance observer were used for the ball bearing test rig but the friction values were changed to the ones measured in Section 4.3.1.

6.1

Point-to-point movements

Point-to-point movements were used to evaluate performance in terms of overshoot and settling time. Based on the typical cases both long movements (1.1m) and short movements (0.01 m and 0.001 m) were performed in both positive and negative direction. The overshoot was measured in µm and the settling time in ms until the position has settled within ±1µm of the desired position. A typical example of the dynamics can be seen in Figure 6.1.

1.300050 air−bearings ball−bearings reference

1.300040 1.300030

Position [m]

1.300020 1.300010 1.300000 1.299990 1.299980 1.299970 1.299960 1.299950

0.6

0.62

0.64

0.66 0.68 Time [s]

0.7

0.72

0.74

Figure 6.1: 1.1 m movement in positive direction

39

It can be seen that the behavior with the two kinds of bearings is similar, both exhibiting an undershoot when the reference velocity goes to zero. The main difference is that while the wagon with ball bearings is well damped the wagon with ball bearings experience large oscillations due to the lack of frictional damping. There was very little difference between the steps depending on length and direction, but all measurements of overshoot, undershoot and settling time can be found in Appendix D. In this case undershoot is defined as moving back in the direction that the wagon came from no matter whether this is defined as the positive or negative direction, and overshoot is defined as moving past the desired position.

6.2

Constant velocity

To compare performance at following reference trajectory at constant velocity tests have been performed running at 1.8 m/s which is the constant velocity needed by the X-wagon. As described in Section 2.5.1 the velocity error must stay within ±0.1m/s. To investigate this the peak and RMS value of the velocity error were used. It turned out that there were no problems fulfilling the requirements by far, as seen in Table 6.1. It can also be seen that the ball bearings perform better than the air bearings. This is partly due to that the air bearing test rig exhibit oscillatory behavior when regulating to constant velocity, disregarding the initial oscillation gives a RMS value at constant velocity of 0.0012 m/s. Table 6.1: Velocity error for constant speed motion

Air bearings Ball bearings

6.3

RMS [m/s] 0.0014 0.0010

Peak [m/s] 0.006 0.0025

Robustness to disturbances

Some minor disturbance tests were performed where disturbances were induced manually by moving the test rig in the order of 100 µm back and forth. The RMS and peak values of the position error were measured and can be found in Table 6.2. Although the peak value of the deviation was 3 µm for the air bearings it predominantly stayed within 1 µm which is the same as for the ball bearings. The difference rather lied in the frequency of the deviations which was considerably higher for the air bearings. Table 6.2: Velocity error for standstill with disturbance

Air bearings Ball bearings

40

RMS [µm] 0.44 0.16

Peak [µm] 3 1

7.

Analysis

This chapter analyzes the results with respect to the background study. The properties of the air bearings are examined first, starting with the advantages and disadvantages experienced during the tests followed by an analysis of the physical properties. After that the controller performance is evaluated with focus on the cogging feedforward and disturbance observer.

7.1

Bearings

The main difference between the bearings has as expected been the friction. The friction of the ball bearings was higher than the value anticipated in Section 3.1.2, but given the results from the friction measurements performed on the air bearings the cable chain adds a force opposite the direction of movement which corresponds well to the difference between the theoretical and measured friction value. The friction force still gave the largest contribution to the counteracting force though, and the force acting on the Ywagon with air bearings was only one fourth of the force acting on the one with ball bearings.

7.1.1

Air bearings

Many of the advantages described in 3.1.1 regard increasing the precision of the application by eliminating stick-slip and movements caused by the balls in ball bearings. Any increase in precision has however not been possible to measure due to lacking performance of the controller which seems to be the main limiting factor to the precision. The commonly mentioned advantage that the bearings are friction free holds for the bearings, but as can be seen in Figure 4.13 there is however a constant force acting on the wagon which is most likely caused by the cable chain. The most noticeable advantage of the air bearings is the smooth and silent motion — when the motor is turned off there is no hearable sound when moving the wagon back and forth along the Y-axis. The motor itself generates noise when it is regulating and the fans used to cool the motor are rather loud so the overall performance is not quite as silence as one would desire but it is a significant improvement from the ball bearing design. In conclusion can be said that the advantages that the bearing manufacturer list cannot be disproved but the precision of the other components of the machine does not make them justice.

7.1.2

Stiffness and damping

The radial characteristics of the air bearings have proven to be very close to the theoretical ones described in Section 3.1.1. There has not been any signs of pneumatic hammer either. Based on those dynamics there seems to be no mechanical hindrance for implementing the air bearings. It must however be kept in mind that the measurements were done for the entire wagon and not directly on the bearing.

41

7.2

Control performance

The controller proposed in the frame of reference with state feedback, dual observer and cogging feedforward has been implemented. It was mentioned in Section 3.3 that the absence of damping could be a problem and it has proven to give rise to oscillations both when the wagon is coming to a halt and when regulating at standstill. According to [13] the arbitrary pole placement of the state space approach should help avoiding permanent oscillations when regulating at standstill and it has been seen that the poles must be chosen carefully to avoid this behavior.

7.2.1

Cogging feedforward

In [9], which investigates the effects of cogging feedforward, the maximum position tracking error is diminished from around 50 µm to 15 µm when applying motor ripple feedforward to a test rig with air bearings. The measurements were done while following a reference trajectory with a maximum velocity of 0.5 m/s and a maximum acceleration of 5 m/s2 . For the Y-wagon running at 0.5 m/s there was an improvement from 5 µm to 2 µm in peak value which is approximately the same ratio as in the article. The effect was not as big for higher or lower velocities as seen in Section 5.6.4, something which is not mentioned in the article[9].

7.2.2

Perturbation observer

The perturbation observer was effective in removing biasing in the estimated velocity at higher speeds which gave a smaller velocity ripple and positioning error when the parameters were set incorrectly. At lower speeds the observer could not entirely remove bias even though there was an improvement. In [10] the RMS value of the position tracking error was 152.92 µm with only a state observer and 20.64 µm with the dual observer consisting of a state observer combined with a perturbation observer. The tests in Section 5.6.4 show that position tracking is almost identical with and without the perturbation observer. This might however be due to that the parameters had already been adjusted to fit the real values good enough not to give any bias. When incorrect static friction was set in the controller a difference could be seen in the tracking, but it was not close to the values seen in the article [10].

42

8.

Discussion

This chapter starts with a discussion of the results and the prospects of using air bearings in future pick and place machines. This is followed by a discussion of potential error sources and recommendations about future work on the subject. The report has shown that the performance with air bearings is not as good as the performance with ball bearings using the proposed control structure. The main problem has been oscillations when settling at a desired position which is probably caused by that the observer does not follow the actual velocity. There is although reason to believe that good performance could be achieved if the velocity measurement was improved, due to the tests that have been done with raw and filtered velocity. The general impression of the air bearing system is that it is more sensitive than the one with ball bearings which was especially evident when regulating at standstill. As very little force is needed to move the wagon, oscillations are easily induced when stopping or regulating at standstill. This would never happen to the same extent with ball bearings where the friction force damps the oscillations. These oscillations at standstills could be noticed by a high frequent noise from the motor but have been possible to avoid by adjusting the poles of the state feedback. It also seemed like adding an integral part to the observer helped with the standstill regulation.

8.1

Error sources

This section describes potential error sources and how they might have affected the outcome of the tests. • The Y-wagon with air bearings was not stiff in the lateral (x) direction, not due to the stiffness of the air film but due to the stiffness of the wagon itself and how the bearings were attached. This led to that the wagon could be moved sideways in the range of millimeters which caused the encoder to loose the reading of the linear scale if it was displaced in that direction. When the encoder was in the correct position it seemed to work fine and it normally did not lose the reading during movements but only after adjustments had been done to the wagon. It is however not possible to exclude the possibility that the encoder lost some pulses and that it amplified the oscillations seen in the step responses. The lack of stiffness in the x-direction also made it impossible to test if the stiffness of the bearings were sufficient in this direction since that was not the limiting factor. The calculations in Section 4.2 considered the wagon as stiff and can therefore not be used to predict the behavior of the current design of the Y-wagon with air-bearings. • The weights that were used to simulate the conveyor were fastened on a bolt and secured with a nut. The holes in the weights were significantly larger than the bolt and they were secured in place just by the friction of the nut. The nut loosened at least once which lead to movement of the weight plates. This resulted in more oscillations than usual and sometimes caused the encoder to lose track of the linear scale. It is not unlikely that the weights still moved a little and added to the amplitude of the oscillations, but except for the amplitude the dynamics were the same with and without weights. • The bearings were dimensioned for a slightly lower attraction force from the motor and no load such as a conveyor. Therefore the tests had to be done with the motor 43

at a higher flying height than ideal and the air pressure to the bearings at 6 bar instead of 4. This made it harder to estimate the motor force constant and might have affected the behavior of the system. Foremost it is important to keep this in mind in case that it was to be implemented in a machine. • The Y-axis used in the experiments were fixed on the floor and had no external disturbances. In reality there would be vibrations in the machine caused by the other axes moving and if this were to be implemented it must be tested with disturbances as well. It is reason to investigate especially the ability of the Ywagon standing still with disturbances as this has proven not to be trivial even without disturbance.

8.2

Recommendations

This section contains recommendations about what can be done to improve the performance with air bearings and what topics are interesting to research now. • First and foremost the velocity measurement should be improved, which could be done in several ways. The perhaps simplest, but also most expensive way is to change the encoder to one that has higher resolution which would give a raw velocity that is less noisy. Another way is to redesign the observer, so that it is less sensitive to modeling errors. An approach that might be worth a try is the observer in [20] which is developed specifically for applications with friction and cogging and use these as states in the observer. Another possible way is add more sensors, like in [28] where the combination of encoder and accelerometer measurements are used to estimate velocity. A quick fix to improve the overshoot and settling time is to decrease the sampling time. Experiments done with half the sampling time showed that the overshoot was decreased to approximately one third of its original value. The wagon still oscillated but with less amplitude since the controller could regulate the deviations faster. • It is necessary to make a design where the connection between the wagon and the bearings is stiff in the x-direction so there is no risk of the encoder loosing track of the linear scale. The design in the test rig was made to be easy to adjust which was convenient when it turned out that the motor needed a larger distance from the magnet to decrease the attraction force. If it were to be put in a machine it must however be possible to guarantee that the wagon stays in place once it is mounted on the Y-axis. • Tests were run at the rig intermittently for three weeks. No problems which could be traced to dirt on the guideways were discovered but to ensure that the air bearings can operate in normal factory environment long term tests should be performed. It would also be interesting to investigate how much particles can be tolerated on the guideways and how they affect the control performance. • There were no problems with the air supply during the testing but it is necessary to find a way to detect a pressure drop and stop the machine. The bearings are soft and will not cause damage to any other parts than themselves but if the pressure failure is detected early also this damage can be avoided.

44

9.

Conclusion

This report has investigated the possibility of implementing air bearings in the MY100 pick and place machine. The stiffness and damping of the air bearings have been investigated and compared to the linear ball guides which are in the machine today, with satisfactory results. The properties of the linear motor has been investigated which has resulted in a motor ripple feedforward which improved the trajectory following significantly, especially at mid-velocity. A disturbance observer has been implemented which gave insignificant improvements compared to what has been achieved in previous research. The overall control performance was considerably worse with air bearings than with ball bearings, which is probably caused by poor velocity estimation. The tests with air bearings achieved an overshoot of around 30 µm and a settling time of at best 75 ms, compared to 8 µm and at worst 25 ms with ball bearings. Experiments with raw and filtered velocity show that there is potential to achieve at least as good results with air bearings if the velocity measurement was improved. The recommendation to the company is to continue working on the velocity estimation which would give better performance with air bearings but also with the current design. The conclusion is that a machine with air bearings is achievable but would require more effort in the control design than a machine with ball bearings.

45

Bibliography [1] Micronic Mydata AB. Home/press/photo archive. http://www. micronic.se/www/main.nsf/content.xsp?action=openDocument\ &documentId=F4463AE7014D5A6FC125771F00661BCF\&cat=C81\&first=true, April 2012. [2] Micronic Mydata AB. My100e brochure. http://www.mydata.com/www2/ elements.nsf/(read)/B872A35342BA0F72C1257886006961B4/$file/MY100e% 20Brochure%20April%202011%20P-001-0230%20rev%200000.pdf, April 2012. [3] New Way Air Bearings. Home/design/basics/technology comparison. http://www. newwayairbearings.com/Technology-Comparisons, April 2012. [4] New Way Air Bearings. Home/solutions/markets. newwayairbearings.com/Markets, April 2012.

http://www.

[5] Andrew Devitt. Air bearings take off. PTdesign, pages 33–36, April 1999. [6] Andrew Devitt. Porous vs. orifice bearing technology, 1999. New Way Air Bearings. [7] Bascetta et al. Force ripple compensation in linear motors based on closed loop position-dependent identification. Transactions on Mechatronics, 15(3):349–359, June 2010. [8] Bodizs et al. On the design of integral observers for unbiased output estimation in the presence of uncertainty. Journal of Process Control, 21:379–390, 2011. [9] Braembussche et al. Accurate tracking control of linear synchronous motor machine tool axes. Mechatronics, 6(5):507–521, 1996. [10] Hamelin et al. Discrete-time state feedback with velocity estimation using a dual observer: Application to an underwater direct-drive grinding robot. IEEE/ASME Transactions on Mechatronics, 17(1):187–191, February 2012. [11] Hsiao et al. Study of prediction of linear motion guide rigidity through grey modeling of linear differential and linear difference equations. In Proceedings of the 9th WSEAS International Conference on Applied Mathematics, pages 174–180. WSEAS, 2006. [12] Ramli et al. Design and modeling of integral control state-feedback controller for implementation on servomotor control. In 6th WSEAS International Conference on Circuits, Systems, Electronics, Control and Signal Processing, pages 208–213. WSEAS, 2007. [13] Schmidt et al. Control approaches for high precision machine tools with air bearings. IEEE Transactions on Industrial Electronics, 46, 1999. [14] Shengping Fu et al. Numerical calculation of ball bearing exitation and application in multi-body dynamics simulation. In Computer-Aided Industrial Design and Conceptual Design, pages 596–600. IEEE, 2009. [15] Slocum et al. Linear motion carriage with aerostatic bearings preloaded by inclined iron core linear electrical motor. Precision Engineering, 27(2003):382–394, 2003. 46

[16] Yusako Fujii. Frictional characteristics of an aerostatic linear bearing. Tribology international, 39(2006):888–896, 2005. [17] Torkel Glad and Lennart Ljung. Reglerteknik – Grundl¨ aggande teori. Studentlitteratur, 4 edition, 2006. [18] Hans Johansson. Elektroteknik, chapter 7. KTH Institutionen f¨or Maskinkonstruktion Mekatronik, 2006. [19] G. Liu. On velocity estimation using position measurements. In Proceedings of the American Control Conference, pages 1115–1120. AACC, 2002. [20] J´er´emy Malaiz´e and Jean L´evine. An observer based design for cogging forces cancellation in permanent magnet linear motors. [21] New Way Air Bearings, Inc., Aston, Pennsylvania. Porous Media Air Bearing Solutions – Flat Rectangular, 2010. [22] Renishaw. RGH22 series redhead, 2008. [23] Rockwell Automation Inc. Anorad Iron Core and Ironless Linear Servo Motors, 2004. [24] M. Tadina and M. Bolteˇzar. Improved model of a ball bearing for the simulation of vibration signals due to faults during run-up. Journal of Sound and Vibration, 300(17):4287–4301, 2011. [25] THK. THK General Catalog. p. O14. [26] THK. Caged ball lm guide. http://www.thk.com/sites/default/files/thkcom/ images/ja/products/class/lmguide/cblmguide\_01.jpg, April 2012. [27] Bin Yao and Li Xu. Adaptive robust control of linear motors for precision manufacturing. In the 14th IFAC World Congress. IFAC, 1999. [28] Wen-Hong Zhu and Tom Lamarche. Velocity estimation by using position and acceleration sensors. IEEE Transactions on Industrial Electronics, 54(5):2706–2715, October 2007. [29] Karl. J ˚ Astr¨ om and Bj¨ orn Wittenmark. Computer controlled systems: theory and design. Prentice Hall, Upper Saddle River, New Jersey, 3rd edition, 1997.

I

A.

Simulations of bearing dynamics Step response in z

−9

3.5

x 10

3 Displacement [m]

2.5 2 1.5 1 0.5 0 0

0.01

0.02 0.03 Time (seconds)

0.04

0.05

(a) Actual bearing dimensions

Step response in z

−9

7

x 10

Displacement [m]

6 5 4 3 2 1 0 0

0.01

0.02

0.03 0.04 Time (seconds)

0.05

0.06

0.07

(b) Scaled bearing dimensions

Figure A.1: Simulations of a unit step (1 N) in z for different dampings

II

Step response in x

−9

7

x 10

Displacement [m]

6 5 4 3 2 1 0 0

0.01

0.02 0.03 Time (seconds)

0.04

0.05

(a) Actual bearing dimensions

Step response in x

−8

1.4

x 10

Displacement [m]

1.2 1 0.8 0.6 0.4 0.2 0 0

0.02

0.04

0.06 0.08 Time (seconds)

0.1

0.12

0.14

(b) Scaled bearing dimensions

Figure A.2: Simulations of a unit step (1 N) in x for different dampings

III

Step response in φ

−3

1

x 10

Displacement [deg]

0.8

0.6

0.4

0.2

0 0

0.01

0.02 0.03 Time (seconds)

0.04

0.05

(a) Actual bearing dimensions

Step response in φ

−3

1.8

x 10

1.6 Displacement [deg]

1.4 1.2 1 0.8 0.6 0.4 0.2 0 0

0.02

0.04

0.06 0.08 Time (seconds)

0.1

0.12

0.14

(b) Scaled bearing dimensions

Figure A.3: Simulations of a 100 mm offset of the motor force from the center of mass. The force is set to 400 N which is used at maximum acceleration.

IV

B.

Simulink models

Figure B.1: The Simulink model used to simulate the Y-wagon

V

Figure B.2: The Simulink model used to simulate the initial control of the Y-wagon

VI

Figure B.3: The Simulink model used to simulate the final control of the Y-wagon

VII

Figure B.4: The subsystem used to simulate the dual observer

VIII

C.

Maple calculations

IX

> > >

(1)

>

(2)

> >

(3)

>

(4)

> (5) > (6)

> (7)

>

(8)

> (9)

>

(10)

>

(11)

>

(12)

(12)

> (13) > (14)

> (15)

> (16) > > (17)

> > > cg = L1 == m * (2 + p(1) * p(2) * p(3) - p(1) - p(2) - p(3)) / h ^ 2 / Kf; > cg0 = L2 == -(m * (-11 + 2 * p(1) * p(2) * p(3) + 2 * p(1) + 2 * p(2) + 2 * p(3) + p(3) * p(2) + p(1) * p(2) + p(3) * p(1)) / h / Kf) / 0.6e1; >

cg1 = L3 == m * (-1 + p(1) * p(2) * p(3) + p(1) + p(2) + p(3) p(3) * p(2) - p(1) * p(2) - p(3) * p(1)) / Kf / h ^ 3; > >

D.

Bearing comparison measurements Table D.1: Measurements of step performance for air and ball bearings.

Air bearings 1.1 m positive 1.1 m negative 0.01 m positive 0.01 m negative 0.001 m positive 0.001 m negative Ball bearings 1.1 m positive 1.1 m negative 0.01 m positive 0.01 m negative 0.001 m positive 0.001 m negative

XIV

Undershoot [µm]

Overshoot [µm]

Settling time [ms]

26 26 29 36 34 33

15 15 13 18 30 28

100 100 62 75 85 75

6 7 9 9 8 8

1 4 2 3 6 6

13 25 20 22 16 17

Suggest Documents