Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder...
Transcript of Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder...
![Page 1: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/1.jpg)
Scale model design Korean Electronics Team
![Page 2: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/2.jpg)
Replace this parts to battery connection
Power Distribution for Control System
Solar Pannel
Power Supply
& Batt C
harge
7.2V NiMH or
7.4V LiPo Battery
7.2V Power Supply
DC Motor
Driver 1
DC Motor
Driver 2
Servo Motor
Arduino (Layer 1,2,3)
Battery Charger
5V Power Supply
DC Motor Encoder 1
DC Motor Encoder 2
![Page 3: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/3.jpg)
Arduino Layer 1,2,3
Layer 1 : Arduino Controller
Layer 2 : Connectors and Wiring
Layer 3 : Xbee Communication
Layer 1 : Arduino Uno board Layer 2 : Larger than layer 1 and 3 because of space for connectors and DC motor drivers. Layer 3 : Xbee shield board. Topmost position is suitable for wireless communication board.
![Page 4: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/4.jpg)
Replace with wiring Wiring
Layer 1 : Arduino Controller Layer 2 : Connectors and Wiring
Layer 3 : Xbee Communication
DC Motor
Driver 1
DC Motor
Driver 2
Molex 6p Molex 6p Molex 3p
Stack up through pin header
Battery Charger
2p
2p
2p
2p
7.2V NiMH or
7.4V LiPo Battery
Solar Pannel
Front DC
Motor
RearDC
Motor
Servo Motor
Molex 3p
Hall Sensor
Molex 3p
Hall sensor
![Page 5: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/5.jpg)
Interrupts and peripherals
Interrupts : Timer Interrupt for control frequency 20Hz USART Rx Interrupt for xbee communication External Interrupt for 2 of hall sensors and 2 of encoders (1 Ext INT and 3 PCINT) Peripherals : PWM for servo Motor 2 PWM for 2 of DC motor driver enable(speed control) 2 Digital output for 2 of DC motor driver phase(directions) 2 Digital input for 2 of encoder direction USART for xbee communication
![Page 6: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/6.jpg)
The circuit for layer 1 (Arduino Uno)
![Page 7: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/7.jpg)
The circuit for layer 2
![Page 8: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/8.jpg)
The circuit for layer 2
Servo Motor
Front DC Motor
Left Hall Sensor
Rear DC Motor Right Hall Sensor
6Cell Ni-MH(7.2V) or 2Cell Li-Po(7.4V) Connector
![Page 9: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/9.jpg)
The circuit for layer 3 (The XBee shield)
![Page 10: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/10.jpg)
The control system
![Page 11: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/11.jpg)
Position Control
Velocity Control
The block diagram for the control system
DC Motor
PI Control
PD Control
Saturation
Desired Velocity
![Page 12: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/12.jpg)
The PC program Station 1
Position of pod 1
Speed Control
Start and stop button
Move to station button
![Page 13: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/13.jpg)
The communication system
XBee communication
![Page 14: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/14.jpg)
The communication protocol
STX Receiver Sender Message
Type Payload
Check sum
ETX
1byte 1byte 1byte 1byte 1byte 1byte 2byte 2byte 1byte 1byte 1byte
0x61 ID ID Type Switch Track Position Velocity Status CS 0x62
Data for check sum
![Page 15: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/15.jpg)
The communication protocol(continued)
![Page 16: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/16.jpg)
The demonstration(1 min 44 sec)
![Page 17: Scale model design - INIST · 2015. 8. 11. · Battery Charger . 5V Power Supply . DC Motor Encoder 1 . DC Motor Encoder 2 . Arduino Layer 1,2,3 . Layer 1 : Arduino Controller . Layer](https://reader036.fdocuments.in/reader036/viewer/2022081615/5fe32772268d9f3eb12e1a61/html5/thumbnails/17.jpg)
Thank you!
Q&A