C/C++ - Servo Bricklet 2.0

This is the description of the C/C++ API bindings for the Servo Bricklet 2.0. General information and technical specifications for the Servo Bricklet 2.0 are summarized in its hardware description.

An installation guide for the C/C++ API bindings is part of their general description.

Examples

The example code below is Public Domain (CC0 1.0).

Configuration

Download (example_configuration.c)

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
#include <stdio.h>

#include "ip_connection.h"
#include "bricklet_servo_v2.h"

#define HOST "localhost"
#define PORT 4223
#define UID "XYZ" // Change XYZ to the UID of your Servo Bricklet 2.0

int main(void) {
    // Create IP connection
    IPConnection ipcon;
    ipcon_create(&ipcon);

    // Create device object
    ServoV2 s;
    servo_v2_create(&s, UID, &ipcon);

    // Connect to brickd
    if(ipcon_connect(&ipcon, HOST, PORT) < 0) {
        fprintf(stderr, "Could not connect\n");
        return 1;
    }
    // Don't use device before ipcon is connected

    // Servo 1: Connected to port 0, period of 19.5ms, pulse width of 1 to 2ms
    //          and operating angle -100 to 100°
    servo_v2_set_degree(&s, 0, -10000, 10000);
    servo_v2_set_pulse_width(&s, 0, 1000, 2000);
    servo_v2_set_period(&s, 0, 19500);
    servo_v2_set_motion_configuration(&s, 0, 500000, 1000,
                                      1000); // Full velocity with slow ac-/deceleration


    // Servo 2: Connected to port 5, period of 20ms, pulse width of 0.95 to 1.95ms
    //          and operating angle -90 to 90°
    servo_v2_set_degree(&s, 5, -9000, 9000);
    servo_v2_set_pulse_width(&s, 5, 950, 1950);
    servo_v2_set_period(&s, 5, 20000);
    servo_v2_set_motion_configuration(&s, 5, 500000, 500000,
                                      500000); // Full velocity with full ac-/deceleration

    servo_v2_set_position(&s, 0, 10000); // Set to most right position
    servo_v2_set_enable(&s, 0, true);

    servo_v2_set_position(&s, 5, -9000); // Set to most left position
    servo_v2_set_enable(&s, 5, true);

    printf("Press key to exit\n");
    getchar();

    servo_v2_set_enable(&s, 0, false);
    servo_v2_set_enable(&s, 5, false);

    servo_v2_destroy(&s);
    ipcon_destroy(&ipcon); // Calls ipcon_disconnect internally
    return 0;
}

Callback

Download (example_callback.c)

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
#include <stdio.h>

#include "ip_connection.h"
#include "bricklet_servo_v2.h"

#define HOST "localhost"
#define PORT 4223
#define UID "XYZ" // Change XYZ to the UID of your Servo Bricklet 2.0

// Use position reached callback to swing back and forth
void cb_position_reached(uint16_t servo_channel, int16_t position, void *user_data) {
    ServoV2 *s = (ServoV2 *)user_data;

    if(position == 9000) {
        printf("Position: 90°, going to -90°\n");
        servo_v2_set_position(s, servo_channel, -9000);
    } else if(position == -9000) {
        printf("Position: -90°, going to 90°\n");
        servo_v2_set_position(s, servo_channel, 9000);
    } else {
        printf("Error\n"); // Can only happen if another program sets position
    }
}

int main(void) {
    // Create IP connection
    IPConnection ipcon;
    ipcon_create(&ipcon);

    // Create device object
    ServoV2 s;
    servo_v2_create(&s, UID, &ipcon);

    // Connect to brickd
    if(ipcon_connect(&ipcon, HOST, PORT) < 0) {
        fprintf(stderr, "Could not connect\n");
        return 1;
    }
    // Don't use device before ipcon is connected

    // Register position reached callback to function cb_position_reached
    servo_v2_register_callback(&s,
                               SERVO_V2_CALLBACK_POSITION_REACHED,
                               (void (*)(void))cb_position_reached,
                               &s);

    // Enable position reached callback
    servo_v2_set_position_reached_callback_configuration(&s, 0, true);

    // Set velocity to 100°/s. This has to be smaller or equal to the
    // maximum velocity of the servo you are using, otherwise the position
    // reached callback will be called too early
    servo_v2_set_motion_configuration(&s, 0, 10000, 500000, 500000);
    servo_v2_set_position(&s, 0, 9000);
    servo_v2_set_enable(&s, 0, true);

    printf("Press key to exit\n");
    getchar();

    servo_v2_set_enable(&s, 0, false);

    servo_v2_destroy(&s);
    ipcon_destroy(&ipcon); // Calls ipcon_disconnect internally
    return 0;
}

