Integration Project Systems and Control 2013 Group 3

From Control Systems Technology Group
Jump to navigation Jump to search

Group Members

Name: Student id: Email:
Joep Alleleijn 0760626 j.h.h.m.alleleijn@student.tue.nl
E. Romero Sahagun 0827538 e.romero.sahagun@student.tue.nl
M. Kabacinski 0789360 m.j.kabacinski@student.tue.nl
N. Kontaras 0827208 n.kontaras@student.tue.nl
A. Simon 0676675 a.s.simon@student.tue.nl

Planning

Week: Activities:
Feb 18 - Feb 24
- Make a list for the requirements of the controller
- Prepare and conduct tests for coupling/decoupling(JA,NK,MK) 3.5 hours
- Prepare and conduct tests for non linearity (JA,NK,MK) 3.5 hours
- Prepare and conduct tests for joint identification and create FRF models of the joints (JA,NK,MK) 5 hours
- Set up DH transfer matrices (AS) 5 hours
- Generate Matlab Simulation of the kinematic chain (ER) 7 Hours
Feb 25 - Mar 3
- Finish tests for moving direction and create FRF models of the moving direction, moving direction is (JA,NK,MK) 5 hours
- Design PID feedback controller, add feedforward and test on the robot for each axis of freedom (JA,NK,MK) 11 hours
- Prepare testing procedure, for following of the trajectory and checking of the requirements (JA,NK,MK) 1.5 hours
- Matlab code for trajectory generation (TG) (ER) 5 hours
Mar 4 - Mar 11
- Test controllers on the robot (JA,NK,MK) 2 hours
- Test trajectory generation on the simulation (ER) 3 hours
- Integrate Inverse Kinematics with Controllers (AS,ER) 2 hours
Mar 12 - Mar 19
- Consider different controller design methods (JA,NK,MK,AS,ER) 10 hours
- Work on report (JA,NK,MK,AS,ER) 2 hours
Mar 20 - Mar 27
- Test routine generation on the robot (JA,NK,MK,AS,ER) 2 hours
- Select optimal routine (JA,NK,MK,AS,ER) 4 hours
- Problem solving (JA,NK,MK,AS,ER) 10 hours
- Consider different controller design methods (JA,NK,MK,AS,ER) 10 hours
- Test different controllers (JA,NK,MK,AS,ER) 5 hours
- Work on report (JA,NK,MK,AS,ER) 2 hours
Mar 28 - Apr 4
- Work on report (JA,NK,MK,AS,ER) 15 hours
- Prepare presentation (JA,NK,MK,AS,ER) 5 hours

Progress

Week 1: Feb 18 - Feb 24

1 Make a list of the requirements and design assumptions for the controller
Controller requirements:
- Each of the four inputs of the robot is required to follow the third order trajectory, thereby the resulting trajectory of the fork will be appropriate to safely move the three pizzas form there initial positions to the final positions.
- The error between the reference trajectory and the actual trajectory of the fork has to be smaller then 0.5 cm during the whole time of operation.
- The settling time of the controller needs to be less 0.5 seconds.
- The acceleration applied to the platform has to be as high as possible without a pizza falling of the platform while following the trajectory.
- The total time of transport of the three pizzas should be less 15 seconds.


Design assumptions:
- Position will be used as input reference for the pizza robot. The pizza robot provides its position as output, this information can be used to compare to the desired position in closed loop control.
- The controller works with the sampling frequency of 500 Hz, because the sampling frequency of the system is 500 Hz.
- FRF will be used to obtain a model of the system. This method can be used to obtain a model of a system without knowing all the parameters of the system.
- Initially a PID controller will be used to follow the setpoint trajectory. A PID controller will be used because it is a simple controller and every team member is familiar with the concept. To increase performance this PID controller can be extended with feedforward block. When this controller functions according to the set requirements, different control methods will be explored to investigate if it would be possible to increase performance.


2 Prepare and conduct tests for coupling/decoupling (JA,NK,MK)
Have not done yet, task is postponed to the next week. However so far we have not encountered problems with decoupling. It seems that the complete system can be approached as several SISO systems. This makes it possible to use decoupled (diagonal) controller. More detailed test are to be carried out next week.


3 Prepare and conduct tests for non linearity (JA,NK,MK)
Have not done yet, task is postponed to the next week.


4 Prepare and conduct tests for joint identification and create FRF models of the joints (JA,NK,MK)
Started with FRF measurements, takes longer then expected. Especially for the vertical movement it is challenge to conduct a measurement without hitting the airbag limits of the machine.

Most recent FRF models of the vertival fork displacement:

FRF vertical movement.jpg
FRF vertical movement (2).jpg
5 Set up DH transfer matrices (AS)
Inverse kinematics do not have to be determined, this has been already done, only trajectory and controllers have to be developed.


6 Generate Matlab Simulation of the kinematic chain (ER)
Kinematic chain is already provided.


7 Trajectory and Path Generation (AS,ER)
LSBP (Linear Segments with Parabolic Blends) and Quintic polynomial trajectory functions have been programmed, as well as a generic script for path generation using these functions. The functions allow to create the fastest trajectory between two points based on acceleration restrictions.

Week 2: Feb 25 - Mar 3

1 Make a list for the requirements of the controller
2 Prepare and conduct tests for coupling/decoupling(JA,NK,MK) 3.5 hours
3 Prepare and conduct tests for non linearity (JA,NK,MK) 3.5 hours
4 Prepare and conduct tests for joint identification and create FRF models of the joints (JA,NK,MK) 5 hours
5 Set up DH transfer matrices (AS) 5 hours
6 Generate Matlab Simulation of the kinematic chain (ER) 7 Hours

Week 3: Mar 4 - Mar 11

1 Test controllers on the robot (JA,NK,MK) 2 hours
2 Test trajectory generation on the simulation (ER) 3 hours
3 Integrate Inverse Kinematics with Controllers (AS,ER) 2 hours

Week 4: Mar 12 - Mar 19

  • ...

Week 5

  • ...

Week 6

  • ...