After lots of real robot tests. Before adding more noise to transitions and different sampling for revolute.