API

Most functions of the C/C++ bindings return an error code (e_code). Data returned from the device, when a getter is called, is handled via output parameters. These parameters are labeled with the ret_ prefix.

Possible error codes are:

  • E_OK = 0
  • E_TIMEOUT = -1
  • E_NO_STREAM_SOCKET = -2
  • E_HOSTNAME_INVALID = -3
  • E_NO_CONNECT = -4
  • E_NO_THREAD = -5
  • E_NOT_ADDED = -6 (unused since C/C++ bindings version 2.0.0)
  • E_ALREADY_CONNECTED = -7
  • E_NOT_CONNECTED = -8
  • E_INVALID_PARAMETER = -9
  • E_NOT_SUPPORTED = -10
  • E_UNKNOWN_ERROR_CODE = -11
  • E_STREAM_OUT_OF_SYNC = -12
  • E_INVALID_UID = -13
  • E_NON_ASCII_CHAR_IN_SECRET = -14
  • E_WRONG_DEVICE_TYPE = -15
  • E_DEVICE_REPLACED = -16
  • E_WRONG_RESPONSE_LENGTH = -17

as defined in ip_connection.h.

All functions listed below are thread-safe.

Every function of the Servo Brick API that has a servo_channel parameter can address a servo with the servo channel (0 to 9). 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 << 15) will address servos 1 and 5. 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.

Basic Functions

void servo_v2_create(ServoV2 *servo_v2, const char *uid, IPConnection *ipcon)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • uid – Type: const char *
  • ipcon – Type: IPConnection *

Creates the device object servo_v2 with the unique device ID uid and adds it to the IPConnection ipcon:

ServoV2 servo_v2;
servo_v2_create(&servo_v2, "YOUR_DEVICE_UID", &ipcon);

This device object can be used after the IP connection has been connected.

void servo_v2_destroy(ServoV2 *servo_v2)
Parameters:
  • servo_v2 – Type: ServoV2 *

Removes the device object servo_v2 from its IPConnection and destroys it. The device object cannot be used anymore afterwards.

int servo_v2_get_status(ServoV2 *servo_v2, bool ret_enabled[10], int16_t ret_current_position[10], int16_t ret_current_velocity[10], uint16_t ret_current[10], uint16_t *ret_input_voltage)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_enabled – Type: bool[10]
  • ret_current_position – Type: int16_t[10], Unit: 1/100 °, Range: ?
  • ret_current_velocity – Type: int16_t[10], Unit: 1/100 °/s, Range: [0 to 500000]
  • ret_current – Type: uint16_t[10], Unit: 1 mA, Range: [0 to 216 - 1]
  • ret_input_voltage – Type: uint16_t, Unit: 1 mV, Range: [0 to 216 - 1]
Returns:
  • e_code – Type: int

Returns the status information of the Servo Bricklet 2.0.

The status includes

  • for each channel if it is enabled or disabled,
  • for each channel the current position,
  • for each channel the current velocity,
  • for each channel the current usage and
  • the input voltage.

Please note that the position and the velocity is a snapshot of the current position and velocity of the servo in motion.

int servo_v2_set_enable(ServoV2 *servo_v2, uint16_t servo_channel, bool enable)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • enable – Type: bool, Default: false
Returns:
  • e_code – Type: int

Enables a servo channel (0 to 9). If a servo is enabled, the configured position, velocity, acceleration, etc. are applied immediately.

int servo_v2_get_enabled(ServoV2 *servo_v2, uint16_t servo_channel, bool *ret_enable)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_enable – Type: bool, Default: false
Returns:
  • e_code – Type: int

Returns true if the specified servo channel is enabled, false otherwise.

int servo_v2_set_position(ServoV2 *servo_v2, uint16_t servo_channel, int16_t position)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • position – Type: int16_t, Unit: 1/100 °, Range: ?
Returns:
  • e_code – Type: int

Sets the position in °/100 for the specified servo channel.

The default range of the position is -9000 to 9000, but it can be specified according to your servo with servo_v2_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 servo_v2_set_degree().

