Delphi/Lazarus - Servo Brick

Dies ist die Beschreibung der Delphi/Lazarus API Bindings für den Servo Brick. Allgemeine Informationen über die Funktionen und technischen Spezifikationen des Servo Brick sind in dessen Hardware Beschreibung zusammengefasst.

Eine Installationanleitung für die Delphi/Lazarus API Bindings ist Teil deren allgemeine Beschreibung.

Beispiele

Der folgende Beispielcode ist Public Domain (CC0 1.0).

Configuration

Download (ExampleConfiguration.pas)

 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
66
67
68
69
70
71
72
73
74
75
76
77
program ExampleConfiguration;

{$ifdef MSWINDOWS}{$apptype CONSOLE}{$endif}
{$ifdef FPC}{$mode OBJFPC}{$H+}{$endif}

uses
  SysUtils, IPConnection, BrickServo;

type
  TExample = class
  private
    ipcon: TIPConnection;
    servo: TBrickServo;
  public
    procedure Execute;
  end;

const
  HOST = 'localhost';
  PORT = 4223;
  UID = 'XXYYZZ'; { Change XXYYZZ to the UID of your Servo Brick }

var
  e: TExample;

procedure TExample.Execute;
begin
  { Create IP connection }
  ipcon := TIPConnection.Create;

  { Create device object }
  servo := TBrickServo.Create(UID, ipcon);

  { Connect to brickd }
  ipcon.Connect(HOST, PORT);
  { Don't use device before ipcon is connected }

  { Configure two servos with voltage 5.5V
    Servo 1: Connected to port 0, period of 19.5ms, pulse width of 1 to 2ms
             and operating angle -100 to 100°

    Servo 2: Connected to port 5, period of 20ms, pulse width of 0.95
             to 1.95ms and operating angle -90 to 90° }
  servo.SetOutputVoltage(5500);

  servo.SetDegree(0, -10000, 10000);
  servo.SetPulseWidth(0, 1000, 2000);
  servo.SetPeriod(0, 19500);
  servo.SetAcceleration(0, 1000); { Slow acceleration }
  servo.SetVelocity(0, 65535); { Full speed }

  servo.SetDegree(5, -9000, 9000);
  servo.SetPulseWidth(5, 950, 1950);
  servo.SetPeriod(5, 20000);
  servo.SetAcceleration(5, 65535); { Full acceleration }
  servo.SetVelocity(5, 65535); { Full speed }

  servo.SetPosition(0, 10000); { Set to most right position }
  servo.Enable(0);

  servo.SetPosition(5, -9000); { Set to most left position }
  servo.Enable(5);

  WriteLn('Press key to exit');
  ReadLn;

  servo.Disable(0);
  servo.Disable(5);

  ipcon.Destroy; { Calls ipcon.Disconnect internally }
end;

begin
  e := TExample.Create;
  e.Execute;
  e.Destroy;
end.

Callback

Download (ExampleCallback.pas)

 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
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
program ExampleCallback;

{$ifdef MSWINDOWS}{$apptype CONSOLE}{$endif}
{$ifdef FPC}{$mode OBJFPC}{$H+}{$endif}

uses
  SysUtils, IPConnection, BrickServo;

type
  TExample = class
  private
    ipcon: TIPConnection;
    servo: TBrickServo;
  public
    procedure PositionReachedCB(sender: TBrickServo; const servoNum: byte;
                                const position: smallint);
    procedure Execute;
  end;

const
  HOST = 'localhost';
  PORT = 4223;
  UID = 'XXYYZZ'; { Change XXYYZZ to the UID of your Servo Brick }

var
  e: TExample;

{ Use position reached callback to swing back and forth }
procedure TExample.PositionReachedCB(sender: TBrickServo; const servoNum: byte;
                                     const position: smallint);
begin
  if (position = 9000) then begin
    WriteLn('Position: 90°, going to -90°');
    sender.SetPosition(servoNum, -9000);
  end
  else if (position = -9000) then begin
    WriteLn('Position: -90°, going to 90°');
    sender.SetPosition(servoNum, 9000);
  end
  else begin
    WriteLn('Error'); { Can only happen if another program sets position }
  end;
end;

procedure TExample.Execute;
begin
  { Create IP connection }
  ipcon := TIPConnection.Create;

  { Create device object }
  servo := TBrickServo.Create(UID, ipcon);

  { Connect to brickd }
  ipcon.Connect(HOST, PORT);
  { Don't use device before ipcon is connected }

  { Register position reached callback to procedure PositionReachedCB }
  servo.OnPositionReached := {$ifdef FPC}@{$endif}PositionReachedCB;

  { Enable position reached callback }
  servo.EnablePositionReachedCallback;

  { 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.SetVelocity(0, 10000);
  servo.SetPosition(0, 9000);
  servo.Enable(0);

  WriteLn('Press key to exit');
  ReadLn;

  servo.Disable(0);

  ipcon.Destroy; { Calls ipcon.Disconnect internally }
end;

begin
  e := TExample.Create;
  e.Execute;
  e.Destroy;
end.

API

Da Delphi nicht mehrere Rückgabewerte direkt unterstützt, wird das out Schlüsselwort genutzt um mehrere Werte von einer Funktion zurückzugeben.

Alle folgend aufgelisteten Funktionen und Prozeduren sind Thread-sicher.

Jede Funktion der Servo Brick API, welche den servo_num Parameter verwendet, kann einen Servo über die Servo Nummer (0 bis 6) adressieren. Falls es sich um eine Setter-Funktion handelt können mehrere Servos gleichzeitig mit einer Bitmaske adressiert werden. Um dies zu kennzeichnen muss das höchstwertigste Bit gesetzt werden. Beispiel: 1 adressiert den Servo 1, (1 << 1) | (1 << 5) | (1 << 7) adressiert die Servos 1 und 5, 0xFF adressiert alle 7 Servos, und so weiter. Das ermöglicht es Konfigurationen von verschiedenen Servos mit einem Funktionsaufruf durchzuführen. Es ist sichergestellt das die Änderungen in der selben PWM Periode vorgenommen werden, für alle Servos entsprechend der Bitmaske.

Grundfunktionen

constructor TBrickServo.Create(const uid: string; ipcon: TIPConnection)
Parameter:
  • uid – Typ: string
  • ipcon – Typ: TIPConnection
Rückgabe:
  • servo – Typ: TBrickServo

Erzeugt ein Objekt mit der eindeutigen Geräte ID uid:

servo := TBrickServo.Create('YOUR_DEVICE_UID', ipcon);

Dieses Objekt kann benutzt werden, nachdem die IP Connection verbunden ist.

procedure TBrickServo.Enable(const servoNum: byte)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]

Aktiviert einen Servo (0 bis 6). Wenn ein Servo aktiviert wird, wird die konfigurierte Position, Geschwindigkeit, Beschleunigung, etc. sofort übernommen.

procedure TBrickServo.Disable(const servoNum: byte)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]

Deaktiviert einen Servo (0 bis 6). Deaktivierte Servos werden nicht angesteuert, z.B. halten deaktivierte Servos nicht ihre Position wenn eine Last angebracht ist.

function TBrickServo.IsEnabled(const servoNum: byte): boolean
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • enabled – Typ: boolean, Standardwert: false

Gibt zurück ob ein Servo aktiviert ist.

procedure TBrickServo.SetPosition(const servoNum: byte; const position: smallint)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]
  • position – Typ: smallint, Einheit: 1/100 °, Wertebereich: ?

