51 prática de código de controle de servo microcontrolador: três etapas para obter rotação precisa do servo

01Por que seu servo está sempre “se contorcendo”? —— Cadeia causal do princípio PWM

Servo é um "paranóico do tempo".

Ele reconhece apenas um idioma, que é uma onda PWM com período de 20ms, e seu tempo de alto nível está entre 0,5ms e 2,5ms.。

cadeia de causalidade：

Razão A: A frequência do oscilador de cristal se desvia, fazendo com que o valor inicial do temporizador seja calculado incorretamente, o que por sua vez faz com que o erro de largura de pulso se acumule, fazendo com que o posicionamento do mecanismo de direção se desvie.

Razão B, o aninhamento de interrupção não é processado, o loop principal interrompe a saída PWM, o período de pulso torna-se mais longo e mais curto e o servo emite um bipe agudo.。

Certa vez, um entusiasta usou um oscilador de cristal de 12 MHz para aplicar diretamente um valor de temporizador de 11,0592 MHz. Em seguida, o servo fez uma ação de “acenar com a cabeça” na frequência de 15 Hz, como se quisesse zombar do código por ter sido escrito muito apressadamente.

Pergunte a si mesmo a resposta: Por que algumas pessoas não conseguem copiar o código da Internet?

Responderam por si mesmos: A razão é que ninguém lhes disse que o ciclo da máquina do microcontrolador 51 é 12 vezes o ciclo do oscilador de cristal, e o modo 1T da série STC é 12 vezes a velocidade do tradicional 8051。

A expressão matemática da modulação por largura de pulso é a seguinte (pseudocódigo):

Tempo de alto nível (ms) = 0,5 + (ângulo/180)Valor de recarga do temporizador 2.0 = 65536 - (largura de pulso_us) / (12/cristal MHz)

A principal conclusão é que não existe controle de direção calibrado para uma base de tempo desatualizada. A situação é como usar uma fita métrica para medir o nível do mar. A ferramenta em si é boa, mas o sistema de referência é um desastre.

02De registros a formas de onda – como é um código funcional?

Dica: modulação por largura de pulso

Abra o Keil, crie um novo projeto e selecione AT89C52.

Este é um caso básico muito comum e também é o ponto de partida para 95% dos iniciantes fazerem o servo girar silenciosamente pela primeira vez.