int servo_v2_get_position(ServoV2 *servo_v2, uint16_t servo_channel, int16_t *ret_position)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_position – Type: int16_t, Unit: 1/100 °, Range: ?
Returns:
  • e_code – Type: int

Returns the position of the specified servo channel as set by servo_v2_set_position().

int servo_v2_get_current_position(ServoV2 *servo_v2, uint16_t servo_channel, int16_t *ret_position)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_position – Type: int16_t, Unit: 1/100 °, Range: ?
Returns:
  • e_code – Type: int

Returns the current position of the specified servo channel. This may not be the value of servo_v2_set_position() if the servo is currently approaching a position goal.

int servo_v2_get_current_velocity(ServoV2 *servo_v2, uint16_t servo_channel, uint16_t *ret_velocity)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_velocity – Type: uint16_t, Unit: 1/100 °/s, Range: [0 to 500000]
Returns:
  • e_code – Type: int

Returns the current velocity of the specified servo channel. This may not be the velocity specified by servo_v2_set_motion_configuration(). if the servo is currently approaching a velocity goal.

int servo_v2_set_motion_configuration(ServoV2 *servo_v2, uint16_t servo_channel, uint32_t velocity, uint32_t acceleration, uint32_t deceleration)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • velocity – Type: uint32_t, Unit: 1/100 °/s, Range: [0 to 500000], Default: 100000
  • acceleration – Type: uint32_t, Unit: 1/100 °/s², Range: [0 to 500000], Default: 50000
  • deceleration – Type: uint32_t, Unit: 1/100 °/s², Range: [0 to 500000], Default: 50000
Returns:
  • e_code – Type: int

Sets the maximum velocity of the specified servo channel in °/100s as well as the acceleration and deceleration in °/100s²

With a velocity of 0 °/100s the position will be set immediately (no velocity).

With an acc-/deceleration of 0 °/100s² the velocity will be set immediately (no acc-/deceleration).

int servo_v2_get_motion_configuration(ServoV2 *servo_v2, uint16_t servo_channel, uint32_t *ret_velocity, uint32_t *ret_acceleration, uint32_t *ret_deceleration)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_velocity – Type: uint32_t, Unit: 1/100 °/s, Range: [0 to 500000], Default: 100000
  • ret_acceleration – Type: uint32_t, Unit: 1/100 °/s², Range: [0 to 500000], Default: 50000
  • ret_deceleration – Type: uint32_t, Unit: 1/100 °/s², Range: [0 to 500000], Default: 50000
Returns:
  • e_code – Type: int

Returns the motion configuration as set by servo_v2_set_motion_configuration().

int servo_v2_set_pulse_width(ServoV2 *servo_v2, uint16_t servo_channel, uint32_t min, uint32_t max)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • min – Type: uint32_t, Unit: 1 µs, Range: [0 to 232 - 1], Default: 1000
  • max – Type: uint32_t, Unit: 1 µs, Range: [0 to 232 - 1], Default: 2000
Returns:
  • e_code – Type: int

Sets the minimum and maximum pulse width of the specified servo channel in µs.

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.

Both values have a range from 1 to 65535 (unsigned 16-bit integer). The minimum must be smaller than the maximum.

The default values are 1000µs (1ms) and 2000µs (2ms) for minimum and maximum pulse width.

int servo_v2_get_pulse_width(ServoV2 *servo_v2, uint16_t servo_channel, uint32_t *ret_min, uint32_t *ret_max)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_min – Type: uint32_t, Unit: 1 µs, Range: [0 to 232 - 1], Default: 1000
  • ret_max – Type: uint32_t, Unit: 1 µs, Range: [0 to 232 - 1], Default: 2000
Returns:
  • e_code – Type: int

Returns the minimum and maximum pulse width for the specified servo channel as set by servo_v2_set_pulse_width().

int servo_v2_set_degree(ServoV2 *servo_v2, uint16_t servo_channel, int16_t min, int16_t max)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • min – Type: int16_t, Unit: 1/100 °, Range: [-215 to 215 - 1], Default: -9000
  • max – Type: int16_t, Unit: 1/100 °, Range: [-215 to 215 - 1], Default: 9000
Returns:
  • e_code – Type: int