Setzt die Position für den angegebenen Servo.

Der Standardbereich für die Position ist -9000 bis 9000, aber dies kann, entsprechend dem verwendetem Servo, mit SetDegree definiert werden.

Wenn ein Linearservo oder RC Brushless Motor Controller oder ähnlich mit dem Servo Brick gesteuert werden soll, können Längen oder Geschwindigkeiten mit SetDegree definiert werden.

function TBrickServo.GetPosition(const servoNum: byte): smallint
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • position – Typ: smallint, Einheit: 1/100 °, Wertebereich: ?

Gibt die Position des angegebenen Servos zurück, wie von SetPosition gesetzt.

function TBrickServo.GetCurrentPosition(const servoNum: byte): smallint
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • position – Typ: smallint, Einheit: 1/100 °, Wertebereich: ?

Gibt die aktuelle Position des angegebenen Servos zurück. Dies kann vom Wert von SetPosition abweichen, wenn der Servo gerade sein Positionsziel anfährt.

procedure TBrickServo.SetVelocity(const servoNum: byte; const velocity: word)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]
  • velocity – Typ: word, Einheit: 1/100 °/s, Wertebereich: [0 bis 216 - 1], Standardwert: 216 - 1

Setzt die maximale Geschwindigkeit des angegebenen Servos. Die Geschwindigkeit wird entsprechend mit dem Wert, wie von SetAcceleration gesetzt, beschleunigt.

Die minimale Geschwindigkeit ist 0 (keine Bewegung) und die maximale ist 65535. Mit einem Wert von 65535 wird die Position sofort gesetzt (keine Geschwindigkeit).

function TBrickServo.GetVelocity(const servoNum: byte): word
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • velocity – Typ: word, Einheit: 1/100 °/s, Wertebereich: [0 bis 216 - 1], Standardwert: 216 - 1

Gibt die Geschwindigkeit des angegebenen Servos zurück, wie von SetVelocity gesetzt.

function TBrickServo.GetCurrentVelocity(const servoNum: byte): word
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • velocity – Typ: word, Einheit: 1/100 °/s, Wertebereich: [0 bis 216 - 1], Standardwert: 216 - 1

Gibt die aktuelle Geschwindigkeit des angegebenen Servos zurück. Dies kann vom Wert von SetVelocity abweichen, wenn der Servo gerade sein Geschwindigkeitsziel anfährt.

procedure TBrickServo.SetAcceleration(const servoNum: byte; const acceleration: word)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]
  • acceleration – Typ: word, Einheit: 1/100 °/s², Wertebereich: [0 bis 216 - 1], Standardwert: 216 - 1

Setzt die Beschleunigung des angegebenen Servos.

Die minimale Beschleunigung ist 1 und die maximale 65535. Mit einem Wert von 65535 wird die Geschwindigkeit sofort gesetzt (keine Beschleunigung).

function TBrickServo.GetAcceleration(const servoNum: byte): word
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • acceleration – Typ: word, Einheit: 1/100 °/s², Wertebereich: [0 bis 216 - 1], Standardwert: 216 - 1

Gibt die Beschleunigung des angegebenen Servos zurück, wie von SetAcceleration gesetzt.

procedure TBrickServo.SetOutputVoltage(const voltage: word)
Parameter:
  • voltage – Typ: word, Einheit: 1 mV, Wertebereich: [2000 bis 9000], Standardwert: 5000

Setzt die Ausgangsspannung mit welchem der Servo angetrieben wird.

Bemerkung

Es wird empfohlen diesen Wert auf die maximale Spannung laut Spezifikation des Servos zu setzten. Die meisten Servos erreichen ihre maximale Kraft nur mit hohen Spannungen

function TBrickServo.GetOutputVoltage: word
Rückgabe:
  • voltage – Typ: word, Einheit: 1 mV, Wertebereich: [2000 bis 9000], Standardwert: 5000

