Skip to content

Magnetically Encoded HLS Servo - Memory Table

For HLS half-duplex TTL series servos. Two-byte fields are transmitted with the low byte first.

1 Servo Communication Protocol

Servos use the FT-SCS proprietary protocol. Factory serial defaults: baud rate 1 Mbps, 8 data bits, no parity, 1 stop bit; configurable baud rate range 38400~1 Mbps, default communication address (station number) 1.

For the full frame format and instruction set, see FT-SCS Protocol.

2 Servo Memory Table Definition

If a function address uses two bytes of data, the low byte is at the leading address and the high byte at the following address.

Notes:

  • Initial values and ranges vary by model (shown as – in the table); refer to the data for your model.
  • "Minimum resolution angle" here is the smallest angle the encoder can resolve: the series divides a full turn of 360° into 4096 parts, each 360° ÷ 4096 ≈ 0.0879°, which is the value shown in the Unit column; position and angle-limit registers count in this unit, per your model's data.

2.1 Version Information

Address (DEC) Address (HEX) Function Bytes Initial value Access Range Unit Description
0 0x00 Firmware major version 1 3 R
1 0x01 Firmware minor version 1 – R 40 ~ 59
2 0x02 END 1 0 R 0 indicates little-endian storage structure
3 0x03 Servo major version 1 10 R
4 0x04 Servo minor version 1 – R

2.2 EEPROM Configuration

Address (DEC) Address (HEX) Function Bytes Initial value Access Range Unit Description
5 0x05 Main ID 1 1 R/W 0~253 ID Unique main ID on the bus (first identifier)
6 0x06 Baud rate 1 0 R/W 0~7 None 0-7 correspond to baud rates: 1000000(0), 500000(1), 250000(2), 128000(3), 115200(4), 76800(5), 57600(6), 38400(7)
7 0x07 Secondary ID 1 0 R/W 0~253 ID Secondary ID (second identifier). It applies to write, async write (0x04), async write execution (0x05) and sync-write instructions; writing to the main ID also updates the secondary ID
8 0x08 Response status level 1 1 R/W 0~1 None 0: no response packet for instructions other than READ and PING; 1: response packet for all instructions
9 0x09 Minimum angle limit 2 0 R/W 0~4094 0.0879° Sets the minimum running angle limit; the value must be smaller than the maximum angle limit; minimum angle limit = maximum angle limit = 0 enters multi-turn absolute position control mode
11 0x0B Maximum angle limit 2 4095 R/W 0~4095 0.0879° Sets the maximum running angle limit; the value must be larger than the minimum angle limit; minimum angle limit = maximum angle limit = 0 enters multi-turn absolute position control mode
13 0x0D Maximum temperature limit 1 70 R/W 0~100 °C Temperature threshold of the overheat protection
14 0x0E Maximum input voltage 1 – R/W 0~254 0.1V Voltage threshold of the over-voltage protection
15 0x0F Minimum input voltage 1 40 R/W 0~254 0.1V Voltage threshold of the under-voltage protection (the default suits low-voltage models; raise it for higher-voltage models)
16 0x10 Maximum torque 2 980 R/W 0~1000 0.1% Written to address 48 (torque limit) at power-on
18 0x12 Phase 1 – R/W 0~254 None Special function byte; do not modify unless specifically required
19 0x13 Unload condition 1 – R/W 0~254 None Set bit to 1 to enable the corresponding protection, set bit to 0 to disable it; bit definitions in 3.3 Unload Condition
20 0x14 LED alarm condition 1 – R/W 0~254 None Set bit to 1 to enable the flashing LED alarm, set bit to 0 to disable the flashing LED alarm; bit definitions in 3.4 LED Alarm Condition
21 0x15 Position loop P (proportional) coefficient 1 – R/W 0~254 None Written to address 50 (Kp) at power-on
22 0x16 Position loop D (derivative) coefficient 1 – R/W 0~254 None Written to address 51 (Kd) at power-on
23 0x17 Position loop I (integral) coefficient 1 0 R/W 0~254 None Written to address 52 (Ki) at power-on
24 0x18 Minimum startup torque 1 – R/W 0~254 0.1% Sets the minimum output startup torque of the servo
25 0x19 Integral limit 1 0 R/W 0~254 None Maximum integral = limit × 4; 0 disables the integral limit; effective in position mode 0 and mode 4 (mode 4 is a custom build, only on special models)
26 0x1A Positive deadband 1 1 R/W 0~16 0.0879° The minimum unit is one minimum resolution angle
27 0x1B Negative deadband 1 1 R/W 0~16 0.0879° The minimum unit is one minimum resolution angle
28 0x1C Protection current 2 – R/W 0~2047 6.5mA Written to address 44 (goal current) at power-on
30 0x1E Angle resolution 1 1 R/W 1~128 None Magnification factor of the sensor's minimum resolution angle: set to K, one count = K × 0.0879° and the full 0~4095 range covers K turns; a larger K means more turns but a coarser step
31 0x1F Position offset 2 0 R/W -4095~4095 0.0879° BIT15 is the direction bit; the remaining bits cover 0-4095
33 0x21 Operating mode 1 0 R/W 0~3 None 0: position servo mode (position + current limit); 1: constant-speed motor mode (constant speed + current limit); 2: constant-current motor mode (current limit, speed not controllable); 3: PWM open-loop speed mode
34 0x22 Current loop P (proportional) coefficient 1 – R/W None
35 0x23 Current loop I (integral) coefficient 1 – R/W None
36 0x24 Undefined 1 – R/W – – –
37 0x25 Velocity loop P (proportional) coefficient 1 – R/W 0~254 None Speed-loop proportional coefficient in constant-speed motor mode (mode 1)
38 0x26 Overcurrent protection time 1 200 R/W 0~254 10ms
39 0x27 Velocity loop I (integral) coefficient 1 – R/W 0~254 None Speed-loop integral coefficient in constant-speed motor mode (mode 1)

