This is the description of the Modbus protocol for the Servo Brick. General information and technical specifications for the Servo Brick are summarized in its hardware description.
A general description of the Modbus protocol structure can be found here.
Every function of the Servo Brick API that has a servo_num parameter can
address a servo with the servo number (0 to 6). If it is a setter function then
multiple servos can be addressed at once with a bitmask for the
servos, if the highest bit is set. For example: 1
will address servo 1,
(1 << 1) | (1 << 5) | (1 << 7)
will address servos 1 and 5, 0xFF
will
address all seven servos, etc. This allows to set configurations to several
servos with one function call. It is guaranteed that the changes will take
effect in the same PWM period for all servos you specified in the bitmask.
BrickServo.
enable
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Enables a servo (0 to 6). If a servo is enabled, the configured position, velocity, acceleration, etc. are applied immediately.
BrickServo.
disable
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Disables a servo (0 to 6). Disabled servos are not driven at all, i.e. a disabled servo will not hold its position if a load is applied.
BrickServo.
is_enabled
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns true if the specified servo is enabled, false otherwise.
BrickServo.
set_position
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the position for the specified servo.
The default range of the position is -9000 to 9000, but it can be specified
according to your servo with set_degree
.
If you want to control a linear servo or RC brushless motor controller or
similar with the Servo Brick, you can also define lengths or speeds with
set_degree
.
BrickServo.
get_position
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the position of the specified servo as set by set_position
.
BrickServo.
get_current_position
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the current position of the specified servo. This may not be the
value of set_position
if the servo is currently approaching a
position goal.
BrickServo.
set_velocity
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the maximum velocity of the specified servo. The velocity
is accelerated according to the value set by set_acceleration
.
The minimum velocity is 0 (no movement) and the maximum velocity is 65535. With a value of 65535 the position will be set immediately (no velocity).
BrickServo.
get_velocity
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the velocity of the specified servo as set by set_velocity
.
BrickServo.
get_current_velocity
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the current velocity of the specified servo. This may not be the
value of set_velocity
if the servo is currently approaching a
velocity goal.
BrickServo.
set_acceleration
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the acceleration of the specified servo.
The minimum acceleration is 1 and the maximum acceleration is 65535. With a value of 65535 the velocity will be set immediately (no acceleration).
BrickServo.
get_acceleration
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the acceleration for the specified servo as set by
set_acceleration
.
BrickServo.
set_output_voltage
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the output voltages with which the servos are driven.
Note
We recommend that you set this value to the maximum voltage that is specified for your servo, most servos achieve their maximum force only with high voltages.
BrickServo.
get_output_voltage
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the output voltage as specified by set_output_voltage
.
BrickServo.
set_pulse_width
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the minimum and maximum pulse width of the specified servo.
Usually, servos are controlled with a PWM, whereby the length of the pulse controls the position of the servo. Every servo has different minimum and maximum pulse widths, these can be specified with this function.
If you have a datasheet for your servo that specifies the minimum and maximum pulse width, you should set the values accordingly. If your servo comes without any datasheet you have to find the values via trial and error.
The minimum must be smaller than the maximum.
BrickServo.
get_pulse_width
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the minimum and maximum pulse width for the specified servo as set by
set_pulse_width
.
BrickServo.
set_degree
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the minimum and maximum degree for the specified servo (by default given as °/100).
This only specifies the abstract values between which the minimum and maximum
pulse width is scaled. For example: If you specify a pulse width of 1000µs
to 2000µs and a degree range of -90° to 90°, a call of set_position
with 0 will result in a pulse width of 1500µs
(-90° = 1000µs, 90° = 2000µs, etc.).
Possible usage:
set_position
with a resolution of cm/100. Also the velocity will
have a resolution of cm/100s and the acceleration will have a resolution of
cm/100s².set_position
now controls the rpm.The minimum must be smaller than the maximum.
BrickServo.
get_degree
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the minimum and maximum degree for the specified servo as set by
set_degree
.
BrickServo.
set_period
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the period of the specified servo.
Usually, servos are controlled with a PWM. Different servos expect PWMs with different periods. Most servos run well with a period of about 20ms.
If your servo comes with a datasheet that specifies a period, you should set it accordingly. If you don't have a datasheet and you have no idea what the correct period is, the default value will most likely work fine.
BrickServo.
get_period
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the period for the specified servo as set by set_period
.
BrickServo.
get_servo_current
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the current consumption of the specified servo.
BrickServo.
get_overall_current
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the current consumption of all servos together.
BrickServo.
get_stack_input_voltage
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the stack input voltage. The stack input voltage is the voltage that is supplied via the stack, i.e. it is given by a Step-Down or Step-Up Power Supply.
BrickServo.
get_external_input_voltage
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the external input voltage. The external input voltage is given via the black power input connector on the Servo Brick.
If there is an external input voltage and a stack input voltage, the motors will be driven by the external input voltage. If there is only a stack voltage present, the motors will be driven by this voltage.
Warning
This means, if you have a high stack voltage and a low external voltage, the motors will be driven with the low external voltage. If you then remove the external connection, it will immediately be driven by the high stack voltage
BrickServo.
set_spitfp_baudrate_config
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
The SPITF protocol can be used with a dynamic baudrate. If the dynamic baudrate is enabled, the Brick will try to adapt the baudrate for the communication between Bricks and Bricklets according to the amount of data that is transferred.
The baudrate will be increased exponentially if lots of data is sent/received and decreased linearly if little data is sent/received.
This lowers the baudrate in applications where little data is transferred (e.g. a weather station) and increases the robustness. If there is lots of data to transfer (e.g. Thermal Imaging Bricklet) it automatically increases the baudrate as needed.
In cases where some data has to transferred as fast as possible every few seconds (e.g. RS485 Bricklet with a high baudrate but small payload) you may want to turn the dynamic baudrate off to get the highest possible performance.
The maximum value of the baudrate can be set per port with the function
set_spitfp_baudrate
. If the dynamic baudrate is disabled, the baudrate
as set by set_spitfp_baudrate
will be used statically.
New in version 2.3.4 (Firmware).
BrickServo.
get_spitfp_baudrate_config
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the baudrate config, see set_spitfp_baudrate_config
.
New in version 2.3.4 (Firmware).
BrickServo.
get_send_timeout_count
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the timeout count for the different communication methods.
The methods 0-2 are available for all Bricks, 3-7 only for Master Bricks.
This function is mostly used for debugging during development, in normal operation the counters should nearly always stay at 0.
New in version 2.3.2 (Firmware).
The following meanings are defined for the elements of this function:
For communication_method:
BrickServo.
set_spitfp_baudrate
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the baudrate for a specific Bricklet port.
If you want to increase the throughput of Bricklets you can increase
the baudrate. If you get a high error count because of high
interference (see get_spitfp_error_count
) you can decrease the
baudrate.
If the dynamic baudrate feature is enabled, the baudrate set by this
function corresponds to the maximum baudrate (see set_spitfp_baudrate_config
).
Regulatory testing is done with the default baudrate. If CE compatibility or similar is necessary in your applications we recommend to not change the baudrate.
New in version 2.3.2 (Firmware).
BrickServo.
get_spitfp_baudrate
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the baudrate for a given Bricklet port, see set_spitfp_baudrate
.
New in version 2.3.2 (Firmware).
BrickServo.
get_spitfp_error_count
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the error count for the communication between Brick and Bricklet.
The errors are divided into
The errors counts are for errors that occur on the Brick side. All Bricklets have a similar function that returns the errors on the Bricklet side.
New in version 2.3.2 (Firmware).
BrickServo.
enable_status_led
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Enables the status LED.
The status LED is the blue LED next to the USB connector. If enabled is is on and it flickers if data is transfered. If disabled it is always off.
The default state is enabled.
New in version 2.3.1 (Firmware).
BrickServo.
disable_status_led
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Disables the status LED.
The status LED is the blue LED next to the USB connector. If enabled is is on and it flickers if data is transfered. If disabled it is always off.
The default state is enabled.
New in version 2.3.1 (Firmware).
BrickServo.
is_status_led_enabled
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns true if the status LED is enabled, false otherwise.
New in version 2.3.1 (Firmware).
BrickServo.
get_chip_temperature
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the temperature as measured inside the microcontroller. The value returned is not the ambient temperature!
The temperature is only proportional to the real temperature and it has an accuracy of ±15%. Practically it is only useful as an indicator for temperature changes.
BrickServo.
reset
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Calling this function will reset the Brick. Calling this function on a Brick inside of a stack will reset the whole stack.
After a reset you have to create new device objects, calling functions on the existing ones will result in undefined behavior!
BrickServo.
get_identity
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the UID, the UID where the Brick is connected to, the position, the hardware and firmware version as well as the device identifier.
The position is the position in the stack from '0' (bottom) to '8' (top).
The device identifier numbers can be found here.
BrickServo.
set_minimum_voltage
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Sets the minimum voltage, below which the CALLBACK_UNDER_VOLTAGE
callback
is triggered. The minimum possible value that works with the Servo Brick is 5V.
You can use this function to detect the discharge of a battery that is used
to drive the stepper motor. If you have a fixed power supply, you likely do
not need this functionality.
BrickServo.
get_minimum_voltage
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the minimum voltage as set by set_minimum_voltage
BrickServo.
enable_position_reached_callback
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Enables the CALLBACK_POSITION_REACHED
callback.
Default is disabled.
New in version 2.0.1 (Firmware).
BrickServo.
disable_position_reached_callback
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Disables the CALLBACK_POSITION_REACHED
callback.
New in version 2.0.1 (Firmware).
BrickServo.
is_position_reached_callback_enabled
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns true if CALLBACK_POSITION_REACHED
callback is enabled, false otherwise.
New in version 2.0.1 (Firmware).
BrickServo.
enable_velocity_reached_callback
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Enables the CALLBACK_VELOCITY_REACHED
callback.
Default is disabled.
New in version 2.0.1 (Firmware).
BrickServo.
disable_velocity_reached_callback
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Disables the CALLBACK_VELOCITY_REACHED
callback.
Default is disabled.
New in version 2.0.1 (Firmware).
BrickServo.
is_velocity_reached_callback_enabled
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns true if CALLBACK_VELOCITY_REACHED
callback is enabled, false otherwise.
New in version 2.0.1 (Firmware).
BrickServo.
CALLBACK_UNDER_VOLTAGE
¶Function ID: |
|
---|---|
Response: |
|
This callback is triggered when the input voltage drops below the value set by
set_minimum_voltage
. The response value is the current voltage.
BrickServo.
CALLBACK_POSITION_REACHED
¶Function ID: |
|
---|---|
Response: |
|
This callback is triggered when a position set by set_position
is reached. If the new position matches the current position then the
callback is not triggered, because the servo didn't move.
The response values are the servo and the position that is reached.
You can enable this callback with enable_position_reached_callback
.
Note
Since we can't get any feedback from the servo, this only works if the
velocity (see set_velocity
) is set smaller or equal to the
maximum velocity of the servo. Otherwise the servo will lag behind the
control value and the callback will be triggered too early.
BrickServo.
CALLBACK_VELOCITY_REACHED
¶Function ID: |
|
---|---|
Response: |
|
This callback is triggered when a velocity set by set_velocity
is reached. The response values are the servo and the velocity that is reached.
You can enable this callback with enable_velocity_reached_callback
.
Note
Since we can't get any feedback from the servo, this only works if the
acceleration (see set_acceleration
) is set smaller or equal to the
maximum acceleration of the servo. Otherwise the servo will lag behind the
control value and the callback will be triggered too early.
Internal functions are used for maintenance tasks such as flashing a new firmware of changing the UID of a Bricklet. These task should be performed using Brick Viewer instead of using the internal functions directly.
BrickServo.
get_protocol1_bricklet_name
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Returns the firmware and protocol version and the name of the Bricklet for a given port.
This functions sole purpose is to allow automatic flashing of v1.x.y Bricklet plugins.
BrickServo.
write_bricklet_plugin
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Writes 32 bytes of firmware to the bricklet attached at the given port. The bytes are written to the position offset * 32.
This function is used by Brick Viewer during flashing. It should not be necessary to call it in a normal user program.
BrickServo.
read_bricklet_plugin
¶Function ID: |
|
---|---|
Request: |
|
Response: |
|
Reads 32 bytes of firmware from the bricklet attached at the given port. The bytes are read starting at the position offset * 32.
This function is used by Brick Viewer during flashing. It should not be necessary to call it in a normal user program.