Edit on GitHub

MX-106

주의: Control Table 의 Compliance 설정부분이 PID설정으로 대체 되었습니다.

주의: 컨트롤테이블에서 PID순서가 0x1E 버젼 이후부터DIP로 변경되었습니다. 사용시 참고해주세요.

주의: MX-106T(TTL)와 MX-106R(RS485)은 통신방식만 다르며 동일한 성능과 기능을 갖고 있습니다. (TTL은 3핀 커넥터, RS485는 4핀 커넥터를 사용합니다.)

주의: MX-106의 프로토콜 2.0는 펌웨어 V39부터 지원됩니다. 프로토콜 2.0의 컨트롤 테이블은 MX-106 (2.0) 컨트롤 테이블 에서 확인 가능합니다.

로보플러스 매니저 2.0으로 펌웨어 업데이트하기

주요 사양 요약

항목 내용
MCU ST CORTEX-M3 (STM32F103C8 @ 72MHZ, 32BIT)
위치 센서 Contactless absolute encoder (12BIT, 360 [°])
Maker : ams (www.ams.com), Part No : AS5045
모터 Coreless(Maxon)
통신속도 8,000 [bps] ~ 4.5 [Mbps]
제어 알고리즘 PID Control
최소 제어각 0.088 [°]
동작 모드 관절 모드 (0 ~ 360 [°])
바퀴 모드 (무한 회전)
무게 153 [g]
크기 40.2 x 65.1 x 46 [mm]
기어비 225 : 1
Stall Torque 8.0 [Nm] @ 11.1 [V], 4.8 [A]
8.4 [Nm] @ 12[V], 5.2 [A]
10.0 [Nm] @ 14.8 [V], 6.3 [A]
No Load Speed 41 [rev/min] @ 11.1 [V]
45 [rev/min] @ 12 [V]
55 [rev/min] @ 14.8 [V]
동작 온도 -5 ~ +80 [°C]
사용 전압 10 ~ 14.8 [V] (권장 전압 : 12 [V])
Command Signal Digital Packet
Protocol Type MX-106T: Half Duplex Asynchronous Serial Communication
MX-106R: RS485 Asynchronous Serial Communication
(8bit,1stop, No Parity)
Link (Physical) MX-106T: TTL Level Multidrop BUS
MX-106R: RS485 Multidrop BUS
ID 254 ID (0 ~ 253)
Feedback Position, Temperature, Load, Input Voltage, etc
Material Full Metal Gear
Metal(Front), Engineering Plastic(Middle, Back)
Standby Current 100 [mA]


위험
(심각한 상해 또는 사망에 이르게 할 수 있습니다.)

  • 제품 주위에 가연성 물질, 계면 화성제, 음료수, 물을 분사하거나 흡입시키지 마세요.
  • 작동 중인 제품에 손, 발과 같은 신체 또는 신체의 일부를 넣지 마세요.
  • 제품에서 이상한 냄새가 나거나, 연기가 발생하면 전원 연결을 즉시 끊어주세요.
  • 아이들이 제품으로 장난치지 않도록 하세요.
  • 전원의 극성을 반드시 확인 후 배선하세요.


경고
(상해나 제품 손상의 원인이 됩니다.)

  • 제품의 사용 환경을 준수하세요. (온도 : 5 ~ 55 [°C])
  • 작동 중인 제품 내부로 칼날, 압정, 불씨 등을 흡입시키지 마세요.


주의
(상해나 제품 손상의 원인이 됩니다.)

  • 제품을 사용자 임의로 분해 또는 개조하지 마세요.
  • 제품에 강한 충격을 가하거나 떨어드리지 마세요.

성능 그래프

Stall torque :
Stall torque와 Performance Graph의 Max torque의 차이는 측정 방식에 기인합니다.
Stall torque는 순간적인 최대토크를 측정하는 방식으로, 고전적인 RC Servo 제품에서 주로 사용하는 사양입니다.
Performance Graph는 N-T Curve라고도 불리며, 부하(load)를 점진적으로 증가시키면서 측정됩니다.
모터 구동되는 환경은 Stall torque 측정 방식보다는 Performance Graph 측정 방식에 가깝습니다.
이러한 이유로 Performance Graph가 산업전반에서 보다 폭넓게 사용됩니다.
일반적으로 Perforamnce Graph의 Max torque는 Stall torque보다 적게 측정됩니다.