Gibt die Ausgangsspannung zurück, wie von SetOutputVoltage gesetzt.

procedure TBrickServo.SetPulseWidth(const servoNum: byte; const min: word; const max: word)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]
  • min – Typ: word, Einheit: 1 µs, Wertebereich: [0 bis 216 - 1], Standardwert: 1000
  • max – Typ: word, Einheit: 1 µs, Wertebereich: [0 bis 216 - 1], Standardwert: 2000

Setzt die minimale und maximale Pulsweite des angegebenen Servos.

Normalerweise werden Servos mit einer PWM angesteuert, wobei die Länge des Pulses die Position des Servos steuert. Jeder Servo hat unterschiedliche minimale und maximale Pulsweiten, diese können mit dieser Funktion spezifiziert werden.

Wenn im Datenblatt des Servos die minimale und maximale Pulsweite spezifiziert ist, sollten diese Werte entsprechend gesetzt werden. Sollte der Servo ohne ein Datenblatt vorliegen, müssen die Werte durch Ausprobieren gefunden werden.

Der minimale Wert muss kleiner als der maximale sein.

procedure TBrickServo.GetPulseWidth(const servoNum: byte; out min: word; out max: word)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Ausgabeparameter:
  • min – Typ: word, Einheit: 1 µs, Wertebereich: [0 bis 216 - 1], Standardwert: 1000
  • max – Typ: word, Einheit: 1 µs, Wertebereich: [0 bis 216 - 1], Standardwert: 2000

Gibt die minimale und maximale Pulsweite des angegebenen Servos zurück, wie von SetPulseWidth gesetzt.

procedure TBrickServo.SetDegree(const servoNum: byte; const min: smallint; const max: smallint)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]
  • min – Typ: smallint, Einheit: 1/100 °, Wertebereich: [-215 bis 215 - 1], Standardwert: -9000
  • max – Typ: smallint, Einheit: 1/100 °, Wertebereich: [-215 bis 215 - 1], Standardwert: 9000

Setzt den minimalen und maximalen Winkel des angegebenen Servos (standardmäßig in °/100).

Dies definiert die abstrakten Werte zwischen welchen die minimale und maximale Pulsweite skaliert wird. Beispiel: Wenn eine Pulsweite von 1000µs bis 2000µs und ein Winkelbereich von -90° bis 90° spezifiziert ist, wird ein Aufruf von SetPosition mit 0 in einer Pulsweite von 1500µs resultieren (-90° = 1000µs, 90° = 2000µs, etc.).

Anwendungsfälle:

  • Das Datenblatt des Servos spezifiziert einen Bereich von 200° mit einer Mittelposition bei 110°. In diesem Fall kann das Minimum auf -9000 und das Maximum auf 11000 gesetzt werden.
  • Es wird ein Bereich von 220° am Servo gemessen und eine Mittelposition ist nicht bekannt bzw. wird nicht benötigt. In diesem Fall kann das Minimum auf 0 und das Maximum auf 22000 gesetzt werden.
  • Ein Linearservo mit einer Antriebslänge von 20cm. In diesem Fall kann das Minimum auf 0 und das Maximum auf 20000 gesetzt werden. Jetzt kann die Position mittels SetPosition mit einer Auflösung von cm/100 gesetzt werden. Auch die Geschwindigkeit hat eine Auflösung von cm/100s und die Beschleunigung von cm/100s².
  • Die Einheit ist irrelevant und eine möglichst hohe Auflösung ist gewünscht. In diesem Fall kann das Minimum auf -32767 und das Maximum auf 32767 gesetzt werden.
  • Ein Brushless Motor, mit einer maximalen Drehzahl von 1000 U/min, soll mit einem RC Brushless Motor Controller gesteuert werden. In diesem Fall kann das Minimum auf 0 und das Maximum auf 10000 gesetzt werden. SetPosition steuert jetzt die Drehzahl in U/min.

Der minimale Wert muss kleiner als der maximale sein.

procedure TBrickServo.GetDegree(const servoNum: byte; out min: smallint; out max: smallint)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Ausgabeparameter:
  • min – Typ: smallint, Einheit: 1/100 °, Wertebereich: [-215 bis 215 - 1], Standardwert: -9000
  • max – Typ: smallint, Einheit: 1/100 °, Wertebereich: [-215 bis 215 - 1], Standardwert: 9000

Gibt den minimalen und maximalen Winkel für den angegebenen Servo zurück, wie von SetDegree gesetzt.

procedure TBrickServo.SetPeriod(const servoNum: byte; const period: word)
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6, 128 bis 255]
  • period – Typ: word, Einheit: 1 µs, Wertebereich: [0 bis 216 - 1], Standardwert: 19500

Setzt die Periode des angegebenen Servos.

Normalerweise werden Servos mit einer PWM angesteuert. Unterschiedliche Servos erwarten PWMs mit unterschiedlichen Perioden. Die meisten Servos werden mit einer Periode von 20ms betrieben.

Wenn im Datenblatt des Servos die Periode spezifiziert ist, sollte dieser Wert entsprechend gesetzt werden. Sollte der Servo ohne ein Datenblatt vorliegen und die korrekte Periode unbekannt sein, wird der Standardwert meist funktionieren.

function TBrickServo.GetPeriod(const servoNum: byte): word
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • period – Typ: word, Einheit: 1 µs, Wertebereich: [0 bis 216 - 1], Standardwert: 19500

Gibt die Periode für den angegebenen Servo zurück, wie von SetPeriod gesetzt.

function TBrickServo.GetServoCurrent(const servoNum: byte): word
Parameter:
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
Rückgabe:
  • current – Typ: word, Einheit: 1 mA, Wertebereich: [0 bis 216 - 1]

