Wayback Machinekoobas.hobune.stream
May JUN Jul
Previous capture 14 Next capture
2021 2022 2023
4 captures
13 Jun 22 - 14 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
1
Question by fast35890 · May 14 at 08:25 AM · c#meshgeometry

How can i get the center of intersection of two capsules


How can i find center of intersection of two capsules?


Is there some math or algorithms that can help me in terms of tasks like that?


alt text


untitle1d.png (21.0 kB)
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

2 Replies

· Add your reply
  • Sort: 
avatar image
2
Best Answer

Answer by andrew-lukasik · May 14 at 02:03 PM

capsule capsule intersection center


 // web* src: https://gist.github.com/andrew-raphael-lukasik/dcf4d308f96852b790f49efb87e462dd
 using UnityEngine;
 using Unity.Mathematics;
 
 public class CapsuleCapsuleIntersection : MonoBehaviour
 {
     [SerializeField] CapsuleCollider _capsuleA, _capsuleB;
     
     void OnDrawGizmos ()
     {
         if( _capsuleA==null || _capsuleB==null ) return;
         
         // calculate all the points:
         ToWorldSpaceCapsule( _capsuleA , out float3 A0 , out float3 A1 , out float Ar );
         ToWorldSpaceCapsule( _capsuleB , out float3 B0 , out float3 B1 , out float Br );
         SegmentSegmentCPA( A0 , A1 , B0 , B1 , out float3 C0 , out float3 C1 , out bool parallel );
         
         // draw debug shapes:
         Gizmos.DrawLine( A0 , A1 );
         Gizmos.DrawLine( B0 , B1 );
         Gizmos.color = new Color( 1 , 0.92f , 0.016f , 0.5f );
         Gizmos.DrawLine( C0 , C1 );
         UnityEditor.Handles.Label( A0 , nameof(A0) );
         UnityEditor.Handles.Label( A1 , nameof(A1) );
         UnityEditor.Handles.Label( B0 , nameof(B0) );
         UnityEditor.Handles.Label( B1 , nameof(B1) );
         UnityEditor.Handles.Label( C0 , nameof(C0) );
         UnityEditor.Handles.Label( C1 , nameof(C1) );
 
         // calculate contact details:
         float3 axis = math.normalize( C1 - C0 );
         float distance = math.length( C1 - C0 );
         bool contact = distance <= Ar+Br;
         if( contact )
         {
             float3 contactA = C1-axis*math.min(Br,distance);
             float3 contactB = C0+axis*math.min(Ar,distance);
             float3 contactCenter = math.lerp( contactA , contactB , 0.5f );
             float contactLength = math.length( contactB - contactA );
 
             // draw debug shapes:
             UnityEditor.Handles.Label( contactA , nameof(contactA) );
             UnityEditor.Handles.Label( contactB , nameof(contactB) );
             Gizmos.color = Color.red;
             Gizmos.DrawLine( contactA , contactB );
             float debugContactLen = math.min(Ar,Br)*0.1f;
             quaternion quat = quaternion.LookRotation( axis , new float3{y=1} );
             Gizmos.DrawLine(
                 contactCenter + math.mul(quat,new float3(-debugContactLen,-debugContactLen,-debugContactLen)*0.5f) ,
                 contactCenter + math.mul(quat,new float3(debugContactLen,debugContactLen,debugContactLen)*0.5f)
             );
             Gizmos.DrawLine(
                 contactCenter + math.mul(quat,new float3(-debugContactLen,-debugContactLen,debugContactLen)*0.5f) ,
                 contactCenter + math.mul(quat,new float3(debugContactLen,debugContactLen,-debugContactLen)*0.5f)
             );
 
             if( parallel )
             {
                 // calculate average contact center:
                 var aabb = new Bounds{ center=A0 };
                 aabb.Encapsulate( A1 );
                 aabb.Encapsulate( B0 );
                 aabb.Encapsulate( B1 );
                 float3 averageContactCenter = aabb.center;
 
                 // draw debug shapes:
                 Gizmos.DrawSphere( averageContactCenter , debugContactLen );
                 // Gizmos.DrawWireCube( aabb.center , aabb.size );
             }
         }
     }
 
     // src: https://stackoverflow.com/a/67102941/2528943
     void SegmentSegmentCPA
     (
         float3 a0 , float3 a1 , float3 b0 , float3 b1 ,
         out float3 c0 , out float3 c1 , out bool parallel
     )
     {
         var r = b0 - a0;
         var u = a1 - a0;
         var v = b1 - b0;
         var ru = math.dot(r,u);
         var rv = math.dot(r,v);
         var uu = math.dot(u,u);
         var uv = math.dot(u,v);
         var vv = math.dot(v,v);
         var det = uu*vv - uv*uv;
         float3 s, t;
         if( det<(1e-6f*uu*vv) )
         {
             s = math.clamp(ru/uu, 0, 1);
             t = 0;
             parallel = true;
         }
         else
         {
             s = math.clamp((ru*vv - rv*uv)/det, 0, 1);
             t = math.clamp((ru*uv - rv*uu)/det, 0, 1);
             parallel = false;
         }
         var S = math.clamp((t*uv + ru)/uu, 0, 1);
         var T = math.clamp((s*uv - rv)/vv, 0, 1);
         c0 = a0 + S*u;
         c1 = b0 + T*v;
     }
 
     // src: https://github.com/justonia/UnityExtensions/blob/219168f1f52012eaf625996abc193524c78ba9ca/PhysicsExtensions.cs//L209-L241
     void ToWorldSpaceCapsule ( CapsuleCollider capsule , out float3 start , out float3 end , out float r )
     {
         float3 center = capsule.transform.TransformPoint( capsule.center );
         r = 0f;
         float height = 0f;
         float3 lossyScale = math.abs( capsule.transform.lossyScale );
         float3 dir = float3.zero;
 
         switch( capsule.direction ) {
         case 0:// x
             r = math.max( lossyScale.y , lossyScale.z ) * capsule.radius;
             height = lossyScale.x * capsule.height;
             dir = capsule.transform.TransformDirection(Vector3.right);
             break;
         case 1:// y
             r = math.max( lossyScale.x , lossyScale.z ) * capsule.radius;
             height = lossyScale.y * capsule.height;
             dir = capsule.transform.TransformDirection(Vector3.up);
             break;
         case 2:// z
             r = math.max( lossyScale.x , lossyScale.y ) * capsule.radius;
             height = lossyScale.z * capsule.height;
             dir = capsule.transform.TransformDirection(Vector3.forward);
             break;
         }
 
         if( height<r*2f )
             dir = float3.zero;
 
         start = center + dir*( height*0.5f - r );
         end = center - dir*( height*0.5f - r );
     }
 }