2.3 SRAM Control

Address (DEC) Address (HEX) Function Bytes Initial value Access Range Unit Description
40 0x28 Torque switch 1 0 R/W 0~2 None Write 0: torque output off; write 1: torque output on; write 2: damping output
41 0x29 Acceleration 1 0 R/W 0~254 8.79°/s² Run acceleration/deceleration of the servo; 0 means maximum acceleration
42 0x2A Goal position 2 0 R/W -32767~32767 0.0879° Absolute position control; the maximum corresponds to the maximum effective angle; BIT15 is the direction bit; ±32767 is the conceptual range — what you actually write is the magnitude (0~32767), and set BIT15 to 1 for the reverse direction
44 0x2C Goal current 2 Protection current (28) R/W -2047~2047 6.5mA In modes other than mode 3, this value limits the maximum running current of the motor; in constant-current mode (mode 2) BIT15 is the current direction bit; in mode 3 the register is the PWM duty cycle (write 0~1000, set BIT10 to 1 for reverse, unit 0.1%)
46 0x2E Running speed 2 Factory default maximum speed R/W -32767~32767 0.732RPM Controls the maximum running speed of the motor; 0 means stop; in constant-speed mode (1) BIT15 is the speed direction bit
48 0x30 Torque limit 2 Maximum torque (16) R/W 0~1000 0.1% Can be modified to control the stall torque output
50 0x32 Kp 1 Position loop P coefficient (21) / velocity loop P coefficient (37) R/W 0~254 None Position servo mode: proportional coefficient of the position loop (1/8); constant-speed motor mode: proportional coefficient of the speed loop
51 0x33 Kd 1 Position loop D coefficient (22) R/W 0~254 None Position servo mode: derivative coefficient of the position loop (1/4); constant-speed motor mode: invalid
52 0x34 Ki 1 Velocity loop I coefficient (39) R/W 0~254 None Position servo mode: invalid; constant-speed motor mode: integral coefficient of the speed loop
53 0x35 Undefined 1 – R/W – –
54 0x36 Undefined 1 – R/W – –
55 0x37 Lock flag 1 1 R/W 0~1 None Write 0 to close the write lock: values written to EEPROM addresses persist after power-off; write 1 to open the write lock: values written to EEPROM addresses do not persist

2.4 SRAM Feedback