Gibt den Stromverbrauch des angegebenen Servos zurück.

function TBrickServo.GetOverallCurrent: word
Rückgabe:
  • current – Typ: word, Einheit: 1 mA, Wertebereich: [0 bis 216 - 1]

Gibt den Stromverbrauch aller Servos zusammen zurück.

function TBrickServo.GetStackInputVoltage: word
Rückgabe:
  • voltage – Typ: word, Einheit: 1 mV, Wertebereich: [0 bis 216 - 1]

Gibt die Eingangsspannung des Stapels zurück. Die Eingangsspannung des Stapels wird über diesen verteilt, z.B. mittels einer Step-Down oder Step-Up Power Supply.

function TBrickServo.GetExternalInputVoltage: word
Rückgabe:
  • voltage – Typ: word, Einheit: 1 mV, Wertebereich: [0 bis 216 - 1]

Gibt die externe Eingangsspannung zurück. Die externe Eingangsspannung wird über die schwarze Stromversorgungsbuchse, in den Servo Brick, eingespeist.

Sobald eine externe Eingangsspannung und die Spannungsversorgung des Stapels anliegt, werden die Motoren über die externe Spannung versorgt. Sollte nur die Spannungsversorgung des Stapels verfügbar sein, erfolgt die Versorgung der Motoren über diese.

Warnung

Das bedeutet, bei einer hohen Versorgungsspannung des Stapels und einer geringen externen Versorgungsspannung erfolgt die Spannungsversorgung der Motoren über die geringere externe Versorgungsspannung. Wenn dann die externe Spannungsversorgung getrennt wird, erfolgt sofort die Versorgung der Motoren über die höhere Versorgungsspannung des Stapels.

Fortgeschrittene Funktionen

procedure TBrickServo.SetSPITFPBaudrateConfig(const enableDynamicBaudrate: boolean; const minimumDynamicBaudrate: longword)
Parameter:
  • enableDynamicBaudrate – Typ: boolean, Standardwert: true
  • minimumDynamicBaudrate – Typ: longword, Einheit: 1 Bd, Wertebereich: [400000 bis 2000000], Standardwert: 400000

Das SPITF-Protokoll kann mit einer dynamischen Baudrate genutzt werden. Wenn die dynamische Baudrate aktiviert ist, versucht der Brick die Baudrate anhand des Datenaufkommens zwischen Brick und Bricklet anzupassen.

Die Baudrate wird exponentiell erhöht wenn viele Daten gesendet/empfangen werden und linear verringert wenn wenig Daten gesendet/empfangen werden.

Diese Vorgehensweise verringert die Baudrate in Anwendungen wo nur wenig Daten ausgetauscht werden müssen (z.B. eine Wetterstation) und erhöht die Robustheit. Wenn immer viele Daten ausgetauscht werden (z.B. Thermal Imaging Bricklet), wird die Baudrate automatisch erhöht.

In Fällen wo wenige Daten all paar Sekunden so schnell wie Möglich übertragen werden sollen (z.B. RS485 Bricklet mit hoher Baudrate aber kleinem Payload) kann die dynamische Baudrate zum maximieren der Performance ausgestellt werden.

Die maximale Baudrate kann pro Port mit der Funktion SetSPITFPBaudrate. gesetzt werden. Falls die dynamische Baudrate nicht aktiviert ist, wird die Baudrate wie von SetSPITFPBaudrate gesetzt statisch verwendet.

Neu in Version 2.3.4 (Firmware).

procedure TBrickServo.GetSPITFPBaudrateConfig(out enableDynamicBaudrate: boolean; out minimumDynamicBaudrate: longword)
Ausgabeparameter:
  • enableDynamicBaudrate – Typ: boolean, Standardwert: true
  • minimumDynamicBaudrate – Typ: longword, Einheit: 1 Bd, Wertebereich: [400000 bis 2000000], Standardwert: 400000

Gibt die Baudratenkonfiguration zurück, siehe SetSPITFPBaudrateConfig.

Neu in Version 2.3.4 (Firmware).

function TBrickServo.GetSendTimeoutCount(const communicationMethod: byte): longword
Parameter:
  • communicationMethod – Typ: byte, Wertebereich: Siehe Konstanten
Rückgabe:
  • timeoutCount – Typ: longword, Wertebereich: [0 bis 232 - 1]

Gibt den Timeout-Zähler für die verschiedenen Kommunikationsmöglichkeiten zurück

Die Kommunikationsmöglichkeiten 0-2 stehen auf allen Bricks zur verfügung, 3-7 nur auf Master Bricks.

Diese Funktion ist hauptsächlich zum debuggen während der Entwicklung gedacht. Im normalen Betrieb sollten alle Zähler fast immer auf 0 stehen bleiben.

Die folgenden Konstanten sind für diese Funktion verfügbar:

Für communicationMethod:

  • BRICK_SERVO_COMMUNICATION_METHOD_NONE = 0
  • BRICK_SERVO_COMMUNICATION_METHOD_USB = 1
  • BRICK_SERVO_COMMUNICATION_METHOD_SPI_STACK = 2
  • BRICK_SERVO_COMMUNICATION_METHOD_CHIBI = 3
  • BRICK_SERVO_COMMUNICATION_METHOD_RS485 = 4
  • BRICK_SERVO_COMMUNICATION_METHOD_WIFI = 5
  • BRICK_SERVO_COMMUNICATION_METHOD_ETHERNET = 6
  • BRICK_SERVO_COMMUNICATION_METHOD_WIFI_V2 = 7

Neu in Version 2.3.2 (Firmware).

