#[allow(unused_imports)]
use crate::{
byte_converter::*, device::*, error::TinkerforgeError, ip_connection::async_io::AsyncIpConnection, low_level_traits::LowLevelRead,
};
#[allow(unused_imports)]
use futures_core::Stream;
#[allow(unused_imports)]
use tokio_stream::StreamExt;
pub enum ServoV2BrickletFunction {
GetStatus,
SetEnable,
GetEnabled,
SetPosition,
GetPosition,
GetCurrentPosition,
GetCurrentVelocity,
SetMotionConfiguration,
GetMotionConfiguration,
SetPulseWidth,
GetPulseWidth,
SetDegree,
GetDegree,
SetPeriod,
GetPeriod,
GetServoCurrent,
SetServoCurrentConfiguration,
GetServoCurrentConfiguration,
SetInputVoltageConfiguration,
GetInputVoltageConfiguration,
GetOverallCurrent,
GetInputVoltage,
SetCurrentCalibration,
GetCurrentCalibration,
SetPositionReachedCallbackConfiguration,
GetPositionReachedCallbackConfiguration,
GetSpitfpErrorCount,
SetBootloaderMode,
GetBootloaderMode,
SetWriteFirmwarePointer,
WriteFirmware,
SetStatusLedConfig,
GetStatusLedConfig,
GetChipTemperature,
Reset,
WriteUid,
ReadUid,
GetIdentity,
CallbackPositionReached,
}
impl From<ServoV2BrickletFunction> for u8 {
fn from(fun: ServoV2BrickletFunction) -> Self {
match fun {
ServoV2BrickletFunction::GetStatus => 1,
ServoV2BrickletFunction::SetEnable => 2,
ServoV2BrickletFunction::GetEnabled => 3,
ServoV2BrickletFunction::SetPosition => 4,
ServoV2BrickletFunction::GetPosition => 5,
ServoV2BrickletFunction::GetCurrentPosition => 6,
ServoV2BrickletFunction::GetCurrentVelocity => 7,
ServoV2BrickletFunction::SetMotionConfiguration => 8,
ServoV2BrickletFunction::GetMotionConfiguration => 9,
ServoV2BrickletFunction::SetPulseWidth => 10,
ServoV2BrickletFunction::GetPulseWidth => 11,
ServoV2BrickletFunction::SetDegree => 12,
ServoV2BrickletFunction::GetDegree => 13,
ServoV2BrickletFunction::SetPeriod => 14,
ServoV2BrickletFunction::GetPeriod => 15,
ServoV2BrickletFunction::GetServoCurrent => 16,
ServoV2BrickletFunction::SetServoCurrentConfiguration => 17,
ServoV2BrickletFunction::GetServoCurrentConfiguration => 18,
ServoV2BrickletFunction::SetInputVoltageConfiguration => 19,
ServoV2BrickletFunction::GetInputVoltageConfiguration => 20,
ServoV2BrickletFunction::GetOverallCurrent => 21,
ServoV2BrickletFunction::GetInputVoltage => 22,
ServoV2BrickletFunction::SetCurrentCalibration => 23,
ServoV2BrickletFunction::GetCurrentCalibration => 24,
ServoV2BrickletFunction::SetPositionReachedCallbackConfiguration => 25,
ServoV2BrickletFunction::GetPositionReachedCallbackConfiguration => 26,
ServoV2BrickletFunction::GetSpitfpErrorCount => 234,
ServoV2BrickletFunction::SetBootloaderMode => 235,
ServoV2BrickletFunction::GetBootloaderMode => 236,
ServoV2BrickletFunction::SetWriteFirmwarePointer => 237,
ServoV2BrickletFunction::WriteFirmware => 238,
ServoV2BrickletFunction::SetStatusLedConfig => 239,
ServoV2BrickletFunction::GetStatusLedConfig => 240,
ServoV2BrickletFunction::GetChipTemperature => 242,
ServoV2BrickletFunction::Reset => 243,
ServoV2BrickletFunction::WriteUid => 248,
ServoV2BrickletFunction::ReadUid => 249,
ServoV2BrickletFunction::GetIdentity => 255,
ServoV2BrickletFunction::CallbackPositionReached => 27,
}
}
}
pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_BOOTLOADER: u8 = 0;
pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_FIRMWARE: u8 = 1;
pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_BOOTLOADER_WAIT_FOR_REBOOT: u8 = 2;
pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_REBOOT: u8 = 3;
pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_ERASE_AND_REBOOT: u8 = 4;
pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_OK: u8 = 0;
pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_INVALID_MODE: u8 = 1;
pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_NO_CHANGE: u8 = 2;
pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_ENTRY_FUNCTION_NOT_PRESENT: u8 = 3;
pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_DEVICE_IDENTIFIER_INCORRECT: u8 = 4;
pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_CRC_MISMATCH: u8 = 5;
pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_OFF: u8 = 0;
pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_ON: u8 = 1;
pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_SHOW_HEARTBEAT: u8 = 2;
pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_SHOW_STATUS: u8 = 3;
#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
pub struct Status {
pub enabled: [bool; 10],
pub current_position: [i16; 10],
pub current_velocity: [i16; 10],
pub current: [u16; 10],
pub input_voltage: u16,
}
impl FromByteSlice for Status {
fn bytes_expected() -> usize {
64
}
fn from_le_byte_slice(bytes: &[u8]) -> Status {
Status {
enabled: <[bool; 10]>::from_le_byte_slice(&bytes[0..2]),
current_position: <[i16; 10]>::from_le_byte_slice(&bytes[2..22]),
current_velocity: <[i16; 10]>::from_le_byte_slice(&bytes[22..42]),
current: <[u16; 10]>::from_le_byte_slice(&bytes[42..62]),
input_voltage: <u16>::from_le_byte_slice(&bytes[62..64]),
}
}
}
#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
pub struct MotionConfiguration {
pub velocity: u32,
pub acceleration: u32,
pub deceleration: u32,
}
impl FromByteSlice for MotionConfiguration {
fn bytes_expected() -> usize {
12
}
fn from_le_byte_slice(bytes: &[u8]) -> MotionConfiguration {
MotionConfiguration {
velocity: <u32>::from_le_byte_slice(&bytes[0..4]),
acceleration: <u32>::from_le_byte_slice(&bytes[4..8]),
deceleration: <u32>::from_le_byte_slice(&bytes[8..12]),
}
}
}
#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
pub struct PulseWidth {
pub min: u32,
pub max: u32,
}
impl FromByteSlice for PulseWidth {
fn bytes_expected() -> usize {
8
}
fn from_le_byte_slice(bytes: &[u8]) -> PulseWidth {
PulseWidth { min: <u32>::from_le_byte_slice(&bytes[0..4]), max: <u32>::from_le_byte_slice(&bytes[4..8]) }
}
}
#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
pub struct Degree {
pub min: i16,
pub max: i16,
}
impl FromByteSlice for Degree {
fn bytes_expected() -> usize {
4
}
fn from_le_byte_slice(bytes: &[u8]) -> Degree {
Degree { min: <i16>::from_le_byte_slice(&bytes[0..2]), max: <i16>::from_le_byte_slice(&bytes[2..4]) }
}
}
#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
pub struct PositionReachedEvent {
pub servo_channel: u16,
pub position: i16,
}
impl FromByteSlice for PositionReachedEvent {
fn bytes_expected() -> usize {
4
}
fn from_le_byte_slice(bytes: &[u8]) -> PositionReachedEvent {
PositionReachedEvent { servo_channel: <u16>::from_le_byte_slice(&bytes[0..2]), position: <i16>::from_le_byte_slice(&bytes[2..4]) }
}
}
#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
pub struct SpitfpErrorCount {
pub error_count_ack_checksum: u32,
pub error_count_message_checksum: u32,
pub error_count_frame: u32,
pub error_count_overflow: u32,
}
impl FromByteSlice for SpitfpErrorCount {
fn bytes_expected() -> usize {
16
}
fn from_le_byte_slice(bytes: &[u8]) -> SpitfpErrorCount {
SpitfpErrorCount {
error_count_ack_checksum: <u32>::from_le_byte_slice(&bytes[0..4]),
error_count_message_checksum: <u32>::from_le_byte_slice(&bytes[4..8]),
error_count_frame: <u32>::from_le_byte_slice(&bytes[8..12]),
error_count_overflow: <u32>::from_le_byte_slice(&bytes[12..16]),
}
}
}
#[derive(Clone, Debug, Default, PartialEq, Eq, Hash)]
pub struct Identity {
pub uid: String,
pub connected_uid: String,
pub position: char,
pub hardware_version: [u8; 3],
pub firmware_version: [u8; 3],
pub device_identifier: u16,
}
impl FromByteSlice for Identity {
fn bytes_expected() -> usize {
25
}
fn from_le_byte_slice(bytes: &[u8]) -> Identity {
Identity {
uid: <String>::from_le_byte_slice(&bytes[0..8]),
connected_uid: <String>::from_le_byte_slice(&bytes[8..16]),
position: <char>::from_le_byte_slice(&bytes[16..17]),
hardware_version: <[u8; 3]>::from_le_byte_slice(&bytes[17..20]),
firmware_version: <[u8; 3]>::from_le_byte_slice(&bytes[20..23]),
device_identifier: <u16>::from_le_byte_slice(&bytes[23..25]),
}
}
}
#[derive(Clone)]
pub struct ServoV2Bricklet {
device: Device,
}
impl ServoV2Bricklet {
pub const DEVICE_IDENTIFIER: u16 = 2157;
pub const DEVICE_DISPLAY_NAME: &'static str = "Servo Bricklet 2.0";
pub fn new(uid: &str, connection: AsyncIpConnection) -> ServoV2Bricklet {
let mut result = ServoV2Bricklet { device: Device::new([2, 0, 10], uid, connection, Self::DEVICE_DISPLAY_NAME) };
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetStatus) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetEnable) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetEnabled) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPosition) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPosition) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetCurrentPosition) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetCurrentVelocity) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetMotionConfiguration) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetMotionConfiguration) as usize] =
ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPulseWidth) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPulseWidth) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetDegree) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetDegree) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPeriod) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPeriod) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetServoCurrent) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetServoCurrentConfiguration) as usize] =
ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetServoCurrentConfiguration) as usize] =
ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetInputVoltageConfiguration) as usize] =
ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetInputVoltageConfiguration) as usize] =
ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetOverallCurrent) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetInputVoltage) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetCurrentCalibration) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetCurrentCalibration) as usize] =
ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPositionReachedCallbackConfiguration) as usize] =
ResponseExpectedFlag::True;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPositionReachedCallbackConfiguration) as usize] =
ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetSpitfpErrorCount) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetBootloaderMode) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetBootloaderMode) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetWriteFirmwarePointer) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::WriteFirmware) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::SetStatusLedConfig) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetStatusLedConfig) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetChipTemperature) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::Reset) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::WriteUid) as usize] = ResponseExpectedFlag::False;
result.device.response_expected[u8::from(ServoV2BrickletFunction::ReadUid) as usize] = ResponseExpectedFlag::AlwaysTrue;
result.device.response_expected[u8::from(ServoV2BrickletFunction::GetIdentity) as usize] = ResponseExpectedFlag::AlwaysTrue;
result
}
pub fn get_response_expected(&mut self, fun: ServoV2BrickletFunction) -> Result<bool, GetResponseExpectedError> {
self.device.get_response_expected(u8::from(fun))
}
pub fn set_response_expected(&mut self, fun: ServoV2BrickletFunction, response_expected: bool) -> Result<(), SetResponseExpectedError> {
self.device.set_response_expected(u8::from(fun), response_expected)
}
pub fn set_response_expected_all(&mut self, response_expected: bool) {
self.device.set_response_expected_all(response_expected)
}
pub fn get_api_version(&self) -> [u8; 3] {
self.device.api_version
}
pub async fn get_position_reached_callback_receiver(&mut self) -> impl Stream<Item = PositionReachedEvent> {
self.device
.get_callback_receiver(u8::from(ServoV2BrickletFunction::CallbackPositionReached))
.await
.map(|p| PositionReachedEvent::from_le_byte_slice(p.body()))
}
pub async fn get_status(&mut self) -> Result<Status, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetStatus), &payload).await?;
Ok(Status::from_le_byte_slice(result.body()))
}
pub async fn set_enable(&mut self, servo_channel: u16, enable: bool) -> Result<(), TinkerforgeError> {
let mut payload = [0; 3];
servo_channel.write_to_slice(&mut payload[0..2]);
enable.write_to_slice(&mut payload[2..3]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetEnable), &payload).await?;
Ok(())
}
pub async fn get_enabled(&mut self, servo_channel: u16) -> Result<bool, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetEnabled), &payload).await?;
Ok(bool::from_le_byte_slice(result.body()))
}
pub async fn set_position(&mut self, servo_channel: u16, position: i16) -> Result<(), TinkerforgeError> {
let mut payload = [0; 4];
servo_channel.write_to_slice(&mut payload[0..2]);
position.write_to_slice(&mut payload[2..4]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPosition), &payload).await?;
Ok(())
}
pub async fn get_position(&mut self, servo_channel: u16) -> Result<i16, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPosition), &payload).await?;
Ok(i16::from_le_byte_slice(result.body()))
}
pub async fn get_current_position(&mut self, servo_channel: u16) -> Result<i16, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetCurrentPosition), &payload).await?;
Ok(i16::from_le_byte_slice(result.body()))
}
pub async fn get_current_velocity(&mut self, servo_channel: u16) -> Result<u16, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetCurrentVelocity), &payload).await?;
Ok(u16::from_le_byte_slice(result.body()))
}
pub async fn set_motion_configuration(
&mut self,
servo_channel: u16,
velocity: u32,
acceleration: u32,
deceleration: u32,
) -> Result<(), TinkerforgeError> {
let mut payload = [0; 14];
servo_channel.write_to_slice(&mut payload[0..2]);
velocity.write_to_slice(&mut payload[2..6]);
acceleration.write_to_slice(&mut payload[6..10]);
deceleration.write_to_slice(&mut payload[10..14]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetMotionConfiguration), &payload).await?;
Ok(())
}
pub async fn get_motion_configuration(&mut self, servo_channel: u16) -> Result<MotionConfiguration, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetMotionConfiguration), &payload).await?;
Ok(MotionConfiguration::from_le_byte_slice(result.body()))
}
pub async fn set_pulse_width(&mut self, servo_channel: u16, min: u32, max: u32) -> Result<(), TinkerforgeError> {
let mut payload = [0; 10];
servo_channel.write_to_slice(&mut payload[0..2]);
min.write_to_slice(&mut payload[2..6]);
max.write_to_slice(&mut payload[6..10]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPulseWidth), &payload).await?;
Ok(())
}
pub async fn get_pulse_width(&mut self, servo_channel: u16) -> Result<PulseWidth, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPulseWidth), &payload).await?;
Ok(PulseWidth::from_le_byte_slice(result.body()))
}
pub async fn set_degree(&mut self, servo_channel: u16, min: i16, max: i16) -> Result<(), TinkerforgeError> {
let mut payload = [0; 6];
servo_channel.write_to_slice(&mut payload[0..2]);
min.write_to_slice(&mut payload[2..4]);
max.write_to_slice(&mut payload[4..6]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetDegree), &payload).await?;
Ok(())
}
pub async fn get_degree(&mut self, servo_channel: u16) -> Result<Degree, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetDegree), &payload).await?;
Ok(Degree::from_le_byte_slice(result.body()))
}
pub async fn set_period(&mut self, servo_channel: u16, period: u32) -> Result<(), TinkerforgeError> {
let mut payload = [0; 6];
servo_channel.write_to_slice(&mut payload[0..2]);
period.write_to_slice(&mut payload[2..6]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPeriod), &payload).await?;
Ok(())
}
pub async fn get_period(&mut self, servo_channel: u16) -> Result<u32, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPeriod), &payload).await?;
Ok(u32::from_le_byte_slice(result.body()))
}
pub async fn get_servo_current(&mut self, servo_channel: u16) -> Result<u16, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetServoCurrent), &payload).await?;
Ok(u16::from_le_byte_slice(result.body()))
}
pub async fn set_servo_current_configuration(&mut self, servo_channel: u16, averaging_duration: u8) -> Result<(), TinkerforgeError> {
let mut payload = [0; 3];
servo_channel.write_to_slice(&mut payload[0..2]);
averaging_duration.write_to_slice(&mut payload[2..3]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetServoCurrentConfiguration), &payload).await?;
Ok(())
}
pub async fn get_servo_current_configuration(&mut self, servo_channel: u16) -> Result<u8, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetServoCurrentConfiguration), &payload).await?;
Ok(u8::from_le_byte_slice(result.body()))
}
pub async fn set_input_voltage_configuration(&mut self, averaging_duration: u8) -> Result<(), TinkerforgeError> {
let mut payload = [0; 1];
averaging_duration.write_to_slice(&mut payload[0..1]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetInputVoltageConfiguration), &payload).await?;
Ok(())
}
pub async fn get_input_voltage_configuration(&mut self) -> Result<u8, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetInputVoltageConfiguration), &payload).await?;
Ok(u8::from_le_byte_slice(result.body()))
}
pub async fn get_overall_current(&mut self) -> Result<u16, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetOverallCurrent), &payload).await?;
Ok(u16::from_le_byte_slice(result.body()))
}
pub async fn get_input_voltage(&mut self) -> Result<u16, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetInputVoltage), &payload).await?;
Ok(u16::from_le_byte_slice(result.body()))
}
pub async fn set_current_calibration(&mut self, offset: &[i16; 10]) -> Result<(), TinkerforgeError> {
let mut payload = [0; 20];
offset.write_to_slice(&mut payload[0..20]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetCurrentCalibration), &payload).await?;
Ok(())
}
pub async fn get_current_calibration(&mut self) -> Result<Box<[i16; 10]>, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetCurrentCalibration), &payload).await?;
Ok(Box::<[i16; 10]>::from_le_byte_slice(result.body()))
}
pub async fn set_position_reached_callback_configuration(&mut self, servo_channel: u16, enabled: bool) -> Result<(), TinkerforgeError> {
let mut payload = [0; 3];
servo_channel.write_to_slice(&mut payload[0..2]);
enabled.write_to_slice(&mut payload[2..3]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPositionReachedCallbackConfiguration), &payload).await?;
Ok(())
}
pub async fn get_position_reached_callback_configuration(&mut self, servo_channel: u16) -> Result<bool, TinkerforgeError> {
let mut payload = [0; 2];
servo_channel.write_to_slice(&mut payload[0..2]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPositionReachedCallbackConfiguration), &payload).await?;
Ok(bool::from_le_byte_slice(result.body()))
}
pub async fn get_spitfp_error_count(&mut self) -> Result<SpitfpErrorCount, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetSpitfpErrorCount), &payload).await?;
Ok(SpitfpErrorCount::from_le_byte_slice(result.body()))
}
pub async fn set_bootloader_mode(&mut self, mode: u8) -> Result<u8, TinkerforgeError> {
let mut payload = [0; 1];
mode.write_to_slice(&mut payload[0..1]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::SetBootloaderMode), &payload).await?;
Ok(u8::from_le_byte_slice(result.body()))
}
pub async fn get_bootloader_mode(&mut self) -> Result<u8, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetBootloaderMode), &payload).await?;
Ok(u8::from_le_byte_slice(result.body()))
}
pub async fn set_write_firmware_pointer(&mut self, pointer: u32) -> Result<(), TinkerforgeError> {
let mut payload = [0; 4];
pointer.write_to_slice(&mut payload[0..4]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetWriteFirmwarePointer), &payload).await?;
Ok(())
}
pub async fn write_firmware(&mut self, data: &[u8; 64]) -> Result<u8, TinkerforgeError> {
let mut payload = [0; 64];
data.write_to_slice(&mut payload[0..64]);
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::WriteFirmware), &payload).await?;
Ok(u8::from_le_byte_slice(result.body()))
}
pub async fn set_status_led_config(&mut self, config: u8) -> Result<(), TinkerforgeError> {
let mut payload = [0; 1];
config.write_to_slice(&mut payload[0..1]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::SetStatusLedConfig), &payload).await?;
Ok(())
}
pub async fn get_status_led_config(&mut self) -> Result<u8, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetStatusLedConfig), &payload).await?;
Ok(u8::from_le_byte_slice(result.body()))
}
pub async fn get_chip_temperature(&mut self) -> Result<i16, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetChipTemperature), &payload).await?;
Ok(i16::from_le_byte_slice(result.body()))
}
pub async fn reset(&mut self) -> Result<(), TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::Reset), &payload).await?;
Ok(())
}
pub async fn write_uid(&mut self, uid: u32) -> Result<(), TinkerforgeError> {
let mut payload = [0; 4];
uid.write_to_slice(&mut payload[0..4]);
#[allow(unused_variables)]
let result = self.device.set(u8::from(ServoV2BrickletFunction::WriteUid), &payload).await?;
Ok(())
}
pub async fn read_uid(&mut self) -> Result<u32, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::ReadUid), &payload).await?;
Ok(u32::from_le_byte_slice(result.body()))
}
pub async fn get_identity(&mut self) -> Result<Identity, TinkerforgeError> {
let payload = [0; 0];
#[allow(unused_variables)]
let result = self.device.get(u8::from(ServoV2BrickletFunction::GetIdentity), &payload).await?;
Ok(Identity::from_le_byte_slice(result.body()))
}
}