sequencing and replanning

This commit is contained in:
Fabian
2022-06-29 16:30:36 +02:00
parent 9b48fc9d48
commit b200cf4b69
2 changed files with 34 additions and 55 deletions
+5
View File
@@ -1,4 +1,5 @@
import numpy as np
import torch as ch
def angle_normalize(x, type="deg"):
@@ -19,3 +20,7 @@ def angle_normalize(x, type="deg"):
two_pi = 2 * np.pi
return x - two_pi * np.floor((x + np.pi) / two_pi)
def get_numpy(x: ch.Tensor):
return x.detach().cpu().numpy()