Esempio n. 1
0
 def integrate(self, state, command):
     v = se2.algebra_from_vector(command)
     delta = SE2.group_from_algebra(v * self.dt)
     return np.dot(state, delta)
Esempio n. 2
0
 def integrate(self, state, command):
     v = se2.algebra_from_vector(command)
     delta = SE2.group_from_algebra(v * self.dt)
     return np.dot(state, delta)
Esempio n. 3
0
 def default_state(self):
     return SE2.identity()
Esempio n. 4
0
 def default_state(self):
     return SE2.identity()