Group 10 – Helping Hand - Department of Electrical Engineering

advertisement
Group 10 – Helping Hand
Kurt Graf
Matt Carlson
Eric Donley
Taylor Jones
Our Project Is
A haptic robotic arm controlled by a sleeve mounted
with motion and force sensors on a human
operator's arm – which controls the motiontracking robotic arm's proportional motion.
These robots have a wide range of industrial and
medical applications such as pick and place
robots, surgical robots etc. They can be employed
in places where precision and accuracy are
required. Robots can also be employed where
human hand cannot penetrate.
The Future of Technology
“The future of technology is computers and
power electronics”
- recent IEEE literature
The interpretation is computers tell the machinery
what to do and the power electronics implements
the actual actions.
Power electronics refers to control and conversion of
electrical power by power semiconductor devices
wherein these devices operate as switches.
Motivation for Project
• We are Electrical Engineers and Computer Engineer
candidates for a bachelor of science diploma
• Concern for real working world (industrial) knowledge and
skills led the team to choose for senior design project a modern
application of an industrial standard robotic application - the
robotic arm.
• Our application is more sophisticated technologically than
original manufacturing and packaging and assembly
robotic
arms like the Unimate (See picture next slide)
the original robot arm was basically an open-loop control
scenario:
First Industrial Robotic Arm - 1961
UNIMATE: the first industrial robot, began work at General
Motors. Obeying step-by-step commands stored on a
magnetic drum, the 4,000-pound arm sequenced and
stacked hot pieces of die-cast metal.
UNIMATE at Work
was first used to lift and stack die-cast metal parts from molds

Over 1,000,000 current working industrial robots

Over 100,000 new industrial robots each year

Most common type of robotic device is the robot arm
 The most common type of existing robotic device is the
