BR112018071211B1 - Sistema de aquisição de linha, método implementado por computador para controlar um veículo e sistema de controle de direção - Google Patents

Sistema de aquisição de linha, método implementado por computador para controlar um veículo e sistema de controle de direção Download PDF

Info

Publication number
BR112018071211B1
BR112018071211B1 BR112018071211-6A BR112018071211A BR112018071211B1 BR 112018071211 B1 BR112018071211 B1 BR 112018071211B1 BR 112018071211 A BR112018071211 A BR 112018071211A BR 112018071211 B1 BR112018071211 B1 BR 112018071211B1
Authority
BR
Brazil
Prior art keywords
vehicle
path
acquisition
error
simulated
Prior art date
Application number
BR112018071211-6A
Other languages
English (en)
Other versions
BR112018071211A2 (pt
Inventor
Eran D. B. Medagoda
Timothy J. Sullivan
Tri M. Dang
Original Assignee
Agjunction Llc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Agjunction Llc filed Critical Agjunction Llc
Publication of BR112018071211A2 publication Critical patent/BR112018071211A2/pt
Publication of BR112018071211B1 publication Critical patent/BR112018071211B1/pt

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/003Steering or guiding of machines or implements pushed or pulled by or mounted on agricultural vehicles such as tractors, e.g. by lateral shifting of the towing connection
    • A01B69/006Steering or guiding of machines or implements pushed or pulled by or mounted on agricultural vehicles such as tractors, e.g. by lateral shifting of the towing connection derived from the steering of the tractor
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/029Steering assistants using warnings or proposing actions to the driver without influencing the steering system
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Soil Sciences (AREA)
  • Environmental Sciences (AREA)
  • Transportation (AREA)
  • Combustion & Propulsion (AREA)
  • Chemical & Material Sciences (AREA)
  • Mathematical Physics (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

Um sistema de aquisição de linha prevê e exibe um caminho de aquisição para reduzir a incerteza em torno do caminho percorrido por um veículo ao adquirir um caminho de destino. O sistema de aquisição de linha calcula o caminho de aquisição dirigível com base nos estados atuais do veículo, como posição, velocidade, rumo e curvatura. O sistema de aquisição de linha continuamente atualiza e exibe o caminho de aquisição à medida que o veículo é direcionado manualmente pelo usuário. Quando o usuário aciona um controlador de direção, o último caminho de aquisição calculado é usado para direcionar automaticamente o veículo para o caminho de destino. A exibição do caminho de aquisição permite que o usuário observe, antes do engate automático da direção, o caminho que o veículo seguiria do seu estado atual até o destino. O usuário pode então decidir se o caminho de aquisição previsto irá interferir no terreno ou nos obstáculos que o usuário deseja evitar.

Description

AVISO DE COPYRIGHT
[0001] Uma parte da divulgação deste documento de patente contém material que está sujeito à proteção de direitos autorais. O proprietário dos direitos autorais não tem objeções à reprodução fac-símile feita por qualquer pessoa do documento de patente ou da divulgação de patente, como aparece no arquivo ou nos registros do Escritório de Marcas e Patentes dos Estados Unidos, mas reserva todos os direitos autorais.
CAMPO TÉCNICO
[0002] Uma ou mais implementações referem-se de forma geral a um sistema de aquisição de linha.
ANTECEDENTES
[0003] Um controlador de direção automaticamente guia um veículo a partir de um local atual para um local de destino, tal como um caminho de destino em um campo. O caminho percorrido pelo veículo até ao destino é determinado em tempo real com base na natureza do sistema de controle de direção automática do veículo e na posição do veículo em relação ao caminho de destino. O controlador de direção ajusta continuamente a direção do veículo conforme o veículo se aproxima do caminho de destino. Em outras palavras, o controlador de direção não conhece o caminho de aquisição tomado pelo veículo até alcançar e adquirir o caminho de destino.
BREVE DESCRIÇÃO DOS DESENHOS
[0004] Os desenhos incluídos são para fins ilustrativos e servem para fornecer exemplos de possíveis estruturas e operações para os sistemas inventivos, aparelhos, métodos e meios de armazenamento legíveis por computador. Estes desenhos não limitam, de modo algum, quaisquer alterações na forma e detalhes que possam ser feitas por um versado na técnica sem se afastar do espírito e escopo das implementações divulgadas.
[0005] A Figura 1 mostra um exemplo de sistema de aquisição de linha.
[0006] A Figura 2 mostra exemplos de parâmetros usados para calcular um caminho de aquisição.
[0007] A Figura 3 mostra um exemplo de caminho de aquisição previsto.
[0008] A Figura 4 mostra um veículo usando o caminho de aquisição para adquirir um caminho de destino.
[0009] A Figura 5A mostra caminhos de aquisição gerados dinamicamente.
[0010] A Figura 5B mostra um processo para gerar os caminhos de aquisição.
[0011] As Figuras 6A-6D mostram exemplos de caminhos de aquisição para adquirir um caminho de destino de linha reta.
[0012] As Figuras 7A e 7B mostram exemplos de caminhos de aquisição de giro à esquerda e à direita em um caminho de destino reto.
[0013] As Figuras 8A e 8B mostram exemplos de caminhos de aquisição de giro à esquerda e à direita em um caminho de destino curvo.
[0014] As Figuras 9A-9D mostram exemplos de caminhos de aquisição para adquirir caminhos de destino contornados.
[0015] As Figuras 10A e 10B mostram exemplos de caminhos de aquisição gerados quando um controlador de direção pode não se engatar normalmente com o caminho de destino.
[0016] As Figuras 11A e 11B mostram como os caminhos de aquisição impedem o engate automático da direção sobre uma área trabalhada.
[0017] A Figura 12 mostra um exemplo de sistema de guia que inclui o sistema de aquisição de linha.
[0018] A Figura 13 mostra o sistema de guia da Figura 12 controlando um sistema de direção automática.
DESCRIÇÃO DETALHADA
[0019] Um sistema de aquisição de linha prevê e exibe um caminho de aquisição para reduzir a incerteza em torno do caminho percorrido por um veículo ao adquirir um caminho de destino. O sistema de aquisição de linha calcula o caminho de aquisição dirigível com base nos estados atuais do veículo, como posição, velocidade, rumo e curvatura. O sistema de aquisição de linha atualiza continuamente e exibe o caminho de aquisição conforme o veículo é direcionado manualmente pelo usuário. Quando o usuário aciona um controlador de direção, o último caminho de aquisição calculado é usado para direcionar automaticamente o veículo para o caminho de destino.
[0020] A exibição do caminho de aquisição permite que o usuário observe, antes do engate automático da direção, o caminho que o veículo seguiria do seu estado atual até o destino. Do ponto de vista agrícola, o caminho de aquisição fornece ao usuário uma descrição de onde o veículo irá dirigir ao adquirir um caminho de destino, como uma linha de caminho em um campo. O usuário pode então decidir se o caminho de aquisição previsto irá interferir no terreno ou nos obstáculos que o usuário deseja evitar.
[0021] O conhecimento do caminho de aquisição tem implicações mais abrangentes, que vão desde uma melhor gestão das operações de campo entre caminhos e promontórios, a capacidade de planejar tarefas do veículo com base na posição atual do veículo no caminho de aquisição, bem como a criação de um controlador de direção automático robusto que não precisa mais lidar com condições de aquisição incertas.
[0022] O caminho de aquisição fornece ao usuário um caminho dirigível completo desde a posição atual do veículo até o caminho de destino. Isso aumenta a conscientização situacional do usuário para melhorar a tomada de decisões. O usuário pode decidir qual o melhor momento para acionar o controlador automático de direção, sabendo que o caminho de aquisição conduzido pelo veículo evitará perigos e outras áreas do campo.
[0023] O sistema de aquisição de linha pode aumentar os níveis de autonomia do veículo. Por exemplo, com um caminho de aquisição computado completo, o usuário pode ter menos tarefas de direção para executar ao processar um campo, tal como dirigir manualmente o veículo para uma posição adequada perto do caminho de destino antes de engatar o controlador de direção automática. O sistema de aquisição de linha também pode permitir giros automáticos no final da linha que reduzem a quantidade de direção manual ao fazer a transição entre diferentes caminhos de destino e, em última análise, reduzir a carga de trabalho do usuário.
[0024] Fornecer um caminho completo de aquisição de linha da posição atual do veículo para o caminho de destino pode melhorar os projetos do controlador de direção automática. Por exemplo, o veículo pode não precisar mais executar certas manobras de aquisição no caminho de destino e o controlador de direção pode não precisar mais processar grandes entradas do controlador, como grandes erros de trajetória cruzada e de rumo. O controlador de direção pode, portanto, manter um controle de rastreamento mais rigoroso quando posicionado no caminho de destino, já que o veículo pode estar alinhado com os caminhos de aquisição e de destino a partir do momento do engate do controle de direção automática.
[0025] A previsão de caminhos de aquisição também pode permitir que o controlador de direção acomode um maior número de condições de engate que poderiam ser rejeitadas. Esses casos ocorrem quando o estado atual do veículo em relação ao caminho de destino excede os limites de restrições da direção do controlador.
[0026] A FIG. 1 mostra um sistema de controle de veículo 110 que utiliza um simulador de veículo baseado em modelo para gerar caminhos de aquisição. O sistema de controle do veículo 110 pode guiar automaticamente um veículo. Por exemplo, o sistema de controle de veículos 110 pode estar localizado em um trator e ser utilizado para guiar automaticamente o trator sobre linhas de caminho alinhadas com linhas em um campo. O sistema de controle do veículo 110 pode guiar automaticamente o veículo ao longo das linhas de caminho enquanto o veículo trabalha, tal como arar, semear, pulverizar, descarregar ou semelhantes, ou qualquer combinação destes. Naturalmente, este é apenas um exemplo e o sistema de controle do veículo 110 pode guiar qualquer tipo de veículo sobre qualquer tipo de caminho de destino.
[0027] O sistema de controle de veículo 110 pode incluir um sistema de aquisição de linha 112 que replica o comportamento de circuito fechado de um veículo e prevê a trajetória do veículo a partir de um estado atual para o caminho de destino. A trajetória prevista gerada pelo sistema de aquisição de linha 112 é utilizada por um planejador de caminho de veículo 122 para gerar um caminho dirigível para conduzir o veículo a partir de uma posição atual para o caminho de destino.
[0028] O sistema de aquisição de linha 112 pode incluir um gerador de erro de veículo/caminho 114 que recebe um caminho de destino 126 selecionado pelo usuário e estados atuais 128 do veículo. O caminho de destino 126 pode ser criado eletronicamente e armazenado na memória. Como explicado acima, os caminhos de destino 126 podem incluir linhas de caminho para um campo selecionado pelo operador do veículo. Por exemplo, o sistema de controle 110 pode rastrear as posições do sistema de posicionamento global (GPS) do veículo que se deslocam ao longo de uma linha no campo e então armazenar as posições GPS como caminho de destino 126.
[0029] Os estados atuais do veículo 128 podem incluir posições x e y, velocidade V, rumo ^ e curvatura K. O gerador de erro 114 pode gerar estados de erro 130, tais como erro entre pistas ect e erro de rumo e^ do veículo em relação ao caminho de destino 126.
[0030] A FIG. 2 mostra um exemplo dos parâmetros utilizados pelo gerador de erro de veículo/caminho 114 na FIG. 1. Com referência às Figs. 1 e 2, o gerador de erro 114 calcula os estados de erro 130, tal como um erro entre pistas ect e um erro de rumo e^. Estados de erro 130 são baseados na comparação dos estados do veículo 128 (x, y, ^, V, K) com um rumo (xp, yp, typ) para um ponto mais próximo 140 no caminho de destino 126.
[0031] Um módulo de controle 116 utiliza estados de erro 130 para calcular uma curvatura de veículo demandada 132 para introduzir no modelo de veículo 118. O módulo de controle 116 contém um modelo do controlador de direção localizado no veículo 100. O modelo do controlador de direção é expresso geralmente como:
Figure img0001
K1, K2 e K3 são ganhos do controlador que atuam no erro de rumo e^, erro entre pistas ect e estados integrais de erro entre pistas, respectivamente. O resultado kd a partir da equação 1 é a curvatura veículo demandada 132. A curvatura do veículo 132 é limitada pelos limites de curvatura e de taxa de curvatura do veículo antes da sua aplicação ao modelo do veículo 118. Os limites de curvatura e taxa de curvatura são aplicados à demanda de curvatura 132, que é o resultado da equação 1.
[0032] Um modelo de veículo 118 é uma representação idealizada do veículo 100. O modelo de veículo 118 pode ser expresso da seguinte forma:
Figure img0002
No modelo de veículo 118, os termos x e y representam novamente as coordenadas posicionais do veículo 100, ) representa o rumo do veículo 100, e V representa a velocidade do veículo 100.
[0033] A curvatura do veículo demandada Kd gerada pelo módulo de controle 116 tenta guiar o modelo do veículo 118 para o caminho de destino 126. O modelo do veículo 118 gera estados do veículo atualizados 128 com base na curvatura do veículo limitada pela curvatura e taxa de curvatura 132. Em outras palavras, o modelo de veículo 118 prevê uma alteração na posição e rumo do veículo 100 com base na posição prevista atual e no rumo do veículo 100 em relação ao caminho de destino 126.
[0034] Por exemplo, o veículo 100 pode ter limites de curvatura que restringem o quanto o veículo 100 pode virar para a esquerda ou para a direita e uma taxa de curvatura que limita a velocidade com que o veículo 100 pode virar para a esquerda ou para a direita. O operador do veículo pode executar uma série de voltas para calcular os limites de curvatura de giro do veículo que seriam aplicados à curvatura do veículo 132. O modelo de veículo 118 tomaria a curvatura de veículo limitada 132 ao prever estados de veículo simulados 128 para o veículo 100.
[0035] Os estados de veículo atualizados 128 são realimentados no gerador de erro de caminho/veículo 114. O gerador de erro 114 gera estados de erro 130 para a próxima posição de veículo prevista. O sistema de aquisição de linha 112 recursivamente executa o processo de retorno acima descrito até que as condições de saída sejam satisfeitas, seja por atender a um limiar de convergência de aquisição ou por exceder um limite de iteração. A convergência de aquisição pode ocorrer quando estados de erro 130 entre estados de veículo simulados 128 e o caminho de destino 126 estão dentro de valores limiares predefinidos, tal como um erro entre pistas menor ou igual a 2 centímetros e um erro de rumo inferior ou igual a 5 graus. Alternativamente, se o limite de iteração for excedido, uma solução dirigível não foi encontrada.
[0036] Durante o processo iterativo do caminho de aquisição, o sistema de aquisição de linha 112 rastreia e armazena estados simulados do veículo 128 no armazenamento 120. Uma vez que o sistema de aquisição de linha 112 converge em uma solução válida, os estados do veículo simulados armazenados 128 são alimentados em um planejador de caminho do veículo 122 como caminho de aquisição 134. O planejador do caminho de veículo 122 pode incluir uma interface de usuário 125 que exibe o caminho de aquisição 134 e o caminho de destino 126. Por exemplo, o planejador de caminho do veículo 122 pode exibir uma série de pontos que mostram o caminho de aquisição previsto a partir de um local atual do veículo 100 para o caminho de destino 126.
[0037] A FIG. 3 mostra um exemplo de caminho de aquisição 134 gerado pelo sistema de aquisição de linha 112. Em um tempo atual 150, o sistema de aquisição de linha 112 determina os estados atuais e erros de posição do veículo 100 em relação ao caminho de destino 126. Por exemplo, o sistema de aquisição de linha 112 pode determinar a posição atual e o rumo do veículo 100 a partir de um receptor GPS e sensores inerciais operando no veículo 100.
[0038] O sistema de aquisição de linhas 112, em seguida, gera o caminho de aquisição 134 calculando uma curvatura de direção demandada para o veículo 100 para reduzir um erro entre pistas e erro de rumo. O sistema de aquisição de linha 112 alimenta a curvatura de direção demandada no modelo do veículo para prever uma próxima posição 154 do veículo 100 em direção ao caminho de destino 126. Como mencionado acima, o sistema de aquisição de linha 112 completa o caminho de aquisição 134 quando o erro entre pistas e erro de rumo para uma posição prevista atual 154 está dentro de algum intervalo do caminho de destino 126.
[0039] A FIG. 4 mostra o sistema de controle de direção 110 automaticamente guiando o veículo 100 ao longo do caminho de aquisição 134. Com referência às Figs. 1 e 4, o caminho de aquisição previsto 134 é enviado para o planejador de caminho de veículo 122. O planejador de caminho de veículo 122 exibe o caminho de aquisição 134 na interface de usuário 125. O operador do veículo pode engatar o controlador de direção 124 quando o caminho de aquisição 134 converge com o caminho de destino 126 em um ponto de aquisição aceitável 160 e não intercepta quaisquer obstruções.
[0040] Em resposta ao usuário selecionar o caminho de aquisição 134, o planejador de caminho do veículo 122 pode combinar o caminho de aquisição 134 com o caminho de destino 126. O planejador de caminho do veículo 122 envia então os caminhos combinados 134 e 126 ao controlador de direção 124. O controlador de direção 124 utiliza então informação de navegação, tal como informação de GPS e de sensor inercial, para guiar o veículo 100 ao longo do caminho de aquisição 134 e para o caminho de destino 126.
[0041] Sistemas de controle que guiam automaticamente veículos agrícolas utilizando a tecnologia GPS/INS sobre os caminhos de destino são descritos na Patente dos EUA 7.142.956, emitida em Novembro 128 12006, intitulada: AUTOMATIC STEERING SYSTEM AND METHOD; Patente dos EUA 7.689.354, emitida em março 130 12010, intitulada ADAPTIVE GUIDANCE SYSTEM AND METHOD; Patente dos EUA 7.835.832, Novembro 116 12010, intitulada: VEHICLE CONTROL SYSTEM; a Patente dos EUA 7.437.230, emitida em Outubro 114 12008, intitulada: SATELLITE BASED VEHICLE GUIDANCE CONTROL IN STRAIGHT AND CONTOUR MODES, que são todos aqui incorporados por referência na sua totalidade.
[0042] A FIG. 5A mostra como o sistema de aquisição de linha atualiza automaticamente o caminho de aquisição. Um operador de veículo pode dirigir manualmente o veículo 100 para diferentes posições 162A-162C em relação ao caminho de destino 126. O sistema de aquisição de linha 112 pode atualizar automaticamente os caminhos de aquisição 134A-134C com base nas posições atuais 162A-162C, respectivamente, do veículo 100. Por exemplo, sistema de aquisição de linha 112 calcula um primeiro caminho de aquisição 134A do veículo 100 em uma primeira posição e rumo 162A. À medida que o veículo 100 se move da posição 162A para a posição e rumo 162B, o sistema de aquisição de linha 112 calcula um novo caminho de aquisição 134B. O sistema de aquisição de linha 112 recalcula continuamente e exibe os caminhos de aquisição 134 para as novas posições 162 do veículo 100.
[0043] Os caminhos de aquisição 134A-134C fornecem ao operador do veículo uma indicação visual de quaisquer impedimentos que possam impedir a ativação do controlador de direção automática. Por exemplo, uma pedra 164 pode estar no caminho de aquisição 134A. O operador do veículo pode atrasar a ativação do controlador de direção 124 (FIG. 1) até que o veículo 100 se mova para uma posição diferente 162B ou 162C, onde a pedra 164 não se encontre no caminho de aquisição associado 134B ou 134C, respectivamente.
[0044] A FIG. 5B mostra um processo exemplar para gerar um caminho de aquisição. Na operação 200A, o sistema de aquisição de linha inicia a geração do caminho de aquisição a partir de uma posição atual do veículo. Por exemplo, o usuário pode direcionar manualmente o veículo para diferentes posições em relação a um caminho de destino.
[0045] Na operação 200B, o sistema de aquisição de linha calcula um erro entre pistas e erro de rumo entre a posição atual do veículo e o caminho de destino. Na operação 200C, o sistema de aquisição de linha calcula uma curvatura do veículo para reduzir os erros calculados entre pista e de rumo. Por exemplo, o sistema de aquisição de linha pode calcular uma curvatura demandada do veículo que gira o veículo o mais difícil possível para a direita ou para a esquerda para adquirir o caminho de destino o mais rápido possível.
[0046] Na operação 200D, o sistema de aquisição de linha alimenta a curvatura do veículo demandada no modelo do veículo para gerar os próximos estados do veículo simulados. Por exemplo, o modelo do veículo simula a próxima posição e rumo do veículo com base na curvatura demandada do veículo e nas limitações de curvatura do veículo. Na operação 200E, o sistema de aquisição de linha armazena os estados do veículo simulado na memória.
[0047] Na operação 200F, o sistema de aquisição de linha calcula um próximo erro entre pistas e erro de rumo para os próximos estados do veículo simulado. Na operação 200G, o sistema de aquisição de linha determina se os estados do veículo simulados convergem com o caminho de destino. Por exemplo, o sistema de aquisição de linha determina se o erro entre pistas e o erro de rumo estão dentro de valores limites predefinidos. Se não, o sistema de aquisição de linha salta de volta para a operação 200C e calcula uma próxima curvatura do veículo demandada para gerar os próximos estados do veículo simulados em direção ao caminho de destino.
[0048] Se os estados simulados do veículo convergem com o caminho de destino na operação 200G, o sistema de aquisição de linha na operação 200H exibe o conjunto de estados do veículo simulados como o caminho de aquisição. Na operação 200I, o veículo pode se mover para um novo local. Por exemplo, o usuário pode continuar a dirigir manualmente o veículo. O sistema de aquisição de linha pula para a operação 200A e calcula um novo caminho de aquisição para a nova posição do veículo. Exemplos de Aquisição de Linha
[0049] As FIGS. 6-11 ilustram exemplos adicionais de como o sistema de aquisição de linha gera diferentes caminhos de aquisição. Nestes exemplos, o veículo 100 está em várias posições em relação ao caminho de destino 126. Os caminhos de aquisição associados 134 são apresentados na interface de usuário 125, mostrando ao usuário o caminho que o veículo 100 dirigiria a partir de uma posição atual para atingir o caminho de destino 126. A direção e formatos dos caminhos de aquisição 134 podem mudar com base no formato do caminho de destino, posição do veículo em relação ao caminho de destino, velocidade do veículo e limites de direção do veículo, tal como a curvatura máxima e a taxa de curvatura máxima.
[0050] As FIGS. 6A-6D mostram diferentes caminhos de aquisições 134A-134D, respectivamente, que adquirem um caminho de destino de linha reta 126. A FIG. 6A mostra um exemplo de uma abordagem direta em que o veículo 100 tem uma curvatura do veículo inicial zero. A FIG. 6B mostra um exemplo de uma abordagem direta em que o veículo 100 tem uma curvatura do veículo inicial diferente de zero. A FIG. 6C mostra uma abordagem indireta exemplificativa para o caminho de destino 126, em que o veículo 100 tem uma curvatura do veículo inicial diferente de zero. A FIG. 6D mostra um exemplo de abordagem indireta do veículo 100 inicialmente afastado do caminho de destino 126 com uma curvatura do veículo inicial diferente de zero.
[0051] Nos exemplos nas FIGS. 6A-6D, as condições iniciais do veículo 100 variam na posição, rumo e curvatura em relação ao caminho de destino 126. Em cada exemplo, o sistema de aquisição de linha 112 gera caminhos de aquisição dirigíveis 134 que suavemente adquirem o caminho de destino 126 na direção atual de viagem do veículo 100. Como mencionado acima, o módulo de controle 116 na FIG. 1 incrementalmente deriva novas curvaturas de veículo 132 para reduzir um erro atual entre pistas e de rumo e move o veículo 100 para mais perto do caminho de destino 126.
[0052] As FIGS. 7A e 7B mostram exemplos onde os caminhos de aquisições 134A e 134B, respectivamente, giram em direções opostas para o caminho de destino 126. Os caminhos de aquisição 134A e 134B são análogos ao veículo 100 que tenta uma virada de um promontório ou de fim de linha quando faz a transição de um caminho de destino 126 para outro caminho de destino 126. O sistema de aquisição de linha 112 pode gerar caminhos de aquisição 134 em qualquer direção e não é restringido por limitações do controlador de direção 124 na FIG. 1. As FIGS. 8A e 8B mostram, por exemplo, caminhos de aquisição exemplares 134A e 134B, respectivamente, gerados em caminhos de destino circulares 126. As FIGS. 9A-9D mostram caminhos de aquisição exemplares 134A-134D, respectivamente, gerados em caminhos de destino contornados 126 com variações de curvatura. Nestes exemplos, o sistema de aquisição de linha 112 gera transições de caminho de aquisição suaves em caminhos de destino circulares e contornados 126.
[0053] O sistema de aquisição de linhas 112 pode identificar um ponto no caminho de destino 126 mais próximo da posição prevista atual do veículo 100. A posição identificada no caminho de destino 126 pode ter uma curvatura diferente do que a posição mais próxima anterior no caminho de destino 126. O sistema de aquisição de linhas 112 calcula um erro entre pistas e erro de direção entre a posição prevista do veículo 100 e o novo ponto identificado no caminho de destino 126. O sistema de aquisição de linha 112 utiliza o erro entre pistas calculado, erro de rumo, curvatura do veículo e taxa de curvatura do veículo para prever uma posição seguinte e rumo para o veículo 100. Assim, à medida que as posições previstas do veículo 100 se aproximam do caminho de destino 126, o sistema de aquisição de linha 112 continua a gerar estados do veículo simulados que se alinham com o caminho de destino 126.
[0054] Por exemplo, na FIG. 7A, o sistema de aquisição de linha 112 pode gerar um giro para a direita para o caminho de aquisição 134A, uma vez que o giro para a direita pode proporcionar o caminho mais curto para o caminho de destino 126. Na FIG. 7B, o sistema de aquisição de linha 112 pode gerar um giro para a esquerda para o caminho de aquisição 134B uma vez que o veículo 100 já se encontra numa curvatura para a direita e o caminho de aquisição para a esquerda 134B pode proporcionar o caminho mais curto para o caminho de destino 126.
[0055] Com base na posição e orientação do veículo 100 na FIG. 8A, o sistema de aquisição de linha 112 pode determinar que um giro para a esquerda cria um caminho de aquisição mais curto 134A para o caminho de destino 126. Com base na posição e na curvatura para a direita do veículo 100 nas FIGS. 8B, o sistema de aquisição de linha 112 pode determinar que um giro para a direita cria um caminho de aquisição mais curto 134B para o caminho de destino 126.
[0056] As FIGS. 9A e 9B mostram como o sistema de aquisição de linha 112 pode gerar caminhos de aquisição 134A e 134B, respectivamente, com múltiplas voltas. Por exemplo, o veículo 100 na FIG. 9A pode estar localizado mesmo à frente ou no caminho de destino 126. O sistema de aquisição de linha 112 pode gerar um primeiro giro para reaproximar o caminho de destino 126 e depois gerar um segundo giro para a esquerda no caminho de aquisição 134A para convergir e alinhar com o caminho de destino 126. O sistema de aquisição de linha 112 na FIG. 9B pode gerar um primeiro giro para a esquerda no caminho de aquisição 134B para se aproximar inicialmente do caminho de destino 126 e depois determinar que é necessário um segundo giro para a direita para convergir e alinhar com o caminho de destino 126.
[0057] Similarmente, as FIGS. 9C e 9D mostram como o sistema de aquisição de linha 112 pode gerar um giro inicial para a direita ou para a esquerda nos caminhos de aquisição 134C e 134D, respectivamente, para reduzir o erro entre pistas e mover o veículo 100 para mais perto do caminho de destino 126. O sistema de aquisição de linha 112 gera então giros para a esquerda ou para a direita opostos nos caminhos de aquisição 134C e 134D, respectivamente, para reduzir o erro entre pistas e direcional e alinhar o veículo 100 nos caminhos de destino contornados 126.
[0058] As FIGS. 10A e 10B mostram como o sistema de aquisição de linha 112 gera caminhos de aquisição durante as condições de não-engatamento do controlador de direção. As posições iniciais do veículo 100 em relação ao caminho de destino 126 na FIG. 10A (caminho de destino direto) e FIG. 10B (caminho de destino circular) podem impedir que o controlador de direção 124 na FIG. 1 engate e dirija automaticamente o veículo 100.
[0059] Por exemplo, um usuário pode tentar ativar o controlador de direção 124 para iniciar automaticamente a direção do veículo 100 no caminho de destino 126. O controlador de direção 124 pode não ser ativado quando o veículo 100 está muito próximo do caminho de destino 126 como mostrado na FIG. 10A ou quando o veículo 100 se aproxima do caminho de destino 126 num ângulo muito largo como mostrado na FIG. 10B. Por exemplo, alguns controladores de direção podem não engatar se o erro de rumo entre o veículo 100 e o caminho de destino 126 for maior que 80 graus.
[0060] O sistema de aquisição de linha 112 proporciona caminhos de aquisição 134A e 134B nas FIGS. 10A e 10B, respectivamente, para expandir as condições de engate do controlador de direção. Com os caminhos de aquisição 134A e 134B, o controlador de direção 124 não está mais limitado ao engate com base na posição atual do veículo em relação ao caminho de destino 126. Como o veículo 100 já está localizado e alinhado com os caminhos de aquisição simulados 134A e 134B, quaisquer erros entre pistas ou de rumo entre o veículo 100 e o caminho de aquisição 134 devem estar já dentro dos limites de engate permitidos para o controlador de direção 124.
[0061] O sistema de aquisição de linha 112 também permite que um usuário controle onde o veículo 100 intercepta o caminho de destino 126. Com referência novamente à FIG. 7A, o usuário pode orientar manualmente o veículo 100 mais para a direita para fazer com que o sistema de aquisição de linha 112 crie um caminho de aquisição 134A que vira para a direita e adquire o caminho de destino 126 para a direita do veículo 100. Com referência novamente à FIG. 7B, o usuário pode dirigir o veículo 100 mais para a esquerda para fazer com que o sistema de aquisição de linha 112 crie o caminho de aquisição 134B que vira para a esquerda e adquire o caminho de destino 126 para a esquerda do veículo 100.
[0062] As FIGS. 11A e 11B mostram como o sistema de aquisição de linha 112 é usado em conjunto com a direção automática para evitar certas áreas. A FIG. 11A mostra um caminho de aquisição 134A que cruza uma área de faixa existente 70A e a FIG. 11B mostra um caminho de aquisição 134B que elimina uma área de faixa existente 70B. Neste exemplo, as áreas 70A e 70B podem ter sido trabalhadas anteriormente por aragem, ou aplicando sementes, fertilizantes, herbicidas, ou similares, ou qualquer combinação destes. O operador do veículo pode não querer evitar cruzar ou retrabalhar as áreas 70A e 70B.
[0063] Na FIG. 11A, o operador do veículo pode optar por não engatar o controlador de direção automático 124 e executar uma ação diferente. Por exemplo, o operador do veículo pode conduzir manualmente o veículo 100 ao redor da área 70A ou conduzir o veículo 100 sobre a área 70A mas não ativar um implemento 90 que possa aplicar fertilizante ou sementes de plantas.
[0064] Na FIG. 11B, o operador do veículo é livre para engatar no controlador de direção 124 e dirigir automaticamente o veículo 100 ao longo do caminho de aquisição 134B e para o caminho de destino 126 sem correr o risco de atravessar a área previamente trabalhada 70B. Como mencionado acima na FIG. 5A, exibir o caminho de aquisição 134 na interface de usuário 125 também permite que o operador do veículo identifique caminhos de aquisição 134 que interceptam obstáculos, tais como pedregulhos, árvores, valas, etc. O usuário pode dirigir manualmente o veículo 100 para um local diferente com um caminho de aquisição diferente 134 para evitar o obstáculo antes de engatar o controlador de direção automática 124.
[0065] O sistema de aquisição de linha 112 elimina eficazmente a fase de aquisição de linha, onde o controlador de direção 124 adquire o caminho de destino (linha de caminho). O controlador de direção 124 pode não mais necessitar calcular os grandes erros entre pista e de rumo durante a fase de aquisição de linha e agora pode operar em um único modo de rastreamento onde o veículo 100 já segue o caminho de aquisição 134 e o caminho de destino 126 adquiridos.
Sistemas de Computador, Software e Hardware
[0066] Um sistema global de navegação por satélite (GNSS) pode incluir GPS (EUA) Galileo (União Europeia, proposto) GLONASS (Rússia), Beidou (China) Compass (China, proposto) IRNSS (Índia, proposto), QZSS (Japão, proposto) e outras tecnologias de posicionamento atuais e futuras usando sinal de satélites, com ou com aumento de fontes terrestres.
[0067] Sistemas de navegação inercial (INS) podem incluir sensores giroscópicos (giroscópios), acelerômetros e tecnologias similares para fornecer saídas correspondentes ao inercial de componentes móveis em todos os eixos, isto é, através de seis graus de liberdade (direções positivas e negativas ao longo dos eixos X transversal, Y longitudinal e Z vertical). Guinada, passo e rolamento (Yaw, pitch and roll) referem-se à rotação de componentes em movimento em torno dos eixos Z, X e Y, respectivamente. A terminologia pode incluir as palavras especificamente mencionadas, seus derivados e palavras de significado similar.
[0068] A FIG. 12 geralmente mostra o sistema de controle 110 usado em conjunto com um mecanismo de assistência de direção de acionamento direto elétrico 3. Sem limitação na generalidade das aplicações úteis do sistema de controle 110 pode incluir um receptor GNSS 4 e um processador de orientação 6 conectado a uma antena GNSS 12 e instalado no veículo 100, tal como um veículo agrícola ou trator. Um sistema de direção automática 8 é eletricamente conectado ao processador de orientação 6, e é mecanicamente conectado com o veículo 100 através do mecanismo de assistência de direção 3.
[0069] A Figura 13 mostra detalhes adicionais do sistema de controle 110. O receptor GNSS 4 é ainda constituído por um conversor RF (isto é, conversor de baixa frequência) 16, um dispositivo de rastreio 18 e um elemento receptor de RTK rover 20. O receptor 4 comunica-se eletricamente com e fornece dados de posicionamento de GNSS para o processador de orientação 6. O processador de orientação 6 inclui uma interface gráfica de usuário (GUI) 26, um microprocessador 24 e um elemento de mídia 22, tal como uma unidade de armazenamento de memória. O processador de orientação 6 comunica-se eletricamente com e fornece dados de controle ao sistema de direção automática 8. O sistema de direção automática 8 inclui um comutador de detecção de movimento de volante 28 e um codificador 30 para interpretar comandos de orientação e direção da CPU 6.
[0070] O sistema de direção automática 8 pode conectar-se mecanicamente com a coluna de direção do veículo 34, que é mecanicamente conectada ao volante 32. Uma linha de controle 42 pode transmitir dados de orientação a partir da CPU 6 para o sistema de direção automática 8. Um subsistema elétrico 44, que alimenta as necessidades elétricas do veículo 100, pode interagir diretamente com o sistema de direção automática 8 através de um cabo de força 46. O subsistema de direção automática 8 pode ser montado na coluna de direção 34 perto do chão do veículo, e na proximidade dos pedais do controle do veículo 36. Alternativamente, o sistema de direção automática 8 pode ser montado em outros locais ao longo da coluna de direção 34.
[0071] O sistema de direção automática 8 fisicamente dirige e orienta o veículo 100 ao ativamente girar o volante 32 através da coluna de direção 34. Um motor 45 energizado pelo subsistema elétrico do veículo 44 pode energizar uma unidade helicoidal que energiza uma engrenagem helicoidal 48 afixada ao sistema de direção automática 8. Esses componentes são preferencialmente colocados em um invólucro. Em outras concretizações, o sistema de direção automática 8 é integrado diretamente ao sistema de controle de acionamento do veículo, independentemente da coluna de direção 34.
[0072] Algumas das operações descritas acima podem ser implementadas em software e outras operações podem ser implementadas em hardware. Uma ou mais das operações, processos ou métodos aqui descritos podem ser realizados por um aparelho, dispositivo ou sistema semelhante aos aqui descritos e com referência às figuras ilustradas. Os dispositivos de computação descritos acima podem incluir qualquer coleção de dispositivos ou circuitos que individualmente ou em conjunto executem um conjunto (ou múltiplos conjuntos) de instruções para executar qualquer uma ou mais das operações discutidas acima. Dispositivos de computação podem fazer parte de um sistema de controle integrado ou gerenciador de sistemas, ou podem ser fornecidos como um dispositivo eletrônico portátil configurado para interagir com um sistema em rede local ou remotamente via transmissão sem fio.
[0073] “Meio de armazenamento legível por computador” (ou, alternativamente, “meio de armazenamento legível por máquina”) usado no sistema de controle 110 pode incluir qualquer tipo de memória, bem como novas tecnologias que possam surgir no futuro, desde que possam ser capazes de armazenar informação digital sob a natureza de um programa de computador ou outros dados, pelo menos temporariamente, de tal maneira que a informação armazenada possa ser “lida” por um dispositivo de processamento apropriado. O termo "legível por computador" pode não se limitar ao uso histórico de "computador" para indicar um mainframe completo, um minicomputador, um desktop, um dispositivo sem fio ou até mesmo um laptop. Em vez disso, “legível por computador” pode compreender um meio de armazenamento que pode ser lido por um processador, dispositivo de processamento ou qualquer sistema de computação. Essa mídia pode ser qualquer mídia disponível que possa ser localmente e/ou remotamente acessível por um computador ou processador, e pode incluir mídia volátil e não volátil, e mídia removível e não removível.
[0074] Exemplos de sistemas, aparelhos, meios de armazenamento legíveis por computador, e métodos são fornecidos apenas para adicionar contexto e auxiliar na compreensão das implementações divulgadas. Será assim evidente para um versado na técnica que as implementações divulgadas podem ser praticadas sem alguns ou todos os detalhes específicos proporcionados. Em outros casos, certos processos ou métodos também aqui referidos como "blocos", não foram descritos em detalhes, a fim de evitar obscurecer desnecessariamente as implementações divulgadas. Outras implementações e aplicações também são possíveis e, como tal, os exemplos a seguir não devem ser tomados como definitivos ou limitantes no escopo ou configuração.
[0075] Foram feitas referências aos desenhos acompanhantes, os quais formam uma parte da descrição e nos quais são mostradas, a título de ilustração, as implementações específicas. Embora estas implementações divulgadas sejam descritas em detalhes suficiente para permitir que um versado na técnica pratique as implementações, deve ser entendido que estes exemplos não são limitantes, de modo que outras implementações podem ser utilizadas e que podem ser feitas alterações nas implementações divulgadas sem se afastar de seu espírito e escopo. Por exemplo, os blocos dos métodos mostrados e descritos não são necessariamente executados na ordem indicada em algumas outras implementações. Adicionalmente, em outras implementações, os métodos divulgados podem incluir mais ou menos blocos do que os descritos. Como outro exemplo, alguns blocos aqui descritos como blocos separados podem ser combinados em algumas outras implementações. Por outro lado, o que pode ser descrito aqui como um único bloco pode ser implementado em vários blocos em algumas outras implementações. Além disso, a conjunção “ou” é aqui pretendida no sentido inclusivo, quando apropriado, salvo indicação em contrário; isto é, a frase “A, B ou C” pretende incluir as possibilidades de “A”, “B”, “C”, “A e B”, “B e C”, “A e C” e “A, B e C”.
[0076] Tendo descrito e ilustrado os princípios de uma concretização preferida, deve ser evidente que as concretizações podem ser modificadas em arranjo e detalhes sem se afastar de tais princípios. É feita reivindicação para todas as modificações e variações que vêm dentro do espírito e escopo das reivindicações a seguir.

Claims (15)

1. Sistema de aquisição de linha (112) para guiar automaticamente um veículo (100), compreendendo: um processador configurado para: identificar um caminho de destino (126); caracterizado pelo fato de que o processador é ainda configurado para: calcular um caminho de aquisição (134) simulado de uma posição atual (150) do veículo (100) para o caminho de destino (126); armazenar o caminho de aquisição (134) simulado na memória (120); exibir o caminho de aquisição (134) simulado em uma interface do usuário (125); calcular continuamente novos caminhos de aquisição simulados (134) para novas posições atuais (150) do veículo (100) em relação ao caminho de destino (126); exibir os novos caminhos de aquisição simulados (134) na interface de usuário (125); e com base em uma seleção de um caminho de aquisição (134) exibido, enviar o caminho de aquisição (134) selecionado para um controlador de direção automático (124).
2. Sistema de aquisição de linha (112) de acordo com a reivindicação 1, caracterizado pelo fato de que o processador é ainda configurado para: calcular incrementalmente novos estados simulados do veículo (100) em direção ao caminho de destino (126) com base nos estados de erro (130) entre estados simulados anteriores do veículo (100) e o caminho de destino (126); e armazenar os novos estados simulados e estados simulados anteriores do veículo como o caminho de aquisição simulado (134).
3. Sistema de aquisição de linha (112) de acordo com a reivindicação 1 ou reivindicação 2, caracterizado pelo fato de que o processador é ainda configurado para: identificar uma curvatura e taxa de curvatura para o veículo (100); e calcular os caminhos de aquisição simulados (134) com base na curvatura e taxa de curvatura; e/ou o processador é ainda configurado para: enviar comandos de direção para o controlador de direção automático (124) para guiar o veículo (100) ao longo dos caminhos de aquisição (134) até alcançar o caminho de destino (126) e, em seguida, enviar comandos de direção para o controlador de direção automático (124) para guiar o veículo (100) ao longo do caminho de destino (126).
4. Sistema de aquisição de linha (112) de acordo com qualquer uma das reivindicações 1 a 3, caracterizado pelo fato de que o processador é ainda configurado para: exibir uma área na interface do usuário (125); exibir uma seção da área previamente trabalhada pelo veículo (100); e exibir o caminho de destino (126) e os caminhos de aquisição simulados (134) com a área e a seção da área previamente trabalhada pelo veículo (100).
5. Sistema de aquisição de linha (112) de acordo com qualquer uma das reivindicações 1 a 4, caracterizado pelo fato de que o processador é ainda configurado para: calcular um erro de guia entre um rumo atual do veículo (100) e um rumo do caminho de destino (126); calcular um erro entre pistas entre a localização atual do veículo (100) e o caminho de destino (126); prever posições incrementais do veículo (100) com base no erro de rumo, erro entre pistas, uma curvatura do veículo (100) e uma taxa de curvatura do veículo (100); e usar as posições incrementais do veículo (100) como o caminho de aquisição simulado (134).
6. Sistema de aquisição de linha (112) de acordo com qualquer uma das reivindicações 1 a 5, caracterizado pelo fato de que o processador é adicionalmente configurado para calcular o caminho de aquisição (134) simulado baseado em um modelo de veículo (118) expresso como:
Figure img0003
onde: x e y são coordenadas posicionais do veículo (100); Φ é um rumo do veículo (100); V é uma velocidade do veículo (100); Kd é uma demanda de curvatura para o veículo (100), onde
Figure img0004
K1 é um ganho do controlador que atua em um erro de rumo e^; K2 é um ganho de controlador que atua em um erro entre pistas ect; e K3 é um ganho do controlador que atua em um erro entre pistas integral
Figure img0005
.
7. Método implementado por computador para controlar um veículo (100), o método compreendendo um conjunto de instruções operáveis para: identificar um caminho de destino (126); caracterizado pelo fato de que o conjunto de instruções é ainda operável para: prever caminhos de aquisição (134) diferentes de locais diferentes do veículo (100) para o caminho de destino (126); exibir os diferentes caminhos de aquisição (134) para os diferentes locais do veículo (100) em uma interface de usuário (125); detectar um pedido para automaticamente direcionar o veículo (100); e usar um dos caminhos de aquisição (134) para uma localização atual do veículo (100) para direcionar automaticamente o veículo (100) para o caminho de destino (126).
8. Método implementado por computador de acordo com a reivindicação 7, caracterizado pelo fato de que as instruções são ainda operáveis para: prever posições incrementais do veículo (100) a partir dos diferentes locais do veículo (100) até o caminho de destino (126); e usar as posições incrementais do veículo (100) como os caminhos de aquisição (134).
9. Método implementado por computador de acordo com a reivindicação 8, caracterizado pelo fato de que as instruções são ainda operáveis para: identificar uma curvatura e taxa de curvatura para o veículo (100); identificar uma distância e rumo do veículo (100) em relação ao caminho de destino (126); e prever as posições incrementais do veículo (100) com base na curvatura, taxa de curvatura, distância e rumo do veículo (100); e/ou em que as instruções são ainda operáveis para: calcular um erro de rumo entre um rumo do veículo (100) e um rumo do caminho de destino (126) para uma posição atual das posições incrementais previstas do veículo (100); calcular um erro entre pistas entre uma localização atual (150) do veículo (100) e o caminho de destino (126) para uma posição atual das posições incrementais previstas do veículo (100); prever uma próxima posição das posições incrementais do veículo (100) com base no erro de rumo e no erro entre pistas.
10. Método implementado por computador de acordo com qualquer uma das reivindicações 7 a 9, caracterizado pelo fato de que as instruções são ainda operáveis para: receber seleção de um dos caminhos de aquisição (134) exibidos na interface do usuário (125); e gerar comandos de rumo para guiar automaticamente o veículo (100) ao longo do caminho de aquisição (134) selecionado até alcançar o caminho de destino (126) e, em seguida, direcionar automaticamente o veículo (100) ao longo do caminho de destino (126).
11. Método implementado por computador de acordo com qualquer uma das reivindicações 7 a 10, caracterizado pelo fato de que as instruções são ainda operáveis para: exibir uma área na interface do usuário (125); exibir uma seção da área previamente trabalhada pelo veículo (100); e exibir o caminho de destino (126) e o caminho de aquisição (134) com a área e a seção da área previamente trabalhada pelo veículo (100).
12. Método implementado por computador de acordo com qualquer uma das reivindicações 7 a 11, caracterizado pelo fato de que as instruções são ainda operáveis para prever os caminhos de aquisição (134) com base em um modelo de veículo (118) expresso como:
Figure img0006
Figure img0007
onde: x e y são coordenadas posicionais do veículo (100); p é um rumo do veículo (100); V é uma velocidade do veículo (100); Kd é uma demanda de curvatura para o veículo (100), onde
Figure img0008
K1 é um ganho do controlador que atua em um erro de rumo ep; K2 é um ganho de controlador que atua em um erro entre pistas ect; e K3 é um ganho do controlador que atua em um erro entre pistas integral
Figure img0009
13. Sistema de controle de direção para identificar um caminho de aquisição (134) para um veículo (100), caracterizado pelo fato de que compreende: um gerador de erro de caminho de veículo para gerar estados de erro (130) para estados simulados de um veículo (100) a partir de um caminho de destino (126); um módulo de controle para gerar as curvaturas de veículo desejadas com base nos estados de erro (130); um modelo de veículo para gerar os estados simulados do veículo (100) com base nas curvaturas desejadas do veículo; um planejador de caminho de veículo para usar os estados de veículo simulados para gerar caminhos de aquisição (134) de localizações diferentes do veículo (100) para o caminho de destino (126); em que o planejador de caminho de veículo exibe os caminhos de aquisição (134) para as diferentes localizações do veículo (100) para permitir que um usuário visualize como um controlador de direção automático (124) conduziria o veículo (100) para o caminho de destino (126).
14. Sistema de controle de direção de acordo com a reivindicação 13, caracterizado pelo fato de que o gerador de erro de caminho de veículo calcula estados de erro entre pistas e estados de erro de rumo entre os estados simulados do veículo (100) e o caminho de destino (126); e/ou em que o modelo de veículo gera os estados simulados do veículo (100) com base nas curvaturas de veículo desejadas e uma curvatura medida e taxa de curvatura do veículo (100).
15. Sistema de controle de direção de acordo com a reivindicação 13 ou reivindicação 14, caracterizado pelo fato de que o planejador de caminho de veículo é adicionalmente para: detectar um pedido para ativar um controlador de direção automático (124); e gerar comandos de rumo que fazem com que o controlador de direção automática (124) conduza o veículo (100) ao longo de um dos caminhos de aquisição (134) para uma localização atual do veículo (100) para o caminho de destino (126).
BR112018071211-6A 2016-04-12 2017-04-10 Sistema de aquisição de linha, método implementado por computador para controlar um veículo e sistema de controle de direção BR112018071211B1 (pt)

Applications Claiming Priority (5)

Application Number Priority Date Filing Date Title
US201662321393P 2016-04-12 2016-04-12
US62/321,393 2016-04-12
PCT/US2017/026780 WO2017180504A1 (en) 2016-04-12 2017-04-10 Line acquisition path generation
US15/483,061 2017-04-10
US15/483,061 US10209714B2 (en) 2016-04-12 2017-04-10 Line acquisition path generation

Publications (2)

Publication Number Publication Date
BR112018071211A2 BR112018071211A2 (pt) 2019-02-05
BR112018071211B1 true BR112018071211B1 (pt) 2023-02-07

Family

ID=59998125

Family Applications (2)

Application Number Title Priority Date Filing Date
BR112018071211-6A BR112018071211B1 (pt) 2016-04-12 2017-04-10 Sistema de aquisição de linha, método implementado por computador para controlar um veículo e sistema de controle de direção
BR112018071212-4A BR112018071212B1 (pt) 2016-04-12 2017-04-10 Sistema de aquisição de linha, método implementado por computador para gerar um caminho de aquisição e método para gerar um perfil de curvatura

Family Applications After (1)

Application Number Title Priority Date Filing Date
BR112018071212-4A BR112018071212B1 (pt) 2016-04-12 2017-04-10 Sistema de aquisição de linha, método implementado por computador para gerar um caminho de aquisição e método para gerar um perfil de curvatura

Country Status (6)

Country Link
US (2) US10209714B2 (pt)
EP (2) EP3443428B1 (pt)
AU (2) AU2017249204B2 (pt)
BR (2) BR112018071211B1 (pt)
CA (2) CA3020922A1 (pt)
WO (2) WO2017180504A1 (pt)

Families Citing this family (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101748269B1 (ko) * 2015-11-11 2017-06-27 현대자동차주식회사 자율 주행 차량의 조향 제어 방법 및 장치
US11180189B2 (en) * 2015-11-19 2021-11-23 Agjunction Llc Automated reverse implement parking
US10239555B2 (en) * 2015-11-19 2019-03-26 Agjunction Llc Single-mode implement steering
JP6837196B2 (ja) * 2017-02-15 2021-03-03 日立Astemo株式会社 車両運動制御装置、車両運動制御方法および車両運動制御システム
US10663966B2 (en) * 2017-03-29 2020-05-26 Mitsubishi Electric Research Laboratories, Inc. Vehicle motion control system and method
US10591915B2 (en) * 2017-08-03 2020-03-17 Mitsubishi Electric Research Laboratories, Inc. Motion controller for real-time continuous curvature path planning
GB2568548B (en) * 2017-11-21 2020-07-29 Jaguar Land Rover Ltd Apparatus and method for controling a process
CN109154821B (zh) * 2017-11-30 2022-07-15 深圳市大疆创新科技有限公司 轨迹生成方法、装置和无人驾驶地面车辆
DK201870263A1 (en) * 2018-05-02 2019-12-03 Intelligent Marking Aps Method for marking a ground surface using a robot unit and a local base station, the system therefore and use thereof
US11229154B2 (en) 2018-09-04 2022-01-25 Deere & Company Automatic path correction for guided vehicles
CN111328385B (zh) * 2018-09-28 2023-08-15 百度时代网络技术(北京)有限公司 用于自动驾驶车辆的基于螺旋路径的三点转弯规划
DE102019202299B4 (de) * 2019-02-20 2020-12-31 Zf Friedrichshafen Ag Verfahren zur Online-Kalibrierung und Kalibriereinrichtung
US11212954B2 (en) * 2019-05-08 2022-01-04 Deere & Company Apparatus and methods for field operations based on historical field operation data
CN110262509B (zh) 2019-07-10 2022-06-28 百度在线网络技术(北京)有限公司 车辆自动驾驶方法和装置
CN110703754B (zh) * 2019-10-17 2021-07-09 南京航空航天大学 一种自动驾驶车辆路径与速度高度耦合的轨迹规划方法
JP7262374B2 (ja) * 2019-11-20 2023-04-21 ヤンマーパワーテクノロジー株式会社 作業車両用の自動走行システム
CN113050614B (zh) * 2019-12-26 2022-07-26 炬星科技(深圳)有限公司 机器人自主管理执行能力的方法、设备及存储介质
US20220046383A1 (en) * 2020-08-04 2022-02-10 Qualcomm Incorporated Validating and using map data for positioning
CN112433522A (zh) * 2020-08-19 2021-03-02 深圳市银星智能科技股份有限公司 一种机器人行走控制方法及机器人
CN112068566A (zh) * 2020-09-15 2020-12-11 北京百度网讯科技有限公司 引导路径确定方法及车辆的行驶控制方法、装置、设备
US20220128993A1 (en) * 2020-10-23 2022-04-28 Deere & Company Methods, apparatus, and articles of manufacture to display acquisition paths
CN112526989B (zh) * 2020-11-20 2023-11-21 广州极飞科技股份有限公司 一种农业无人车导航方法、装置、农业无人车及存储介质
CN112857359B (zh) * 2021-01-19 2024-03-01 中冶赛迪工程技术股份有限公司 一种路径规划方法、系统、介质及电子终端
CN113252040B (zh) * 2021-05-08 2022-10-18 云南财经大学 一种改进的agv小车二维码弧线导航方法
US11925132B2 (en) * 2021-06-30 2024-03-12 Deere & Company Methods, apparatus, and articles of manufacture to generate acquisition paths
CN115077534B (zh) * 2022-08-11 2022-11-15 合肥井松智能科技股份有限公司 一种基于b样条曲线的agv路径规划方法
CN116079076B (zh) * 2023-02-28 2023-09-26 南京衍构科技有限公司 一种异形薄壁件的3d打印扫描填充路径规划方法
CN116605211B (zh) * 2023-07-19 2023-09-26 广汽埃安新能源汽车股份有限公司 一种泊车路径规划方法、装置、电子设备和存储介质

Family Cites Families (71)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5663879A (en) 1987-11-20 1997-09-02 North American Philips Corporation Method and apparatus for smooth control of a vehicle with automatic recovery for interference
US5610815A (en) 1989-12-11 1997-03-11 Caterpillar Inc. Integrated vehicle positioning and navigation system, apparatus and method
US5438517A (en) 1990-02-05 1995-08-01 Caterpillar Inc. Vehicle position determination system and method
US5646843A (en) * 1990-02-05 1997-07-08 Caterpillar Inc. Apparatus and method for surface based vehicle control system
US5194851A (en) 1991-02-21 1993-03-16 Case Corporation Steering controller
FI942218A0 (fi) 1994-05-13 1994-05-13 Modulaire Oy Automatiskt styrningssystem foer obemannat fordon
US6070673A (en) 1996-11-22 2000-06-06 Case Corporation Location based tractor control
CA2283904C (en) 1997-03-21 2007-01-09 The Board Of Trustees Of The Leland Stanford Junior University A system using leo satellites for centimeter-level navigation
US6052647A (en) 1997-06-20 2000-04-18 Stanford University Method and system for automatic control of vehicles based on carrier phase differential GPS
US6212453B1 (en) 1998-09-11 2001-04-03 Honda Giken Kogyo Kabushiki Kaisha Vehicle steering control system
AUPP679598A0 (en) 1998-10-27 1998-11-19 Agsystems Pty Ltd A vehicle navigation apparatus
US6445983B1 (en) 2000-07-07 2002-09-03 Case Corporation Sensor-fusion navigator for automated guidance of off-road vehicles
US6377889B1 (en) 2000-10-13 2002-04-23 Trimble Navigation Limited Non-linear method of guiding to arbitrary curves with adaptive feedback
US6711501B2 (en) 2000-12-08 2004-03-23 Satloc, Llc Vehicle navigation system and method for swathing applications
US6539303B2 (en) 2000-12-08 2003-03-25 Mcclure John A. GPS derived swathing guidance system
US6819780B2 (en) 2001-02-02 2004-11-16 Cnh America Llc Method and apparatus for automatically steering a vehicle in an agricultural field using a plurality of fuzzy logic membership functions
AUPR430301A0 (en) 2001-04-09 2001-05-17 Agsystems Pty Ltd Soil-cultivation implement control apparatus and method
AUPR733701A0 (en) 2001-08-29 2001-09-20 Beeline Technologies Apparatus and method for assisted navigation of a land vehicle
US7089162B2 (en) 2001-11-07 2006-08-08 Harman International Industries, Incorporated Navigation map creation system
US6865465B2 (en) 2002-05-06 2005-03-08 Csi Wireless, Inc. Method and system for implement steering for agricultural vehicles
US7885745B2 (en) 2002-12-11 2011-02-08 Hemisphere Gps Llc GNSS control system and method
US7142956B2 (en) 2004-03-19 2006-11-28 Hemisphere Gps Llc Automatic steering system and method
US7162348B2 (en) 2002-12-11 2007-01-09 Hemisphere Gps Llc Articulated equipment position control system and method
US7437230B2 (en) * 2003-03-20 2008-10-14 Hemisphere Gps Llc Satellite based vehicle guidance control in straight and contour modes
US7400956B1 (en) 2003-03-20 2008-07-15 Hemisphere Gps Inc. Satellite position and heading sensor for vehicle steering control
US7689354B2 (en) 2003-03-20 2010-03-30 Hemisphere Gps Llc Adaptive guidance system and method
JP4427953B2 (ja) * 2003-01-29 2010-03-10 株式会社豊田自動織機 駐車支援装置
US8190337B2 (en) 2003-03-20 2012-05-29 Hemisphere GPS, LLC Satellite based vehicle guidance control in straight and contour modes
US8634993B2 (en) 2003-03-20 2014-01-21 Agjunction Llc GNSS based control for dispensing material from vehicle
US8639416B2 (en) 2003-03-20 2014-01-28 Agjunction Llc GNSS guidance and machine control
US8214111B2 (en) 2005-07-19 2012-07-03 Hemisphere Gps Llc Adaptive machine control system and method
US8594879B2 (en) 2003-03-20 2013-11-26 Agjunction Llc GNSS guidance and machine control
US9002565B2 (en) 2003-03-20 2015-04-07 Agjunction Llc GNSS and optical guidance and machine control
JP4235026B2 (ja) * 2003-04-28 2009-03-04 トヨタ自動車株式会社 駐車支援装置
US6789014B1 (en) 2003-05-09 2004-09-07 Deere & Company Direct modification of DGPS information with inertial measurement data
US8583315B2 (en) 2004-03-19 2013-11-12 Agjunction Llc Multi-antenna GNSS control system and method
US20060167600A1 (en) 2005-01-27 2006-07-27 Raven Industries, Inc. Architecturally partitioned automatic steering system and method
JP2007326415A (ja) * 2006-06-06 2007-12-20 Jtekt Corp 車両用操舵装置
JP2008143430A (ja) * 2006-12-12 2008-06-26 Toyota Motor Corp 駐車支援装置
US7835832B2 (en) 2007-01-05 2010-11-16 Hemisphere Gps Llc Vehicle control system
US8311696B2 (en) 2009-07-17 2012-11-13 Hemisphere Gps Llc Optical tracking vehicle control system and method
US8768558B2 (en) 2007-01-05 2014-07-01 Agjunction Llc Optical tracking vehicle control system and method
US9002566B2 (en) 2008-02-10 2015-04-07 AgJunction, LLC Visual, GNSS and gyro autosteering control
WO2009126587A1 (en) 2008-04-08 2009-10-15 Hemisphere Gps Llc Gnss-based mobile communication system and method
US8190364B2 (en) 2008-06-30 2012-05-29 Deere & Company System and method for providing towed implement compensation
US8112201B2 (en) * 2008-10-02 2012-02-07 Trimble Navigation Limited Automatic control of passive, towed implements
US8386129B2 (en) 2009-01-17 2013-02-26 Hemipshere GPS, LLC Raster-based contour swathing for guidance and variable-rate chemical application
US8126620B2 (en) 2009-04-28 2012-02-28 Cnh America Llc Grain transfer control system and method
US8401704B2 (en) 2009-07-22 2013-03-19 Hemisphere GPS, LLC GNSS control system and method for irrigation and related applications
WO2011014482A1 (en) * 2009-07-27 2011-02-03 Magna Electronics Inc. Parking assist system
US8649930B2 (en) 2009-09-17 2014-02-11 Agjunction Llc GNSS integrated multi-sensor control system and method
US9173337B2 (en) 2009-10-19 2015-11-03 Efc Systems, Inc. GNSS optimized control system and method
US8548649B2 (en) 2009-10-19 2013-10-01 Agjunction Llc GNSS optimized aircraft control system and method
US8583326B2 (en) 2010-02-09 2013-11-12 Agjunction Llc GNSS contour guidance path selection
WO2011150353A1 (en) 2010-05-28 2011-12-01 Gvm, Inc. Remote management system for equipment
US8489291B2 (en) 2010-07-12 2013-07-16 Hemisphere Gps Llc System and method for collecting soil samples
US8803735B2 (en) 2010-11-19 2014-08-12 Agjunction Llc Portable base station network for local differential GNSS corrections
US8589013B2 (en) 2011-10-25 2013-11-19 Jaybridge Robotics, Inc. Method and system for dynamically positioning a vehicle relative to another vehicle in motion
US8781685B2 (en) 2012-07-17 2014-07-15 Agjunction Llc System and method for integrating automatic electrical steering with GNSS guidance
US10131376B2 (en) 2013-01-30 2018-11-20 Agjunction Llc Steering controller for precision farming
US9162703B2 (en) 2013-01-30 2015-10-20 AgJunction, LLC Steering controller for precision farming
US9781915B2 (en) 2013-03-14 2017-10-10 Agjunction Llc Implement and boom height control system and method
US9945957B2 (en) 2013-03-14 2018-04-17 Agjunction Llc Machine control system and method
US9223314B2 (en) 2013-03-14 2015-12-29 Aglunction, LLC Hovering control for helicopters using a GNSS vector
US20140266877A1 (en) 2013-03-15 2014-09-18 Agjunction Llc Precision accuracy global navigation satellite system (gnss) with smart devices
US9733643B2 (en) 2013-12-20 2017-08-15 Agjunction Llc Hydraulic interrupter safety system and method
US10349573B2 (en) * 2014-06-02 2019-07-16 Trimble Inc. Implement guidance
US9857478B2 (en) 2015-01-27 2018-01-02 Agjunction Llc Apparatus and method to mount steering actuator
US10139826B2 (en) 2015-04-24 2018-11-27 Autonomous Solutions Inc. Apparatus and method for controlling a vehicle
CN107851375B (zh) 2015-07-21 2021-01-05 日产自动车株式会社 驾驶计划装置、行驶辅助装置、驾驶计划方法
JP6644425B2 (ja) * 2016-07-07 2020-02-12 アルパイン株式会社 移動経路生成装置および移動経路生成方法

Also Published As

Publication number Publication date
AU2017249204A1 (en) 2018-11-08
AU2017249204B2 (en) 2022-03-31
AU2017249162B2 (en) 2022-03-17
EP3443428B1 (en) 2022-07-27
CA3020924A1 (en) 2017-10-19
BR112018071212A2 (pt) 2019-02-05
WO2017180521A2 (en) 2017-10-19
BR112018071212B1 (pt) 2023-03-07
WO2017180521A3 (en) 2018-01-11
US20170293303A1 (en) 2017-10-12
US10209714B2 (en) 2019-02-19
WO2017180521A9 (en) 2017-12-07
WO2017180504A1 (en) 2017-10-19
US10416675B2 (en) 2019-09-17
BR112018071211A2 (pt) 2019-02-05
AU2017249162A1 (en) 2018-11-08
EP3443429A2 (en) 2019-02-20
EP3443428A1 (en) 2019-02-20
CA3020922A1 (en) 2017-10-19
US20170293304A1 (en) 2017-10-12
EP3443429B1 (en) 2020-12-02

Similar Documents

Publication Publication Date Title
BR112018071211B1 (pt) Sistema de aquisição de linha, método implementado por computador para controlar um veículo e sistema de controle de direção
US20220253063A1 (en) Autonomous machine navigation and training using vision system
Han et al. Path-tracking simulation and field tests for an auto-guidance tillage tractor for a paddy field
Zelinsky et al. Planning paths of complete coverage of an unstructured environment by a mobile robot
US20180113473A1 (en) Gnss and optical guidance and machine control
US20190375450A1 (en) Automated reverse implement parking
BR112018074430B1 (pt) Sistema e método para mapeamento de veículo de aferição
AU2016259279A1 (en) K-turn path controller
BR102021003780A2 (pt) Método e sistema para estimar a rugosidade de superfície de um solo
BR102021003756A2 (pt) Método e sistema para estimar a rugosidade de superfície de um solo
BR102021003737A2 (pt) Método e sistema para estimar rugosidade superficial de um solo
US20180156622A1 (en) Method and robot system for autonomous control of a vehicle
EP3864484A2 (en) Autonomous map traversal with waypoint matching
WO2018101319A1 (ja) 作業機制御装置および作業機械
JP2020530077A (ja) 単一の位置センサを用いる回転プラットフォームのヨーおよび回転中心の決定方法
BR112022003592B1 (pt) Sistema e método de controle para plataforma de veículo autônoma ou controlada remotamente
Zhang et al. Development of a prototype of guidance system for rice-transplanter
BR102022007052A2 (pt) Método, mídia legível por computador não transitória, e, sistema
JP2008287487A (ja) 移動体及び移動体の走行方法
AU2018201778B2 (en) Ranging radio relative maching positioning system and method
Bak Vision-GPS fusion for guidance of an autonomous vehicle in row crops
Vatsal et al. Design and Testing of the TeamIndus ECA Lunar Rover Navigation and Control
Yun et al. Quick Turn-based Headland-Turning Control Strategy for an Autonomous Rice Transplanter
王昊 Development of Robot Vehicles Adaptable to Changing Ground Conditions and Their Work Management System
RU2481204C1 (ru) Способ работы топопривязчика

Legal Events

Date Code Title Description
B350 Update of information on the portal [chapter 15.35 patent gazette]
B06W Patent application suspended after preliminary examination (for patents with searches from other patent authorities) chapter 6.23 patent gazette]
B09A Decision: intention to grant [chapter 9.1 patent gazette]
B16A Patent or certificate of addition of invention granted [chapter 16.1 patent gazette]

Free format text: PRAZO DE VALIDADE: 20 (VINTE) ANOS CONTADOS A PARTIR DE 10/04/2017, OBSERVADAS AS CONDICOES LEGAIS