Wiki source code of LSS - Communication Protocol

Version 93.1 by Coleman Benson on 2019/01/31 15:51

Show last authors
1 (% class="wikigeneratedid" id="HTableofContents" %)
2 **Table of Contents**
3
4 {{toc depth="3"/}}
5
6 = Serial Protocol Concept =
7
8 The Lynxmotion Smart Servo (LSS) serial protocol was created in order to be as simple and straightforward as possible from a user perspective ("human readable"), while at the same time trying to be compact and robust yet highly versatile. The protocol was based on Lynxmotion's SSC-32 RC servo controller and almost everything one might expect to be able to configure for a smart servo motor is available.
9
10 In serial mode, in order to have servos react differently when commands are sent to all servos in a bus, the first step a user should take is to assign a different ID number to each servo (explained below). Once this has been done, only the servo(s) which have been assigned to the ID sent as part of the command will take action. There is currently no CRC / checksum implemented as part of the protocol.
11
12 == Session ==
13
14 A "session" is defined as the time between when the servo is powered ON to when it is powered OFF or reset.
15
16 == Action Commands ==
17
18 Action commands tell the servo, within that session, to do something (i.e. "take an action"). The type of action commands which can be sent are described below, and they cannot be combined with other commands such as queries or configurations. Only one action command can be sent at a time. Action commands are session-specific, therefore once a servo is power cycled, it will not have any "memory" of previous actions or virtual positions (as described at the bottom of this page). Action commands are sent serially to the servo's Rx pin and must be set in the following format:
19
20 1. Start with a number sign # (U+0023)
21 1. Servo ID number as an integer
22 1. Action command (one to three letters, no spaces, capital or lower case)
23 1. Action value in the correct units with no decimal
24 1. End with a control / carriage return '<cr>'
25
26 (((
27 Ex: #5PD1443<cr>
28
29 This sends a serial command to all servo's Rx pins which are connected to the bus and only servo(s) with ID #5 will move to a position of 144.3 degrees. Any servo in the bus which does not have ID 5 will take no action when they receive this command.
30
31 == Action Modifiers ==
32
33 Only two commands can be used as action modifiers: Timed Move (T) and Speed (S). Action modifiers can only be used with certain action commands. The format to include a modifier is:
34
35 1. Start with a number sign # (U+0023)
36 1. Servo ID number as an integer
37 1. Action command (one to three letters, no spaces, capital or lower case)
38 1. Action value in the correct units with no decimal
39 1. Modifier command (one letter)
40 1. Modifier value in the correct units with no decimal
41 1. End with a control / carriage return '<cr>'
42
43 Ex: #5P1456T1263<cr>
44
45 This results in the servo with ID #5 rotating from the current angular position to a pulse position of 1456 in 1263 milliseconds. Position in pulses is described below.
46 )))
47
48 == Configuration Commands ==
49
50 Configuration commands affect a servo's default values which are written to the servo's EEPROM and are retained in memory after the servo loses power or is reset. Some configuration commands affect the session, while others do not (see each command for details). Not all action commands have a corresponding configuration and vice versa. More information about which configuration commands are retained in RC mode can be found on the [[LSS - RC PWM page>>doc:Lynxmotion Smart Servo (LSS).LSS - RC PWM.WebHome]]. Configuration commands are not cumulative, in that if two configurations are sent, one after the next, only the last configuration is used and stored. The format to send a configuration command is identical to that of an action command:
51
52 1. Start with a number sign # (U+0023)
53 1. Servo ID number as an integer
54 1. Configuration command (two to three letters, no spaces, capital or lower case)
55 1. Configuration value in the correct units with no decimal
56 1. End with a control / carriage return '<cr>'
57
58 Ex: #5CO-50<cr>
59
60 This assigns an absolute origin offset of -5.0 degrees (with respect to factory origin) to servo with ID #5 and changes the offset for that session to -5.0 degrees. Once the servo is powered off and then powered on, zeroing the servo will cause it to move to -5.0 degrees with respect to the factory origin. Configuration commands can be undone / reset either by sending the servo's default value for that configuration, or by doing a factory reset (clears all configurations) described below.
61
62 == Query Commands ==
63
64 Query commands request information from the servo. They are received via the Rx pin of the servo, and the servo's reply is sent via the servo's Tx pin. This is called "full duplex". Query commands are also similar to action and configuration commands and must use the following format:
65
66 1. Start with a number sign # (U+0023)
67 1. Servo ID number as an integer
68 1. Query command (one to three letters, no spaces, capital or lower case)
69 1. End with a control / carriage return '<cr>'
70
71 (((
72 Ex: #5QD<cr>Query position in degrees for servo #5
73 )))
74
75 (((
76 The query will return a serial string (almost instantaneously) via the servo's Tx pin with the following format:
77
78 1. Start with an asterisk * (U+002A)
79 1. Servo ID number as an integer
80 1. Query command (one to three letters, no spaces, capital letters)
81 1. The reported value in the units described, no decimals.
82 1. End with a control / carriage return '<cr>'
83
84 There is currently no option to control how fast a servo replies after it has received a query command, therefore when sending a query command to the bus, the controller should be prepared to immediately "listen" for and parse the reply. Sending multiple queries on a bus in fast succession may result in replies overlapping and giving incorrect or corrupt data. As such, the controller should receive a reply before sending a new command.
85
86 (((
87 Ex: *5QD1443<cr>
88 )))
89
90 This reply to the query above indicates that servo #5 is currently at 144.3 degrees (1443 tenths of degrees).
91
92 **Session vs Configuration Query**
93
94 By default, the query command returns the sessions' value. Should no action commands have been sent to change the session value, it will return the value saved in EEPROM from the last configuration command.
95
96 In order to query the value in EEPROM (configuration), add a '1' to the query command.
97
98 Ex: #5CSR20<cr> immediately sets the maximum speed for servo #5 to 20rpm (explained below) .
99
100 After RESET: #5SR4<cr> sets the session's speed to 4rpm.
101
102 #5QSR<cr> would return *5QSR4<cr> which represents the value for that session.
103
104 #5QSR1<cr> would return *5QSR20<cr> which represents the value in EEPROM
105
106 == Virtual Angular Position ==
107
108 A "virtual position" is a feature which allows for rotation beyond 360 degrees, permitting multiple rotations of the output horn, moving the center position and more. In virtual position mode, the "absolute position" would be the angle of the output shaft with respect to 360.0 degrees, and can be obtained by taking the modulus (with respect to 360 degrees) of the value. For example if the virtual position is reported as 15335 (or 1533.5 degrees), taking the modulus would give 93.5 degrees (3600 * 4 + 935 = 15335).
109
110 [[image:LSS-servo-positions.jpg]]
111
112 In this example, the gyre direction (explained below, a.k.a. rotation direction) is positive (clockwise), and origin offset has not been modified. Each square represents 30 degrees. The following command is sent:
113
114 #1D-300<cr> This causes the servo to move to -30.0 degrees (green arrow)
115
116 #1D2100<cr> This second position command is sent to the servo, which moves it to 210.0 degrees (orange arrow)
117
118 #1D-4200<cr> This next command rotates the servo counterclockwise to a position of -420 degrees (red arrow), which means one full rotation of 360 degrees,  stopping at an absolute position of 60.0 degrees (420.0 - 360.0), with a virtual position of -420.0 degrees.
119
120 Although the final physical position would be the same as if the servo were commanded to move to -60.0 degrees, the servo is in fact at -420.0 degrees.
121
122 #1D4800<cr> This new command is sent which would then cause the servo to rotate from -420.0 degrees to 480.0 degrees (blue arrow), which would be a total of 900 degrees of clockwise rotation, or 2.5 complete rotations.
123
124 #1D3300<cr> would cause the servo to rotate from 480.0 degrees to 330.0 degrees (yellow arrow).
125
126 If / once the servo loses power or is power cycled, it also loses the virtual position associated with that session. For example, if the virtual position was 480.0 degrees before power is cycled, upon power up the servo's position will be read as +120.0 degrees from zero (assuming center position has not been modified).
127 )))
128
129 = Command List =
130
131 |= #|=Description|= Action|= Query|= Config|= RC|= Serial|= Units|=(% style="width: 510px;" %) Notes|=(% style="width: 113px;" %)Default Value
132 | 1|[[**L**imp>>||anchor="H1.Limp28L29"]]| L| | | | ✓|none|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
133 | 2|[[**H**alt & **H**old>>||anchor="H2.Halt26Hold28H29"]]| H| | | | ✓|none|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
134 | 3|[[**T**imed move>>||anchor="H3.Timedmove28T29"]]| T| | | | ✓|milliseconds|(% style="width:510px" %) Modifier only for {P, D, MD}|(% style="text-align:center; width:113px" %)
135 | 4|[[**S**peed>>||anchor="H4.Speed28S29"]]| S| | | | ✓|microseconds / second|(% style="width:510px" %) Modifier only {P}|(% style="text-align:center; width:113px" %)
136 | 5|[[**M**ove in **D**egrees (relative)>>||anchor="H5.28Relative29MoveinDegrees28MD29"]]| MD| | | | ✓|tenths of degrees (ex 325 = 32.5 degrees; 91 = 9.1 degrees)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
137 | 6|[[**O**rigin Offset>>||anchor="H6.OriginOffsetAction28O29"]]| O| QO| CO| ✓| ✓|tenths of degrees (ex 325 = 32.5 degrees; 91 = 9.1 degrees)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)(((
138 0
139 )))
140 | 7|[[**A**ngular **R**ange>>||anchor="H7.AngularRange28AR29"]]| AR| QAR| CAR| ✓| ✓|tenths of degrees (ex 325 = 32.5 degrees; 91 = 9.1 degrees)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)(((
141 1800
142 )))
143 | 8|[[Position in **P**ulse>>||anchor="H8.PositioninPulse28P29"]]| P| QP| | | ✓|microseconds|(% style="width:510px" %)(((
144 Inherited from SSC-32 serial protocol
145 )))|(% style="text-align:center; width:113px" %)
146 | 9|[[Position in **D**egrees>>||anchor="H9.PositioninDegrees28D29"]]| D| QD| | | ✓|tenths of degrees (ex 325 = 32.5 degrees; 91 = 9.1 degrees)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
147 | 10|[[**W**heel mode in **D**egrees>>||anchor="H10.WheelModeinDegrees28WD29"]]| WD| QWD| | | ✓|tenths of degrees per second (ex 248 = 24.8 degrees per second)|(% style="width:510px" %)A.K.A. "Speed mode" or "Continuous rotation"|(% style="text-align:center; width:113px" %)
148 | 11|[[**W**heel mode in **R**PM>>||anchor="H11.WheelModeinRPM28WR29"]]| WR| QWR| | | ✓| rpm|(% style="width:510px" %)A.K.A. "Speed mode" or "Continuous rotation"|(% style="text-align:center; width:113px" %)
149 | 12|[[Max **S**peed in **D**egrees>>||anchor="H12.SpeedinDegrees28SD29"]]| SD| QSD|CSD| ✓| ✓|tenths of degrees per second (ex 248 = 24.8 degrees per second)|(% style="width:510px" %)QSD: Add modifier "2" for instantaneous speed|(% style="text-align:center; width:113px" %)Max per servo
150 | 13|[[Max **S**peed in **R**PM>>||anchor="H13.SpeedinRPM28SR29"]]| SR| QSR|CSR| ✓| ✓|rpm|(% style="width:510px" %)QSR: Add modifier "2" for instantaneous speed|(% style="text-align:center; width:113px" %)Max per servo
151 | 16|[[**LED** Color>>||anchor="H16.RGBLED28LED29"]]| LED| QLED| CLED| ✓| ✓|none (integer from 0 to 8)|(% style="width:510px" %)0=Off (black); 1=Red 2=Green; 3=Blue; 4=Yellow; 5=Cyan; 6=Magenta; 7=White;|(% style="text-align:center; width:113px" %)7
152 | 17|[[**ID** #>>||anchor="H17.IdentificationNumber"]]| | QID| CID| | ✓|none (integer from 0 to 250)|(% style="width:510px" %)Note: ID 254 is a "broadcast" which all servos respond to|(% style="text-align:center; width:113px" %)0
153 | 18|[[**B**aud rate>>||anchor="H18.BaudRate"]]| B| QB| CB| | ✓|none (integer)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)9600
154 | 19|[[**G**yre direction (**G**)>>||anchor="H19.GyreRotationDirection"]]| G| QG| CG| ✓| ✓|none |(% style="width:510px" %) Gyre / rotation direction where 1= CW (clockwise) -1 = CCW (counter-clockwise)|(% style="text-align:center; width:113px" %)1 CW
155 | 20|[[**F**irst Position (**P**ulse)>>||anchor="H20.First2InitialPosition28pulse29"]]| | QFP|CFP | ✓| ✓|none |(% style="width:510px" %) |(% style="text-align:center; width:113px" %)(((
156 Limp
157 )))
158 | 21|[[**F**irst Position (**D**egrees)>>||anchor="H21.First2InitialPosition28Degrees29"]]| | QFD|CFD| ✓| ✓|none |(% style="width:510px" %) |(% style="text-align:center; width:113px" %)Limp
159 | 22|[[**T**arget (**D**egree) **P**osition>>||anchor="H22.QueryTargetPositioninDegrees28QDT29"]]| | QDT| | | ✓|tenths of degrees (ex 325 = 32.5 degrees; 91 = 9.1 degrees)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
160 | 23|[[**M**odel **S**tring>>||anchor="H23.QueryModelString28QMS29"]]| | QMS| | | |none (string)|(% style="width:510px" %) Recommended to determine the model|(% style="text-align:center; width:113px" %)
161 | 23b|[[**M**odel>>||anchor="H23b.QueryModel28QM29"]]| | QM| | | |none (integer)|(% style="width:510px" %) Returns a raw value representing the three model inputs (36 bit)|(% style="text-align:center; width:113px" %)
162 | 24|[[Serial **N**umber>>||anchor="H24.QuerySerialNumber28QN29"]]| | QN| | | |none (integer)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
163 | 25|[[**F**irmware version>>||anchor="H25.QueryFirmware28QF29"]]| | QF| | | |none (integer)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
164 | 26|[[**Q**uery (general status)>>||anchor="H26.QueryStatus28Q29"]]| | Q| | | ✓|none (integer from 1 to 8)|(% style="width:510px" %) See command description for details|(% style="text-align:center; width:113px" %)
165 | 27|[[**V**oltage>>||anchor="H27.QueryVoltage28QV29"]]| | QV| | | ✓|millivolts (ex 5936 = 5936mV = 5.936V)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
166 | 28|[[**T**emperature>>||anchor="H28.QueryTemperature28QT29"]]| | QT| | | ✓|tenths of degrees Celsius|(% style="width:510px" %)Max temp before error: 85°C (servo goes limp)|(% style="text-align:center; width:113px" %)
167 | 29|[[**C**urrent>>||anchor="H29.QueryCurrent28QC29"]]| | QC| | | ✓|milliamps (ex 200 = 0.2A)|(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
168 | 30|[[**RC** Mode>>||anchor="H30.RCMode28CRC29"]]| | |CRC| |✓|none|(% style="width:510px" %)(((
169 CRC: Add modifier "1" for RC-position mode.
170 CRC: Add modifier "2" for RC-wheel mode.
171 Any other value for the modifier results in staying in smart mode.
172 Puts the servo into RC mode. To revert to smart mode, use the button menu.
173 )))|(% style="text-align:center; width:113px" %)Serial
174 |31|[[**RESET**>>||anchor="H31.RESET"]]| | | | | ✓|none|(% style="width:510px" %)Soft reset. See command for details.|(% style="text-align:center; width:113px" %)
175 |32|[[**DEFAULT**>>||anchor="H32.DEFAULTA026CONFIRM"]]| | | | |✓|none|(% style="width:510px" %)Revert to firmware default values. See command for details|(% style="text-align:center; width:113px" %)
176 |33|[[**UPDATE**>>||anchor="H33.UPDATEA026CONFIRM"]]| | | | |✓|none|(% style="width:510px" %)Update firmware. See command for details.|(% style="text-align:center; width:113px" %)
177
178 (% class="wikigeneratedid" %)
179 == Advanced ==
180
181 |= #|=Description|= Action|= Query|= Config|= RC|= Serial|= Units|=(% style="width: 510px;" %) Notes|=(% style="width: 113px;" %)Default Value
182 | 1|[[**A**ngular **S**tiffness>>||anchor="H14.AngularStiffness28AS29"]]| AS| QAS|CAS| ✓| ✓|none|(% style="width:510px" %)-4 to +4, but suggested values are between 0 to +4|(% style="text-align:center; width:113px" %)0
183 | 2|[[**A**ngular **H**olding Stiffness>>||anchor="H15.AngularHoldStiffness28AH29"]]|AH|QAH|CAH| | ✓|none|(% style="width:510px" %)-10 to +10, with default as 0. |(% style="text-align:center; width:113px" %)1
184 | 3|[[**A**ngular **A**cceleration>>||anchor="H15b:AngularAcceleration28AA29"]]|AA|QAA|CAA| | ✓|degrees per second squared|(% style="width:510px" %)Increments of 10 degrees per second squared|(% style="text-align:center; width:113px" %)
185 | 4|[[**A**ngular **D**eceleration>>||anchor="H15c:AngularDeceleration28AD29"]]|AD|QAD|CAD| | ✓|degrees per second squared|(% style="width:510px" %)Increments of 10 degrees per second squared|(% style="text-align:center; width:113px" %)
186 | 5|[[**E**nable **M**otion control>>||anchor="H15d:MotionControl28MC29"]]|EM|QEM| | | ✓|none|(% style="width:510px" %)EM0 to disable motion control, EM1 to enable. Session specific / does not survive power cycles|(% style="text-align:center; width:113px" %)
187 | 6|[[**C**onfigure **L**ED **B**linking>>||anchor="H16b.ConfigureLEDBlinking28CLB29"]]| | | CLB| ✓| |none (integer from 0 to 63)|(% style="width:510px" %)0=No blinking, ; 63=Always blink; Blink while: 1=Limp; 2=Holding 4=Accel; 8=Decel; 16=Free 32=Travel;|(% style="text-align:center; width:113px" %)
188 | | | | | | | | |(% style="width:510px" %) |(% style="text-align:center; width:113px" %)
189
190 == Details ==
191
192 ====== __1. Limp (**L**)__ ======
193
194 Example: #5L<cr>
195
196 This action causes the servo to go "limp". The microcontroller will still be powered, but the motor will not. As an emergency safety feature, should the robot not be doing what it is supposed to or risks damage, use the broadcast ID to set all servos limp #254L<cr>.
197
198 ====== __2. Halt & Hold (**H**)__ ======
199
200 Example: #5H<cr>
201
202 This action overrides whatever the servo might be doing at the time the command is received (accelerating, moving continuously etc.) and causes it to stop immediately and hold that position.
203
204 ====== __3. Timed move (**T**)__ ======
205
206 Example: #5P1500T2500<cr>
207
208 Timed move can be used only as a modifier for a position (P) action. The units are in milliseconds, so a timed move of 2500 milliseconds would cause the servo to rotate from its current position to the desired position in 2.5 seconds. This command is in place to ensure backwards compatibility with the SSC-32 / 32U protocol.
209
210 Note: If the calculated speed at which a servo must rotate for a timed move is greater than its maximum speed (which depends on voltage and load), then it will move at its maximum speed, and the time of the move may be longer than requested.
211
212 ====== __4. Speed (**S**)__ ======
213
214 Example: #5P1500S750<cr>
215
216 This command is a modifier only for a position (P) action and determines the speed of the move in microseconds per second. A speed of 750 microseconds would cause the servo to rotate from its current position to the desired position at a speed of 750 microseconds per second. This command is in place to ensure backwards compatibility with the SSC-32 / 32U protocol.
217
218 ====== __5. (Relative) Move in Degrees (**MD**)__ ======
219
220 Example: #5MD123<cr>
221
222 The relative move command causes the servo to read its current position and move the specified number of tenths of degrees in the corresponding position. For example if the servo is set to rotate CW (default) and an MD command of 123 is sent to the servo, it will cause the servo to rotate clockwise by 12.3 degrees. Negative commands would cause the servo to rotate in the opposite configured direction.
223
224 ====== __6. Origin Offset Action (**O**)__ ======
225
226 Example: #5O2400<cr>
227
228 This command allows you to temporarily change the origin of the servo in relation to the factory zero position. The setting will be lost upon servo reset / power cycle. Origin offset commands are not cumulative and always relate to factory zero. Note that for a given session, the O command overrides the CO command. In the first image, the origin at factory offset '0' (centered).
229
230 [[image:LSS-servo-default.jpg]]
231
232 In the second image, the origina, as well as the angular range (explained below) have been shifted by 240.0 degrees:
233
234 [[image:LSS-servo-origin.jpg]]
235
236 Origin Offset Query (**QO**)
237
238 Example: #5QO<cr> Returns: *5QO-13
239
240 This allows you to query the angle (in tenths of degrees) of the origin in relation to the factory zero position.
241
242 Configure Origin Offset (**CO**)
243
244 Example: #5CO-24<cr>
245
246 This command allows you to change the origin of the servo in relation to the factory zero position in EEPROM. The setting will be saved upon servo reset / power cycle. Origin offset configuration commands are not cumulative and always relate to factory zero. The new origin is also used in RC mode.
247
248 ====== __7. Angular Range (**AR**)__ ======
249
250 Example: #5AR1800<cr>
251
252 This command allows you to temporarily change the total angular range of the servo in tenths of degrees. This applies to the Position in Pulse (P) command and RC mode. The default for (P) and RC mode is 1800 (180.0 degrees total, or ±90.0 degrees). In the first image,
253
254 [[image:LSS-servo-default.jpg]]
255
256 Here, the angular range has been restricted to 180.0 degrees, or -90.0 to +90.0. The center has remained unchanged.
257
258 [[image:LSS-servo-ar.jpg]]
259
260 The angular range action command (ex. #5AR1800<cr>) and origin offset action command (ex. #5O-1200<cr>) an be used to move both the center and limit the angular range:
261
262 [[image:LSS-servo-ar-o-1.jpg]]
263
264 Query Angular Range (**QAR**)
265
266 Example: #5QAR<cr> might return *5AR2756
267
268 Configure Angular Range (**CAR**)
269
270 This command allows you to change the total angular range of the servo in tenths of degrees in EEPROM. The setting will be saved upon servo reset / power cycle.
271
272 ====== __8. Position in Pulse (**P**)__ ======
273
274 Example: #5P2334<cr>
275
276 The position in PWM pulses was retained in order to be backward compatible with the SSC-32 / 32U protocol. This relates the desired angle with an RC standard PWM pulse and is further explained in the SSC-32 and SSC-32U manuals found on Lynxmotion.com. Without any modifications to configuration considered, and a ±90.0 degrees standard range where 1500 microseconds is centered, a pulse of 2334 would set the servo to 165.1 degrees. Valid values for P are [500, 2500]. Values outside this range are corrected to end points.
277
278 Query Position in Pulse (**QP**)
279
280 Example: #5QP<cr> might return *5QP2334
281
282 This command queries the current angular position in PWM "units". The user must take into consideration that the response includes any angular range and origin configurations in order to determine the actual angle. 
283 Valid values for QP are {-500, [500, 2500], -2500}. Values outside the [500, 2500] range are given a negative corresponding end point value to indicate they are out of bounds (note that if the servo is physically located at one of the endpoints, it may return a negative number if it is a fraction of a degree beyond the position).
284
285 ====== __9. Position in Degrees (**D**)__ ======
286
287 Example: #5PD1456<cr>
288
289 This moves the servo to an angle of 145.6 degrees, where the center (0) position is centered. Negative values (ex. -176 representing -17.6 degrees) are used. A full circle would be from -1800 to 1800 degrees. A value of 2700 would be the same angle as -900, except the servo would move in a different direction.
290
291 Larger values are permitted and allow for multi-turn functionality using the concept of virtual position.
292
293 Query Position in Degrees (**QD**)
294
295 Example: #5QD<cr> might return *5QD132<cr>
296
297 This means the servo is located at 13.2 degrees.
298
299 ====== __10. Wheel Mode in Degrees (**WD**)__ ======
300
301 Ex: #5WD900<cr>
302
303 This command sets the servo to wheel mode where it will rotate in the desired direction at the selected speed. The example above would have the servo rotate at 90.0 degrees per second clockwise (assuming factory default configurations).
304
305 Query Wheel Mode in Degrees (**QWD**)
306
307 Ex: #5QWD<cr> might return *5QWD900<cr>
308
309 The servo replies with the angular speed in tenths of degrees per second. A negative sign would indicate the opposite direction (for factory default a negative value would be counter clockwise).
310
311 ====== __11. Wheel Mode in RPM (**WR**)__ ======
312
313 Ex: #5WR40<cr>
314
315 This command sets the servo to wheel mode where it will rotate in the desired direction at the selected rpm. Wheel mode (a.k.a. "continuous rotation") has the servo operate like a geared DC motor. The servo's maximum rpm cannot be set higher than its physical limit at a given voltage. The example above would have the servo rotate at 40 rpm clockwise (assuming factory default configurations).
316
317 Query Wheel Mode in RPM (**QWR**)
318
319 Ex: #5QWR<cr> might return *5QWR40<cr>
320
321 The servo replies with the angular speed in rpm. A negative sign would indicate the opposite direction (for factory default a negative value would be counter clockwise).
322
323 ====== __12. Speed in Degrees (**SD**)__ ======
324
325 Ex: #5SD1800<cr>
326
327 This command sets the servo's maximum speed for action commands in tenths of degrees per second for that session. In the example above, the servo's maximum speed for that session would be set to 180.0 degrees per second. Therefore maximum speed for actions can be set "on the fly". The servo's maximum speed cannot be set higher than its physical limit at a given voltage. SD overrides CSD (described below) for that session. Upon reset or power cycle, the servo reverts to the value associated with CSD as described below. Note that SD and SR (described below) are effectively the same, but allow the user to specify the speed in either unit. The last command (either SR or SD) is what the servo uses for that session.
328
329 Query Speed in Degrees (**QSD**)
330
331 Ex: #5QSD<cr> might return *5QSD1800<cr>
332
333 By default QSD will return the current session value, which is set to the value of CSD as reset/power cycle and changed whenever a SD/SR command is processed.
334 If #5QSD1<cr> is sent, the configured maximum speed (CSD value) will be returned instead. You can also query the current speed using "2" and the current target travel speed using "3". See the table below for an example:
335
336 |**Command sent**|**Returned value (1/10 °)**
337 |ex: #5QSD<cr>|Session value for maximum speed (set by latest SD/SR command)
338 |ex: #5QSD1<cr>|Configured maximum speed  (set by CSD/CSR)
339 |ex: #5QSD2<cr>|Instantaneous speed (same as QWD)
340 |ex: #5QSD3<cr>|Target travel speed
341
342 Configure Speed in Degrees (**CSD**)
343
344 Ex: #5CSD1800<cr>
345
346 Using the CSD command sets the servo's maximum speed which is saved in EEPROM. In the example above, the servo's maximum speed will be set to 180.0 degrees per second. When the servo is powered on (or after a reset), the CSD value is used. Note that CSD and CSR (described below) are effectively the same, but allow the user to specify the speed in either unit. The last command (either CSR or CSD) is what the servo uses for that session.
347
348 ====== __13. Speed in RPM (**SR**)__ ======
349
350 Ex: #5SD45<cr>
351
352 This command sets the servo's maximum speed for action commands in rpm for that session. In the example above, the servo's maximum speed for that session would be set to 45rpm. Therefore maximum speed for actions can be set "on the fly". The servo's maximum speed cannot be set higher than its physical limit at a given voltage. SD overrides CSD (described below) for that session. Upon reset or power cycle, the servo reverts to the value associated with CSD as described below. Note that SD (described above) and SR are effectively the same, but allow the user to specify the speed in either unit. The last command (either SR or SD) is what the servo uses for that session.
353
354 Query Speed in Degrees (**QSR**)
355
356 Ex: #5QSR<cr> might return *5QSR45<cr>
357
358 By default QSR will return the current session value, which is set to the value of CSR as reset/power cycle and changed whenever a SD/SR command is processed.
359 If #5QSR1<cr> is sent, the configured maximum speed (CSR value) will be returned instead. You can also query the current speed using "2" and the current target travel speed using "3". See the table below for an example:
360
361 |**Command sent**|**Returned value (1/10 °)**
362 |ex: #5QSR<cr>|Session value for maximum speed (set by latest SD/SR command)
363 |ex: #5QSR1<cr>|Configured maximum speed  (set by CSD/CSR)
364 |ex: #5QSR2<cr>|Instantaneous speed (same as QWR)
365 |ex: #5QSR3<cr>|Target travel speed
366
367 Configure Speed in RPM (**CSR**)
368
369 Ex: #5CSR45<cr>
370
371 Using the CSR command sets the servo's maximum speed which is saved in EEPROM. In the example above, the servo's maximum speed will be set to 45rpm. When the servo is powered on (or after a reset), the CSR value is used. Note that CSD and CSR are effectively the same, but allow the user to specify the speed in either unit. The last command (either CSR or CSD) is what the servo uses for that session.
372
373 ====== __14. Angular Stiffness (**AS**)__ ======
374
375 The servo's rigidity / angular stiffness can be thought of as (though not identical to) a damped spring in which the value affects the stiffness and embodies how much, and how quickly the servo tried keep the requested position against changes.
376
377 A positive value of "angular stiffness":
378
379 * The more torque will be applied to try to keep the desired position against external input / changes
380 * The faster the motor will reach its intended travel speed and the motor will decelerate faster and nearer to its target position
381
382 A negative value on the other hand:
383
384 * Causes a slower acceleration to the travel speed, and a slower deceleration
385 * Allows the target position to deviate more from its position before additional torque is applied to bring it back
386
387 The default value is zero and the effect becomes extreme by -4, +4. There are no units, only integers between -4 to 4. Greater values produce increasingly erratic behavior.
388
389 Ex: #5AS-2<cr>
390
391 This reduces the angular stiffness to -2 for that session, allowing the servo to deviate more around the desired position. This can be beneficial in many situations such as impacts (legged robots) where more of a "spring" effect is desired. Upon reset, the servo will use the value stored in memory, based on the last configuration command.
392
393 Ex: #5QAS<cr>
394
395 Queries the value being used.
396
397 Ex: #5CAS<cr>
398
399 Writes the desired angular stiffness value to memory.
400
401 ====== __15. Angular Hold Stiffness (**AH**)__ ======
402
403 The angular holding stiffness determines the servo's ability to hold a desired position under load. Values can be from -10 to 10, with the default being 0. Note that negative values mean the final position can be easily deflected.
404
405 Ex: #5AH3<cr>
406
407 This sets the holding stiffness for servo #5 to 3 for that session.
408
409 Query Angular Hold Stiffness (**QAH**)
410
411 Ex: #5QAH<cr> might return *5QAH3<cr>
412
413 This returns the servo's angular holding stiffness value.
414
415 Configure Angular Hold Stiffness (**CAH**)
416
417 Ex: #5CAH2<cr>
418
419 This writes the angular holding stiffness of servo #5 to 2 to EEPROM
420
421 ====== __15b: Angular Acceleration (**AA**)__ ======
422
423 {More details to come}
424
425 ====== __15c: Angular Deceleration (**AD**)__ ======
426
427 {More details to come}
428
429 ====== __15d: Motion Control (**EM**)__ ======
430
431 {More details to come}
432
433 ====== __16. RGB LED (**LED**)__ ======
434
435 Ex: #5LED3<cr>
436
437 This action sets the servo's RGB LED color for that session.The LED can be used for aesthetics, or (based on user code) to provide visual status updates. Using timing can create patterns.
438
439 0=OFF 1=RED 2=GREEN 3= BLUE 4=YELLOW 5=CYAN 6= 7=MAGENTA, 8=WHITE 
440
441 Query LED Color (**QLED**)
442
443 Ex: #5QLED<cr> might return *5QLED5<cr>
444
445 This simple query returns the indicated servo's LED color.
446
447 Configure LED Color (**CLED**)
448
449 Configuring the LED color via the CLED command sets the startup color of the servo after a reset or power cycle. Note that it also changes the session's LED color immediately as well.
450
451 ====== __16b. Configure LED Blinking (**CLB**)__ ======
452
453 This command allows you to control when the RGB LED will blink the user set color (see [[16. RGB LED>>||anchor="H16.RGBLED28LED29"]] for details).
454 You can turn on or off blinking for various LSS status. Here is the list and their associated value: 0=No blinking, ; 63=Always blink; Blink while: 1=Limp; 2=Holding 4=Accel; 8=Decel; 16=Free 32=Travel;
455
456 To set blinking, use CLB with the value of your choosing. To activate blinking in multiple status, simply add together the values of the corresponding status. See examples below:
457
458 Ex: #5CLB0<cr> to turn off all blinking (LED always solid)
459 Ex: #5CLB1<cr> only blink when limp
460 Ex: #5CLB2<cr> only blink when holding
461 Ex: #5CLB12<cr> only blink when accel or decel
462 Ex: #5CLB48<cr> only blink when free or travel
463 Ex: #5CLB63<cr> blink in all status
464
465 ====== __17. Identification Number__ ======
466
467 A servo's identification number cannot be set "on the fly" and must be configured via the CID command described below. The factory default ID number for all servos is 0. Since smart servos are intended to be daisy chained, in order to respond differently from one another, the user must set different identification numbers. Servos with the same ID and baud rate will all receive and react to the same commands.
468
469 Query Identification (**QID**)
470
471 EX: #254QID<cr> might return *QID5<cr>
472
473 When using the query ID command, it is best to only have one servo connected and thus receive only one reply using the broadcast command (ID 254). Alternatively, pushing the button upon startup and temporarily setting the servo ID to 255 will still result in the servo responding with its "real" ID.
474
475 Configure ID (**CID**)
476
477 Ex: #4CID5<cr>
478
479 Setting a servo's ID in EEPROM is done via the CID command. All servos connected to the same serial bus will be assigned that ID. In most situations each servo must be set a unique ID, which means each servo must be connected individually to the serial bus and receive a unique CID number. It is best to do this before the servos are added to an assembly. Numbered stickers are provided to distinguish each servo after their ID is set, though you are free to use whatever alternative method you like.
480
481 ====== __18. Baud Rate__ ======
482
483 A servo's baud rate cannot be set "on the fly" and must be configured via the CB command described below. The factory default baud rate for all servos is 9600. Since smart servos are intended to be daisy chained, in order to respond to the same serial bus, all servos in that project should ideally be set to the same baud rate. Setting different baud rates will have the servos respond differently and may create issues. Available baud rates are: 9.6 kbps, 19.2 kbps, 38.4 kbps, 57.6 kbps, 115.2 kbps, 230.4 kbps, 250.0 kbps, 460.8 kbps, 500.0 kbps, 750.0 kbps*, 921.6 kbps*. Servos are shipped with a baud rate set to 9600. The baud rates are currently restricted to those above.
484 \*: Current tests reveal baud rates above 500 kbps are unstable and can cause timeouts. Please keep this in mind if using those / testing them out.
485
486 Query Baud Rate (**QB**)
487
488 Ex: #5QB<cr> might return *5QB9600<cr>
489
490 Querying the baud rate is used simply to confirm the CB configuration command before the servo is power cycled.
491
492 Configure Baud Rate (**CB**)
493
494 Important Note: the servo's current session retains the given baud rate and the new baud rate will only be in place when the servo is power cycled.
495
496 Ex: #5CB9600<cr>
497
498 Sending this command will change the baud rate associated with servo ID 5 to 9600 bits per second.
499
500 ====== __19. Gyre Rotation Direction__ ======
501
502 "Gyre" is defined as a circular course or motion. The effect of changing the gyre direction is as if you were to use a mirror image of a circle. CW = 1; CCW = -1. The factory default is clockwise (CW).
503
504 {images showing before and after with AR and Origin offset}
505
506 Query Gyre Direction (**QG**)
507
508 Ex: #5QG<cr> might return *5QG-1<cr>
509
510 The value returned above means the servo is in a counter-clockwise gyration.
511
512 Configure Gyre (**CG**)
513
514 Ex: #5CG-1<cr>
515
516 This changes the gyre direction as described above and also writes to EEPROM.
517
518 ====== __20. First / Initial Position (pulse)__ ======
519
520 In certain cases, a user might want to have the servo move to a specific angle upon power up. We refer to this as "first position". The factory default has no first position value stored in EEPROM and therefore upon power up, the servo remains limp until a position (or hold command) is assigned. FP and FD are different in that FP is used for RC mode only, whereas FD is used for smart mode only.
521
522 Query First Position in Pulses (**QFP**)
523
524 Ex: #5QFP<cr> might return *5QFP1550<cr>
525
526 The reply above indicates that servo with ID 5 has a first position pulse of 1550 microseconds. If no first position has been set, servo will respond with DIS ("disabled").
527
528 Configure First Position in Pulses (**CFP**)
529
530 Ex: #5CP1550<cr>
531
532 This configuration command means the servo, when set to RC mode, will immediately move to an angle equivalent to having received an RC pulse of 1550 microseconds upon power up. Sending a CFP command without a number results in the servo remaining limp upon power up (i.e. disabled).
533
534 ====== __21. First / Initial Position (Degrees)__ ======
535
536 In certain cases, a user might want to have the servo move to a specific angle upon power up. We refer to this as "first position". The factory default has no first position value stored in EEPROM and therefore upon power up, the servo remains limp until a position (or hold command) is assigned. FP and FD are different in that FP is used for RC mode only, whereas FD is used for smart mode only.
537
538 Query First Position in Degrees (**QFD**)
539
540 Ex: #5QFD<cr> might return *5QFD64<cr>
541
542 The reply above indicates that servo with ID 5 has a first position pulse of 1550 microseconds.
543
544 Configure First Position in Degrees (**CFD**)
545
546 Ex: #5CD64<cr>
547
548 This configuration command means the servo, when set to smart mode, will immediately move to 6.4 degrees upon power up. Sending a CFD command without a number results in the servo remaining limp upon power up.
549
550 ====== __22. Query Target Position in Degrees (**QDT**)__ ======
551
552 Ex: #5QDT<cr> might return *5QDT6783<cr>
553
554 The query target position command returns the target angle during and after an action which results in a rotation of the servo horn. In the example above, the servo is rotating to a virtual position of 678.3 degrees. Should the servo not have a target position or be in wheel mode, it will respond without a number (Ex: *5QDT<cr>).
555
556 ====== __23. Query Model String (**QMS**)__ ======
557
558 Ex: #5QMS<cr> might return *5QMSLSS-HS1cr>
559
560 This reply means the servo model is LSS-HS1, meaning a high speed servo, first revision.
561
562 ====== __23b. Query Model (**QM**)__ ======
563
564 Ex: #5QM<cr> might return *5QM68702699520cr>
565
566 This reply means the servo model is 0xFFF000000 or 100, meaning a high speed servo, first revision.
567
568 ====== __24. Query Serial Number (**QN**)__ ======
569
570 Ex: #5QN<cr> might return *5QN~_~_<cr>
571
572 The number in the response is the servo's serial number which is set and cannot be changed.
573
574 ====== __25. Query Firmware (**QF**)__ ======
575
576 Ex: #5QF<cr> might return *5QF11<cr>
577
578 The integer in the reply represents the firmware version with one decimal, in this example being 1.1
579
580 ====== __26. Query Status (**Q**)__ ======
581
582 Ex: #5Q<cr> might return *5Q6<cr>, which indicates the motor is holding a position.
583
584 |*Value returned|**Status**|**Detailed description**
585 |ex: *5Q0<cr>|Unknown|LSS is unsure
586 |ex: *5Q1<cr>|Limp|Motor driving circuit is not powered and horn can be moved freely
587 |ex: *5Q2<cr>|Free moving|Motor driving circuit is not powered and horn can be moved freely
588 |ex: *5Q3<cr>|Accelerating|Increasing speed from rest (or previous speeD) towards travel speed
589 |ex: *5Q4<cr>|Traveling|Moving at a stable speed
590 |ex: *5Q5<cr>|Decelerating|Decreasing from travel speed towards final position.
591 |ex: *5Q6<cr>|Holding|Keeping current position
592 |ex: *5Q7<cr>|Stepping|Special low speed mode to maintain torque
593 |ex: *5Q8<cr>|Outside limits|{More details coming soon}
594 |ex: *5Q9<cr>|Stuck|Motor cannot perform request movement at current speed setting
595 |ex: *5Q10<cr>|Blocked|Similar to stuck, but the motor is at maximum duty and still cannot move (i.e.: stalled)
596
597 ====== __27. Query Voltage (**QV**)__ ======
598
599 Ex: #5QV<cr> might return *5QV11200<cr>
600
601 The number returned has one decimal, so in the case above, servo with ID 5 has an input voltage of 11.2V (perhaps a three cell LiPo battery).
602
603 ====== __28. Query Temperature (**QT**)__ ======
604
605 Ex: #5QT<cr> might return *5QT564<cr>
606
607 The units are in tenths of degrees Celcius, so in the example above, the servo's internal temperature is 56.4 degrees C. To convert from degrees Celcius to degrees Farenheit, multiply by 1.8 and add 32. Therefore 56.4C = 133.52F.
608
609 ====== __29. Query Current (**QC**)__ ======
610
611 Ex: #5QC<cr> might return *5QC140<cr>
612
613 The units are in milliamps, so in the example above, the servo is consuming 140mA, or 0.14A.
614
615 ====== __30. RC Mode (**CRC**)__ ======
616
617 This command puts the servo into RC mode (position or continuous), where it will only respond to RC pulses. Note that because this is the case, the servo will no longer accept serial commands. The servo can be placed back into smart mode by using the button menu.
618
619 |**Command sent**|**Note**
620 |ex: #5CRC<cr>|Stay in smart mode.
621 |ex: #5CRC1<cr>|Change to RC position mode.
622 |ex: #5CRC2<cr>|Change to RC continuous (wheel) mode.
623 |ex: #5CRC*<cr>|Where * is any number or value. Stay in smart mode.
624
625 EX: #5CRC<cr>
626
627 ====== __31. RESET__ ======
628
629 Ex: #5RESET<cr> or #5RS<cr>
630
631 This command does a "soft reset" (no power cycle required) and reverts all commands to those stored in EEPROM (i.e. configuration commands).
632
633 ====== __32. DEFAULT & CONFIRM__ ======
634
635 Ex: #5DEFAULT<cr>
636
637 This command sets in motion the reset all values to the default values included with the version of the firmware installed on that servo. The servo then waits for the CONFIRM command. Any other command received will cause the servo to exit the DEFAULT function.
638
639 EX: #5DEFAULT<cr> followed by #5CONFIRM<cr>
640
641 Since it it not common to have to restore all configurations, a confirmation command is needed after a firmware command is sent. Should any command other than CONFIRM be received by the servo after the firmware command has been received, it will leave the firmware action.
642
643 Note that after the CONFIRM command is sent, the servo will automatically perform a RESET.
644
645 ====== __33. UPDATE & CONFIRM__ ======
646
647 Ex: #5UPDATE<cr>
648
649 This command sets in motion the equivalent of a long button press when the servo is not powered in order to enter firmware update mode. This is useful should the button be broken or inaccessible. The servo then waits for the CONFIRM command. Any other command received will cause the servo to exit the UPDATE function.
650
651 EX: #5UPDATE<cr> followed by #5CONFIRM<cr>
652
653 Since it it not common to have to update firmware, a confirmation command is needed after an UPDATE command is sent. Should any command other than CONFIRM be received by the servo after the firmware command has been received, it will leave the firmware action.
654
655 Note that after the CONFIRM command is sent, the servo will automatically perform a RESET.
Copyright RobotShop 2018