Sets the minimum and maximum degree for the specified servo channel (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 servo_v2_set_position() with 0 will result in a pulse width of 1500µs (-90° = 1000µs, 90° = 2000µs, etc.).

Possible usage:

  • The datasheet of your servo specifies a range of 200° with the middle position at 110°. In this case you can set the minimum to -9000 and the maximum to 11000.
  • You measure a range of 220° on your servo and you don't have or need a middle position. In this case you can set the minimum to 0 and the maximum to 22000.
  • You have a linear servo with a drive length of 20cm, In this case you could set the minimum to 0 and the maximum to 20000. Now you can set the Position with servo_v2_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².
  • You don't care about units and just want the highest possible resolution. In this case you should set the minimum to -32767 and the maximum to 32767.
  • You have a brushless motor with a maximum speed of 10000 rpm and want to control it with a RC brushless motor controller. In this case you can set the minimum to 0 and the maximum to 10000. servo_v2_set_position() now controls the rpm.

Both values have a possible range from -32767 to 32767 (signed 16-bit integer). The minimum must be smaller than the maximum.

The default values are -9000 and 9000 for the minimum and maximum degree.

int servo_v2_get_degree(ServoV2 *servo_v2, uint16_t servo_channel, int16_t *ret_min, int16_t *ret_max)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_min – Type: int16_t, Unit: 1/100 °, Range: [-215 to 215 - 1], Default: -9000
  • ret_max – Type: int16_t, Unit: 1/100 °, Range: [-215 to 215 - 1], Default: 9000
Returns:
  • e_code – Type: int

Returns the minimum and maximum degree for the specified servo channel as set by servo_v2_set_degree().

int servo_v2_set_period(ServoV2 *servo_v2, uint16_t servo_channel, uint32_t period)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • period – Type: uint32_t, Unit: 1 µs, Range: [1 to 1000000], Default: 19500
Returns:
  • e_code – Type: int

Sets the period of the specified servo channel in µs.

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 (19.5ms) will most likely work fine.

The minimum possible period is 1µs and the maximum is 1000000µs.

The default value is 19.5ms (19500µs).

int servo_v2_get_period(ServoV2 *servo_v2, uint16_t servo_channel, uint32_t *ret_period)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_period – Type: uint32_t, Unit: 1 µs, Range: [1 to 1000000], Default: 19500
Returns:
  • e_code – Type: int

Returns the period for the specified servo channel as set by servo_v2_set_period().

int servo_v2_get_servo_current(ServoV2 *servo_v2, uint16_t servo_channel, uint16_t *ret_current)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_current – Type: uint16_t, Unit: 1 mA, Range: [0 to 216 - 1]
Returns:
  • e_code – Type: int

Returns the current consumption of the specified servo channel in mA.

int servo_v2_set_servo_current_configuration(ServoV2 *servo_v2, uint16_t servo_channel, uint8_t averaging_duration)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • averaging_duration – Type: uint8_t, Unit: 1 ms, Range: [1 to 255], Default: 255
Returns:
  • e_code – Type: int

Sets the averaging duration of the current measurement for the specified servo channel in ms.

int servo_v2_get_servo_current_configuration(ServoV2 *servo_v2, uint16_t servo_channel, uint8_t *ret_averaging_duration)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_averaging_duration – Type: uint8_t, Unit: 1 ms, Range: [1 to 255], Default: 255
Returns:
  • e_code – Type: int

Returns the servo current configuration for the specified servo channel as set by servo_v2_set_servo_current_configuration().

int servo_v2_set_input_voltage_configuration(ServoV2 *servo_v2, uint8_t averaging_duration)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • averaging_duration – Type: uint8_t, Unit: 1 ms, Range: [1 to 255], Default: 255
Returns:
  • e_code – Type: int

Sets the averaging duration of the input voltage measurement for the specified servo channel in ms.

int servo_v2_get_input_voltage_configuration(ServoV2 *servo_v2, uint8_t *ret_averaging_duration)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_averaging_duration – Type: uint8_t, Unit: 1 ms, Range: [1 to 255], Default: 255
Returns:
  • e_code – Type: int

Returns the input voltage configuration as set by servo_v2_set_input_voltage_configuration().

int servo_v2_get_overall_current(ServoV2 *servo_v2, uint16_t *ret_current)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_current – Type: uint16_t, Unit: 1 mA, Range: [0 to 216 - 1]
Returns:
  • e_code – Type: int

Returns the current consumption of all servos together in mA.

int servo_v2_get_input_voltage(ServoV2 *servo_v2, uint16_t *ret_voltage)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_voltage – Type: uint16_t, Unit: 1 mV, Range: [0 to 216 - 1]
Returns:
  • e_code – Type: int

Returns the input voltage in mV. The input voltage is given via the black power input connector on the Servo Brick.

Advanced Functions

int servo_v2_set_current_calibration(ServoV2 *servo_v2, int16_t offset[10])
Parameters:
  • servo_v2 – Type: ServoV2 *
  • offset – Type: int16_t[10], Unit: 1 mA, Range: [-215 to 215 - 1]
Returns:
  • e_code – Type: int

Sets an offset value (in mA) for each channel.

Note: On delivery the Servo Bricklet 2.0 is already calibrated.

int servo_v2_get_current_calibration(ServoV2 *servo_v2, int16_t ret_offset[10])
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_offset – Type: int16_t[10], Unit: 1 mA, Range: [-215 to 215 - 1]
Returns:
  • e_code – Type: int

Returns the current calibration as set by servo_v2_set_current_calibration().

int servo_v2_get_spitfp_error_count(ServoV2 *servo_v2, uint32_t *ret_error_count_ack_checksum, uint32_t *ret_error_count_message_checksum, uint32_t *ret_error_count_frame, uint32_t *ret_error_count_overflow)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_error_count_ack_checksum – Type: uint32_t, Range: [0 to 232 - 1]
  • ret_error_count_message_checksum – Type: uint32_t, Range: [0 to 232 - 1]
  • ret_error_count_frame – Type: uint32_t, Range: [0 to 232 - 1]
  • ret_error_count_overflow – Type: uint32_t, Range: [0 to 232 - 1]
Returns:
  • e_code – Type: int

Returns the error count for the communication between Brick and Bricklet.

The errors are divided into

  • ACK checksum errors,
  • message checksum errors,
  • framing errors and
  • overflow errors.

The errors counts are for errors that occur on the Bricklet side. All Bricks have a similar function that returns the errors on the Brick side.

int servo_v2_set_status_led_config(ServoV2 *servo_v2, uint8_t config)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • config – Type: uint8_t, Range: See constants, Default: 3
Returns:
  • e_code – Type: int

Sets the status LED configuration. By default the LED shows communication traffic between Brick and Bricklet, it flickers once for every 10 received data packets.

You can also turn the LED permanently on/off or show a heartbeat.

If the Bricklet is in bootloader mode, the LED is will show heartbeat by default.

The following constants are available for this function:

For config:

  • SERVO_V2_STATUS_LED_CONFIG_OFF = 0
  • SERVO_V2_STATUS_LED_CONFIG_ON = 1
  • SERVO_V2_STATUS_LED_CONFIG_SHOW_HEARTBEAT = 2
  • SERVO_V2_STATUS_LED_CONFIG_SHOW_STATUS = 3
int servo_v2_get_status_led_config(ServoV2 *servo_v2, uint8_t *ret_config)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_config – Type: uint8_t, Range: See constants, Default: 3
Returns:
  • e_code – Type: int

Returns the configuration as set by servo_v2_set_status_led_config()

The following constants are available for this function:

For ret_config:

  • SERVO_V2_STATUS_LED_CONFIG_OFF = 0
  • SERVO_V2_STATUS_LED_CONFIG_ON = 1
  • SERVO_V2_STATUS_LED_CONFIG_SHOW_HEARTBEAT = 2
  • SERVO_V2_STATUS_LED_CONFIG_SHOW_STATUS = 3
int servo_v2_get_chip_temperature(ServoV2 *servo_v2, int16_t *ret_temperature)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_temperature – Type: int16_t, Unit: 1 °C, Range: [-215 to 215 - 1]
Returns:
  • e_code – Type: int

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 bad accuracy. Practically it is only useful as an indicator for temperature changes.

int servo_v2_reset(ServoV2 *servo_v2)
Parameters:
  • servo_v2 – Type: ServoV2 *
Returns:
  • e_code – Type: int

Calling this function will reset the Bricklet. All configurations will be lost.

After a reset you have to create new device objects, calling functions on the existing ones will result in undefined behavior!

int servo_v2_get_identity(ServoV2 *servo_v2, char ret_uid[8], char ret_connected_uid[8], char *ret_position, uint8_t ret_hardware_version[3], uint8_t ret_firmware_version[3], uint16_t *ret_device_identifier)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_uid – Type: char[8]
  • ret_connected_uid – Type: char[8]
  • ret_position – Type: char, Range: ['a' to 'h', 'z']
  • ret_hardware_version – Type: uint8_t[3]
    • 0: major – Type: uint8_t, Range: [0 to 255]
    • 1: minor – Type: uint8_t, Range: [0 to 255]
    • 2: revision – Type: uint8_t, Range: [0 to 255]
  • ret_firmware_version – Type: uint8_t[3]
    • 0: major – Type: uint8_t, Range: [0 to 255]
    • 1: minor – Type: uint8_t, Range: [0 to 255]
    • 2: revision – Type: uint8_t, Range: [0 to 255]
  • ret_device_identifier – Type: uint16_t, Range: [0 to 216 - 1]
Returns:
  • e_code – Type: int

Returns the UID, the UID where the Bricklet is connected to, the position, the hardware and firmware version as well as the device identifier.

The position can be 'a', 'b', 'c', 'd', 'e', 'f', 'g' or 'h' (Bricklet Port). A Bricklet connected to an Isolator Bricklet is always at position 'z'.

The device identifier numbers can be found here. There is also a constant for the device identifier of this Bricklet.

Callback Configuration Functions

void servo_v2_register_callback(ServoV2 *servo_v2, int16_t callback_id, void (*function)(void), void *user_data)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • callback_id – Type: int16_t
  • function – Type: void (*)(void)
  • user_data – Type: void *

Registers the given function with the given callback_id. The user_data will be passed as the last parameter to the function.

The available callback IDs with corresponding function signatures are listed below.

int servo_v2_set_position_reached_callback_configuration(ServoV2 *servo_v2, uint16_t servo_channel, bool enabled)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9, 215 to 33791]
  • enabled – Type: bool, Default: false