주의 : 전원 공급시 주의사항!

  • 안정적인 전원공급을 위해 로보티즈 제어기 나 SMPS2Dynamixel 통한 전원공급을 권장 드립니다.
  • 전원이 꺼진 상태에서 장치와 전원을 연결하시고 스위치로 ON/OFF를 해주세요.

컨트롤 테이블

Control Table은 장치 내부에 존재하는 값으로서 장치의 현재 상태와 구동에 관한 Data로 구성되어 있습니다.
사용자는 Instruction Packet을 통해 Control Table의 Data를 변경하는 방식으로 장치를 제어할 수 있습니다.

컨트롤 테이블, 데이터, 주소

Control Table은 장치의 상태와 제어를 위한 다수의 Data 필드로 구성된 집합체입니다.
사용자는 READ Instruction Packet을 통해 Control Table의 특정 Data를 읽어서 장치의 상태를 파악할 수 있습니다.
또한 WRITE Instruction Packet을 통해 Control Table의 특정 Data를 변경함으로써 장치를 제어할 수 있습니다.
Address는 Instruction Packet으로 Control Table의 특정 Data를 접근할 때 사용하는 고유값입니다.
장치의 Data를 읽거나 쓰기 위해서는 Instruction Packet에 해당 Data의 Address를 지정해 주어야 합니다.
Packet에 대한 자세한 내용은 Protocol 1.0을 참고해주세요.

참고 : 음수의 표현 방법은 2의 보수(Two’s complement) 규칙을 따릅니다. 2의 보수에 대한 자세한 설명은 위키피디아의 Two’s complement를 참고하세요.

영역 (EEPROM, RAM)

Control Table은 2가지 영역으로 구분됩니다. RAM Area에 위치한 Data는 전원이 인가될 때마다 다시 초기값으로 설정됩니다(Volatile).
반면 EEPROM Area에 위치한 Data는 값을 변경하면 전원이 꺼져도 그 값이 보존됩니다(Non-Volatile).
EEPROM Area에 위치한 모든 Data는 Torque Enable(24)의 값이 ‘0’일 때만 변경할 수 있습니다.

크기

Data의 Size는 용도에 따라 1 ~ 2 byte로 정해져 있습니다. Instruction Packet을 통해 Data를 변경할 때는 해당 Data의 Size를 확인하시기 바랍니다.
2 byte 데이터는 Little Endian 규칙에 의해 기록됩니다.

접근권한

Control Table의 Data는 2가지 접근 속성을 갖습니다. ‘RW’는 읽기와 쓰기 접근이 모두 가능합니다. 반면 ‘R’은 읽기 전용(Read Only) 속성을 갖습니다.
읽기 전용 속성의 Data는 WRITE Instruction으로 값이 변경되지 않습니다.
읽기 전용 속성(‘R’)은 주로 측정 또는 모니터링 용도로 사용되고, 읽기 쓰기 속성(‘RW’)은 장치의 제어 용도로 사용됩니다.

초기값

장치에 전원이 인가될 때, Control Table의 각 Data는 초기값으로 설정됩니다.
매뉴얼에 표기된 EEPROM 영역의 Default Value는 제품의 초기 설정값(공장 출하 설정값)입니다.
사용자가 변경한 경우, 초기값은 사용자가 변경한 값으로 적용됩니다.
RAM 영역의 Default Value 값은 전원이 인가되었을 때 설정되는 값입니다.

EEPROM 영역

주소 크기
(Byte)
명칭 의미 접근 기본값
0 2 Model Number 모델 번호의 바이트 R 320
2 1 Firmware Version 펌웨어 버전 정보 R -
3 1 ID 통신 ID RW 1
4 1 Baud Rate 통신 속도 RW 34
5 1 Return Delay Time 응답 지연 시간 RW 250
6 2 CW Angle Limit 시계 방향 한계 각도 값의 바이트 RW 0
8 2 CCW Angle Limit 반시계 방향 한계 각도 값의 바이트 RW 4,095
10 1 Drive Mode 드라이브 모드 설정 RW 0
11 1 Temperature Limit 내부 한계 온도 RW 80
12 1 Min Voltage Limit 최저 한계 전압 RW 60
13 1 Max Voltage Limit 최고 한계 전압 RW 160
14 2 Max Torque 토크 한계 값의 바이트 RW 1023
16 1 Status Return Level 응답 레벨 RW 2
17 1 Alarm LED 알람용 LED 기능 RW 36
18 1 Shutdown 알람용 셧 다운(Shut down) 기능 RW 36
20 2 Multi Turn Offset 다중 회전 오프셋 바이트 RW 0
22 1 Resolution Divider 해상도 디바이더 RW 1

