Frenet Frame Planning
- Também chamado: Frenet planner, Frenet optimal trajectory planning, Frenet-frame trajectory generation
- Categoria: Planning & manipulation › Motion planning
- Tags: trajectory-generation, autonomous-driving, sampling-based-planning, lane-change
Planejamento de trajetórias em coordenadas alinhadas à via, distância ao longo de um caminho de referência e deslocamento lateral em relação a ele, geralmente amostrando muitas trajetórias candidatas suaves e escolhendo a válida mais barata.
Definição
O planejamento no referencial de Frenet (Frenet frame planning) descreve o movimento de um veículo em relação a uma curva de referência, geralmente a linha central de uma faixa, em vez de em x e y globais. A posição é dada pelo comprimento de arco s ao longo da curva e pelo deslocamento lateral com sinal d em relação a ela, medido no referencial móvel tangente–normal da curva, que leva o nome das fórmulas de Frenet–Serret. Nessas coordenadas, manter-se na faixa significa manter d perto de zero, mudar de faixa significa levar d ao deslocamento da próxima faixa e seguir o trânsito significa controlar s ao longo do tempo, o que torna simples escrever funções de custo e restrições.
A formulação mais usada é a de Werling, Ziegler, Kammel e Thrun (ICRA 2010). Ela planeja o movimento lateral e o longitudinal separadamente como polinômios no tempo: polinômios de quinto grau para o deslocamento lateral e para tarefas longitudinais com uma posição-alvo, como seguir outro veículo ou parar, e polinômios de quarto grau para manter uma velocidade-alvo. Cada polinômio minimiza o jerk entre o estado atual e um estado final. O planejador amostra muitos estados finais, como diferentes deslocamentos laterais, tempos de chegada e velocidades-alvo, combina candidatos laterais e longitudinais, converte-os de volta para coordenadas cartesianas e descarta os que excedem os limites de curvatura, aceleração ou velocidade ou colidem com obstáculos previstos. O candidato válido de menor custo, que pondera jerk, tempo e desvio em relação ao objetivo, é executado, e o planejamento se repete em alta frequência partindo do plano anterior para manter as trajetórias sucessivas consistentes. Em baixa velocidade, é melhor planejar o deslocamento lateral em função de s do que do tempo.
A abordagem depende de uma boa linha de referência. A curva precisa ser suave, com curvatura contínua, e a conversão de volta para coordenadas cartesianas falha quando o deslocamento lateral se aproxima do raio de curvatura, o que acontece em curvas fechadas com deslocamentos grandes. O planejamento no referencial de Frenet se adapta a vias e faixas estruturadas; para estacionamentos ou espaços abertos, usam-se planejadores como o Hybrid A.
Por que importa
A condução em vias é naturalmente descrita em relação às faixas, e as coordenadas de Frenet transformam a manutenção de faixa, as mudanças de faixa, as incorporações e o seguimento de veículos em problemas unidimensionais simples. A formulação por amostragem é fácil de implementar, gera trajetórias suaves e confortáveis e tornou-se um planejador padrão para ensino e como referência para veículos autônomos.
Principais aplicações
- Manutenção de faixa, mudanças de faixa e ultrapassagens em rodovias
- Seguimento de veículos, incorporação e parada em faixas de retenção na condução urbana
- Planejadores de referência em plataformas de pesquisa e simuladores de condução autônoma
- Seguimento de caminhos para robôs que se movem ao longo de corredores, fileiras ou trilhos
- Traçados de corrida planejados em relação à linha central de uma pista
Na prática
Em uma rodovia, um veículo autônomo de testes constrói uma spline suave ao longo do centro da sua faixa atual como linha de referência. A cada ciclo de planejamento, ele amostra deslocamentos laterais finais para a própria faixa e as faixas vizinhas, várias durações de manobra e um conjunto de velocidades-alvo. Gera os polinômios correspondentes, converte cada candidato para x, y, orientação e curvatura, rejeita os que excedem os limites de conforto ou dos pneus ou chegam perto demais das trajetórias previstas dos carros próximos e passa a trajetória restante mais barata a um controlador de rastreamento. Uma mudança de faixa acontece quando um candidato que termina na faixa seguinte se torna o mais barato, por exemplo quando o carro da frente desacelera.
Equívocos comuns
- O planejamento no referencial de Frenet é um único algoritmo — é uma escolha de coordenadas; a amostragem com polinômios é a abordagem comum, mas planejadores baseados em otimização também trabalham em coordenadas de Frenet
- As trajetórias são viáveis porque são suaves no referencial de Frenet — os limites de curvatura e aceleração precisam ser verificados após a conversão de volta para coordenadas cartesianas
- Funciona em qualquer lugar — precisa de um caminho de referência suave e se degrada em curvas fechadas e em espaços abertos sem faixas
- O planejamento lateral e o longitudinal são totalmente independentes — são planejados separadamente por conveniência, mas precisam ser combinados e verificados juntos
Quem deve saber
- Engenheiros de planejamento para condução autônoma
- Pesquisadores que usam simuladores de condução como o CARLA
- Desenvolvedores de robôs móveis que seguem rotas estruturadas
- Estudantes aprendendo geração de trajetórias
Tecnologias relacionadas
- Trajetórias polinomiais de quinto e quarto grau
- Fórmulas de Frenet–Serret
- Linhas de referência com splines cúbicas
- Planejador por reticulado de estados (state lattice planner)
- Controle preditivo por modelo
- Simulador CARLA
Termos relacionados
- Trajectory Planning
- Bicycle model
- Model Predictive Control
- Obstacle Avoidance
- Nonholonomic Constraint
- Hybrid A*
Projetos relacionados
- Ruckig: Real-time jerk-constrained time-optimal trajectory generation for robots and machines
- Vision Pilot: Autoware Foundation's open-source L2 ADAS stack from a single camera
- python_simple_mppi: MPPI control derived and implemented in numpy, with four worked examples
- NVIDIA Alpamayo: NVIDIA's open driving VLA models that plan a path and explain it, with sim, RL and data