6 views

Uploaded by fenixnomahotmailcom

save

You are on page 1of 29

Andrew Davison Department of Computing Imperial College London

Robot Motion

A mobile robot can move and sense, and must process information

to link these two. In this lecture we concentrate on robot movement, or locomotion. What are the possible goals of a robot locomotion system?

Speed and/or acceleration of movement. Precision of positioning (repeatability). Flexibility and robustness in dierent conditions. Eciency (low power consumption)?

Locomotion

AUV

Spider

Humanoid

fairly at surfaces.

yW xR yR R Coordinate Frame Carried With Robot W

yW

xW

xW World Frame W

2D

3D

world, and a robot frame R which is carried by and stays xed relative to the robot at all times.

Often we are interested in knowing the robots location: i.e. what is

A rigid body which translates and rotates on a 2D plane has 3 DOF:

A rigid body which translates and rotates in a 3D volume has 6

A holonomic robot is one which is able to move instantaneously in

Holonomic robots do exist, but need many motors or unusual

Ground-based holonomic robots can be made using omnidirectional

Mars Rover

Segway platform with dynamic balance gives good height with small Mars Rover has wheels on stalks to tackle large obstacles.

Synchro Drive

All of these robots are non-holonomic (each uses two motors, but

three degrees of movement freedom). For instance, a car-like robot cant instantaneously move sideways.

Dierential Drive

speeds.

Wheels run at equal speeds for straight-line motion. Wheels run at equal and opposite speeds to turn on the spot. Other combinations of speeds lead to motion in a circular arc.

W R

If we dene wheel velocities (the translational speed at which they cover ground) vL and vR , and width between wheels is W :

Straight line motion if vL = vR Turns on the spot if vL = vR More general case: moves in a circular arc.

To nd radius R of curved path: consider a period of motion t where the robot moves along a circular arc through angle .

Left wheel: distance moved = vL t ; radius of arc = R Both wheel arcs subtend the same angle so:

W 2

.

W 2

W (vL + vR ) 2 W ( vR + vL ) 2(vR vL )

v L t v R t = W R 2 R+W 2

= R (vR vL )

R=

(vR vL )t W

Car

Two motors: one to drive, one to steer. Cannot normally turn on the spot.

Tricycle

With a xed speed and steering angle, it will follow a circular path. With four wheels, need rear dierential and variable (Ackerman)

Robot Centre

s s Rd R L

Assuming no sideways wheel slip, we intersect the axes of the front and back wheels to form a right-angle triangle, and obtain: R= L . tan s

The radius of the path that the rear driving wheel moves in is: Rd = L . sin s

Robot Centre

s s Rd R L

In time t the distance along its circular arc moved by the drive wheel is v t , so the angle through which the robot rotates is: = L tan s v t v t sin s = . Rd L = v t sin s L

R=

Most common motors, available in all sizes and types. Simple control with voltage or pulse width modulation. For precision, encoders and feedback can be used for servo control

Gearing

DC motors tend to oer high speed and low torque, so gearing is

Gearing

The change in angular velocity between Gear 1 and Gear 2 is calculated by considering velocity at the point where they meet: v 2 = = 1 r1 = 2 r2 r1 1 r2

When a small gear drives a bigger gear, the second gear has higher

Gears can be chained together to achieve compound eects.

Very often, a robot will want to estimate its motion by monitoring

its proprioceptive sensors, such as motor voltages or wheel encoders. This information is usually known as odometry.

e.g. for very simple voltage/timing based estimation:

D = KV t Distance travelled is proportional to voltage and time. Here K is a constant to be calculated (from knowledge of electrics and geometry) or calibrated.

Calibration involves experimental motion and comparison with

ground truth.

Encoders give more accurate, measured odometry of the number of

wheel turns and this information can be converted in principle to linear distance by multiplying by a constant for wheel radius; but still we will normally calibrate for full accuracy.

Calibration

the real world with a real robot motion, it can be compared with ground truth measurement of how the robot has actually moved.

If there is a discrepancy over repeated trials, we can aim to improve

matters by altering the values of the constants in our expressions (such as K above) and then iterating.

x and y specify the location of the pre-dened robot centre point

species the rotation angle between the two coordinate frames

The two coordinate frame coincide when the robot is at the origin,

and x = y = = 0.

Integrating Motion in 2D

2D motion on a plane: three degrees of positional freedom,

Consider a robot which only drives ahead or turns on the spot:

yW xR yR R Coordinate Frame Carried With Robot W

xW

During a pure rotation of angle angle :

ynew new

R y

x new

In the cases of both dierential drive and the tricycle robot, we were able to obtain expressions for R and for periods of constant circular motion. Given these: xnew x + R (sin( + ) sin ) ynew = y R (cos( + ) cos ) new +

y

Assuming that a robot has localisation, and knows where it is relative to a xed coordinate frame, then position-based path planning enables it to move in a precise way along a sequence of pre-dened waypoints. Paths of various curved shapes could be planned, aiming to optimise criteria such as overall time or power usage. Here we will consider the specic, simple case where we assume that:

Our robots movements are composed by straight-line segments

The robot aims to minimise total distance travelled, so it always

turns immediately to face the next waypoint and drives straight towards it.

In one step of path planning, assume that the robots current pose is (x , y , ) and the next waypoint to travel to is at (Wx , Wy ).

It must rst rotate to point towards the waypoint. The vector

The absolute angular orientation the robot must drive in is therefore given by: dy = tan1 dx Care must be taken to make sure that is in the correct quadrant of < . A standard tan1 function will return a value in the range /2 < <= /2. This can be also achieved directly with an atan2(dy, dx) function usually available in C (though not in RobotC!).

the robot is to move as eciently as possible, care should be taken to shift this angle by adding or subtracting 2 so make sure that < .

