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