Returns:
  • e_code – Type: int

Enable/Disable SERVO_V2_CALLBACK_POSITION_REACHED callback.

int servo_v2_get_position_reached_callback_configuration(ServoV2 *servo_v2, uint16_t servo_channel, bool *ret_enabled)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • servo_channel – Type: uint16_t, Range: [0 to 9]
Output Parameters:
  • ret_enabled – Type: bool, Default: false
Returns:
  • e_code – Type: int

Returns the callback configuration as set by servo_v2_set_position_reached_callback_configuration().

Callbacks

Callbacks can be registered to receive time critical or recurring data from the device. The registration is done with the servo_v2_register_callback() function:

void my_callback(int value, void *user_data) {
    printf("Value: %d\n", value);
}

servo_v2_register_callback(&servo_v2,
                           SERVO_V2_CALLBACK_EXAMPLE,
                           (void (*)(void))my_callback,
                           NULL);

The available constants with corresponding function signatures are described below.

Note

Using callbacks for recurring events is always preferred compared to using getters. It will use less USB bandwidth and the latency will be a lot better, since there is no round trip time.

SERVO_V2_CALLBACK_POSITION_REACHED
void callback(uint16_t servo_channel, int16_t position, void *user_data)
Callback Parameters:
  • servo_channel – Type: uint16_t, Range: [0 to 9]
  • position – Type: int16_t, Unit: 1/100 °, Range: ?
  • user_data – Type: void *

