ksys/phys: Finish RagdollRigidBody and add more RagdollController functions

3 files changed, 23 insertions, 1 deletions

diff --git a/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.h b/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.h
index c9bd6b97..cf11f5f5 100644
--- a/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.h
+++ b/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.h
@@ -147,6 +147,10 @@ public:
     template <int N>
     HK_FORCE_INLINE void setDot(hkVector4fParameter a, hkVector4fParameter b);
 
+    /// Get the length of this vector as if it had N components.
+    template <int N>
+    HK_FORCE_INLINE hkSimdFloat32 length() const;
+
     /// Get the squared length (|v|^2) of this vector as if it had N components.
     template <int N>
     HK_FORCE_INLINE hkSimdFloat32 lengthSquared() const;
diff --git a/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.inl b/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.inl
index 41c5a1a1..8dba60dd 100644
--- a/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.inl
+++ b/lib/hkStubs/Havok/Common/Base/Math/Vector/hkVector4f.inl
@@ -482,6 +482,11 @@ inline void hkVector4f::setDot(hkVector4fParameter a, hkVector4fParameter b) {
 }
 
 template <int N>
+inline hkSimdFloat32 hkVector4f::length() const {
+    return lengthSquared<N>().sqrt();
+}
+
+template <int N>
 inline hkSimdFloat32 hkVector4f::lengthSquared() const {
     return dot<N>(*this);
 }
diff --git a/lib/hkStubs/Havok/Physics2012/Collide/Shape/Convex/Capsule/hkpCapsuleShape.h b/lib/hkStubs/Havok/Physics2012/Collide/Shape/Convex/Capsule/hkpCapsuleShape.h
index d46634f2..d0de3ec9 100644
--- a/lib/hkStubs/Havok/Physics2012/Collide/Shape/Convex/Capsule/hkpCapsuleShape.h
+++ b/lib/hkStubs/Havok/Physics2012/Collide/Shape/Convex/Capsule/hkpCapsuleShape.h
@@ -17,7 +17,7 @@ public:
     hkpCapsuleShape() = default;
     hkpCapsuleShape(const hkVector4& vertexA, const hkVector4& vertexB, hkReal radius);
     explicit hkpCapsuleShape(hkFinishLoadedObjectFlag flag);
-    virtual ~hkpCapsuleShape();
+    ~hkpCapsuleShape() override;
 
     HK_FORCE_INLINE void getSupportingVertex(hkVector4Parameter direction,
                                              hkcdVertex& supportingVertexOut) const override;
@@ -57,3 +57,16 @@ protected:
     // The line's second point.
     hkVector4 m_vertexB;
 };
+
+inline const hkVector4* hkpCapsuleShape::getVertices() const {
+    return &m_vertexA;
+}
+
+inline const hkVector4& hkpCapsuleShape::getVertex(int i) const {
+    return getVertices()[i];
+}
+
+template <int I>
+inline const hkVector4& hkpCapsuleShape::getVertex() const {
+    return getVertices()[I];
+}