RAM 영역

주소 크기
(Byte)
명칭 의미 접근 기본값
24 1 Torque Enable 토크 On/Off RW 0
25 1 LED LED On/Off RW 0
26 1 D Gain Derivative Gain RW 0
27 1 I Gain Integral Gain RW 0
28 1 P Gain Proportional Gain RW 32
30 2 Goal Position 목표 위치 값의 바이트 RW -
32 2 Moving Speed 목표 속도 값의 바이트 RW -
34 2 Torque Limit 토크 한계 값의 바이트 RW ADD 14\&15
36 2 Present Position 현재 위치 값의 바이트 R -
38 2 Present Speed 현재 속도 값의 바이트 R -
40 2 Present Load 현재 하중 값의 바이트 R -
42 1 Present Voltage 현재 전압 R -
43 1 Present Temperature 현재 온도 R -
44 1 Registered Instruction의 등록 여부 R 0
46 1 Moving 움직임 유무 R 0
47 1 Lock EEPROM 잠금 RW 0
48 2 Punch Punch 값의 바이트 RW 0
50 2 Realtime Tick Realtime Tick 값의 바이트 R 0
68 2 Current 전류소비량의 바이트 RW 0
70 1 Torque Ctrl Mode Enable 토크 제어 모드 On/Off RW 0
71 2 Goal Torque 목표 토크 값의 바이트 RW 0
73 1 Goal Acceleration 목표 가속도값 RW 0

컨트롤 테이블 설명

Model Number (0)

장치의 모델 번호입니다.

Firmware Version (2)

장치의 펌웨어 버전입니다.

ID (3)

Instruction Packet으로 장치를 식별하기 위한 고유 번호입니다.
0~253 (0xFD) 까지 사용 가능하며, 254(0xFE)는 브로드캐스트(Broadcast) ID로 특수하게 사용됩니다.
브로드캐스트 ID(254, 0xFE)로 Instruction Packet을 전송하면 모든 장치에 명령을 내릴 수 있습니다.

참고 : 연결된 장치의 ID가 중복되지 않도록 주의해야 합니다. 또한 ID(7)는 EEPROM 영역에 존재하기 때문에 Torque Enable(64) 의 값이 ’0’ 일 때만 변경할 수 있습니다.

Baud Rate (4)

제어기와 통신하기 위한 통신 속도 입니다. 0 ~ 254 (0xFE) 까지 사용 가능하며 산출 공식은 다음과 같습니다.
Baudrate(BPS) = 2,000,000 / (Value + 1)

통신속도(bps) 오차율
1 1M 0.000 [%]
3 500,000 0.000 [%]
4 400,000 0.000 [%]
7 250,000 0.000 [%]
9 200,000 0.000 [%]
16 115200 -2.124 [%]
34(초기값) 57600 0.794 [%]
103 19200 -0.160 [%]
207 9600 -0.160 [%]

참고 : UART는 Baudrate 오차가 3 [%] 이내이면 통신에 지장이 없습니다.

Value 값이 250 이상인 경우 :

Value Baud Rate 오차
250 2,250,000 0.000 [%]
251 2,500,000 0.000 [%]
252 3,000,000 0.000 [%]

주의:UART는 Baudrate오차가 3 [%] 이내이면 통신에 지장이 없습니다.

Return Delay Time (5)

제어기로부터 Instruction Packet을 받은 후, Status Packet을 반환하기까지 걸리는 시간입니다.
0 ~ 254 (0xFE) 까지 사용 가능하며 단위는 2 [μsec] 입니다.
예를 들어, 값이 10일 경우 20 [μsec] 만큼 시간이 지난 후에 Status Packet을 응답합니다.

단위 범위 상세설명
2 [μsec] 0 ~ 254 기본값: ‘250’(500 [μsec]), 최대 508 [μsec]