This callback is triggered when a position set by servo_v2_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 parameters are the servo and the position that is reached.

You can enable this callback with servo_v2_set_position_reached_callback_configuration().

Note

Since we can't get any feedback from the servo, this only works if the velocity (see servo_v2_set_motion_configuration()) 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.

Virtual Functions

Virtual functions don't communicate with the device itself, but operate only on the API bindings device object. They can be called without the corresponding IP Connection object being connected.

int servo_v2_get_api_version(ServoV2 *servo_v2, uint8_t ret_api_version[3])
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_api_version – Type: uint8_t[3]
    • 0: major – Type: uint8_t, Range: [0 to 255]
    • 1: minor – Type: uint8_t, Range: [0 to 255]
    • 2: revision – Type: uint8_t, Range: [0 to 255]
Returns:
  • e_code – Type: int

Returns the version of the API definition implemented by this API bindings. This is neither the release version of this API bindings nor does it tell you anything about the represented Brick or Bricklet.

int servo_v2_get_response_expected(ServoV2 *servo_v2, uint8_t function_id, bool *ret_response_expected)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • function_id – Type: uint8_t, Range: See constants
Output Parameters:
  • ret_response_expected – Type: bool
Returns:
  • e_code – Type: int

Returns the response expected flag for the function specified by the function ID parameter. It is true if the function is expected to send a response, false otherwise.

