디지털 서보 모터 프로그래밍: 완전한 단계별 가이드

2.1 하드웨어 설정

서보의 전원선(빨간색)을 서보당 최소 1A를 제공할 수 있는 5V 공급 장치에 연결합니다.

접지(갈색/검은색)를 마이크로컨트롤러의 공통 접지에 연결합니다.

신호선(주황색/노란색)을 PWM 지원 핀에 연결합니다.

2.2 코드 구현 - 직접 PWM 제어

// 외부 라이브러리가 없는 디지털 서보 제어 // 핀 9에서 타이머1 16비트 PWM 사용(Arduino Uno) const int ServoPin = 9; const int minPulse = 1000; // 1.0 ms = 0도(마이크로초 단위) const int maxPulse = 2000; // 2.0ms = 180도 const int period = 20000; // 20ms 주기(50Hz) void setup() { pinMode(servoPin, OUTPUT); // 50Hz PWM용 Timer1 구성(간단한 설정) // 간결성을 위해 전체 초기화 코드 생략 - 전체 기능은 2.3단계 참조 } void setServoAngle(int angle) { // 각도: 0 ~ 180 int pulseWidth = map(angle, 0, 180, minPulse, maxPulse); // 계산된 펄스 폭으로 50Hz 신호를 생성합니다. // 실제 구현에는 타이머 레지스터가 필요합니다. 아래 전체 기능을 참조하세요. }

2.3 모든 마이크로컨트롤러에 대한 완벽하고 검증된 기능

가장 신뢰할 수 있는 방법은 하드웨어 타이머를 사용하여 핀을 전환하는 것입니다. 다음은 레지스터 이름을 조정하면 모든 플랫폼에서 작동하는 이식 가능한 기능입니다.

// 펄스 폭 변조를 사용하여 서보 각도를 설정하는 함수 // 입력: 각도(0-180도) // 출력: 없음 – PWM 듀티 사이클 업데이트 void setServoAngle(int angle) { // 각도를 유효한 범위로 제한 if (angle 180) angle = 180; // 펄스 폭을 마이크로초 단위로 계산합니다. // 표준 매핑: 0° = 1000us, 180° = 2000us unsigned int pulseWidth_us = 1000 + (angle1000/180); // 50Hz 신호의 경우: 주기 = 20,000us // 듀티 사이클 = pulseWidth_us / 20000100% // 예: 1.5ms = 90°에 대한 7.5% 듀티 사이클 // 플랫폼별 PWM 레지스터 업데이트: // AVR에서: OCR1A = (pulseWidth_us / 20000.0)TOP_값; // ARM의 경우: AnalogWrite(servoPin, (pulseWidth_us255) / 20000); // 아래 코드는 마이크로초 값을 허용하는 일반 AnalogWrite를 가정합니다. // 하드웨어의 실제 PWM 함수로 바꿉니다. writeMicrosecondsToPWM(servoPin, pulseWidth_us); }

실제 테스트:6-DOF 로봇 팔을 만드는 취미생활자는 이 정확한 매핑을 사용했습니다. 각 서보의 최소/최대 펄스 제한(모델에 따라 약간 다를 수 있음)을 보정한 후 암은 ±1° 반복성을 달성했습니다.

2.4 표준 서보 라이브러리 사용하기(초보자용)

대부분의 개발 환경은 타이머 구성을 추상화하는 전용 서보 라이브러리를 제공합니다. 논리는 동일하게 유지됩니다.

#포함하다서보 myServo; 무효 설정() { myServo.attach(9); // PWM 핀 9 myServo.write(90); // 90°로 이동(1.5ms 펄스) } void loop() { for (int angle = 0; angle

> 메모:그만큼쓰다()함수는 라이브러리 기본값에 따라 내부적으로 0–180°를 0.5–2.5ms 또는 1.0–2.0ms로 매핑합니다. 항상 오실로스코프를 사용하거나 물리적 서보 한계를 테스트하여 확인하십시오.

4.1 부드러운 움직임(가속도 제어)

새로운 각도로 직접 이동하는 대신 작은 단계로 각도를 증가시키세요.

void smoothMove(int targetAngle, int stepDelay_ms) { static int currentAngle = 90; if (currentAngle = targetAngle; a--) { setServoAngle(a); 지연(stepDelay_ms); } } currentAngle = targetAngle; }

4.2 다중 서보 동기화

한 번에 여러 서보를 제어하려면 동일한 20ms 창 내에서 모든 PWM 레지스터를 업데이트하십시오. 20ms마다 트리거되고 각 서보의 펄스 폭을 순차적으로 출력하는 타이머 인터럽트를 사용하십시오.

8개 서보의 구조 예:

목표 펄스 폭을 배열에 저장합니다.

인터럽트 루틴에서는 첫 번째 서보 핀을 켜고 펄스 폭을 기다렸다가 끈 다음 다음 서보에 대해 반복합니다.

이렇게 하면 모든 서보가 동일한 프레임 내에서 신호를 수신하여 지터가 제거됩니다.