CW/CCW Angle Limit(6, 8)

동작이 허용되는 각도를 설정할 수 있습니다.
값의 범위와 단위는 Goal Position(Address 30, 31)과 같습니다.

동작모드 CW/CCW
바퀴 모드 CW와 CCW가 0일때
관절 모드 CW와 CCW가 0이 아닐때
다중회전 모드 CW와 CCW가 4,095일때

바퀴 모드는 모터가 무한 회전을 하여 바퀴형 구동 로봇에 쓸 수 있습니다.
관절 모드는 특정 각도로 제어가 가능하여 다관절 로봇에 쓸 수 있습니다.
다중 회전 모드는 관절모드와 같이 특정 각도로 제어가 가능하며 -28,672 ~ 28,672 까지 제어가 가능합니다.

Drive Mode (10)

Bit 명칭 내용
Bit 2 ~ 7 N/A -
Bit 1 Master/Slave Mode 0일 경우: 마스터 모드, 1일 경우 : 슬레이브 모드
Bit 0 Normal/Reverse Mode 0일 경우: 일반 모드, 1일 경우: 리버스 모드

듀얼 관절

듀얼 관절은 2개의 모터를 동시에 제어하여 1개의 관절로 사용하는 방법입니다. 듀얼 관절을 쓰기 위해서는 마스터 모드로 설정된 1개의 모터와 슬레이브로 설정된 1개의 모터가 필요합니다. 그리고 동기화 케이블을 이용해서 이 2개의 모터를 연결시켜야 합니다.  

주의: 슬레이브는 마스터로부터 동기화 케이블을 통해 제어 명령을 직접 받아 동기화 되어 구동됩니다. 슬레이브 모드 경우에도 각 통신 명령 패킷에 통신 반응은 하지만 모터 구동과 관련된 부분은 마스터와 연결된 동기화 케이블을 통해서만 동작합니다.

주의: 듀얼로 구동시 Slave의 위치정보는무시되며 Mster는 Mster의 위치값을 기반으로 두개의 모터에 동일한 PWM제어를 하게됩니다. Master와 Slave가 하드웨어적으로 연결되어있지않으면 로드차이에 의해 조금씩 다르게 구동됩니다. 아래와 같이 프레임으로 연결하신후 듀얼모드를 사용해주세요.

Temperature Limit (11)

동작 온도의 상한 값입니다.

단위 범위
약 1 [°C] 0 ~ 100

주의 : 온도 상한선을 초기값보다 높게 설정하지 마십시오. 온도 알람셧다운 발생시 20분이상 휴식하여 장치의 온도를 충분히 낮춘후 사용해 주세요. 온도가 높은상태에서 사용시 제품이 손상될 수 있습니다.

Min/Max Voltage Limit (12, 13)

전압 동작 범위의 상한과 하한 값입니다.

단위 범위 상세설명
약 0.1 [V] 50 ~ 160 5.0 ~ 16.0 [V]

상한과 하한 각각 50 ~ 250 (0x32 ~ 0xFA)까지 사용 가능하며, 단위는 0.1 [V]입니다. 예를 들어, 값이 120이면 12 [V]입니다. Present Voltage(42) 현재 전압 값이 이 범위를 벗어날 경우 Status Packet 중 ERROR의 Voltage Range Error Bit(Bit0)가 ‘1’로 설정되어 반환되고, Alram LED(Address 17)과 Shutdown(Address 18)의 플래그(flag)중 입력 전압 에러(Input Voltage Error)가 설정되어 있다면 기능이 발휘됩니다.

Max Torque (14)

모터의 최대 출력 제한 값입니다.
0 ~ 1,023 (0x3FF) 까지 사용 가능하며, 단위는 약 0.1 [%]입니다.
예를 들어, 값이 512이면 약 50 [%]이고 최대 출력 대비 50 [%]만 사용하겠다는 의미입니다.
전원이 켜지면 Torque Limit(Address 34, 35)는 이 값을 초기 값으로 사용합니다.

Status Return Level (16)

Status Packet의 반환 방식을 결정합니다.

응답하는 명령 상세설명
0 PING Instruction 모든 명령에 대해 반환하지 않음
1 PING Instruction
READ Instruction
READ 명령에 대해서만 반환함
2 All Instructions 모든 명령에 대해서 반환함