For getter functions this is enabled by default and cannot be disabled, because those functions will always send a response. For callback configuration functions it is enabled by default too, but can be disabled by servo_v2_set_response_expected(). For setter functions it is disabled by default and can be enabled.

Enabling the response expected flag for a setter function allows to detect timeouts and other error conditions calls of this setter as well. The device will then send a response for this purpose. If this flag is disabled for a setter function then no response is sent and errors are silently ignored, because they cannot be detected.

The following constants are available for this function:

For function_id:

  • SERVO_V2_FUNCTION_SET_ENABLE = 2
  • SERVO_V2_FUNCTION_SET_POSITION = 4
  • SERVO_V2_FUNCTION_SET_MOTION_CONFIGURATION = 8
  • SERVO_V2_FUNCTION_SET_PULSE_WIDTH = 10
  • SERVO_V2_FUNCTION_SET_DEGREE = 12
  • SERVO_V2_FUNCTION_SET_PERIOD = 14
  • SERVO_V2_FUNCTION_SET_SERVO_CURRENT_CONFIGURATION = 17
  • SERVO_V2_FUNCTION_SET_INPUT_VOLTAGE_CONFIGURATION = 19
  • SERVO_V2_FUNCTION_SET_CURRENT_CALIBRATION = 23
  • SERVO_V2_FUNCTION_SET_POSITION_REACHED_CALLBACK_CONFIGURATION = 25
  • SERVO_V2_FUNCTION_SET_WRITE_FIRMWARE_POINTER = 237
  • SERVO_V2_FUNCTION_SET_STATUS_LED_CONFIG = 239
  • SERVO_V2_FUNCTION_RESET = 243
  • SERVO_V2_FUNCTION_WRITE_UID = 248
int servo_v2_set_response_expected(ServoV2 *servo_v2, uint8_t function_id, bool response_expected)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • function_id – Type: uint8_t, Range: See constants
  • response_expected – Type: bool
Returns:
  • e_code – Type: int

Changes the response expected flag of the function specified by the function ID parameter. This flag can only be changed for setter (default value: false) and callback configuration functions (default value: true). For getter functions it is always enabled.

Enabling the response expected flag for a setter function allows to detect timeouts and other error conditions calls of this setter as well. The device will then send a response for this purpose. If this flag is disabled for a setter function then no response is sent and errors are silently ignored, because they cannot be detected.

The following constants are available for this function:

For function_id:

  • SERVO_V2_FUNCTION_SET_ENABLE = 2
  • SERVO_V2_FUNCTION_SET_POSITION = 4
  • SERVO_V2_FUNCTION_SET_MOTION_CONFIGURATION = 8
  • SERVO_V2_FUNCTION_SET_PULSE_WIDTH = 10
  • SERVO_V2_FUNCTION_SET_DEGREE = 12
  • SERVO_V2_FUNCTION_SET_PERIOD = 14
  • SERVO_V2_FUNCTION_SET_SERVO_CURRENT_CONFIGURATION = 17
  • SERVO_V2_FUNCTION_SET_INPUT_VOLTAGE_CONFIGURATION = 19
  • SERVO_V2_FUNCTION_SET_CURRENT_CALIBRATION = 23
  • SERVO_V2_FUNCTION_SET_POSITION_REACHED_CALLBACK_CONFIGURATION = 25
  • SERVO_V2_FUNCTION_SET_WRITE_FIRMWARE_POINTER = 237
  • SERVO_V2_FUNCTION_SET_STATUS_LED_CONFIG = 239
  • SERVO_V2_FUNCTION_RESET = 243
  • SERVO_V2_FUNCTION_WRITE_UID = 248
int servo_v2_set_response_expected_all(ServoV2 *servo_v2, bool response_expected)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • response_expected – Type: bool
Returns:
  • e_code – Type: int

Changes the response expected flag for all setter and callback configuration functions of this device at once.

Internal Functions

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.

int servo_v2_set_bootloader_mode(ServoV2 *servo_v2, uint8_t mode, uint8_t *ret_status)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • mode – Type: uint8_t, Range: See constants
Output Parameters:
  • ret_status – Type: uint8_t, Range: See constants
Returns:
  • e_code – Type: int

Sets the bootloader mode and returns the status after the requested mode change was instigated.

