void CRigidBody::UpdateCollisionReaction() { CVehicle* Car = (CVehicle*)this; Vector3f OldPosition = m_vPosition; // update reflection motion m_vReflection *= RIGIDBODY_REFLECTION_ENTROPY_FACTOR; m_vPosition = m_translate + m_vReflection; m_vDirectionWhenDisturbed = m_vPosition - OldPosition; m_translate = m_vPosition; m_box.Center() = m_vPosition; m_sphere.Center() = m_vPosition; Car->SetVehiclePositionLC(Vector3f(m_vPosition.X(), m_vPosition.Z(), m_vPosition.Y())); // update angular velocity m_vRotation *= RIGIDBODY_ROTATION_ENTROPY_FACTOR; Car->GetRotationLC().Z() += m_vRotation.Y(); // see if reflection has dissipated enough to stop if (m_vReflection.Length() < RIGIDBODY_REFLECTION_DEATH_FACTOR) { disturbed = false; } }
void CRigidBody::DeliverCollisionMessage(CCollisionMessage* ColMsg) { if (!ColMsg) return; if (ColMsg->GetCollisionType() == SPHERE_TO_SPHERE) { HandleSphereToSphereCollision(ColMsg); return; } /****** Deploy to HandlePushCollision() if this is the case ******/ // Push collision not working. Commenting this out for now. /* if (ColMsg->GetCollisionType() == PUSHED) { HandlePushCollision(ColMsg); return; } */ CVehicle* Car = (CVehicle*)ColMsg->GetEntity(); /************** set reflection motion ************/ m_vPosition = m_translate + (*ColMsg->GetReverse())*RIGIDBODY_SPACING_FACTOR; Vector3f velocityWC; if (disturbed) { velocityWC = m_vDirectionWhenDisturbed*80.0f; } else { velocityWC = Car->GetVehicleVelocityWC(); // if reversing, velocityWC will point in opposite direction as actual velocity if (Car->GetVehicleVelocityLC().X() < 0.0f) velocityWC *= -1.0f; } m_vReflection = velocityWC - 2.0f*(velocityWC.Dot(*ColMsg->GetNormal()))*(*ColMsg->GetNormal()); m_vReflection *= RIGIDBODY_REFLECTION_FACTOR; m_vDirectionWhenDisturbed = m_vReflection; Car->SetVehicleVelocityLC(0.0f); Car->SetVehiclePositionLC(Vector3f(m_vPosition.X(), m_vPosition.Z(), m_vPosition.Y())); /*************** set angular velocity ******************/ // Compute angle between vehicle heading and plane Vector3f PlaneEdge = ColMsg->GetPlane()->Edge0(); Vector3f CarHeading = Car->GetVehicleHeadingWC(); float angle = acos(CarHeading.Dot(PlaneEdge)/(PlaneEdge.Length()*CarHeading.Length())); // spin CW or CCW? float spin; // magnitude of spin about the y-axis if (angle > Math<float>::PI/2.0f) { // CCW spin = Math<float>::PI - angle; } else { // CW spin = -angle; } spin *= RIGIDBODY_SPIN_FACTOR; m_vRotation = Vector3f(0.0f, spin, 0.0f); /*************** set vectors that are actually used in renderer ************/ /*********************** to the values computed above **********************/ m_translate = m_vPosition; m_box.Center() = m_vPosition; m_sphere.Center() = m_vPosition; Car->GetRotationLC().Z() += spin; disturbed = true; /* CLog::GetLog().Write(LOG_MISC, "\n\n\nreflection = (%f, %f, %f)", m_vReflection.X(), m_vReflection.Y(), m_vReflection.Z()); CLog::GetLog().Write(LOG_MISC, "direction = (%f, %f, %f)\n\n", m_vDirectionWhenDisturbed.X(), m_vDirectionWhenDisturbed.Y(), m_vDirectionWhenDisturbed.Z()); */ }