참고 : Instruction packet 의 ID가 Broadcast ID 인 경우는 이 값에 상관 없이 Status Packet이 반환되지 않습니다. 더 자세한 설명은 Protocol 1.0Protocol 2.0Status Packet 항목을 참조하심시오.

Alarm LED(17), Shutdown(18)

장치는 동작 중에 발생하는 위험 상황을 감지하여 스스로를 보호할 수 있습니다.
각 Bit의 기능은 ‘OR’의 논리로 적용되기 때문에 중복 설정이 가능합니다.
즉, Shutdown(63)이 ‘0x05’ (2 진수: 00000101)로 설정되었을 경우, Input Voltage Error(2 진수 : 00000001)와 Overheating Error(2 진수 : 00000100)가 발생하는 것을 모두 감지할 수 있습니다.
위험 상황이 감지되면, Torque Enable(64) 값이 ‘0’으로 변경되고 모터 출력은 0 [%]가 됩니다.
제어기는 Status Packet의 Error 필드에 Hardware Error Bit(0x80)이 설정되었는지를 확인하거나, Hardware Error Status(70)을 통해서 현재 상태를 확인할 수 있습니다.
위험 상황이 감지된 후에는 REBOOT을 하지 않는 한, Torque Enable(64)을 ‘1’(Torque ON)로 설정할 수 없습니다.
Shutdown(63)에서 감지할 수 있는 위험 상황은 아래 표와 같습니다.

Bit 항목 설명
Bit 7 0 -
Bit 6 Instruction Error 정의되지 않은 Instruction이 전송된 경우, 또는 reg_write명령없이 Action명령이 전달된 경우
Bit 5 Overload Error 모터의 최대 출력으로 제어할 수 없는 하중이 지속적으로 적용되는 경우
Bit 4 CheckSum Error 전송된 Instruction Packet의 ChecklSum이 맞지 않을 경우
Bit 3 Range Error 해당 Address의 값의 범위를 벗어난 값을 Instruction Packet으로 보내는 경우
Bit 2 OverHeating Error 내부 온도가 설정된 동작 온도 범위를 벗어난 경우
Bit 1 Angle Limit Error 적용한 Goal Position이 설정한 CW/CCW Angle Limit 범위를 벗어난 경우
Bit 0 Input Voltage Error 인가된 전압이 설정된 동작 전압 범위를 벗어났을 경우

각 Bit의 기능은 ‘OR’의 논리로 적용되기 때문에 중복 설정이 가능합니다. 즉, 0x05 (2 진수: 00000101)로 설정되었을 경우 Input Voltage Error와 Overheating Error가 발생하는 것을 모두 감지할 수 있습니다. 위험 상황이 발생하면 LED를 깜박이고, Torque Limit의 값을 0 으로 만들어서 모터 출력이 0%가 되도록 합니다.

Multi Turn Offset (20)

0점의 위치를 조절 할 수 있습니다. 이 값은 Present Position(36)에 더해지게 됩니다.
Present Position = 실제 위치 + Multi Turn offset 이 됩니다.
초기값은 0 값의 범위는 -24,576 ~ 24,576 까지 입니다.
모터의 실제 위치가 2,048값에 있을 때 Multi Turn offset = 1,024를 적용하면 모터는 회전 하지 않지만 Present Position의 값은 3,072가 됩니다.

참고 : 다중 회전 모드(Multi-turn Mode)일 때 만 이 값이 적용되며, 그 외의 모드에서는 이 값은 무시 됩니다.

Resolution Divider (22)

모터의 해상도를 변경 할 수 있습니다.
초기값은 1이며 1 ~ 4까지 사용 가능합니다.
모터의 해상도를 낮추고 CW, CCW 방향으로 회전 횟수를 늘릴 수 있습니다.
각 방향으로 최대 28바퀴까지 회전 가능 합니다.

Present Position = 실제 위치 / Resolution Divider

예를 들어, 실제 위치 값이 2,048 일 때 Resolution Divider의 값이 2이면 2,048/2 = 1,024 즉 Present Position의 값은 1,024가 됩니다.
이렇게 Resolution Divider의 값을 2로 변경하면 모터의 한 바퀴의 해상도는 2,048이 됩니다.
Multi Turn offset과 Resolution Divider를 같이 사용한다면 Present Position은 아래와 같은 식을 통해 구할 수 있습니다.