Address (DEC) Address (HEX) Function Bytes Initial value Access Range Unit Description
56 0x38 Present position 2 – R – 0.0879° Absolute position feedback of the servo; BIT15 is the direction bit
58 0x3A Present speed 2 – R – 0.732RPM Rotational speed of the motor; BIT15 is the direction bit
60 0x3C Present load 2 – R – 0.1% Duty cycle of the output driving the motor; BIT10 is the direction bit
62 0x3E Present voltage 1 – R – 0.1V Current working voltage of the servo
63 0x3F Present temperature 1 – R – °C Current internal working temperature of the servo
64 0x40 Async write flag 1 0 R – None Flag used with the async write instruction: set to 1 as soon as the async write instruction (0x04, unicast or broadcast) is accepted, cleared to 0 as soon as the execution instruction (0x05) is accepted; a direct write (0x03) does not change it; it is a RAM bit and clears at power-off.
65 0x41 Servo status 1 0 R – None A bit set to 1 indicates the corresponding error; see Special Byte Explanation for details
66 0x42 Moving flag 1 0 R – None BIT0: 1 while the servo is moving (above the moving speed threshold), 0 when stopped; BIT1: 1 while the servo is moving, 0 when the target is reached and the servo stops, stays 0 when no new goal position is written; the threshold is a factory-calibrated parameter, see address 80 in 2.5, per your model's data
67 0x43 Goal position 2 – R – 0.0879° Current goal position
69 0x45 Present current 2 – R – 6.5mA Motor phase current feedback; BIT15 is the current direction bit
71 0x47 Undefined 2 – R – –
73 0x49 Current offset 2 – R – – Current zero-point offset
75~76 0x4B~0x4C Undefined 2 – R – – Reserved

2.5 Factory Parameters

Address (DEC) Address (HEX) Function Bytes Initial value Access Range Unit Description
77 0x4D vFk(*10) 1 – R – – –
78 0x4E vKgI 1 – R – – –
79 0x4F pFk(*10) 1 – R – – –
80 0x50 Moving speed threshold 1 – R – – –
81 0x51 DTs(ms) 1 – R – – –
82 0x52 eFk(*10) 1 – R – – –
83 0x53 Vk(ms) 1 – R – – –
84 0x54 Maximum speed limit 1 – R – – –
85 0x55 Acceleration limit 1 – R – – –
86 0x56 Acceleration multiplier 1 – R – – –

3 Special Byte Explanation

3.1 Servo Phase

Bit (weight): Description

  • BIT0 (1): Servo phase (firmware version <= 3.41); magnetic encoder support (firmware version >= 3.44): (0: AS5600, 1: MT6701)
  • BIT1 (2): Current feedback direction phase; (0) forward, (1) reverse
  • BIT2 (4): Driver bridge direction phase; (0) forward, (1) reverse
  • BIT3 (8): Speed direction phase (firmware version <= 3.41)
  • BIT4 (16): Angle feedback mode; (0) single-turn angle feedback, (1) full-angle feedback
  • BIT5 (32): Driver bridge configuration, (0) independent H-bridge, (1) integrated H-bridge
  • BIT6 (64): PWM frequency, (0) 24kHz, (1) 16kHz
  • BIT7 (128): Position feedback direction phase, (0) forward, (1) reverse

Note

If multiple bits are set at the same time, the phase value is the sum of the bit values. Example: with an original phase value of 0, if the servo runs in reverse, the phase value is 128+4+2=134;

3.2 Servo Status

Servo status: 0 means normal, 1 means abnormal

Bit (weight): Description

  • BIT0 (1): Voltage status
  • BIT1 (2): Magnetic encoder status
  • BIT2 (4): Temperature status
  • BIT3 (8): Current status
  • BIT4 (16): -----
  • BIT5 (32): -----
  • BIT6 (64): -----
  • BIT7 (128): -----

Note

If multiple statuses occur at the same time, the status value is the sum of the bit values. Example: over-voltage/under-voltage together with servo overheating gives a status value of 4+1=5;

3.3 Unload Condition

Unload condition: 0 means off, 1 means on

Bit (weight): Description

  • BIT0 (1): Voltage protection
  • BIT1 (2): Magnetic encoder protection
  • BIT2 (4): Overheat protection
  • BIT3 (8): Overcurrent protection
  • BIT4 (16): -----
  • BIT5 (32): -----
  • BIT6 (64): -----
  • BIT7 (128): -----

Note

If multiple bits are set at the same time, the unload condition value is the sum of the bit values. Example: with voltage protection and overheat protection enabled together, the unload condition value is 4+1=5;

3.4 LED Alarm Condition

Alarm condition: 0 means off, 1 means on

