def setUp(self): joint = PrismaticJoint('joint', [0, 0, 1]) joint.stiffness = self.K joint.damping = 2 * self.damping_coeff * (self.K * self.M) ** 0.5 body = RigidBody('body', self.M) system = System() system.add_leaf(joint) joint.add_leaf(body) system.setup() system.update_kinematics() self.joint, self.body, self.system = joint, body, system
def setUp(self): joint = PrismaticJoint('joint', [0, 0, 1]) joint.stiffness = self.K joint.damping = 2 * self.damping_coeff * (self.K * self.M)**0.5 body = RigidBody('body', self.M) system = System() system.add_leaf(joint) joint.add_leaf(body) system.setup() system.update_kinematics() self.joint, self.body, self.system = joint, body, system
def test_1dof_linear_system(self): s = System() j = PrismaticJoint('joint', [0, 0, 1]) j.stiffness = 5.0 j.damping = 2.3 b = RigidBody('body', 10) s.add_leaf(j) j.add_leaf(b) s.setup() linsys = LinearisedSystem.from_system(s) assert_array_equal(linsys.M, [[10.0]]) assert_array_equal(linsys.C, [[2.3]]) assert_array_equal(linsys.K, [[5.0]])