Beispiel #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)
Beispiel #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)
Beispiel #3
0
 def default_state(self):
     return SE2.identity()
Beispiel #4
0
 def default_state(self):
     return SE2.identity()