void Timer0_ISR() interrupção 1 {contador de caracteres estático não assinado = 0; TH0 = 0xFC; // Valor de recarga: interrompe uma vez a cada 1ms (oscilador de cristal de 12MHz) TL0 = 0x66; contador++; if(contador = 20) contador = 0; }

largura_de_pulso_em_ms = 10; // 1,0ms → 0 graus? Não, estão -45 graus! largura_de_pulso_em_ms = 15; // 1,5ms → mediana pulse_width_in_ms = 20; // 2,0ms → 90 graus

03Quatro armadilhas comuns para quebrar a maldição de copiar e colar

O pedido de ajuda foi enviado por um engenheiro de automação de fábrica com o mesmo código.potência servoÉ o mesmo. Na sua linha de produção, o servo da estação 5 sempre trava.

Após três horas de investigação, descobrimos:

Perguntas/Respostas:Por que o servo gira loucamente assim que é ligado?

Resposta: Como a porta P1.0 está alta durante a reinicialização, ela deve ser definida como baixa durante a inicialização.

Perguntas/Respostas:Por que minha correspondência angular está invertida?

O seguinte é: Verifique a direção de instalação do braço servo. Para muitas marcas de servos, 0 graus corresponde a 0,5ms. No entanto, a definição de alguns servos de modelos de aeronaves é oposta.。

Perguntas/Respostas:O que devo fazer se o servo tremer depois que a tensão da bateria cair?

Resposta: Devido à corrente insuficiente devido à redução de tensão, o bloqueio de subtensão é definido ao configurar uma fonte de alimentação independente e o limite é definido para 4,8V.

Perguntas/Respostas:É possível que um microcontrolador 51 controle 8 servos ao mesmo tempo?

Resposta: Isso não é possível, porque uma interrupção de temporizador separada irá expirar, então ele precisa ser substituído por um módulo PCA ou atualizado o compartilhamento de tempo.

O medo apela. Se você ignorar qualquer um dos itens acima, seu servo irá fumar no 47º minuto de depuração, e este é o ponto de tempo de desgaste de hardware mais frequente nas estatísticas de laboratório.

04Ascensão em espiral – desde um único mecanismo de direção até um braço robótico com vários graus de liberdade

Palavra de alerta: base de tempo

Controlar um servo é uma enumeração; controlar oito servos é um algoritmo.

Quando você precisa deixar o braço do robô traçar uma trajetória senoidal, o controle linear da largura de pulso expõe imediatamente seus pontos fracos:

A velocidade angular de cada junta apresenta um estado descontínuo, o que provoca uma mudança repentina na aceleração da extremidade, fazendo com que a vibração mecânica seja transmitida à base.

argumento causal：

O microcontrolador 51 não possui uma matriz PWM de hardware, portanto, ele deve usar o método "sondagem de compartilhamento de tempo + interpolação de variável intermediária".

Solução:

1. Divida o grande período de 20ms em N intervalos de tempo (N=número de servos).

2. Apenas uma linha de sinal é puxada para cima em cada intervalo de tempo e as demais são mantidas em nível baixo.

3. Use uma matriz para armazenar a largura de pulso de cada servo e produza-a sequencialmente dentro da interrupção.

É como se uma creche do jardim de infância entregasse salgadinhos crocantes comestíveis para muitas crianças, uma por uma e alternadamente. Cada vez que eles são dados leva apenas um milissegundo muito curto. Embora pareça implacável e frio, tem um efeito eficaz.

Exemplo de transformação de código (lógica de pseudocódigo):

int não assinado pwm_val[8] = {10,15,20,12,18,9,14,16}; caractere não assinado atual_servo= 0; void Timer0_ISR() interrupção 1 { // Desliga o sinal do servo anterior P1 &= 0xFE; // Apenas limpa P1.0, a máscara real é necessária // Carrega o tempo de alto nível do servo atual TH0 = (65536 - pwm_val[current_servo]100) >> 8; // Suponha que a unidade seja 0,1ms TL0 = (65536 - pwm_val[current_servo]100) & 0xFF; //Ativa o sinal atual do servo P1 |= (1

O primeiro é um lembrete importante. Quanto a este código, sempre que ocorrer uma troca de servo, o temporizador será reiniciado. Como resultado, o período total final não mantém mais o valor original de 20ms. Diante desta situação, é necessário adicionar lógica temporal adicional.

05Uma bíblia de ajuste para engenheiros “perfeccionistas”

Palavra de dica: zona morta

Mesmo que sejam do mesmo lotepotênciaO servo, devido a diferenças individuais, também fará com que 15% dos servos tenham uma diferença estática de um a três graus.

Isso não é uma falha, é a tolerância da física.

Olhando para trás na história, na década de 1980, os robôs industriais usavam um método de feedback de potenciômetro, e a configuração da zona morta sob esse método de feedback chegava a cinco graus; agora, os servos codificadores magnéticos já podem atingir uma precisão de repetição de 0,1 grau. No entanto, a resolução PWM de oito bits do microcontrolador 51, que é do tipo de 256 níveis, só consegue distinguir mudanças de cerca de 0,7 graus.

órgão de revisão de produtosEtapas de ajuste:

1. Use o método de calibração aproximado, defina a largura de pulso mediana para 1,5 ms e escreva-a, depois meça o ângulo real e registre o deslocamento Δθ.

2. Compensação linear: Na fórmula composta por ângulo e largura de pulso, é adicionado um termo de correção de deslocamento. Este termo de correção está na forma em que a largura do pulso é igual ao valor base mais o passo angular mais o deslocamento. A fórmula específica é: pulso = base + passo angular + deslocamento.

3. Evitando zona morta: Quando o ângulo alvo é diferente do ângulo atual

Exemplo: Em um projeto de braço robótico subaquático, mudanças na temperatura da água do mar fizeram com que a frequência do oscilador de cristal variasse em ±0,1%. Os engenheiros calibravam-se a cada 10 minutos: girando o servo para a posição limite mecânica, registrando a largura de pulso correspondente e corrigindo a base de tempo sob condições dinâmicas.

06Final: O escultor do tempo nunca se aposenta

"A paciência é a base de toda inteligência." - Platão.

O segredo final sobre o controle do servo microcontrolador 51 não está nas habilidades maravilhosas exibidas pelo código, mas na admiração de cada microssegundo.

Repita os pontos-chave：

PWM não é uma teoria complexa;modulação por largura de pulsoAs restrições matemáticas por trás desta palavra-chave.

Estabilidade da base de tempo > Elegância do código.

Ao encontrar condições de instabilidade, uivos ou desvios, primeiro verifique a fonte de alimentação, depois verifique a interrupção e, finalmente, questione o mecanismo de direção.

Sugestões de ação(A base final da espiral):

1. Esta noite, usarei uma placa de ensaio para construir um único circuito de teste de servo.

2. A partir de dez graus, avance em etapas e use um osciloscópio ou analisador lógico para registrar a largura real do pulso correspondente a cada ângulo.

3. Adicione função de zona morta e aviso de monitoramento de tensão ao código.

4. Use seu microcontrolador 51 como uma "máquina de gravação do tempo". Cada vez que é interrompido, é o momento em que a faca de gravação cai.

Numa noite de outono, uma brisa fresca sopra pela janela do laboratório. Neste momento, uma linha bem organizada de ondas quadradas exibidas no osciloscópio está saltando na tela fluorescente. Neste momento você finalmente entende que o controle não é uma conquista, mas uma reconciliação com o tempo.

Neste momento, comece a escrever seu primeiro código de servocontrole para o microcontrolador 51. Lembre-se, para cada movimento preciso, você está cumprindo sua promessa de microssegundos.