Bit (weight): Description

  • BIT0 (1): Voltage alarm
  • BIT1 (2): Magnetic encoder alarm
  • BIT2 (4): Overheat alarm
  • BIT3 (8): Overcurrent alarm
  • BIT4 (16): -----
  • BIT5 (32): -----
  • BIT6 (64): -----
  • BIT7 (128): -----

Note

If multiple bits are set at the same time, the alarm condition value is the sum of the bit values. Example: with the voltage alarm and the overheat alarm enabled together, the alarm condition value is 4+1=5;

Do not reuse addresses across families

Other series may use the same address with a different meaning (for example, SMS addresses 44–45 are PWM open-loop speed, not the goal current of this table). Return to Bus Protocol and select the matching memory table.

4 Common Workflows

Once the connection is up, day-to-day work on the servo comes down to reading and writing a handful of registers. This section collects the common ones by task; how to build the instruction frames is out of scope here — see FT-SCS Protocol. All numbers below refer to the addresses in this table.

4.0 Before You Start

  • EEPROM area (2.2, 5~39): write 40 Torque switch = 0 to cut the torque output first, then write 55 Lock flag = 0, and set the lock back to 1 when done. Measured: with the torque enabled a write is still accepted and takes effect immediately, but it does not survive power-off (the same holds with the lock flag at 0) — re-enable the torque afterwards if you need it.
  • SRAM area (2.3, 40~55): write directly, effective immediately, lost at power-off — good for trial writes; 55 Lock flag itself lives here, so writing it needs no unlock.
  • 56~76 in 2.4 and 77~86 in 2.5 are read-only; reading them does not change the servo state.
  • Position registers in this series count in "minimum resolution angle": by default (angle resolution in 30 = 1) a full turn is 4096 counts and each count is 0.0879° (360° ÷ 4096) — that is the "count" used below; with 30 set to K one count becomes K × 0.0879°.

4.1 Getting the Servo Moving

Goal: turn the output shaft through a small angle for the first time.

Step Action Register Value / example
1 Read the present position, mask BIT15 (direction), call it P 56 Present position read-only, e.g. 2048
2 Drop the torque limit to 30% 48 Torque limit 300 (power-on default comes from 16 = 980)
3 Set the running speed 46 Running speed 100 (100 × 0.732 RPM ≈ 73 RPM)
4 Turn the torque output on (can be skipped) 40 Torque switch 1
5 Write the goal position 42 Goal position P + 200 (about 17.6°)

Turning by angle

42 Goal position takes an absolute position, so "turn 90°" first needs a reference point. One count is 0.0879°, and 90° is exactly 1024 counts.

Desired result How to work it out Worked example
Turn another 90° from the present position (recommended) read 56 Present position as P (mask BIT15), goal = P ± (90° ÷ 0.0879°) P ± 1024
Turn 90° from the start of the travel goal = 90° ÷ 0.0879° 1024
  • Try P + 1024 first; if it turns the wrong way, use P − 1024. Which side adds depends on how the horn is mounted.
  • If the result is negative, write its absolute value and set BIT15 (direction bit) in 42 Goal position.
  • The goal must stay within 9 Minimum angle limit / 11 Maximum angle limit (see 4.3).

Notes:

  • 48 Torque limit is in SRAM: effective immediately, lost at power-off, and re-loaded from 16 Maximum torque at power-on, so 48 is the easy one to change for a trial; use 16 only when the value must persist (EEPROM, so turn the torque off and unlock first, see 4.0).
  • The unit of 46 Running speed is always 0.732 RPM (this table has no second, finer unit), and 0 means stop, not "highest speed"; BIT15 is the speed direction bit and only matters in constant-speed mode (33 Operating mode = 1).
  • 40 Torque switch takes only 0, 1 and 2 (2 is damping output); this series has no 128 midpoint calibration — calibration goes through the protocol command 0x0B, see 4.2.
  • Writing 42 Goal position directly sets 40 Torque switch to 1 automatically, so step 4 can be skipped.

Check: while moving, both BIT0 and BIT1 of 66 Moving flag are 1 and return to 0 once the servo stops on target; 56 Present position (mask BIT15) should then equal the magnitude of the goal (or the boundary value if clamped by the travel range).

4.2 Midpoint Calibration