screenshot-2022-05-16-110054.png (23.7 kB)
screenshot-2022-05-16-105036.png (24.4 kB)
Comment
Add comment · Show 2 · Share
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
avatar image fast35890 · May 15 at 08:15 PM 0
Share

alt text

123123.png (68.1 kB)
avatar image andrew-lukasik fast35890 · May 16 at 08:57 AM 0
Share


Ok, case solved I think. @Thygrrr comment gave me an idea that this can be approximated as an AABB.center, which is neat and simple.


capsule-capsule intersection center


capsule-capsule intersection center

avatar image
1

Answer by Thygrrr · May 15 at 09:52 PM

A capsule is just a string of spheres on a line segment.

All you need is to get the two closest points on the capsules long axes (line segments), and get the midpoint of that.

If the two segments are further than the capsule sum radius apart, there is no intersection.

  1. Find closest points on each capsule axis line segments

  2. Find midpoint between these.

Andrew's solution seems to do that, with some extra steps.

Comment
Add comment · Share
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

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

790 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 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 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 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 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 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 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

How to Move Vertices from a Mesh to a Specific Location 2 Answers

Combining two meshes 0 Answers

Multiple Cars not working 1 Answer

Distribute terrain in zones 3 Answers

Procedurally generated mesh acting weird. 0 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