procedure TBrickServo.SetSPITFPBaudrate(const brickletPort: char; const baudrate: longword)
Parameter:
  • brickletPort – Typ: char, Wertebereich: ['a' bis 'b']
  • baudrate – Typ: longword, Einheit: 1 Bd, Wertebereich: [400000 bis 2000000], Standardwert: 1400000

Setzt die Baudrate eines spezifischen Bricklet Ports .

Für einen höheren Durchsatz der Bricklets kann die Baudrate erhöht werden. Wenn der Fehlerzähler auf Grund von lokaler Störeinstrahlung hoch ist (siehe GetSPITFPErrorCount) kann die Baudrate verringert werden.

Wenn das Feature der dynamische Baudrate aktiviert ist, setzt diese Funktion die maximale Baudrate (siehe SetSPITFPBaudrateConfig).

EMV Tests werden mit der Standardbaudrate durchgeführt. Falls eine CE-Kompatibilität o.ä. in der Anwendung notwendig ist empfehlen wir die Baudrate nicht zu ändern.

Neu in Version 2.3.2 (Firmware).

function TBrickServo.GetSPITFPBaudrate(const brickletPort: char): longword
Parameter:
  • brickletPort – Typ: char, Wertebereich: ['a' bis 'b']
Rückgabe:
  • baudrate – Typ: longword, Einheit: 1 Bd, Wertebereich: [400000 bis 2000000], Standardwert: 1400000

Gibt die Baudrate für einen Bricklet Port zurück, siehe SetSPITFPBaudrate.

Neu in Version 2.3.2 (Firmware).

procedure TBrickServo.GetSPITFPErrorCount(const brickletPort: char; out errorCountACKChecksum: longword; out errorCountMessageChecksum: longword; out errorCountFrame: longword; out errorCountOverflow: longword)
Parameter:
  • brickletPort – Typ: char, Wertebereich: ['a' bis 'b']
Ausgabeparameter:
  • errorCountACKChecksum – Typ: longword, Wertebereich: [0 bis 232 - 1]
  • errorCountMessageChecksum – Typ: longword, Wertebereich: [0 bis 232 - 1]
  • errorCountFrame – Typ: longword, Wertebereich: [0 bis 232 - 1]
  • errorCountOverflow – Typ: longword, Wertebereich: [0 bis 232 - 1]

Gibt die Anzahl der Fehler die während der Kommunikation zwischen Brick und Bricklet aufgetreten sind zurück.

Die Fehler sind aufgeteilt in

  • ACK-Checksummen Fehler,
  • Message-Checksummen Fehler,
  • Framing Fehler und
  • Overflow Fehler.

Die Fehlerzähler sind für Fehler die auf der Seite des Bricks auftreten. Jedes Bricklet hat eine ähnliche Funktion welche die Fehler auf Brickletseite ausgibt.

Neu in Version 2.3.2 (Firmware).

procedure TBrickServo.EnableStatusLED

Aktiviert die Status LED.

Die Status LED ist die blaue LED neben dem USB-Stecker. Wenn diese aktiviert ist, ist sie an und sie flackert wenn Daten transferiert werden. Wenn sie deaktiviert ist, ist sie immer aus.

Der Standardzustand ist aktiviert.

Neu in Version 2.3.1 (Firmware).

procedure TBrickServo.DisableStatusLED

Deaktiviert die Status LED.

Die Status LED ist die blaue LED neben dem USB-Stecker. Wenn diese aktiviert ist, ist sie an und sie flackert wenn Daten transferiert werden. Wenn sie deaktiviert ist, ist sie immer aus.

Der Standardzustand ist aktiviert.

Neu in Version 2.3.1 (Firmware).

function TBrickServo.IsStatusLEDEnabled: boolean
Rückgabe:
  • enabled – Typ: boolean, Standardwert: true

Gibt true zurück wenn die Status LED aktiviert ist, false sonst.

Neu in Version 2.3.1 (Firmware).

function TBrickServo.GetChipTemperature: smallint
Rückgabe:
  • temperature – Typ: smallint, Einheit: 1/10 °C, Wertebereich: [-215 bis 215 - 1]

Gibt die Temperatur, gemessen im Mikrocontroller, aus. Der Rückgabewert ist nicht die Umgebungstemperatur.

Die Temperatur ist lediglich proportional zur echten Temperatur und hat eine Genauigkeit von ±15%. Daher beschränkt sich der praktische Nutzen auf die Indikation von Temperaturveränderungen.

procedure TBrickServo.Reset

Ein Aufruf dieser Funktion setzt den Brick zurück. Befindet sich der Brick innerhalb eines Stapels wird der gesamte Stapel zurück gesetzt.

Nach dem Zurücksetzen ist es notwendig neue Geräteobjekte zu erzeugen, Funktionsaufrufe auf bestehende führt zu undefiniertem Verhalten.

procedure TBrickServo.GetIdentity(out uid: string; out connectedUid: string; out position: char; out hardwareVersion: array [0..2] of byte; out firmwareVersion: array [0..2] of byte; out deviceIdentifier: word)
Ausgabeparameter:
  • uid – Typ: string, Länge: bis zu 8
  • connectedUid – Typ: string, Länge: bis zu 8
  • position – Typ: char, Wertebereich: ['0' bis '8']
  • hardwareVersion – Typ: array [0..2] of byte
    • 0: major – Typ: byte, Wertebereich: [0 bis 255]
    • 1: minor – Typ: byte, Wertebereich: [0 bis 255]
    • 2: revision – Typ: byte, Wertebereich: [0 bis 255]
  • firmwareVersion – Typ: array [0..2] of byte
    • 0: major – Typ: byte, Wertebereich: [0 bis 255]
    • 1: minor – Typ: byte, Wertebereich: [0 bis 255]
    • 2: revision – Typ: byte, Wertebereich: [0 bis 255]
  • deviceIdentifier – Typ: word, Wertebereich: [0 bis 216 - 1]