Present Position = (실제 위치/ Resolution Divider) + Multi Turn offset

모터의 실제 위치가 2,048값에 있을 때 Multi Turn offset = 1,024, Resolution Divider = 4 를 적용하면 모터는 회전하지 않지만 Present Position의 값은 1,535가 됩니다.

참고 : 다중 회전 모드(Multi-Turn Mode) 일 때 만 이 값이 적용되며, 그 외의 모드에서는 이 값은 무시 됩니다.

Torque Enable (24)

상세 설명
0 Torque OFF(Free-run) 상태로 변경합니다
1 Torque ON 상태로 변경하고 EEPROM 영역의 모든 데이터는 잠김상태로 변경됩니다

LED (25)

LED를 ON/OFF 합니다.

설명
0(초기값) LED를 Off 시킵니다.
1 LED를 On 시킵니다.

참고 : 장치의 상태(조건)에 따른 LED의 동작입니다.

상태 LED 동작
부팅 1회 점멸
공장 초기화 4회 점멸
알람 점멸
슬레이브 모드(MX-106) 3회 점멸
부트 모드 점등

PID Gains (26, 27, 28)

MX 시리즈는 대표적 제어기법인 PID Controller를 이용합니다.

The relationship between Compliance Slop and PID

Slope P Gain
8 128
16 64
32 32
64 16
128 8

The less the P gain, The larger the back lash, and the weaker the amount of output near goal position.
At some extent, it is like a combined concept of margine and slope.
It does not exactly match the previous concept of compliance. So it is obvious if you see the difference in terms of motion.
Explanation for PID required.
For the brief explanation about general PID, please refer to the website(link) below.
http://en.wikipedia.org/wiki/PID_controller FYI, PID control theory is not only limited to the control of motor(actuator) but is a generic theory that can be applied to all kinds of control.

Goal Position (30)

이동 시키고자 하는 목표지점의 위치 값입니다.
0 ~ 4,095 (0xFFF)까지 사용 가능하며 단위는 0.088 [°] 입니다.
CW/CCW Angle Limit의 벗어난 값을 사용하게 되면 Status Packet 중 ERROR의 Angle Limit Error Bit (Bit1) 가 ‘1’로 설정되어 반환되고, Alram LED/Shutdown의 플래그(flag)중 Angle Limit Error가 설정되어 있다면 기능이 발휘됩니다.

위 그림은 장치를 정면에서 보았을 때의 그림입니다.

다중 회전 모드일 때 값의 범위는 -28,672 ~ 28,672로 늘어나게 되며 0에서부터 CW, CCW 각 방향으로 7바퀴씩 회전 할 수 있습니다.
만약 Resolution Divider와 같이 사용한다면 회전 횟수를 더 증가 시킬 수 있습니다.

참고 : 휠 모드로 동작시에는 Goal Position값이 사용되지 않습니다.

Moving Speed (32)

Torque Limit (34)

모터의 최대 출력 제한 값입니다.
0 ~ 1,023 (0x3FF)까지 사용 가능하며, 단위는 약 0.1 [%]입니다.
예를 들어, 값이 512이면 약 50 [%]이고 최대 출력 대비 50 [%]만 사용하겠다는 의미입니다.
전원이 켜지면 Max Torque(Address 14, 15)의 값을 초기 값으로 사용합니다.

참고 : Alarm Shutdown의 기능이 발휘되면 이 값이 0이 되어 모터의 힘이 없어지게 됩니다. Alarm Shutdown조건이 해제되고 이 값을 0이 아닌 값으로 바꾸면 다시 모터의 출력이 발휘되어 사용할 수 있습니다.

Present Position (36)

장치의 현재 위치 값입니다. 값의 범위는 0 ~ 4,095 (0xFFF)이며 단위는 0.088 [°] 입니다.

위 그림은 장치를 정면에서 바라본 그림입니다.

다중 회전 모드일 때 값의 범위는 -28,672 ~ 28,672 이며 단위는 Resolution Divider 값에 따라 (0.088 * Resolution Divider)도로 변화 합니다.

