16#ifndef BT_MOUSE_PICKING_FORCE_H
17#define BT_MOUSE_PICKING_FORCE_H
25 btScalar m_elasticStiffness, m_dampingStiffness;
49 for (
int i = 0; i < 3; ++i)
53 if ((m_face.m_n[i]->m_x - m_mouse_pos).norm() >
SIMD_EPSILON)
56 scaled_force =
scale * m_dampingStiffness * v_diff.dot(dir) * dir;
58 force[m_face.m_n[i]->index] -= scaled_force;
65 for (
int i = 0; i < 3; ++i)
67 btVector3 dir = (m_face.m_n[i]->m_q - m_mouse_pos);
68 btVector3 scaled_force = scaled_stiffness * dir;
69 if (scaled_force.safeNorm() > m_maxForce)
71 scaled_force.safeNormalize();
72 scaled_force *= m_maxForce;
74 force[m_face.m_n[i]->index] -= scaled_force;
81 for (
int i = 0; i < 3; ++i)
83 btVector3 local_scaled_df = scaled_k_damp * dv[m_face.m_n[i]->index];
84 if ((m_face.m_n[i]->m_x - m_mouse_pos).norm() >
SIMD_EPSILON)
87 local_scaled_df = scaled_k_damp * dv[m_face.m_n[i]->index].dot(dir) * dir;
89 df[m_face.m_n[i]->index] -= local_scaled_df;
98 for (
int i = 0; i < 3; ++i)
100 btVector3 dir = (m_face.m_n[i]->m_q - m_mouse_pos);
101 btVector3 scaled_force = m_elasticStiffness * dir;
102 if (scaled_force.safeNorm() > m_maxForce)
104 scaled_force.safeNormalize();
105 scaled_force *= m_maxForce;
107 energy += 0.5 * scaled_force.dot(dir);
115 for (
int i = 0; i < 3; ++i)
118 btVector3 scaled_force = m_dampingStiffness * v_diff;
119 if ((m_face.m_n[i]->m_x - m_mouse_pos).norm() >
SIMD_EPSILON)
122 scaled_force = m_dampingStiffness * v_diff.dot(dir) * dir;
124 energy -= scaled_force.dot(m_face.m_n[i]->m_v) / dt;
132 for (
int i = 0; i < 3; ++i)
134 btVector3 dir = (m_face.m_n[i]->m_q - m_mouse_pos);
137 int id = m_face.m_n[i]->index;
143 scaled_df -= scaled_stiffness * dir_normalized.dot(dx_diff) * dir_normalized;
144 scaled_df += scaled_stiffness * dir_normalized.dot(dx_diff) * ((dir_norm - r) / dir_norm) * dir_normalized;
145 scaled_df -= scaled_stiffness * ((dir_norm - r) / dir_norm) * dx_diff;
float btScalar
The btScalar type abstracts floating point numbers, to easily switch between double and single floati...
btVector3
btVector3 can be used to represent 3D points and vectors. It has an un-used w component to suit 16-by...
float3x3 scale(float3x3 mat, float2 scale)
ccl_device_inline Quaternion normalized(const Quaternion q)