Sign in to follow this  
stoneshy

How to simulating a turn radius

Recommended Posts

Hi I trying to simulate a vehicle turning around a radius. This is what I'm currently doing

  1. Calculate the radius of the turn.
  2. Calculate acceleration and add to velocity
  3. Use velocity magnitude to determine distance travelled in one update
  4. Use arctan( distanceTraveled / turnRadius ) to get the angle of rotation
  5. Update vehicle angle
  6. Rotate velocity by vehicle angle. e.g. velocity *= Quaternion.AngleAxis(angle, Vector3.up)
  7. Update vehicle position with velocity

I'm currently getting a lot of drift and not driving straight. Any ideas how to correctly implement this.

 

Cheers

Share this post


Link to post
Share on other sites

You shouldn't have to measure any angles. If you apply an acceleration pointing to the side you want to turn, the vehicle will turn. The relationship between the force applied and the turn radius is taught in high school, and I am sure it's easy to find on the Internet.

 

EDIT: http://en.wikipedia.org/wiki/Centripetal_force

Edited by Álvaro

Share this post


Link to post
Share on other sites

Dynamics for a simple ("unicycle") vehicle in two dimensions:

 

The way to think about this is that your vehicle has some state that evolves according to some dynamics -- this captures the physics of the vehicle -- and it also has some control inputs that describe what the driver is commanding the vehicle to do (e.g., accelerate, brake, turn).  To organize our thoughts, we'll separate these different things.

 

The vehicle's state x = (p, R, s) consists of

p in R2  (position),

R in SO(2)  (orientation: First column is forward vector; second column is left vector), and

s in R  (speed).

 

The control input is u = (a, w), with

a in R (acceleration: positive for going faster; negative for braking), and

w in R (turning rate).

 

Finally, the dynamics (or time-evolution of the state) are given by the following differential equations:

dp/dt = s R e1   (where ei is the ith column of the 2x2 identity matrix)

dR/dt = w R J  (where J is the 90-degree rotation matrix)

ds/dt = a

 

This fully describes the vehicle.  By evolving everything according to these dynamics, you will get consistent behavior, without side-slip.

 

One question remains, and that is how to choose your control inputs.  This depends on what you are trying to achieve -- e.g., going to a specific point, following a road, etc -- and is typically done by designing a controller (aka behavior), which is a function that takes the state x and returns a control input u.

 

You seem concerned with achieving a specified turn radius.  To do that, for a radius r, you need to choose your control input w so that

s = w r.

Share this post


Link to post
Share on other sites

Create an account or sign in to comment

You need to be a member in order to leave a comment

Create an account

Sign up for a new account in our community. It's easy!

Register a new account

Sign in

Already have an account? Sign in here.

Sign In Now

Sign in to follow this