using UnityEngine;
using System.Collections;

public static class AdvancedPhysics {

	public static void AddTorqueAtPosition(this Rigidbody body, Vector3 torque, Vector3 position, ref Vector3 force, ref Vector3 ortho){
		Vector3 torqueAxis = torque.normalized;
		ortho = new Vector3(1,0,0);

		if ( (torqueAxis-ortho).sqrMagnitude < 0.01f ) {
			ortho = new Vector3(0,1,0);
		}

		Vector3.OrthoNormalize(ref torqueAxis, ref ortho);
		force = Vector3.Cross(0.5f * torque, ortho);

		body.AddForceAtPosition (force, position + ortho);
		body.AddForceAtPosition (-force, position - ortho);
	}

	public static void AddTorqueAtPosition(this Rigidbody body, Vector3 torque, Vector3 position){
		Vector3 force = new Vector3 ();
		Vector3 ortho = new Vector3 ();
		AddTorqueAtPosition (body, torque, position, ref force, ref ortho);
	}
}