Hacktoberfest 2026: as issues que os mantenedores marcaram para outubro, abertas e boas para iniciantes. Ver issues do Hacktoberfest

trlog2 loses the quadrant for valid SO(2) and SE(2) rotations

Aberta Para iniciantes
  • Algo errado?
#252 0 comentários 0 reações 0 responsáveis Ver no GitHub

Mantenedores costumam responder em até 1 dia

@vera-rubin já está trabalhando nisso.

Desde 14/10/2026.

  • #256 de @vera-rubin — aberto

Avaliação

Dificuldade
2/5
Tempo estimado
1-3 horas
Facilidade para iniciantes
72/100
Tipo de issue
Bug
Clareza
Claramente especificada
Status de atividade
Ativa
Stack de tecnologia
numpy, python
Domínio
robotics

Direção de pesquisa

O erro está em trlog2 em spatialmath/base/transforms2d.py, onde ambos os ramos recuperam o ângulo com atan(sin/cos) e perdem o quadrante. Comece por aí e verifique se atan2 aplicado às mesmas entradas de seno e cosseno corrige os casos de 120° e 180°. Execute o reprodutor da issue, que compara trlog2, SO2.log, SE2.log e Twist2(SE2).exp com logaritmos exatos. Está pronto quando os cinco ida e volta passarem em 120° e 180° e o controle de 30° continuar passando.

Escrita pelo modelo de indexação a partir do texto da issue.

Descrição

trlog2 returns logarithms that don't exponentiate to valid 120° and 180° inputs. SO2.log(), SE2.log() and Twist2(SE2(...)).exp() inherit this.

Version: spatialmath-python 1.1.18, 2de780137049040a665225b59d65d95ec93a9e13, Python 3.12.3, SymPy 1.14.0, mpmath 1.3.0, Linux x86_64, NumPy 1.26.4 / SciPy 1.15.3 and NumPy 2.5.4 / SciPy 1.18.1.

In an empty directory, use Python 3.12 and Bash:

git clone https://github.com/rai-opensource/spatialmath-python.git spatialmath-python
git -C spatialmath-python checkout --detach 2de780137049040a665225b59d65d95ec93a9e13
python3.12 -m venv .venv
.venv/bin/python -m pip install -e ./spatialmath-python numpy==1.26.4 scipy==1.15.3 sympy==1.14.0 mpmath==1.3.0
OPENBLAS_NUM_THREADS=1 OMP_NUM_THREADS=1 .venv/bin/python - <<'PY'
"""Exact SO(2)/SE(2) log references, including a common 120-degree pose."""
import numpy as np
import sympy as sp
from scipy.linalg import expm
from spatialmath import SO2, SE2, Twist2
from spatialmath.base import trlog2


def numeric(m):
    return np.array(sp.Matrix(m).evalf(60).tolist(), dtype=float)


failures = []
for degrees in (30, 120, 180):
    theta = sp.pi * degrees / 180
    c, s = sp.cos(theta), sp.sin(theta)
    R = sp.Matrix([[c, -s], [s, c]])
    T = sp.eye(3)
    T[:2, :2], T[:2, 2] = R, sp.Matrix([1, 2])
    # exp([v,theta]) translates by V(theta)*v.
    V = sp.Matrix([[s, -(1-c)], [1-c, s]]) / theta
    v = V.inv() * sp.Matrix([1, 2])
    logR = sp.Matrix([[0, -theta], [theta, 0]])
    logT = sp.Matrix([[0, -theta, v[0]], [theta, 0, v[1]], [0, 0, 0]])
    np.testing.assert_allclose(expm(numeric(logT)), numeric(T), atol=1e-14)
    for name, actual, expected in (
        ('trlog2(SO2)', trlog2(numeric(R)), numeric(logR)),
        ('SO2.log', SO2(numeric(R)).log(), numeric(logR)),
        ('trlog2(SE2)', trlog2(numeric(T)), numeric(logT)),
        ('SE2.log', SE2(numeric(T)).log(), numeric(logT)),
        ('Twist2(SE2).exp', Twist2(SE2(numeric(T))).exp().A, numeric(T)),
    ):
        error = np.max(np.abs(actual - expected))
        print(f'{degrees:3d} deg {name:17s} max error {error:.12g}')
        # Any real logarithm branch is acceptable if its exponential is the
        # specified input. This also accepts either sign at the half-turn.
        target = numeric(R) if name in ('trlog2(SO2)', 'SO2.log') else numeric(T)
        recovered = actual if name == 'Twist2(SE2).exp' else expm(actual)
        if not np.allclose(recovered, target, atol=1e-12, rtol=0):
            failures.append((degrees, name))
    print('log rotation =', trlog2(numeric(R), twist=True))
assert not failures, f'Confirmed deviations: {failures}'
PY

The trlog2 contract defines SO(2)/SE(2) matrix logarithms, so exp(log(T)) should recover T. Inputs meet documented forms with default checks enabled and no documented angle bound.

At 120°, trlog2(R, twist=True) returns -pi/3 instead of 2*pi/3, and at 180°, zero. Both angles fail all five round trips. The 30° control passes.

Both branches lose the quadrant through atan(sin/cos). atan2 with the same sine and cosine entries would preserve it.

We tested singleton matrices at 30°, ±120° and 180°, without sequences or robot workflows.

The reproducer is provided under CC0-1.0. Happy to send a PR.

— ChipLab

Linguagem predominante
Python
Estrelas
648
Forks
108
Merge médio
9d 19h
PRs com merge (30d)
9

Preparar o ambiente

Este projeto não oferece contêiner de desenvolvimento, Dockerfile nem guia de contribuição, então a configuração fica por sua conta: comece pelo README e veja nosso guia da primeira contribuição para os passos gerais.

Primeiros passos

  1. Leia a issue inteira e depois o guia de contribuição do projeto.
  2. Comente na issue dizendo que vai assumir — evita que duas pessoas façam o mesmo trabalho.
  3. Faça um fork do repositório e trabalhe em uma branch.
  4. Abra um pull request que referencie o número da issue.

Mais de rai-opensource/spatialmath-python

Todas as issues de rai-opensource/spatialmath-python

Issues semelhantes

Mais issues de Python

Receba novas issues na sua caixa de entrada

Um resumo curto de issues do GitHub para quem está começando.