You can change from bootloader mode to firmware mode and vice versa. A change from bootloader mode to firmware mode will only take place if the entry function, device identifier and CRC are present and correct.

This function is used by Brick Viewer during flashing. It should not be necessary to call it in a normal user program.

The following constants are available for this function:

For mode:

  • SERVO_V2_BOOTLOADER_MODE_BOOTLOADER = 0
  • SERVO_V2_BOOTLOADER_MODE_FIRMWARE = 1
  • SERVO_V2_BOOTLOADER_MODE_BOOTLOADER_WAIT_FOR_REBOOT = 2
  • SERVO_V2_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_REBOOT = 3
  • SERVO_V2_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_ERASE_AND_REBOOT = 4

For ret_status:

  • SERVO_V2_BOOTLOADER_STATUS_OK = 0
  • SERVO_V2_BOOTLOADER_STATUS_INVALID_MODE = 1
  • SERVO_V2_BOOTLOADER_STATUS_NO_CHANGE = 2
  • SERVO_V2_BOOTLOADER_STATUS_ENTRY_FUNCTION_NOT_PRESENT = 3
  • SERVO_V2_BOOTLOADER_STATUS_DEVICE_IDENTIFIER_INCORRECT = 4
  • SERVO_V2_BOOTLOADER_STATUS_CRC_MISMATCH = 5
int servo_v2_get_bootloader_mode(ServoV2 *servo_v2, uint8_t *ret_mode)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_mode – Type: uint8_t, Range: See constants
Returns:
  • e_code – Type: int

Returns the current bootloader mode, see servo_v2_set_bootloader_mode().

The following constants are available for this function:

For ret_mode:

  • SERVO_V2_BOOTLOADER_MODE_BOOTLOADER = 0
  • SERVO_V2_BOOTLOADER_MODE_FIRMWARE = 1
  • SERVO_V2_BOOTLOADER_MODE_BOOTLOADER_WAIT_FOR_REBOOT = 2
  • SERVO_V2_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_REBOOT = 3
  • SERVO_V2_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_ERASE_AND_REBOOT = 4
int servo_v2_set_write_firmware_pointer(ServoV2 *servo_v2, uint32_t pointer)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • pointer – Type: uint32_t, Unit: 1 B, Range: [0 to 232 - 1]
Returns:
  • e_code – Type: int

Sets the firmware pointer for servo_v2_write_firmware(). The pointer has to be increased by chunks of size 64. The data is written to flash every 4 chunks (which equals to one page of size 256).

This function is used by Brick Viewer during flashing. It should not be necessary to call it in a normal user program.

int servo_v2_write_firmware(ServoV2 *servo_v2, uint8_t data[64], uint8_t *ret_status)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • data – Type: uint8_t[64], Range: [0 to 255]
Output Parameters:
  • ret_status – Type: uint8_t, Range: [0 to 255]
Returns:
  • e_code – Type: int

Writes 64 Bytes of firmware at the position as written by servo_v2_set_write_firmware_pointer() before. The firmware is written to flash every 4 chunks.

You can only write firmware in bootloader mode.

This function is used by Brick Viewer during flashing. It should not be necessary to call it in a normal user program.

int servo_v2_write_uid(ServoV2 *servo_v2, uint32_t uid)
Parameters:
  • servo_v2 – Type: ServoV2 *
  • uid – Type: uint32_t, Range: [0 to 232 - 1]
Returns:
  • e_code – Type: int

Writes a new UID into flash. If you want to set a new UID you have to decode the Base58 encoded UID string into an integer first.

We recommend that you use Brick Viewer to change the UID.

int servo_v2_read_uid(ServoV2 *servo_v2, uint32_t *ret_uid)
Parameters:
  • servo_v2 – Type: ServoV2 *
Output Parameters:
  • ret_uid – Type: uint32_t, Range: [0 to 232 - 1]
Returns:
  • e_code – Type: int

Returns the current UID as an integer. Encode as Base58 to get the usual string version.

Constants

SERVO_V2_DEVICE_IDENTIFIER

This constant is used to identify a Servo Bricklet 2.0.

The servo_v2_get_identity() function and the IPCON_CALLBACK_ENUMERATE callback of the IP Connection have a device_identifier parameter to specify the Brick's or Bricklet's type.

SERVO_V2_DEVICE_DISPLAY_NAME

This constant represents the human readable name of a Servo Bricklet 2.0.