Goal: make goal position 2048 correspond to the pose in which the horn is mounted square. The magnetic encoder zero is fixed to the factory shaft angle, and mounting a horn usually introduces an offset — this step puts the zero back where it belongs.

Registers: none — this series uses the protocol position calibration command (0x0B) instead of a register; the firmware computes the result and writes it into 31 Position offset.

Steps:

  • First turn the output shaft by hand to the pose in which the horn should sit square (you can take the horn off, calibrate, then refit it).
  • Send the position calibration command: with no parameter it calibrates the present position to the midpoint (2048); with a 2-byte parameter (low byte first) it calibrates to that value — for example 00 04 calibrates to 1024.

Notes:

  • The position calibration command requires firmware ≥ 3.43; 40 Torque switch accepts only 0, 1 and 2.
  • The shaft should be unloaded and still during calibration; every execution turns "wherever it is now" into the target value, so repeating it accumulates offset.
  • After calibration the whole 0~4095 zero point shifts: position readings taken before are invalid. If the travel limits are still the factory 0 / 4095 (full turn), they still cover a full turn after the shift and need no change; if you set a custom range, the values in 9 Minimum angle limit / 11 Maximum angle limit now refer to the shifted physical angle and must be set again against the new zero (see 4.3).
  • After a power cycle, read 56 Present position again to confirm the calibration held; 31 Position offset is computed by the firmware during calibration and written for you (EEPROM, so it persists) — no need to edit it by hand.

Check: after the command, 56 Present position should read 2048 (or the value given in the command); then write 42 Goal position to the same value and the shaft should not move at all.

4.3 Setting the Travel Range

Goal: limit how far the output shaft may turn.

Registers: 9 Minimum angle limit and 11 Maximum angle limit, in minimum resolution angle (0.0879°); both are in the EEPROM area, so unlock 55 Lock flag before writing.

Steps:

  • Convert the boundaries you want into counts (angle ÷ 0.0879°, see "Turning by angle" in 4.1).
  • Write 9 and 11; 9 must be smaller than 11; turn 40 Torque switch off first, write 55 Lock flag = 0 to unlock (why, see 4.0), and set the lock back to 1 afterwards.

Notes:

  • Factory defaults are 9 = 0 and 11 = 4095, i.e. a full turn.
  • Setting both 9 and 11 to 0 enters multi-turn absolute position control, which is no longer bound to a single turn — an advanced use; to return to normal mode, write both limits again.
  • The limits only constrain goal position commands; an external force can still push the shaft past them.

Check: first set 11 Maximum angle limit to 2048 (EEPROM, so unlock first), then write 42 Goal position = 3000; the shaft should stop at 2048 counts and go no further.

4.4 Changing the ID

Goal: change the bus address of the servo; do this before building a multi-servo bus. Besides the main ID this series also has a secondary ID, so two address sets can be used at the same time.

Registers: 5 Main ID, 7 Secondary ID, 55 Lock flag.

Pitfalls:

  • Only write it when this is the only servo on the bus; with several servos, power them one at a time.
  • Writing through the broadcast address changes every servo on the bus at once.
  • ID range 0~253; never duplicate an ID on the same bus, and do not let the main ID and the secondary ID collide either.
  • After a successful write the servo answers on the new ID at once and no longer answers on the old one; the re-lock and any PING afterwards must use the new ID in the ID byte (no need to reopen the port) — sending with the old ID only times out.
  • The secondary ID only applies to write, async write (0x04), async write execution (0x05) and sync-write instructions; read and PING are not included and still answer on the main ID.
  • The table notes that "writing to the main ID also updates the secondary ID", so after changing the main ID, read 7 back to confirm the secondary ID.

Steps: confirm this is the only servo on the bus → write 55 = 0 → write 5 = new ID (and 7 = secondary ID if needed) → using the new ID write 55 = 1.

Check: a PING with the new ID (or a read of 5) should answer, and the old ID should not; then read 7 to confirm the secondary ID is what you expect. For the broadcast method see FT-SCS Protocol.

4.5 Changing the Baud Rate

Goal: change the communication baud rate to match the host. Factory default is 1 Mbps (gear 0).

Registers: 6 Baud rate, 55 Lock flag.