The robot should then drive forward in a straight line through

distance d =

2 + d 2. dx y

Practical Week 2

Location: Teaching Lab Room 202 Divide yourselves into groups; each group gets access to one Lego

Mindstorms NXT kit located in numbered drawers to which I have the keys.

I will note down the members of each group. One member of each

team who will be specically responsible for their kit, should make sure that it goes back in the drawer when it is not being used and looks after the keys.

There are PCs in Room 202 with RobotC installed these are

indicated by RobotC stickers on the monitors. You need to boot into Windows.

These are the important components; please look after them! 1 1 1 3 1 sonar (ultrasound) sensor Brick charger NXT motors sound sensor 2 light sensors 1 battery USB cable 2 touch sensors 1 compass sensor

The bricks will not start until the battery has a reasonable charge level.

We have spare parts if your kit is not complete.

RobotC

A comprehensive C programming environment for Mindstorms NXT

Run it from the desktop from Windows. On some bricks you may need to reload the RobotC rmware before

Edit and compile programs on the PC then download to Brick via

USB port. Run and monitor from RobotC with cable connected or disconnect and run on Brick independently.

Many sample programs included. Extra documentation at http://www.robotc.net/ Free trial version can be installed for 1 month your own PC.

yW

40cm

40cm

xW

Everyone should read the practical sheet fully! This is an ASSESSED practical: we will assess your achievement

next week.

Please go straight to the lab now.

- chapter 8Uploaded byRoberto Amry
- Calculations of love in vansUploaded bySudhir Kataria
- Reflection.pdfUploaded byIbrahim Hussain
- 9781430800477Uploaded byBen Ahmed
- 20_L500_eUploaded byMiorita_13
- Servo2006 07Uploaded byKarina Cristina Parente
- Manual NetUploaded byAnonymous EPOOkHlPTL
- VEX Robotics Lal 3Uploaded byPiter Nc
- Introduction-Open Gear DrivesUploaded byedmundovillacis
- abaqus.docxUploaded byDevendra Man Palikhe
- Booth Setup for Karnival InovasiUploaded byAnnreetha Anthony
- BLN-10072_Uploaded bywalk001
- Lego Renewable Energy Activities (Spanish)Uploaded bytahder77
- Mechanical Engineering 1Uploaded byAashrith Parvathaneni
- WP6_intro (3.1)Uploaded byFrancielly Pertile
- Q1Uploaded byprasanthikasamsetty
- 10.1.1.148Uploaded byVijay Karma
- manactUploaded bymarsha.fsd
- Magnetic Speed SensorUploaded byBharti Thakur
- Allowable Surface Durability in Grease Lubricated GearsUploaded bysudhakarummadi
- MsShilpaKanchi MrKVKViswanadham MrDrKSudhakarReddy 9Uploaded byAmit Tripathi
- mtd1.pdfUploaded byMabel Graciela Lazzari
- Contact Stress Analysis of Spur Gear Teeth Pair.pdfUploaded byCan Cemre
- Gear Technology India 2013 # 4.pdfUploaded byUday Sankar Sarma Yerramilli
- Analysis of Dynamic Effects in a Rotary Kiln System Used for Iron ProductionUploaded byLuis Gabriel L. Catalan
- Winch Motor CatalogUploaded byjorgekichi
- Agilent+Multiturn+Encoder.pdfUploaded byjurica_2006
- Jchps 31 Rajasekar 142-144Uploaded byDavide Marano
- How to Create a Gear - SolidworkstutorialsUploaded byabyzen
- 18_1_065Uploaded byOmar Eladel Mahmoud

- David Hughes 2006 Hydrology of HopeUploaded bysarasij
- re95203_2007-11.pdfUploaded byrenat
- 9_JDS160301Uploaded byUsman Shabbir
- Le Meridien Ahmdabad Trininmg ReportUploaded bySatwant Yadav
- Teaching ResourceUploaded byRalakk
- Classification Mechanism of Support VectorUploaded byharsha
- Empirical FormulaUploaded byapi-19832454
- How to Solve the Rubik's Cube BlindfoldedUploaded by91238012039237137123
- 0205MAC04HOUploaded bySergeat18B
- 45_treier_palgeUploaded byVijetha Nuthakki
- Options Obv Feb2013Uploaded byzhaozilong
- List PDFUploaded byKuku Homiiom
- State Plan of Action for Children-Orissa - 2007-12Uploaded byRajendra Kumar Slava
- Laccase production by Pleurotus ostreatus 1804: Optimization of submerged culture conditions by Taguchi DOE methodologyUploaded byMihaela Apetrei
- Alexander, Christopher - A Timeless Way of BuildingUploaded byNew0001
- RPT 1810 DominionEnergyProfile-FNEMBUploaded byLowell Feld
- 61995112.xlsUploaded byBronwyn Gahagan
- hinduism presentation 2Uploaded byapi-338768850
- final-140116115146-phpapp02 (1)Uploaded byHemantPatel
- PS31Uploaded byBen Yu
- BC161-16_enUploaded bymitros
- 1forstner w Wrobel b p Photogrammetric Computer Vision StatisUploaded byHamid Mahmood
- quinoline-isoquinolineUploaded bySebastian Nemeth
- Lecture2.pdfUploaded byOmegaUser
- Chainsaw Warrior - Combined Rule Book 2013 by STC-ZeroUploaded bySTC-Zero
- Almarai Initial 032009Uploaded byhamadeenoo
- Speed breaker early warning systemUploaded byraviepic3
- guna ppt.pptxUploaded byShantu Shirurmath
- Did Jesus Command His Followers to Be Muslims? - By Sam ShamounUploaded byGilbert Hanz
- The Sky TerracesUploaded byArron O'Brien