[답변] 서보모터가 움직이지 않습니다.(점검프로그램포함) > Q&A

• 목록
• 글쓰기

서보모터 점검용으로 소스 파일 하나 올려드려요.

캔위성 기본키트에 달려 있는 광센서 A5 와 A6 를 이용하여 서보모터 제어하는 코드입니다.

* 추가 지상국 SW 에서 확인하고 있는 그림 올려드립니다.

 ( 파란색이 PWM 신호의 일부를 잡은 부분입니다. )

실습1 또는 실습2와 같이  연결하였다면, 서보모터가 동작할 것입니다.

참고로, 서보모터 제어시 20이하일 경우 20으로 설정하도록 하였습니다.

void hyCANSAT_SERVO_OPERATION()
{
  hyCANSAT_SERVO_ATTACH();
  if( ad_data[5] < 20 )  csServo[0].write(20); else  csServo[0].write(ad_data[5]);
  if( ad_data[6] < 20 )  csServo[1].write(20); else  csServo[1].write(ad_data[6]);
//  csServo[1].write(30); // when use
}

* 안 될 경우, 서보모터 포트에 오실로스코프로 PWM 신호가 전달되고 있는 지 확인하세요.

  주기적으로 ON/OFF 신호가 출력되고 있을 겁니다.

  이 부분이 모터의 주황색 라인에 연결되어 있어야 합니다.

  즉

 모터1는 캔위성 3층 보드 TD0 의  검정색은 GND, 빨간색은 VCC, 주황색은 신호선에 연결

 모터2는 캔위성 3층 보드 TD1 의  검정색은 GND, 빨간색은 VCC, 주황색은 신호선에 연결

센서를 밝거나 어둡게하여 (손으로 가리시면) 서보모터의 움직임을 확인하실 수 있습니다.

* 서보모터 점검을 하신 후에는 다시 원하시는 프로그램으로 Upload 하셔야 합니다.

> > > 지상국 프로그램 명령창에서 PWM 명령을 주었을 때 서보모터가 움직이지 않습니다. > 전원이 들어왔을 때 서보모터가 잠깐 움직이는 것으로 보아 서보모터의 고장은 아닌 것 같습니다. > >