Allow external forces and torques to be added on rigid bodies

[libs/game.git] / examples / bassteroids / source / rigidbody.cpp

diff --git a/examples/bassteroids/source/rigidbody.cpp b/examples/bassteroids/source/rigidbody.cpp
index 509e3a939cf0872ea4f2daa26e8f8184fe9c24cd..391707a574ee40b2e8b36f8fd098961aab95ab4f 100644 (file)
--- a/examples/bassteroids/source/rigidbody.cpp
+++ b/examples/bassteroids/source/rigidbody.cpp
@@ -1,4 +1,6 @@
 #include "rigidbody.h"
+#include <msp/game/entity.h>
+#include <msp/game/transform.h>
 
 using namespace Msp;
 
@@ -16,3 +18,26 @@ void RigidBody::set_angular_velocity(Geometry::Angle<float> as)
 {
        angular_velocity = as;
 }
+
+void RigidBody::add_force(const LinAl::Vector<float, 2> &f)
+{
+       force += f;
+}
+
+void RigidBody::add_force(const LinAl::Vector<float, 2> &f, const LinAl::Vector<float, 2> &p)
+{
+       force += f;
+       LinAl::Vector<float, 2> r = p-entity->get_transform()->get_position().slice<2>(0);
+       torque += r.x*f.y-r.y*f.x;
+}
+
+void RigidBody::add_torque(float t)
+{
+       torque += t;
+}
+
+void RigidBody::clear_forces()
+{
+       force = LinAl::Vector<float, 2>();
+       torque = 0.0f;
+}