robot arm often used in industry and manufacturing. The
mechanical arm recreates many of the movements of
the human arm, having not only side-to-side and upand-down motion, but also a full 360-degree circular
motion at the wrist, which humans do not have. Robot
arms are of two types. One is computer-operated and
programmed for a specific function. The other requires
a human to actually control the strength and
movement of the arm to perform the task.
Current Light Industry Robot Arms
modern assembly line robot arm(s)
A large robot arm that controls you!
A Very Large Robot Arm
- Caterpillar Large Hydraulic Excavators
A new wave in robot arms (two of 'em) -
BAXTER
Rodney Brooks's new start-up wants to spark a factory
revolution with a low-cost, user-friendly robot - IEEE
BAXTER
Includes two 7 DOF arms with torso and head,
integrated vision system, integrated robot
control system, integrated safety system.
http://www.rethinkrobotics.com/
Learn about Robotics

Robotic systems

Wireless systems

IC/MEMS manufacture

Radar, Antennas

Power Electronics
Are all virtually or literally EE grad school
only subjects.
Robot Arm Update



Our application of a human arm motiontracking robot arm is intended more like the
robot arms used in robot surgery.
Theoretically, adding digits (fingers) to the
arm with extremely fine control could make
a skilled work duplication station possible.
That means you make a part at your
workstation and the Helping Hand
duplicates your work on a robotic station.
An alien abduction simulator?
Da Vinci Robot Surgery
Manual control looks like a two
handed joystick
Da Vinci System
Using the most advanced technology available today, the da Vinci
Surgical System enables surgeons to perform delicate and
complex operations through a few tiny incisions with
increased vision, precision, dexterity and control. The da
Vinci Surgical System consists of several key components,
including: an ergonomically designed console where the
surgeon sits while operating, a patient-side cart where the
patient lays during surgery, four interactive robotic arms, a highdefinition 3D vision system, and proprietary EndoWrist®
instruments.
da Vinci is powered by state-of-the-art robotic technology that
allows the surgeon’s hand movements to be scaled, filtered
and translated into precise movements of the EndoWrist
instruments working inside the patient’s body.
Goals and Objectives of Our Project
1. Proportional motion-tracking of a human
operator's arm motion
2. Fast tracking response (shadow boxing
in Real Steal)
3. Effective grasp-and-place object with endeffector
4. Smooth and safe and stable motion
5. Bold attempt at 7th DOF with elbow roll
Human Arm Motion plus Sensors
Specifications of Performance
1. Less than 0.1 second (human reaction time) delay from
human arm motion to robot arm motion-tracking
response
2. Automatic reset to “home base” position
3. Work volume range-of-motion computer tracked.
4. Internal range-of-motion limitation fail-safes
5. Grasp, lift, and place 13 oz payload
6. End-effector does not damage payload
Basic Idea of Motion Tracking (dc
motor prototype)
Sensors
Human Arm
Motion
Processing
Actuation
Robot Arm
Motion
Not an Open Loop System
Exteroceptive (operator) Feedback
System Schematic (dc motors)
System Schematic (servo motors)
System Schematic (wireless)
Power Supply
• 3 voltage power supply for
• 3.3V sensors/ mcu
• 5.0V sensors
• 6.0V servos
• 2 Buck regulators
• One with multiple loads
8 AA Battery Holder
Power supply schematic
Invensense MPU-6050
6-axis gyroscope and accelerometer
4 x 4 x 1 mm
MPU-6050
Supply voltage of
2.375V – 3.46V
Current of 3.9mA
Uses an I2C bus
Selectable gyroscope
and accelerometer
ranges
1MHz internal clock
How MEMS Gyroscope Works
GYRO equation
The gyro gives data in
degrees/second
To determine actual angle of
rotation requires integration with
respect to time
∫dΘ dt = Θ
Actual MEMS Gyro Construction
Sample Gyro (3-axis) data
[degrees/second]
starting loop
X: -4 Y: 109 Z: -9 // these are values when the gyro isn't moving
X: -5 Y: 72 Z: -17
X: 22 Y: 81 Z: 5
X: 13 Y: 75 Z: 30
X: 11 Y: 75 Z: 67
X: 9 Y: 89 Z: 4
X: 0 Y: 95 Z: 38
X: -12 Y: 88 Z: 32
X: 18 Y: 66 Z: 49
X: 19 Y: 93 Z: 70
X: 27406 Y: -2091 Z: -29629 // these are values after a quick move of the gyro
// inside loop
X: 35 Y: 67 Z: 12
X: 26 Y: 74 Z: 50
// next values after motion stopped
AL5D Arm Hardware-Only
• Distance (base-to-elbow axis) = 5.75"
• Distance (elbow-to-wrist axis) = 7.375"
• Height (arm parked) = 7.25"
• Height (reaching up) = 19.00"
• Median forward reach = 10.25"
• Gripper opening = 1.25"
Microcontrollers
Name
I/O pins
Memory
A/D converter
Language
Price
Basic ATOM 24
24
14k code
368 RAM
256 EEPROM
11 channels
BASIC
$8.95
PICAXE-20X2
18
4k code
256 RAM
11 channels
BASIC
$3.88
ATxmega128A4U
34
128k code
8k SRAM
2k EEPROM
12 channels
C/C++ or
assembly
$3.00
Propeller 40 pin DIP
32
0 channels
Spin
$7.99
64k RAM/ROM
Initial Design of MCU Board
Sensor Data Conversion
Determining axis of rotation:
x coordinate = M21 - M12 / √(M21 – M12)2+(M02 – M20)2+(M10 – M01)2)
y coordinate = M02 – M20 / √(M21 – M12)2+(M02 – M20)2+(M10 – M01)2)
z coordinate = M01 – M10 / √(M21 – M12)2+(M02 – M20)2+(M10 – M01)2)
Determining Angle to axis’:
Angle to x axis = cos-1(x / √(x2 + y2 + z2))
Angle to y axis = cos-1(y / √(x2 + y2 + z2))
Angle to z axis = cos-1(z / √(x2 + y2 + z2))
Motor Coordination
Operating
Flowchart
Deliverables
1. 2 Power Supplies (sensors, mcu, servos) –
3.3V, 5.0V, 6V
2. Micro-controller unit
3. Sensor mounted human operator arm
sleeve
4. Robot arm outfitted with working sensor
system and working software
5. Bold attempt at 7th DOF with elbow roll
Administrative
project is self-funded
- arm h/w is $165
- servos are ? < $200
- sensors about $100
- misc parts for power supply, construction
$100
Target budget is < $800 = 4 x 4914 textbook
Progress Status
Basic Prototype (1 sensor) - 95%
Research – 80%
Component Identification – 85%
Coding - 20%
PC Board (MCU) – 30%
PC Boards (components) – 30%
Power Supply Board – 25%
Servo purchase - 0%
CHALLENGES

getting response time under 0.1 seconds

system stable

system easy to use

safe payload handling

Getting DMP pre-process data from sensors

Bold attempt at 7th DOF with elbow roll
(rotatable wrist and elbow
QUESTIONS
???
Download