Forum Unity3D-France

Code : Tout sélectionner

using System;
using System.Diagnostics;
using System.Collections;
using System.Collections.Generic;
using UnityEngine;

public class testINTERSECT : MonoBehaviour {

	public Transform deb;   // Cube
	public Transform fin;   // Cube
	public Transform cible; // Sphere
	public Transform contact;
	private float rayonC = 0.0f;
	private Color GizCol = Color.green;
	
	private Vector3 tempo = new Vector3(0,0,0);

	void Start () {
		rayonC = cible.localScale.y / 2.0f;
		/*
		// test sqrt ***********************
		UnityEngine.Debug.Log("Precision methode UNITY = " + Mathf.Sqrt(123456.0f));
		UnityEngine.Debug.Log("Precision methode .NET = "  + (float)Math.Sqrt(123456.0f));
		int f = 2000000;
		int z = 0;
		float c = 0.0f;
		var s1 = Stopwatch.StartNew();
		for (z = 0; z < f; z++){
			c = Mathf.Sqrt(z + 1);
		}
		s1.Stop();
		//
		var s2 = Stopwatch.StartNew();
		for (z = 0; z < f; z++){
			c = (float)Math.Sqrt(z + 1);
		}
		s2.Stop();
		UnityEngine.Debug.Log("Timing methode UNITY = " + (double)(s1.Elapsed.TotalMilliseconds));
		UnityEngine.Debug.Log("Timing methode .NET = "  + (double)(s2.Elapsed.TotalMilliseconds)); // 2,5 fois plus rapide !!!!!!!!!!!
		*/
	}

	void LateUpdate () {
		bool Bam = SphereIntersect(deb.position.x, deb.position.y, deb.position.z , fin.position.x, fin.position.y, fin.position.z , cible.position.x, cible.position.y, cible.position.z , rayonC);
		GizCol = Bam ? Color.red : Color.green;
	}

	public bool SphereIntersect( float x1, float y1, float z1, float x2, float y2, float z2, float xC, float yC, float zC, float r )
	{
		float a = (x2 - x1) * (x2 - x1) + (y2 - y1) * (y2 - y1) + (z2 - z1) * (z2 - z1);
		//Debug.Log("Distance entre les cubes = " + Mathf.Sqrt(a)); // Pour info !!!
		//Debug.Log("Distance sans SQRT - plus rapide- entre les cubes = " + a); // Pour info !!!
		//if (a > far * far || a < near * near) return false; // Pas la bonne distance. Comparaison sans SQRT !!!
		float b = 2.0f * ((x2 - x1) * (x1 - xC) + (y2 - y1) * (y1 - yC) + (z2 - z1) * (z1 - zC));
		float c = (x1 - xC) * (x1 - xC) + (y1 - yC) * (y1 - yC) + (z1 - zC) * (z1 - zC) - r * r;
		float d = b * b - (4.0f * a * c);

		if (d < 0.01f) return false;
		else
		{ 
			// Contact perpendiculaire au centre de la sphere
			//float mu = -b / ( 2 * a);

			// Contact fin du raycast
			//float mu = (-b + (float)Math.Sqrt((b * b) - 4 * a * c )) / (2 * a);

			// Contact depart du raycast
			float mu = (-b - (float)Math.Sqrt((b * b) - 4 * a * c )) / (2 * a);
			tempo.x = x1 + mu * (x2 - x1);
			tempo.y = y1 + mu * (y2 - y1);
			tempo.z = z1 + mu * (z2 - z1);
			contact.transform.position = tempo;
			return true;
		}
	}

	public void OnDrawGizmos() 
	{
		if(fin == null || deb == null) return;
		Gizmos.color = GizCol;
		Gizmos.DrawLine(deb.position, fin.position);
	}
	
}