Gibt die UID, die UID zu der der Brick verbunden ist, die Position, die Hard- und Firmware Version sowie den Device Identifier zurück.

Die Position ist die Position im Stack von '0' (unterster Brick) bis '8' (oberster Brick).

Eine Liste der Device Identifier Werte ist hier zu finden. Es gibt auch eine Konstante für den Device Identifier dieses Bricks.

Konfigurationsfunktionen für Callbacks

procedure TBrickServo.SetMinimumVoltage(const voltage: word)
Parameter:
  • voltage – Typ: word, Einheit: 1 mV, Wertebereich: [0 bis 216 - 1], Standardwert: 5000

Setzt die minimale Spannung, bei welcher der OnUnderVoltage Callback ausgelöst wird. Der kleinste mögliche Wert mit dem der Servo Brick noch funktioniert, ist 5V. Mit dieser Funktion kann eine Entladung der versorgenden Batterie detektiert werden. Beim Einsatz einer Netzstromversorgung wird diese Funktionalität höchstwahrscheinlich nicht benötigt.

function TBrickServo.GetMinimumVoltage: word
Rückgabe:
  • voltage – Typ: word, Einheit: 1 mV, Wertebereich: [0 bis 216 - 1], Standardwert: 5000

Gibt die minimale Spannung zurück, wie von SetMinimumVoltage gesetzt.

procedure TBrickServo.EnablePositionReachedCallback

Aktiviert den OnPositionReached Callback.

Voreinstellung ist deaktiviert.

Neu in Version 2.0.1 (Firmware).

procedure TBrickServo.DisablePositionReachedCallback

Deaktiviert den OnPositionReached Callback.

Neu in Version 2.0.1 (Firmware).

function TBrickServo.IsPositionReachedCallbackEnabled: boolean
Rückgabe:
  • enabled – Typ: boolean, Standardwert: false

Gibt true zurück wenn der OnPositionReached Callback aktiviert ist, false sonst.

Neu in Version 2.0.1 (Firmware).

procedure TBrickServo.EnableVelocityReachedCallback

Aktiviert den OnVelocityReached Callback.

Voreinstellung ist deaktiviert.

Neu in Version 2.0.1 (Firmware).

procedure TBrickServo.DisableVelocityReachedCallback

Deaktiviert den OnVelocityReached Callback.

Voreinstellung ist deaktiviert.

Neu in Version 2.0.1 (Firmware).

function TBrickServo.IsVelocityReachedCallbackEnabled: boolean
Rückgabe:
  • enabled – Typ: boolean, Standardwert: false

Gibt true zurück wenn der OnVelocityReached Callback aktiviert ist, false sonst.

Neu in Version 2.0.1 (Firmware).

Callbacks

Callbacks können registriert werden um zeitkritische oder wiederkehrende Daten vom Gerät zu erhalten. Die Registrierung erfolgt indem eine Prozedur einem Callback Property des Geräte Objektes zugewiesen wird:

procedure TExample.MyCallback(sender: TBrickServo; const value: longint);
begin
  WriteLn(Format('Value: %d', [value]));
end;

servo.OnExample := {$ifdef FPC}@{$endif}example.MyCallback;

Die verfügbaren Callback Properties und ihre Parametertypen werden weiter unten beschrieben.

Bemerkung

Callbacks für wiederkehrende Ereignisse zu verwenden ist immer zu bevorzugen gegenüber der Verwendung von Abfragen. Es wird weniger USB-Bandbreite benutzt und die Latenz ist erheblich geringer, da es keine Paketumlaufzeit gibt.

property TBrickServo.OnUnderVoltage
procedure(sender: TBrickServo; const voltage: word) of object;
Callback-Parameter:
  • sender – Typ: TBrickServo
  • voltage – Typ: word, Einheit: 1 mV, Wertebereich: [0 bis 216 - 1]

Dieser Callback wird ausgelöst, wenn die Eingangsspannung unter den, mittels SetMinimumVoltage gesetzten, Schwellwert sinkt. Der Parameter ist die aktuelle Spannung.

property TBrickServo.OnPositionReached
procedure(sender: TBrickServo; const servoNum: byte; const position: smallint) of object;
Callback-Parameter:
  • sender – Typ: TBrickServo
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
  • position – Typ: smallint, Einheit: 1/100 °, Wertebereich: ?

Dieser Callback wird ausgelöst, wenn eine konfigurierte Position, wie von SetPosition gesetzt, erreicht wird. Falls die neue Position der aktuellen Position entspricht, wird der Callback nicht ausgelöst, weil sich der Servo nicht bewegt hat. Die Parameter sind der Servo und die Position die erreicht wurde.

Dieser Callback kann mit EnablePositionReachedCallback aktiviert werden.

Bemerkung

Da es nicht möglich ist eine Rückmeldung vom Servo zu erhalten, funktioniert dies nur wenn die konfigurierte Geschwindigkeit (siehe SetVelocity) kleiner oder gleich der maximalen Geschwindigkeit des Motors ist. Andernfalls wird der Motor hinter dem Vorgabewert zurückbleiben und der Callback wird zu früh ausgelöst.

property TBrickServo.OnVelocityReached
procedure(sender: TBrickServo; const servoNum: byte; const velocity: smallint) of object;
Callback-Parameter:
  • sender – Typ: TBrickServo
  • servoNum – Typ: byte, Wertebereich: [0 bis 6]
  • velocity – Typ: smallint, Einheit: 1/100 °/s, Wertebereich: [-215 bis 215 - 1]