참고 : 다중 회전 모드(Multi-turn Mode)일 때 실제 위치와 Present Position의 관계는 Resolution Divider와 Multi Turn offset의 값에 따라 달라 질 수 있습니다. 더 자세한 내용은 Multi Turn offset과 Resolution Divider를 참고 하시기 바랍니다.

Present Speed (38)

현재  이동하는 속도입니다. 이 값은 0 ~ 2047 (0X7FF) 까지 사용됩니다. 0 ~ 1023 범위의 값이면 CCW방향으로 회전한다는 의미입니다. 1024 ~ 2047 범위의 값이면 CW방향으로 회전한다는 의미입니다. 즉, 10번째 bit가 방향을 제어하는 direction bit가 되며 0과 1024는 같습니다. 이 값의 단위는 약 0.114 [rev/min] 입니다. 예를 들어, 300으로 설정된 경우 CCW방향 약 34.33 [rev/min]으로 이동 중이라는 의미입니다

Present Load (40)

현재 적용되는 하중을 의미합니다.
이 값의 범위는 0 ~ 2,047이며, 단위는 약 0.1 [%]입니다.
0 ~ 1,023 범위의 값은 CCW 방향으로 하중이 작용한다는 의미입니다.
1,024 ~ 2,047 범위의 값은 CW 방향으로 하중이 작용한다는 의미입니다.
즉, 10번째 bit가 방향을 제어하는 direction bit가 되며, 1,024는 0과 같습니다.
예를 들어, 값이 512이면 CCW 방향으로 최대 출력 대비 약 50 [%]로 하중이 감지된다는 의미입니다.

Bit 15 ~ 11 10 9 ~ 0
0 하중 방향 데이터 (하중 비율)

참고 : CCW 하중 : 하중 방향 비트(Bit 10) = 0, CW 하중 : 하중 방향 비트(Bit 10) = 1

참고 : 현재하중은 토크센서 등을 이용하여 측정된 값이 아니라 내부 출력 값을 기반으로 유추된 값 입니다. 따라서 무게나 토크를 측정하는 용도로는 부정확 할 수 있습니다. 해당 관절에 가해지는 힘의 방향과 크기를 예측하는 용도로 사용하시기를 권장합니다.

Present Voltage (42)

현재 공급되고 있는 전압입니다. 이 값의 단위는 0.1 [V]입니다. 예를 들어, 값이 100(0x64)이면 10 [V]입니다.

만약 Present Voltage(42)값이 범위를 벗어나게 되면 Status Packet의 Voltage Range Error Bit(Bit0)이 ‘1’이 되며 Alarm(Address 17)이 ‘1’로 설정되고 Alarm Shutdown(Address 18)의 0번 비트가 1로 설정됩니다.

Present Temperature (43)

내부의 온도이며 이 값의 단위는 섭씨 온도입니다.
예를 들어, 값이 85이면 현재 내부 온도는 85 [°C] 입니다.

Registered Instruction (44)

Value Description
0 REG_WRITE로 전달된 명령이 없습니다.
1 REG_WRITE로 전달된 명령이 있습니다.

참고 : ACTION 명령을 수행하면 이 값이 ‘0’으로 바뀝니다.

Moving (46)

설명
0 Goal position 명령 수행을 완료했습니다.
1 Goal position 명령을 수행중입니다.

Lock (47)

설명
0 EEPROM 영역을 수정할 수 있습니다.
1 EEPROM 영역을 수정하지 못합니다.

주의 : Lock이 1로 설정되면 전원을 껐다 켜야 0으로 바꿀 수 있습니다.

Punch (48)

구동시에 모터에 공급되는 최소 전류량 입니다. 초기값은 0x00이며 최고 0x3FF까지 설정할 수 있습니다.

Realtime-Tick (50)

장치의 시간을 나타내는 지수입니다.

단위 범위 상세 설명
1 [msec] 0 ~ 32,767 32,767 이후에는 ‘0’부터 다시 시작합니다.

주의: 펌웨어 버전 40 이상부터 사용 가능합니다.

Current (68)

전류가 소모되지 않고 있을때의 값은 2,048(0x800)입니다. 만약, 전류가 양의 방향으로 흐르면, 2,048(0x800)보다 큰값이 나옵니다. 만약, 전류가 음의 방향으로 흐르면, 2,048(0x800)보다 작은 값이 나옵니다. 전류값을 계산하는 방법은 다음과 같습니다.

