robotpark.co.kr robotpark.co.kr 로봇파크 쇼핑몰( ROBOTPARK.NET )

컨텐츠 바로가기


board


현재 위치

  1. 게시판
  2. 로봇쌤 교실

로봇쌤 교실

로봇쌤 교실입니다.

메탈파이터 예제-04 기울기센서포트 설정
제목 메탈파이터 예제-04 기울기센서포트 설정
작성자 관리자 (ip:)
  • 작성일 2012-12-07
  • 추천 추천 하기
  • 조회수 250
  • 평점 0점

메탈파이터 예제 프로그램 입니다.

먼저 로보베이직을 인스톨 하신후 윈도우상에서 활성화시켜 주십시오.

최초 구입시 제공된 CD내의 소스를 불어오시면 아래의 기울기센서 값에 해당하는

소스를 보실수 있습니다. (소스 최 상단 부분)

 

아래는 기울기센서 디폴트 값 입니다.

2012년 버젼과, 2012년 이전 버젼의 소스가 약간 다릅니다.

2축 기울기센서는 X(앞/뒤), Y(좌/우) 두 방향의 기울기정도를 감지하며,

감지된 후에는 입력된 프로그램에 의해 작동되는 방식 입니다

초기 로보노바 I 모델은 1축(앞/뒤) 기울기센서가 장착되었으나,

2세대 모델인 메탈파이터(로보노바 II) 부터는 2축 기울기센서가 장착 되었습니다.

기울기센서는 MR-3024 컨트롤러 상단에 핀배열에 장착되어 있습니다.

 

예) 로봇이 앞으로 넘어지면, 기울기센서가 이를 감지하여 적용된 해당프로그램을

      실행하게 되는 방식 입니다.

      넘어지면 다시 일어나게 끔 프로그램이 되어 있으므로,

      앞/뒤, 좌/우 어디로 넘어져도 다시 일어나게 되어 있습니다.

 

팁) 기울기센서의 작동상태를 확인하시려면,

      구입시 제공된 소스를 따운로드후, 로봇을 앞/뒤, 좌/우로 살짝 기울여 보시면

      로봇의 전신이 움직이는 것을 보실수 있습니다.

      이 동작이 넘어졌을때 일어나는 동작 입니다.

   

 

 

'**** 기울기센서포트 설정

CONST 앞뒤기울기AD포트 = 2
CONST 좌우기울기AD포트 = 3
CONST 기울기확인시간 = 10  'ms


CONST min = 100   '뒤로넘어졌을때
CONST max = 160   '앞으로넘어졌을때
CONST COUNT_MAX = 30
CONST 하한전압 = 103 '약6V전압

 

PTP SETON     '단위그룹별 점대점동작 설정
PTP ALLON    '전체모터 점대점 동작 설정

 

DIR G6A,1,0,0,1,0,0  '모터0~5번
DIR G6B,1,1,1,1,1,1  '모터6~11번
DIR G6C,0,0,0,0,0,0  '모터12~17번
DIR G6D,0,1,1,0,1,0  '모터18~23번

첨부파일
비밀번호 삭제하려면 비밀번호를 입력하세요.

목록

삭제 수정 답변

댓글 수정

비밀번호

수정 취소

/ byte