Dieser Callback wird ausgelöst immer wenn eine konfigurierte Geschwindigkeit, wie von SetVelocity gesetzt, erreicht wird. Die Parameter sind der Servo und die Geschwindigkeit die erreicht wurde.

Dieser Callback kann mit EnableVelocityReachedCallback aktiviert werden.

Bemerkung

Da es nicht möglich ist eine Rückmeldung vom Servo zu erhalten, funktioniert dies nur wenn die konfigurierte Beschleunigung (siehe SetAcceleration) kleiner oder gleich der maximalen Beschleunigung des Motors ist. Andernfalls wird der Motor hinter dem Vorgabewert zurückbleiben und der Callback wird zu früh ausgelöst.

Virtuelle Funktionen

Virtuelle Funktionen kommunizieren nicht mit dem Gerät selbst, sie arbeiten nur auf dem API Bindings Objekt. Dadurch können sie auch aufgerufen werden, ohne das das dazugehörige IP Connection Objekt verbunden ist.

function TBrickServo.GetAPIVersion: array [0..2] of byte
Ausgabeparameter:
  • apiVersion – Typ: array [0..2] of byte
    • 0: major – Typ: byte, Wertebereich: [0 bis 255]
    • 1: minor – Typ: byte, Wertebereich: [0 bis 255]
    • 2: revision – Typ: byte, Wertebereich: [0 bis 255]

Gibt die Version der API Definition zurück, die diese API Bindings implementieren. Dies ist weder die Release-Version dieser API Bindings noch gibt es in irgendeiner Weise Auskunft über den oder das repräsentierte(n) Brick oder Bricklet.

function TBrickServo.GetResponseExpected(const functionId: byte): boolean
Parameter:
  • functionId – Typ: byte, Wertebereich: Siehe Konstanten
Rückgabe:
  • responseExpected – Typ: boolean

Gibt das Response-Expected-Flag für die Funktion mit der angegebenen Funktions IDs zurück. Es ist true falls für die Funktion beim Aufruf eine Antwort erwartet wird, false andernfalls.

Für Getter-Funktionen ist diese Flag immer gesetzt und kann nicht entfernt werden, da diese Funktionen immer eine Antwort senden. Für Konfigurationsfunktionen für Callbacks ist es standardmäßig gesetzt, kann aber entfernt werden mittels SetResponseExpected. Für Setter-Funktionen ist es standardmäßig nicht gesetzt, kann aber gesetzt werden.

Wenn das Response-Expected-Flag für eine Setter-Funktion gesetzt ist, können Timeouts und andere Fehlerfälle auch für Aufrufe dieser Setter-Funktion detektiert werden. Das Gerät sendet dann eine Antwort extra für diesen Zweck. Wenn das Flag für eine Setter-Funktion nicht gesetzt ist, dann wird keine Antwort vom Gerät gesendet und Fehler werden stillschweigend ignoriert, da sie nicht detektiert werden können.

Die folgenden Konstanten sind für diese Funktion verfügbar:

Für functionId:

  • BRICK_SERVO_FUNCTION_ENABLE = 1
  • BRICK_SERVO_FUNCTION_DISABLE = 2
  • BRICK_SERVO_FUNCTION_SET_POSITION = 4
  • BRICK_SERVO_FUNCTION_SET_VELOCITY = 7
  • BRICK_SERVO_FUNCTION_SET_ACCELERATION = 10
  • BRICK_SERVO_FUNCTION_SET_OUTPUT_VOLTAGE = 12
  • BRICK_SERVO_FUNCTION_SET_PULSE_WIDTH = 14
  • BRICK_SERVO_FUNCTION_SET_DEGREE = 16
  • BRICK_SERVO_FUNCTION_SET_PERIOD = 18
  • BRICK_SERVO_FUNCTION_SET_MINIMUM_VOLTAGE = 24
  • BRICK_SERVO_FUNCTION_ENABLE_POSITION_REACHED_CALLBACK = 29
  • BRICK_SERVO_FUNCTION_DISABLE_POSITION_REACHED_CALLBACK = 30
  • BRICK_SERVO_FUNCTION_ENABLE_VELOCITY_REACHED_CALLBACK = 32
  • BRICK_SERVO_FUNCTION_DISABLE_VELOCITY_REACHED_CALLBACK = 33
  • BRICK_SERVO_FUNCTION_SET_SPITFP_BAUDRATE_CONFIG = 231
  • BRICK_SERVO_FUNCTION_SET_SPITFP_BAUDRATE = 234
  • BRICK_SERVO_FUNCTION_ENABLE_STATUS_LED = 238
  • BRICK_SERVO_FUNCTION_DISABLE_STATUS_LED = 239
  • BRICK_SERVO_FUNCTION_RESET = 243
  • BRICK_SERVO_FUNCTION_WRITE_BRICKLET_PLUGIN = 246
procedure TBrickServo.SetResponseExpected(const functionId: byte; const responseExpected: boolean)
Parameter:
  • functionId – Typ: byte, Wertebereich: Siehe Konstanten
  • responseExpected – Typ: boolean

Ändert das Response-Expected-Flag für die Funktion mit der angegebenen Funktion IDs. Diese Flag kann nur für Setter-Funktionen (Standardwert: false) und Konfigurationsfunktionen für Callbacks (Standardwert: true) geändert werden. Für Getter-Funktionen ist das Flag immer gesetzt.