I = (4.5 [mA]) * (CURRENT – 2,048 ) (단위 A) 예를 들어, 68번지의 값이 2,148 이면, 양의 방향으로 450 [mA] 가 흐르고 있다는 뜻입니다.

Torque Control Mode Enable (70)

의미
0 토크 모드를 OFF 시킵니다. 관절 모드 또는 휠모드가 실행됩니다.
1 토크 모드를 ON 시킵니다. 위치 제어 및 속도 제어는 되지 않고, 오직 토크만 제어 됩니다.

Torque Control Mode Enable이 1이 되면, 장치는 다음과 같은 행동을 합니다.

  1. 장치는 위치 및 속도 제어를 하지 않습니다.
  2. 장치는 Goal Torque 에 적힌 토크로 제어합니다.
  3. Goal position 및Goal speed 에 값을 적더라도 반응하지 않습니다.
  4. 위치 및 속도 제어가 되지 않으므로, 마치 바퀴모드처럼 행동합니다. 

Goal Torque (71)

목표하는 토크의 값입니다. 0 ~ 2,047 (0x7FF) 까지 사용되며, 단위는 4.5 [mA] 입니다. (토크와 전류값은 정 비례합니다.) 0 ~ 1,023 범위의 값을 사용하면 CCW 방향으로 토크가 가해지며 0으로 설정하면 정지합니다. 1,024 ~2,047 범위의 값을 사용하면 CW 방향으로 토크가 가해지며 1,024으로 설정하면 정지합니다. 즉 10번째 bit가 방향을 제어하는 direction bit가 됩니다. Goal Torque 는Torque Limit(34, 35) 보다 커질 수 없습니다.

Goal Acceleration (73)

목표 가속도 값입니다. 0 ~ 254 (0xFE)까지 사용되며, 단위는 약 8.583 [°] / sec2 입니다.
0으로 설정하면, 가속도 제어를 하지 않고 모터의 최대 가속도로 움직인다는 의미입니다.
목표속도가 0일 경우에도, 가속도 제어를 하지 않고 모터의 최대 가속도로 움직입니다.
254를 설정할 경우 2,180 [°] / sec2이 됩니다.
예를 들어, 장치의 속도가 현재 0이고 Goal Acceleration이 10인 경우, 1초 뒤의 장치의 속도는 14.3 [rev/min2]이 됩니다.

조립 방법

옵션 프레임

기구결합

유지보수

혼과 베어링 교체

혼은 다이나믹셀 정면의 출력축에 부착되어 있으며 베어링은 후면에 부착되어 있습니다.

혼 조립하기

혼을 끼워넣기 전에 혼 와셔를 넣어주어야 합니다.
아래 그림과 같이 혼과 기어의 마킹 위치에 맞추어 혼을 조립합니다.

혼을 끼워넣을 때 혼의 중심부를 밀면서 조립합니다.
이때 혼 와셔가 중심에서 벗어나지 않도록 하고 조립이 끝나면 볼트로 혼을 고정합니다.

베어링 조립하기

기존 다이나믹셀에서 사용하던 베어링을 새 다이나믹셀에 조립해야 할 경우 아래 방법을 따릅니다.
베어링은 쇼핑몰에서 별도로 구매할 수 있습니다. 베어링은 혼과는 달리 구동축에 연결되지 않기 때문에 자유롭게 회전이 가능합니다.

참고자료

주의: 호환성 가이드

커넥터 정보

항목 TTL RS-485 Dual Joint
핀 번호 1 GND
2 VDD
3 DATA
1 GND
2 VDD
3 DATA+
4 DATA-
1 PWM1
2 PWM2
3 ENABLE
다이어그램
하우징
MOLEX 50-37-5033

MOLEX 50-37-5043

MOLEX 51021-0300
PCB 헤더
MOLEX 22-03-5035

MOLEX 22-03-5045

MOLEX 53398-0371
Crimp 터미널 MOLEX 80-70-1039 MOLEX 80-70-1039 MOLEX 50058-8000
Wire Gauge 21 AWG 21 AWG 26 AWG

주의: 커넥터 제조사의 PIN 순서와 상이할 수 있으니 반드시 PIN 순서를 확인하시기 바랍니다.

Videos

도면