Pitfalls:

  • What you write is the gear number 0~7, not the baud rate itself (0=1000000, 1=500000, 2=250000 … full mapping in row 6 of the 2.2 table).
  • The current connection drops the moment the write succeeds: the servo switches to the new gear at once and stops answering on the old rate, so reconnect at the new rate (change the rate and reopen the port in your serial tool, or reinitialise the UART on the host) before sending anything else — the re-lock included; with a wrong gear you can only retry gear by gear or restore the factory default.
  • The host and every servo on the bus must use the same gear; a mixed bus does not communicate.

Steps: unlock as described in 4.0 Before You Start → write 6 = new gear (the connection drops here) → reconnect at the new rate → write 55 = 1.

Check: reconnect at the new rate and send a PING; an answer is all you need. For lost connections see Troubleshooting.

4.6 Configuring Protection

Goal: set temperature, voltage, current and current limiting so a stall or an overcurrent does not damage the servo.

Registers:

Role Register Notes
Temperature threshold 13 Maximum temperature limit °C, default 70; crossing it sets BIT2 of 65
Voltage threshold 14 Maximum input voltage / 15 Minimum input voltage 0.1 V; 15 defaults to 40, i.e. 4.0 V (set for low-voltage models; raise it for higher-voltage models)
Current threshold 28 Protection current / 38 Overcurrent protection time 28 is 6.5 mA per count, range 0~2047; 38 is 10 ms per count (default 200 = 2 s)
Current limiting 44 Goal current current ceiling for every mode except mode 3, effective immediately as it is in SRAM; loaded from 28 at power-on
Whether to unload the output 19 Unload condition bit-wise enable of voltage, magnetic encoder, overheat and overcurrent, with bit definitions in 3.3 Unload Condition
Whether to flash the LED 20 LED alarm condition a separate channel; it flashes only on models with an LED, bit definitions in 3.4 LED Alarm Condition

The thresholds and switches above are in the EEPROM area (2.2) and the SRAM area (2.3); changing an EEPROM item means unlocking 55 Lock flag first.

Key points:

  • All three of temperature, voltage and current need both conditions to fire: the matching bit of 19 Unload condition set to 1 (that item enabled) plus the measured value crossing the threshold in 13~15 or 28 → that protection acts (unloads the output); with the bit at 0 it never acts.
  • Overload protection works through current limiting: 28 / 44 set the current ceiling and 38 sets the overcurrent protection time.
  • 28 Protection current is in EEPROM and is loaded into 44 Goal current at power-on: to make a new current ceiling apply right away, change 44 (SRAM); to keep it across power-off, change 28; writing 0 to 28 means 44 becomes 0 at power-on and the motor will not drive at all.
  • 65 Servo status reflects the detection layer: the bit is set as soon as the threshold is crossed, whether or not 19 is enabled; 20 LED alarm condition is another independent channel — an alarm on 20 never substitutes for unloading on 19.
  • BIT1 (magnetic encoder protection) of 19 has no threshold register: it fires when the sensor itself reports an error.
  • 13~15 and 28 are thresholds, not switches: writing 0 to one of them does not disable that protection.

Check: confirm the matching bit of 19 is set to 1, then cross a threshold on purpose (or stall the servo) and read 65: the matching bit turns 1 and the output follows the protection; both return to 0 once the condition clears.

4.7 Reading Status to Troubleshoot

Goal: locate a problem with read-only registers when the servo misbehaves.

Registers: 56 Present position, 58 Present speed, 60 Present load, 62 Present voltage, 63 Present temperature, 65 Servo status, 66 Moving flag, 67 Goal position, 69 Present current; all read-only, reading them at will does not affect the servo.

Order to check:

  • Read 65 Servo status: if it is not 0, decode it bit by bit with 3.2 Servo Status (1 = voltage, 2 = magnetic encoder, 4 = temperature, 8 = current; BIT4 and above are undefined on this series).
  • Read 62 Present voltage / 63 Present temperature: compare them with the thresholds set in 13~15.
  • Read 69 Present current: mask BIT15 (current direction bit), multiply by 6.5 mA and see how close it is to the threshold in 28 Protection current.
  • Read 60 Present load: mask BIT10 (direction bit) first, then scale 0~1000; a value close to 100% for a long time means a stall or too little torque.
  • Read 56 / 67 / 66: compare the present position with the goal position to see whether the command was executed; mask BIT15 (direction) in both 56 and 58; BIT0 of 66 means the speed is above the moving speed threshold, BIT1 means the servo is still moving and has not reached the target.

Source Definition