[ODE] Optimal orientation arrival

[Darío Mariani]

More or less you have to do this:

dVector3 axis = <normalized axis in which it must be aligned>;
dVector3 vel = <velocity in local coordinates, normalized>;
dVector3 err = cross_product (vel, axis);        // The error
if (squared_length (err) == 0) return;  // If 0, it's aligned. Should
check if it´s aproximately 0
// Adjust err length proportional to the angle of the error, and invert it.
err = normalize (err);
err = err * - angle_between (axis, vel);
dReal ks = 0.1; // Damping constant
dReal kd = 1.5; // Spring constant
dVector3 torque = err * ks - global_angular_velocity * kd;
torque = inertia_tensor * force;  // This step could be skipped
// Adjust if the torque exeeds the maxium torque, alternatively, play
with ks and kd values
adjust (torque, MAX_TORQUE);

Sorry for the pseudocode, but my code is a couple of layers down my
abstractions.
Steal warning: This code was "stolen" from the SpringMotor in Opal
(http://opal.sf.net).

        Darío

On 6/30/05, Paul Bridger <paul.bridger at gmail.com> wrote:
> Hi,
> 
> I want to rotate a body to a given orientation as quickly as possible.
> The body has a maximum torque it can apply, and I want to work out
> what torque to apply at any given time.
> 
> I can calculate the axis of rotation, but I'm not sure how to
> calculate the torque I can apply as a factor of a body's rotational
> inertia etc.
> 
> Any hints?
> 
> Paul
> 
> _______________________________________________
> ODE mailing list
> ODE at q12.org
> http://q12.org/mailman/listinfo/ode
>