Wenn das Response-Expected-Flag für eine Setter-Funktion gesetzt ist, können Timeouts und andere Fehlerfälle auch für Aufrufe dieser Setter-Funktion detektiert werden. Das Gerät sendet dann eine Antwort extra für diesen Zweck. Wenn das Flag für eine Setter-Funktion nicht gesetzt ist, dann wird keine Antwort vom Gerät gesendet und Fehler werden stillschweigend ignoriert, da sie nicht detektiert werden können.

Die folgenden Konstanten sind für diese Funktion verfügbar:

Für functionId:

  • BRICK_SERVO_FUNCTION_ENABLE = 1
  • BRICK_SERVO_FUNCTION_DISABLE = 2
  • BRICK_SERVO_FUNCTION_SET_POSITION = 4
  • BRICK_SERVO_FUNCTION_SET_VELOCITY = 7
  • BRICK_SERVO_FUNCTION_SET_ACCELERATION = 10
  • BRICK_SERVO_FUNCTION_SET_OUTPUT_VOLTAGE = 12
  • BRICK_SERVO_FUNCTION_SET_PULSE_WIDTH = 14
  • BRICK_SERVO_FUNCTION_SET_DEGREE = 16
  • BRICK_SERVO_FUNCTION_SET_PERIOD = 18
  • BRICK_SERVO_FUNCTION_SET_MINIMUM_VOLTAGE = 24
  • BRICK_SERVO_FUNCTION_ENABLE_POSITION_REACHED_CALLBACK = 29
  • BRICK_SERVO_FUNCTION_DISABLE_POSITION_REACHED_CALLBACK = 30
  • BRICK_SERVO_FUNCTION_ENABLE_VELOCITY_REACHED_CALLBACK = 32
  • BRICK_SERVO_FUNCTION_DISABLE_VELOCITY_REACHED_CALLBACK = 33
  • BRICK_SERVO_FUNCTION_SET_SPITFP_BAUDRATE_CONFIG = 231
  • BRICK_SERVO_FUNCTION_SET_SPITFP_BAUDRATE = 234
  • BRICK_SERVO_FUNCTION_ENABLE_STATUS_LED = 238
  • BRICK_SERVO_FUNCTION_DISABLE_STATUS_LED = 239
  • BRICK_SERVO_FUNCTION_RESET = 243
  • BRICK_SERVO_FUNCTION_WRITE_BRICKLET_PLUGIN = 246
procedure TBrickServo.SetResponseExpectedAll(const responseExpected: boolean)
Parameter:
  • responseExpected – Typ: boolean

Ändert das Response-Expected-Flag für alle Setter-Funktionen und Konfigurationsfunktionen für Callbacks diese Gerätes.

Interne Funktionen

Interne Funktionen werden für Wartungsaufgaben, wie zum Beispiel das Flashen einer neuen Firmware oder das Ändern der UID eines Bricklets, verwendet. Diese Aufgaben sollten mit Brick Viewer durchgeführt werden, anstelle die internen Funktionen direkt zu verwenden.

procedure TBrickServo.GetProtocol1BrickletName(const port: char; out protocolVersion: byte; out firmwareVersion: array [0..2] of byte; out name: string)
Parameter:
  • port – Typ: char, Wertebereich: ['a' bis 'b']
Ausgabeparameter:
  • protocolVersion – Typ: byte, Wertebereich: [0 bis 255]
  • firmwareVersion – Typ: array [0..2] of byte
    • 0: major – Typ: byte, Wertebereich: [0 bis 255]
    • 1: minor – Typ: byte, Wertebereich: [0 bis 255]
    • 2: revision – Typ: byte, Wertebereich: [0 bis 255]
  • name – Typ: string, Länge: bis zu 40

Gibt die Firmware und Protokoll Version und den Namen des Bricklets für einen gegebenen Port zurück.

Der einzige Zweck dieser Funktion ist es, automatischen Flashen von Bricklet v1.x.y Plugins zu ermöglichen.

procedure TBrickServo.WriteBrickletPlugin(const port: char; const offset: byte; const chunk: array [0..31] of byte)
Parameter:
  • port – Typ: char, Wertebereich: ['a' bis 'b']
  • offset – Typ: byte, Wertebereich: [0 bis 255]
  • chunk – Typ: array [0..31] of byte, Wertebereich: [0 bis 255]

Schreibt 32 Bytes Firmware auf das Bricklet, dass am gegebenen Port angeschlossen ist. Die Bytes werden an die Position offset * 32 geschrieben.

Diese Funktion wird vom Brick Viewer während des Flashens benutzt. In einem normalem Nutzerprogramm sollte diese Funktion nicht benötigt werden.

function TBrickServo.ReadBrickletPlugin(const port: char; const offset: byte): array [0..31] of byte
Parameter:
  • port – Typ: char, Wertebereich: ['a' bis 'b']
  • offset – Typ: byte, Wertebereich: [0 bis 255]
Rückgabe:
  • chunk – Typ: array [0..31] of byte, Wertebereich: [0 bis 255]

Liest 32 Bytes Firmware vom Bricklet, dass am gegebenen Port angeschlossen ist. Die Bytes werden ab der Position offset * 32 gelesen.

Diese Funktion wird vom Brick Viewer während des Flashens benutzt. In einem normalem Nutzerprogramm sollte diese Funktion nicht benötigt werden.

Konstanten

const BRICK_SERVO_DEVICE_IDENTIFIER

Diese Konstante wird verwendet um einen Servo Brick zu identifizieren.

Die GetIdentity Funktion und der TIPConnection.OnEnumerate Callback der IP Connection haben ein deviceIdentifier Parameter um den Typ des Bricks oder Bricklets anzugeben.

const BRICK_SERVO_DEVICE_DISPLAY_NAME

Diese Konstante stellt den Anzeigenamen eines Servo Brick dar.