ball segway robot
TRANSCRIPT
- 1. Ball Segway Robot
- 2. 1. System Preview 2. System Architecture 3. Hardware Organization 4. Software Organization 5. PID Controller 6. Balancing Algorithm 7. System Performance 8. Future Plan Contents
- 3. 3 01 System Preview
- 4. 4 02 System Architecture CPU TIMER (T=1ms) x,y,z SCI-A Serial interface PID Controller SCI-B Serial interface Main Power Motor Power Balancing Algorithm Internal PWM
- 5. 5 03 Hardware Organization Sensor Bluetooth & MCU & display Motor Part Solid works 3D-tool Photocoupler & Motor driver
- 6. 6 03-1 Hardware Organization - Power Supply 4 Motor Photocoupler Motor Sensor Noise Main Power Motor Power Li-Po 2Cell 7.4V Li-Po 6Cell 22.2V 5V-Regulator ( LM2576 ) 5V-Regulator ( LM2576 ) Motor part DSP (TMS320F2809) Photocoupler Sensor EBIMU9_V2 x,y,z PWM (Main voltage) PWM (Motor voltage) Motor Driver Motor
- 7. 7 03-2 Hardware Organization - Photocoupler
- 8. 8 04 Software Organization Main START END System Initialize Menu Motor interrupt ( T = 1ms )GPIO Interrupt PWM SCI_A, SC I_B Sensor Setting Debugging Value Start Code Jump SCI interrupt PID Controller Balancing Algorithm PWM OUT SCI_A(Bluetooth) SCI_B(Sensor)
- 9. 9 05 PID Controller Ballbot Angle P factor Kp X I factor Ki X D factor Kd X ( ) Angular Velocity Balancing Algorithm
- 10. 10 06 Balancing Algorithm UnSafe zone Safe Zone (-3 ~ + 3)
- 11. 11 06 Balancing Algorithm Balancing Algorithm Value Initialize Current Position Safety zone check Calculation distance Angle
- 12. 12 07 System Performance
- 13. 13 08 Future Plan ( ) ( LQR Controller ) Embedded Board( Raspberry Pi / Odroid ) / CIRO /
- 14. .