Wayback Machinekoobas.hobune.stream
May JUN Jul
Previous capture 12 Next capture
2021 2022 2023
1 capture
12 Jun 22 - 12 Jun 22
sparklines
Close Help
  • Products
  • Solutions
  • Made with Unity
  • Learning
  • Support & Services
  • Community
  • Asset Store
  • Get Unity

UNITY ACCOUNT

You need a Unity Account to shop in the Online and Asset Stores, participate in the Unity Community and manage your license portfolio. Login Create account
  • Blog
  • Forums
  • Answers
  • Evangelists
  • User Groups
  • Beta Program
  • Advisory Panel

Navigation

  • Home
  • Products
  • Solutions
  • Made with Unity
  • Learning
  • Support & Services
  • Community
    • Blog
    • Forums
    • Answers
    • Evangelists
    • User Groups
    • Beta Program
    • Advisory Panel

Unity account

You need a Unity Account to shop in the Online and Asset Stores, participate in the Unity Community and manage your license portfolio. Login Create account

Language

  • Chinese
  • Spanish
  • Japanese
  • Korean
  • Portuguese
  • Ask a question
  • Spaces
    • Default
    • Help Room
    • META
    • Moderators
    • Topics
    • Questions
    • Users
    • Badges
  • Home /
avatar image
0
Question by dylanrw · Apr 30, 2020 at 03:17 AM · c#quaternionmathquaternionsquaternion.slerp

Rotating clockwise or counter clockwise using Quaternions and PID

Given the code below, the object would begin facing to the right, and if something changed yawState to either back or forward orientations you'd see it orient itself to face that direction. Now, this is where I'm having problems, if I transition from right to forward it works, but right to left makes it wind all the way around to arrive at the wanted adjacent orientation rather than just taking the shortest path.

I believe Quaternion.slerp has the functionality where it takes the shortest path to a rotation, but I do not want to use slerp to orient the object as it doesn't play nice with physics (thus the PID).


Can anyone see the error of my ways or highlight something simple I'm missing?


Thank you!


 var desiredRot = Quaternion.identity;
 var yawState = Direction.Right;
 
 void rotate() {
 
     switch (yawState.currentDirection)
     {
         case YawState.Direction.Forward:
             desiredRot = Quaternion.AngleAxis(0, Vector3.up);
             break;
         case YawState.Direction.Back:
             desiredRot = Quaternion.AngleAxis(180, Vector3.up);
             break;
         case YawState.Direction.Left:
             desiredRot = Quaternion.AngleAxis(90, Vector3.up);
             break;
         case YawState.Direction.Right:
             desiredRot = Quaternion.AngleAxis(-90, Vector3.up);
             break;
     }
 }
 
 void RotateWithPID(float frequency, float damping, Quaternion desiredRotation)
 {
     var rotation = gameObject.transform.rotation;
 
     var kp = (6f * frequency) * (6f * frequency) * 0.25f;
     var kd = 4.5f * frequency * damping;
 
     var q = desiredRotation * Quaternion.Inverse(rotation);
 
     q.ToAngleAxis (out var xMag, out var x);
     x.Normalize();
     x *= Mathf.Deg2Rad;
 
     var pidVelocity = kp * x * xMag - kd * rigidbody.angularVelocity;
 
     var rotInertia2World = rigidbody.inertiaTensorRotation * rotation;
 
     pidVelocity = Quaternion.Inverse(rotInertia2World) * pidVelocity;
     pidVelocity.Scale(rigidbody.inertiaTensor);
     pidVelocity = rotInertia2World * pidVelocity;
 
     rigidbody.AddTorque(pidVelocity);
 }
 
 void Update() {
     rotate()
     RotateWithPID(0.5, 1, desiredRot);
 }
 
Comment
Add comment
10 |3000 characters needed characters left characters exceeded
▼
  • Viewable by all users
  • Viewable by moderators
  • Viewable by moderators and the original poster
  • Advanced visibility
Viewable by all users

0 Replies

· Add your reply
  • Sort: 

Your answer

Hint: You can notify a user about this post by typing @username

Up to 2 attachments (including images) can be used with a maximum of 524.3 kB each and 1.0 MB total.

Follow this Question

Answers Answers and Comments

128 People are following this question.

avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image avatar image

Related Questions

Clock script with custom time not working 0 Answers

Unity.Mathematics equivalent to Quaternion.FromToRotation? 3 Answers

few question about quaternion slerp 3 Answers

Comparing lerping quaternion 1 Answer

Distribute terrain in zones 3 Answers


Enterprise
Social Q&A

Social
Subscribe on YouTube social-youtube Follow on LinkedIn social-linkedin Follow on Twitter social-twitter Follow on Facebook social-facebook Follow on Instagram social-instagram

Footer

  • Purchase
    • Products
    • Subscription
    • Asset Store
    • Unity Gear
    • Resellers
  • Education
    • Students
    • Educators
    • Certification
    • Learn
    • Center of Excellence
  • Download
    • Unity
    • Beta Program
  • Unity Labs
    • Labs
    • Publications
  • Resources
    • Learn platform
    • Community
    • Documentation
    • Unity QA
    • FAQ
    • Services Status
    • Connect
  • About Unity
    • About Us
    • Blog
    • Events
    • Careers
    • Contact
    • Press
    • Partners
    • Affiliates
    • Security
Copyright © 2020 Unity Technologies
  • Legal
  • Privacy Policy
  • Cookies
  • Do Not Sell My Personal Information
  • Cookies Settings
"Unity", Unity logos, and other Unity trademarks are trademarks or registered trademarks of Unity Technologies or its affiliates in the U.S. and elsewhere (more info here). Other names or brands are trademarks of their respective owners.
  • Anonymous
  • Sign in
  • Create
  • Ask a question
  • Spaces
  • Default
  • Help Room
  • META
  • Moderators
  • Explore
  • Topics
  • Questions
  • Users
  • Badges