ball on plate balancing system - rpicats-fs.rpi.edu/.../final/team2finalpresentation.pdf ·...

20
Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Upload: others

Post on 22-May-2020

2 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Ball on Plate Balancing System

Greg AndrewsChris ColasuonnoAaron Herrmann

Page 2: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Overview

Objective and MotivationSpecificationsModeling and Design

Inertia, Friction, GravityControlTouchscreen Subsystem

Results (including demo video)AssessmentConclusion

Page 3: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Objective and MotivationTo develop a ball-on-plate balancing system, capable of controlling the position of the ball on the plate for both static positions as well as along smooth paths.

In addition, especially for static positions, the system should be capable of rejecting disturbances to the ball.

Original idea from Labyrinth game

Page 4: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Specifications

System will use motors and optical encoders for control of tilt angle of both horizontal axes of the plateTouchscreen for ball position feedback1/16th inch rubber membrane will provide rolling friction

Page 5: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Specifications (cont.)

Plate Range of Motion 35 degrees about zeroLess than 2% error in ball positioningBall Weight: 130 gramsSystem Weight: 1.2 kg

Page 6: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Modeling: Inertia, Friction, Gravity

System must be linearized about an operating condition to design control systemOver what range is the linearization valid?State-space realization allows for easy control implementation for the MIMO system.

Page 7: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Modeling: Inertia

SolidWorks model createdUsed to aid in machining of necessary metal partsUsed to find mass and inertia tensor of system

Page 8: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Modeling: FrictionRecorded steady state velocity for 200 torque inputsAveraged last 4 of 10 seconds to get the velocity valueA 10 volt spike was used to break stictionLeast squares regression linePan Axis shown

Page 9: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Modeling: Gravity

Simple decoupled gravity model used at first, but this required an added gain to work perfectlyFully coupled gravity compensation is implemented in the actual system.

Plot shows constant applied torque to maintain gravity compensation

Page 10: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Validation and Friction/Gravity Experiment

Actual system response to force of gravity versus simulated response

Page 11: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Friction/Gravity Cancellation Demo

Page 12: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Control Design

Control design consists of two feedback loops:

Inner loop controls motor torque for desired plate angleOuter loop controls plate angle for desired ball positionBoth loops employ state-feedback control with observers

Page 13: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Control DesignLQR Control for optimal control based on our desired time-domain responseKalman Filter for optimal observer poles

Page 14: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Tuning in Experimentation and Simulation

Full Non-Linear Plate Dynamics, Linear Ball DynamicsTouchscreen sampling rate, and motor saturation consideredVR Simulation

Page 15: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Uncertainty and Tolerance Analysis

Axel straightnessBearing seatingTouchscreen AccuracyMotor NoiseErratic Encoder Behavior

Page 16: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Touchscreen

Dynapro 10.4” 95640 Touchscreen

Serial Interface between MATLAB/ xPC target and touch screen controller

80 positions/secActual data

samples run through lowpass filter for trajectory generation

Page 17: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

ResultsSine wave tracking on “pan” axis: simulated, desired, actual

Page 18: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Results: Demo VideosDemo video: Ball Balancing with disturbance rejection and primitive path following

Page 19: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Assessment

Ball BalancingWorks well with minor steady state error

Disturbance RejectionFast response time

Path TrackingNeeds improvement

Overall success

Page 20: Ball on Plate Balancing System - RPIcats-fs.rpi.edu/.../final/team2finalpresentation.pdf · 2004-05-05 · Ball on Plate Balancing System Greg Andrews Chris Colasuonno Aaron Herrmann

Conclusion

Recommendations for improvementFriction Cancellation ImprovementsRevised touchpad interfaceBall Control ObserverNon-linear control