简介

impulse 简单而言就是脉冲. 脉冲就是, 在碰撞的时候给一个脉冲. 导致其速度和角速度改变.

pipeline

Q&A

简述Vi 和 ViNew

Vi 就是碰撞点速度的均值
ViNew 就是碰撞点速度的改变.

J 有什么用

通过 ViNew 和 Vi 计算除了 J. 然后通过J 计算出整个模型的速度v和角速度w.

TIPS

通过角速度的更新来更新, 物体的四元数

code

using UnityEngine;
using System.Collections;

public class Rigid_Bunny : MonoBehaviour 
{
	bool launched 		= false;
	float dt 			= 0.015f;
	Vector3 v 			= new Vector3(0, 0, 0);	// velocity
	Vector3 w 			= new Vector3(0, 0, 0);	// angular velocity
	
	float mass;									// mass
	Matrix4x4 I_ref;							// reference inertia

	float linear_decay	= 0.999f;				// for velocity decay
	float angular_decay	= 0.98f;				
	float restitution 	= 0.5f;                 // for collision
	float mu_T = 0.5f;// may be coefficient of air resistance
	Vector3 G = new Vector3(0.0f, -9.8f, 0.0f);


	// Use this for initialization
	void Start () 
	{		
		Mesh mesh = GetComponent().mesh;
		Vector3[] vertices = mesh.vertices;

		float m=1;
		mass=0;
		for (int i=0; i
	void Collision_Impulse(Vector3 P, Vector3 N)
	{
		Mesh mesh = GetComponent().mesh;
		Vector3[] vertices = mesh.vertices; // may be this is local position
		int[] vid_collision = new int[vertices.Length];
		int num_collision = 0;

		Matrix4x4 R = Matrix4x4.Rotate(transform.rotation);
		for(int i=0; i 0) return; // it may be in the state of Rebound ??

		// calc Compute the wanted ??_??^new 
		Vector3 VN = Vector3.Dot(Vi, N) * N;
		Vector3 VT = Vi - VN;
		restitution = Mathf.Max(restitution - 0.0005f, 0); // We can decrease the restitution ??_?? to reduce oscillation
		float a = Mathf.Max(0, 1.0f - mu_T * (1.0f + restitution)) * Vector3.Magnitude(VN) / Vector3.Magnitude(VT);
		Vector3 ViNew = -1.0f * restitution * VN + a * VT;
		// Compute the impulse j
		Matrix4x4 I_rot = R * I_ref * Matrix4x4.Transpose(R);
		Matrix4x4 I_inverse = Matrix4x4.Inverse(I_rot);

		Matrix4x4 Rri_star = Get_Cross_Matrix(Rri);
		Matrix4x4 K = minusTwoMatrix(multiplyScalar(Matrix4x4.identity , (1.0f / mass)) ,
			Rri_star * I_inverse * Rri_star);
		Vector3 J = K.inverse.MultiplyVector(ViNew - Vi);

		// update v and w
		v = v + 1 / mass * J;
		w = w + I_inverse.MultiplyVector(Vector3.Cross(Rri, J));
	}

	// Update is called once per frame
	void Update () 
	{
		//Game Control
		if(Input.GetKey("r"))
		{
			transform.position = new Vector3 (0, 0.6f, 0);
			restitution = 0.5f;
			launched=false;
		}
		if(Input.GetKey("l"))
		{
			v = new Vector3 (5, 2, 0);
			launched=true;
		}

		// Part I: Update velocities
		if (launched == false) return;

		v = v + dt * G;
		v = v * linear_decay;

		w *= angular_decay;

		// Part II: Collision Impulse
		Collision_Impulse(new Vector3(0, 0.01f, 0), new Vector3(0, 1, 0));
		Collision_Impulse(new Vector3(2, 0, 0), new Vector3(-1, 0, 0));

		// Part III: Update position & orientation
		//Update linear status
		Vector3 x    = transform.position;
		x += dt * v;
		//Update angular status
		Quaternion q = transform.rotation;
		Vector3 dw = 0.5f * dt * w;
		Quaternion qua_rotate = new Quaternion(dw.x, dw.y, dw.z, 0.0f);
		q = addTwoQuaternion(q, qua_rotate * q);
		// Part IV: Assign to the object
		transform.position = x;
		transform.rotation = q;
	}
}

Image