Академический Документы
Профессиональный Документы
Культура Документы
23 November 2010
roundabot.wordpress.com
[BallP Robot, ieeespectrum.org]
La Formule
Project Objective:
Design and build an inverted pendulum robot riding on
a single ball capable of transporting a person safely in
an indoor environment.
Technical Specifications
Ball size: 8.5 - 10" diameter (soccer - basket ball sized)
Robot Height: 2.5 - 3 ft (table-top height)
Cost: $1500
Human transport only
Operational Environment: Indoors
Temperature: 15 - 25 ºC
Surfaces: Tile, Carpet, Concrete, Brick, etc.
Able to traverse slopes up to 10º
Reject disturbances caused by small (~1cm) bumps
Operational Range: ~1 hr continuous battery life with ability to
easily recharge (AC outlet)
Operational Speed: 2-3 mph translational (safe walking speed)
Safety Features: Thermal/Over-current protection, training wheels,
foot support, etc.
Physical Design (3D CAD)
Stock omniwheel
Dinner = 22.225mm
Wkey = 6.6mm
Skey = 2.75mm
Shaft size
Dinner = 1/2" -0.0005 -0.0025
Wkey = 1/8" +0.002"
Skey = 1/16" +0.002"
Physical Design (3D CAD)
MOTOR SHAFT STACK
Overall 3D model
Shaft section
Physical Design (3D CAD)
LOWER HALF ASSEMBLY (BASE PLATE)
Physical Design (3D CAD)
FRAME STRUCTURE (CHICAGO BAR STOOL)
IMU mounting
cRIO, H-Bridge servos, and PCB mounting
Wire pass through slot
Mathematical Modeling
Mathematical Modeling
Controller Design
LQR controller
High emphasis on cylinder position
Low emphasis on ball position
Disturbances
Passenger movements modeled as disturbance
Constant lean: step disturbance in torque
Sine or ramp function initially to better represent human
motion
Mathematical Modeling - Controller
Issues
Size of motor deadband has substantial impact on
controller performance
Sensor noise does not affect ability to balance much but
does increase control effort
Control effort is related to frequency of disturbance
Future work
Actual controller will be designed once we have run
system ID on the motors
If needed, an inner loop will be added to control motor
speed
Simulink Model
Nonlinear Dynamic System
Actuator Model
Sensor Model
Controller Simulations
Step Response
Offset Response
Disturbances
Push
Grade
Controller Simulation
Step Response to 10° user lean
Overview:
Chassis
Drivetrain
Power Supply
Sensors
Microprocessor
Chassis
Stool Requirements
Comfortable height to sit (2.5-3 feet, ball+robot)
Not too heavy, can support 200lb person
Components:
The cRIO, PCB mounted voltage
controller and the H-bridge controller
bolted to the top surface of the plate.
The IMU bolted to the bottom surface
exactly at the center
Lower base plate
Square Aluminum Plate (18x18x0.25")
supports
batteries
Net weight of the batteries:15.7 lbs
drive-train
Motors, omni-wheels and gearboxes
Requirements:
capable of supporting the high loads
Sufficiently strong and light
Mounting:
Aluminum plate bolted to the lower ring
Motors, Omniwheels bolted to bottom of the base plate
Batteries bolted to the top part
Drive-train
Bearing: Flanged open ball bearing(Material:Steel)
ID: 0.5", OD: 1.375",width:0.5"
Dynamic radial load = 450 lbs
number of bearings =6
Total load on the bearing= 58.68 lbs
Bearing load rating C = 1437.25lbf
Number of cycles = 441134
Omni-Wheels:Rotacaster
Number of omni-wheels = 6
Diameter = 4.92 "
Width = 1.06"
Bore = 0.875"
Load Capacity =110 lbs
Power Supply
Motor Battery Selection:
PowerStar 12V 15 A-hr battery:
Type : Sealed Lead Acid Battery
Current: 210 A(peak)
Weight: 9.26 lbs
Size: 5.95x3.86x3.98"
Aux Battery Selection:
PowerStar 12V 3.5 A-hr battery(2 Nos):
Type: Sealed Lead Acid Battery
Current:52.5 A(peak)
Weight: 2.98 lbs
Size: 5.28x2.64x2.62"
Wiring Practices
Twisted pair, shielded cables
Signal wires from controller to motor controller
Sensor wires
Motor cable is separated from controller wiring and signal
wiring
Single ground to eliminate ground loops
Wire gauge
AWG gauge Max amps for chasis Max amps for power
6 wiring
101 transmission
37
7 89 30
8 73 24
Sensors(Encoder)
US Digital: E7P
Cost: $57.42
CPR: 180 to 720
Number of channel: 2(A,B)
Fits shaft diameter: 3 to 10mm
Emergency stop
Cost:$29.56
Dimension Of Button: 22mm
Voltage Regulator
Type:
78L05(5V)
LP2950(3.3V)
Max output current:
100mA
Input voltage range:0 to 30V
Purpose:
Transform 24V battery voltage to 5
and 3.3V
Printed Circuit Board
Matching Printed Circuit Borad with 550
Connect Points
Cost:$2.99
Circuit diagram
Battery Capacity Measuring Circuit
The voltage for turn on the led will be 24V and 12V
Circuit on PCB
Sensor Filter
To be implemented in Labview
Based on previous M-Way team's experiences
Will adjust values once we have confirmed our sensor's
performance
Microprocessor - cRIO
Power Consumption:
24 V recommended power supply
2 A continuous
Dimensions:
7 in x 3.5 in x 3.5 in
Microprocessor - cRIO
Main Tasks
Control algorithm
Sensor feedback
PWM generator
Accelerometer / gyro filter
Microprocessor - cRIO
Modules:
NI cRIO 9004: Controller
NI 9401: Digital I/O
NI 9201: Analog Input
NI 9401 NI 9201
Motor Controllers
Simple H
H bridge circuit for 1 - 2 motor control
5 to 25 V range
1.3 oz
2.5 in x 2.25 in x .75 in (with fan)
Current Sense: Vc = I*0.075
Motor Controllers
Continuous Current 25 A 25 A 48 A
Peak Current 45 A 45 A 70 A
Voltage Range 5 - 24 V 5 - 24 V 5 - 24 V
Component Verification: IMU
Accelerometer test
Component Verification: IMU
Gyroscope test
Component Verification:
Microprocessor
Getting started tutorials performed with cRIO
Plan for Thanksgiving Break:
Create controller VI
Interface with Simulink model
Test controller performance w/ Simulink
Bill of Materials
Round-a-Bot BOM
Engineering Drawings
Round-a-Bot Drawings
Conclusions