1#[allow(unused_imports)]
15use crate::{
16 base58::Uid, byte_converter::*, device::*, error::TinkerforgeError, ip_connection::async_io::AsyncIpConnection,
17 low_level_traits::LowLevelRead,
18};
19#[allow(unused_imports)]
20use futures_core::Stream;
21#[allow(unused_imports)]
22use tokio_stream::StreamExt;
23pub enum ServoV2BrickletFunction {
24 GetStatus,
25 SetEnable,
26 GetEnabled,
27 SetPosition,
28 GetPosition,
29 GetCurrentPosition,
30 GetCurrentVelocity,
31 SetMotionConfiguration,
32 GetMotionConfiguration,
33 SetPulseWidth,
34 GetPulseWidth,
35 SetDegree,
36 GetDegree,
37 SetPeriod,
38 GetPeriod,
39 GetServoCurrent,
40 SetServoCurrentConfiguration,
41 GetServoCurrentConfiguration,
42 SetInputVoltageConfiguration,
43 GetInputVoltageConfiguration,
44 GetOverallCurrent,
45 GetInputVoltage,
46 SetCurrentCalibration,
47 GetCurrentCalibration,
48 SetPositionReachedCallbackConfiguration,
49 GetPositionReachedCallbackConfiguration,
50 GetSpitfpErrorCount,
51 SetBootloaderMode,
52 GetBootloaderMode,
53 SetWriteFirmwarePointer,
54 WriteFirmware,
55 SetStatusLedConfig,
56 GetStatusLedConfig,
57 GetChipTemperature,
58 Reset,
59 WriteUid,
60 ReadUid,
61 GetIdentity,
62 CallbackPositionReached,
63}
64impl From<ServoV2BrickletFunction> for u8 {
65 fn from(fun: ServoV2BrickletFunction) -> Self {
66 match fun {
67 ServoV2BrickletFunction::GetStatus => 1,
68 ServoV2BrickletFunction::SetEnable => 2,
69 ServoV2BrickletFunction::GetEnabled => 3,
70 ServoV2BrickletFunction::SetPosition => 4,
71 ServoV2BrickletFunction::GetPosition => 5,
72 ServoV2BrickletFunction::GetCurrentPosition => 6,
73 ServoV2BrickletFunction::GetCurrentVelocity => 7,
74 ServoV2BrickletFunction::SetMotionConfiguration => 8,
75 ServoV2BrickletFunction::GetMotionConfiguration => 9,
76 ServoV2BrickletFunction::SetPulseWidth => 10,
77 ServoV2BrickletFunction::GetPulseWidth => 11,
78 ServoV2BrickletFunction::SetDegree => 12,
79 ServoV2BrickletFunction::GetDegree => 13,
80 ServoV2BrickletFunction::SetPeriod => 14,
81 ServoV2BrickletFunction::GetPeriod => 15,
82 ServoV2BrickletFunction::GetServoCurrent => 16,
83 ServoV2BrickletFunction::SetServoCurrentConfiguration => 17,
84 ServoV2BrickletFunction::GetServoCurrentConfiguration => 18,
85 ServoV2BrickletFunction::SetInputVoltageConfiguration => 19,
86 ServoV2BrickletFunction::GetInputVoltageConfiguration => 20,
87 ServoV2BrickletFunction::GetOverallCurrent => 21,
88 ServoV2BrickletFunction::GetInputVoltage => 22,
89 ServoV2BrickletFunction::SetCurrentCalibration => 23,
90 ServoV2BrickletFunction::GetCurrentCalibration => 24,
91 ServoV2BrickletFunction::SetPositionReachedCallbackConfiguration => 25,
92 ServoV2BrickletFunction::GetPositionReachedCallbackConfiguration => 26,
93 ServoV2BrickletFunction::GetSpitfpErrorCount => 234,
94 ServoV2BrickletFunction::SetBootloaderMode => 235,
95 ServoV2BrickletFunction::GetBootloaderMode => 236,
96 ServoV2BrickletFunction::SetWriteFirmwarePointer => 237,
97 ServoV2BrickletFunction::WriteFirmware => 238,
98 ServoV2BrickletFunction::SetStatusLedConfig => 239,
99 ServoV2BrickletFunction::GetStatusLedConfig => 240,
100 ServoV2BrickletFunction::GetChipTemperature => 242,
101 ServoV2BrickletFunction::Reset => 243,
102 ServoV2BrickletFunction::WriteUid => 248,
103 ServoV2BrickletFunction::ReadUid => 249,
104 ServoV2BrickletFunction::GetIdentity => 255,
105 ServoV2BrickletFunction::CallbackPositionReached => 27,
106 }
107 }
108}
109pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_BOOTLOADER: u8 = 0;
110pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_FIRMWARE: u8 = 1;
111pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_BOOTLOADER_WAIT_FOR_REBOOT: u8 = 2;
112pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_REBOOT: u8 = 3;
113pub const SERVO_V2_BRICKLET_BOOTLOADER_MODE_FIRMWARE_WAIT_FOR_ERASE_AND_REBOOT: u8 = 4;
114pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_OK: u8 = 0;
115pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_INVALID_MODE: u8 = 1;
116pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_NO_CHANGE: u8 = 2;
117pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_ENTRY_FUNCTION_NOT_PRESENT: u8 = 3;
118pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_DEVICE_IDENTIFIER_INCORRECT: u8 = 4;
119pub const SERVO_V2_BRICKLET_BOOTLOADER_STATUS_CRC_MISMATCH: u8 = 5;
120pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_OFF: u8 = 0;
121pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_ON: u8 = 1;
122pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_SHOW_HEARTBEAT: u8 = 2;
123pub const SERVO_V2_BRICKLET_STATUS_LED_CONFIG_SHOW_STATUS: u8 = 3;
124
125#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
126pub struct Status {
127 pub enabled: [bool; 10],
128 pub current_position: [i16; 10],
129 pub current_velocity: [i16; 10],
130 pub current: [u16; 10],
131 pub input_voltage: u16,
132}
133impl FromByteSlice for Status {
134 fn bytes_expected() -> usize {
135 64
136 }
137 fn from_le_byte_slice(bytes: &[u8]) -> Status {
138 Status {
139 enabled: <[bool; 10]>::from_le_byte_slice(&bytes[0..2]),
140 current_position: <[i16; 10]>::from_le_byte_slice(&bytes[2..22]),
141 current_velocity: <[i16; 10]>::from_le_byte_slice(&bytes[22..42]),
142 current: <[u16; 10]>::from_le_byte_slice(&bytes[42..62]),
143 input_voltage: <u16>::from_le_byte_slice(&bytes[62..64]),
144 }
145 }
146}
147
148#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
149pub struct MotionConfiguration {
150 pub velocity: u32,
151 pub acceleration: u32,
152 pub deceleration: u32,
153}
154impl FromByteSlice for MotionConfiguration {
155 fn bytes_expected() -> usize {
156 12
157 }
158 fn from_le_byte_slice(bytes: &[u8]) -> MotionConfiguration {
159 MotionConfiguration {
160 velocity: <u32>::from_le_byte_slice(&bytes[0..4]),
161 acceleration: <u32>::from_le_byte_slice(&bytes[4..8]),
162 deceleration: <u32>::from_le_byte_slice(&bytes[8..12]),
163 }
164 }
165}
166
167#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
168pub struct PulseWidth {
169 pub min: u32,
170 pub max: u32,
171}
172impl FromByteSlice for PulseWidth {
173 fn bytes_expected() -> usize {
174 8
175 }
176 fn from_le_byte_slice(bytes: &[u8]) -> PulseWidth {
177 PulseWidth { min: <u32>::from_le_byte_slice(&bytes[0..4]), max: <u32>::from_le_byte_slice(&bytes[4..8]) }
178 }
179}
180
181#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
182pub struct Degree {
183 pub min: i16,
184 pub max: i16,
185}
186impl FromByteSlice for Degree {
187 fn bytes_expected() -> usize {
188 4
189 }
190 fn from_le_byte_slice(bytes: &[u8]) -> Degree {
191 Degree { min: <i16>::from_le_byte_slice(&bytes[0..2]), max: <i16>::from_le_byte_slice(&bytes[2..4]) }
192 }
193}
194
195#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
196pub struct PositionReachedEvent {
197 pub servo_channel: u16,
198 pub position: i16,
199}
200impl FromByteSlice for PositionReachedEvent {
201 fn bytes_expected() -> usize {
202 4
203 }
204 fn from_le_byte_slice(bytes: &[u8]) -> PositionReachedEvent {
205 PositionReachedEvent { servo_channel: <u16>::from_le_byte_slice(&bytes[0..2]), position: <i16>::from_le_byte_slice(&bytes[2..4]) }
206 }
207}
208
209#[derive(Clone, Copy, Debug, Default, PartialEq, Eq, Hash)]
210pub struct SpitfpErrorCount {
211 pub error_count_ack_checksum: u32,
212 pub error_count_message_checksum: u32,
213 pub error_count_frame: u32,
214 pub error_count_overflow: u32,
215}
216impl FromByteSlice for SpitfpErrorCount {
217 fn bytes_expected() -> usize {
218 16
219 }
220 fn from_le_byte_slice(bytes: &[u8]) -> SpitfpErrorCount {
221 SpitfpErrorCount {
222 error_count_ack_checksum: <u32>::from_le_byte_slice(&bytes[0..4]),
223 error_count_message_checksum: <u32>::from_le_byte_slice(&bytes[4..8]),
224 error_count_frame: <u32>::from_le_byte_slice(&bytes[8..12]),
225 error_count_overflow: <u32>::from_le_byte_slice(&bytes[12..16]),
226 }
227 }
228}
229
230#[derive(Clone, Debug, Default, PartialEq, Eq, Hash)]
231pub struct Identity {
232 pub uid: String,
233 pub connected_uid: String,
234 pub position: char,
235 pub hardware_version: [u8; 3],
236 pub firmware_version: [u8; 3],
237 pub device_identifier: u16,
238}
239impl FromByteSlice for Identity {
240 fn bytes_expected() -> usize {
241 25
242 }
243 fn from_le_byte_slice(bytes: &[u8]) -> Identity {
244 Identity {
245 uid: <String>::from_le_byte_slice(&bytes[0..8]),
246 connected_uid: <String>::from_le_byte_slice(&bytes[8..16]),
247 position: <char>::from_le_byte_slice(&bytes[16..17]),
248 hardware_version: <[u8; 3]>::from_le_byte_slice(&bytes[17..20]),
249 firmware_version: <[u8; 3]>::from_le_byte_slice(&bytes[20..23]),
250 device_identifier: <u16>::from_le_byte_slice(&bytes[23..25]),
251 }
252 }
253}
254
255#[derive(Clone)]
257pub struct ServoV2Bricklet {
258 device: Device,
259}
260impl ServoV2Bricklet {
261 pub const DEVICE_IDENTIFIER: u16 = 2157;
262 pub const DEVICE_DISPLAY_NAME: &'static str = "Servo Bricklet 2.0";
263 pub fn new(uid: Uid, connection: AsyncIpConnection) -> ServoV2Bricklet {
265 let mut result = ServoV2Bricklet { device: Device::new([2, 0, 10], uid, connection, Self::DEVICE_DISPLAY_NAME) };
266 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetStatus) as usize] = ResponseExpectedFlag::AlwaysTrue;
267 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetEnable) as usize] = ResponseExpectedFlag::False;
268 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetEnabled) as usize] = ResponseExpectedFlag::AlwaysTrue;
269 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPosition) as usize] = ResponseExpectedFlag::False;
270 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPosition) as usize] = ResponseExpectedFlag::AlwaysTrue;
271 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetCurrentPosition) as usize] = ResponseExpectedFlag::AlwaysTrue;
272 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetCurrentVelocity) as usize] = ResponseExpectedFlag::AlwaysTrue;
273 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetMotionConfiguration) as usize] = ResponseExpectedFlag::False;
274 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetMotionConfiguration) as usize] =
275 ResponseExpectedFlag::AlwaysTrue;
276 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPulseWidth) as usize] = ResponseExpectedFlag::False;
277 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPulseWidth) as usize] = ResponseExpectedFlag::AlwaysTrue;
278 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetDegree) as usize] = ResponseExpectedFlag::False;
279 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetDegree) as usize] = ResponseExpectedFlag::AlwaysTrue;
280 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPeriod) as usize] = ResponseExpectedFlag::False;
281 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPeriod) as usize] = ResponseExpectedFlag::AlwaysTrue;
282 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetServoCurrent) as usize] = ResponseExpectedFlag::AlwaysTrue;
283 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetServoCurrentConfiguration) as usize] =
284 ResponseExpectedFlag::False;
285 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetServoCurrentConfiguration) as usize] =
286 ResponseExpectedFlag::AlwaysTrue;
287 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetInputVoltageConfiguration) as usize] =
288 ResponseExpectedFlag::False;
289 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetInputVoltageConfiguration) as usize] =
290 ResponseExpectedFlag::AlwaysTrue;
291 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetOverallCurrent) as usize] = ResponseExpectedFlag::AlwaysTrue;
292 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetInputVoltage) as usize] = ResponseExpectedFlag::AlwaysTrue;
293 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetCurrentCalibration) as usize] = ResponseExpectedFlag::False;
294 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetCurrentCalibration) as usize] =
295 ResponseExpectedFlag::AlwaysTrue;
296 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetPositionReachedCallbackConfiguration) as usize] =
297 ResponseExpectedFlag::True;
298 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetPositionReachedCallbackConfiguration) as usize] =
299 ResponseExpectedFlag::AlwaysTrue;
300 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetSpitfpErrorCount) as usize] = ResponseExpectedFlag::AlwaysTrue;
301 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetBootloaderMode) as usize] = ResponseExpectedFlag::AlwaysTrue;
302 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetBootloaderMode) as usize] = ResponseExpectedFlag::AlwaysTrue;
303 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetWriteFirmwarePointer) as usize] = ResponseExpectedFlag::False;
304 result.device.response_expected[u8::from(ServoV2BrickletFunction::WriteFirmware) as usize] = ResponseExpectedFlag::AlwaysTrue;
305 result.device.response_expected[u8::from(ServoV2BrickletFunction::SetStatusLedConfig) as usize] = ResponseExpectedFlag::False;
306 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetStatusLedConfig) as usize] = ResponseExpectedFlag::AlwaysTrue;
307 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetChipTemperature) as usize] = ResponseExpectedFlag::AlwaysTrue;
308 result.device.response_expected[u8::from(ServoV2BrickletFunction::Reset) as usize] = ResponseExpectedFlag::False;
309 result.device.response_expected[u8::from(ServoV2BrickletFunction::WriteUid) as usize] = ResponseExpectedFlag::False;
310 result.device.response_expected[u8::from(ServoV2BrickletFunction::ReadUid) as usize] = ResponseExpectedFlag::AlwaysTrue;
311 result.device.response_expected[u8::from(ServoV2BrickletFunction::GetIdentity) as usize] = ResponseExpectedFlag::AlwaysTrue;
312 result
313 }
314
315 pub fn get_response_expected(&mut self, fun: ServoV2BrickletFunction) -> Result<bool, GetResponseExpectedError> {
330 self.device.get_response_expected(u8::from(fun))
331 }
332
333 pub fn set_response_expected(&mut self, fun: ServoV2BrickletFunction, response_expected: bool) -> Result<(), SetResponseExpectedError> {
342 self.device.set_response_expected(u8::from(fun), response_expected)
343 }
344
345 pub fn set_response_expected_all(&mut self, response_expected: bool) {
347 self.device.set_response_expected_all(response_expected)
348 }
349
350 pub fn get_api_version(&self) -> [u8; 3] {
353 self.device.api_version
354 }
355
356 pub async fn get_position_reached_callback_receiver(&mut self) -> impl Stream<Item = PositionReachedEvent> {
373 self.device
374 .get_callback_receiver(u8::from(ServoV2BrickletFunction::CallbackPositionReached))
375 .await
376 .map(|p| PositionReachedEvent::from_le_byte_slice(p.body()))
377 }
378
379 pub async fn get_status(&mut self) -> Result<Status, TinkerforgeError> {
392 let payload = [0; 0];
393
394 #[allow(unused_variables)]
395 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetStatus), &payload).await?;
396 Ok(Status::from_le_byte_slice(result.body()))
397 }
398
399 pub async fn set_enable(&mut self, servo_channel: u16, enable: bool) -> Result<(), TinkerforgeError> {
402 let mut payload = [0; 3];
403 servo_channel.write_to_slice(&mut payload[0..2]);
404 enable.write_to_slice(&mut payload[2..3]);
405
406 #[allow(unused_variables)]
407 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetEnable), &payload).await?;
408 Ok(())
409 }
410
411 pub async fn get_enabled(&mut self, servo_channel: u16) -> Result<bool, TinkerforgeError> {
413 let mut payload = [0; 2];
414 servo_channel.write_to_slice(&mut payload[0..2]);
415
416 #[allow(unused_variables)]
417 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetEnabled), &payload).await?;
418 Ok(bool::from_le_byte_slice(result.body()))
419 }
420
421 pub async fn set_position(&mut self, servo_channel: u16, position: i16) -> Result<(), TinkerforgeError> {
430 let mut payload = [0; 4];
431 servo_channel.write_to_slice(&mut payload[0..2]);
432 position.write_to_slice(&mut payload[2..4]);
433
434 #[allow(unused_variables)]
435 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPosition), &payload).await?;
436 Ok(())
437 }
438
439 pub async fn get_position(&mut self, servo_channel: u16) -> Result<i16, TinkerforgeError> {
441 let mut payload = [0; 2];
442 servo_channel.write_to_slice(&mut payload[0..2]);
443
444 #[allow(unused_variables)]
445 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPosition), &payload).await?;
446 Ok(i16::from_le_byte_slice(result.body()))
447 }
448
449 pub async fn get_current_position(&mut self, servo_channel: u16) -> Result<i16, TinkerforgeError> {
453 let mut payload = [0; 2];
454 servo_channel.write_to_slice(&mut payload[0..2]);
455
456 #[allow(unused_variables)]
457 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetCurrentPosition), &payload).await?;
458 Ok(i16::from_le_byte_slice(result.body()))
459 }
460
461 pub async fn get_current_velocity(&mut self, servo_channel: u16) -> Result<u16, TinkerforgeError> {
465 let mut payload = [0; 2];
466 servo_channel.write_to_slice(&mut payload[0..2]);
467
468 #[allow(unused_variables)]
469 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetCurrentVelocity), &payload).await?;
470 Ok(u16::from_le_byte_slice(result.body()))
471 }
472
473 pub async fn set_motion_configuration(
481 &mut self,
482 servo_channel: u16,
483 velocity: u32,
484 acceleration: u32,
485 deceleration: u32,
486 ) -> Result<(), TinkerforgeError> {
487 let mut payload = [0; 14];
488 servo_channel.write_to_slice(&mut payload[0..2]);
489 velocity.write_to_slice(&mut payload[2..6]);
490 acceleration.write_to_slice(&mut payload[6..10]);
491 deceleration.write_to_slice(&mut payload[10..14]);
492
493 #[allow(unused_variables)]
494 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetMotionConfiguration), &payload).await?;
495 Ok(())
496 }
497
498 pub async fn get_motion_configuration(&mut self, servo_channel: u16) -> Result<MotionConfiguration, TinkerforgeError> {
500 let mut payload = [0; 2];
501 servo_channel.write_to_slice(&mut payload[0..2]);
502
503 #[allow(unused_variables)]
504 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetMotionConfiguration), &payload).await?;
505 Ok(MotionConfiguration::from_le_byte_slice(result.body()))
506 }
507
508 pub async fn set_pulse_width(&mut self, servo_channel: u16, min: u32, max: u32) -> Result<(), TinkerforgeError> {
526 let mut payload = [0; 10];
527 servo_channel.write_to_slice(&mut payload[0..2]);
528 min.write_to_slice(&mut payload[2..6]);
529 max.write_to_slice(&mut payload[6..10]);
530
531 #[allow(unused_variables)]
532 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPulseWidth), &payload).await?;
533 Ok(())
534 }
535
536 pub async fn get_pulse_width(&mut self, servo_channel: u16) -> Result<PulseWidth, TinkerforgeError> {
539 let mut payload = [0; 2];
540 servo_channel.write_to_slice(&mut payload[0..2]);
541
542 #[allow(unused_variables)]
543 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPulseWidth), &payload).await?;
544 Ok(PulseWidth::from_le_byte_slice(result.body()))
545 }
546
547 pub async fn set_degree(&mut self, servo_channel: u16, min: i16, max: i16) -> Result<(), TinkerforgeError> {
578 let mut payload = [0; 6];
579 servo_channel.write_to_slice(&mut payload[0..2]);
580 min.write_to_slice(&mut payload[2..4]);
581 max.write_to_slice(&mut payload[4..6]);
582
583 #[allow(unused_variables)]
584 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetDegree), &payload).await?;
585 Ok(())
586 }
587
588 pub async fn get_degree(&mut self, servo_channel: u16) -> Result<Degree, TinkerforgeError> {
591 let mut payload = [0; 2];
592 servo_channel.write_to_slice(&mut payload[0..2]);
593
594 #[allow(unused_variables)]
595 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetDegree), &payload).await?;
596 Ok(Degree::from_le_byte_slice(result.body()))
597 }
598
599 pub async fn set_period(&mut self, servo_channel: u16, period: u32) -> Result<(), TinkerforgeError> {
615 let mut payload = [0; 6];
616 servo_channel.write_to_slice(&mut payload[0..2]);
617 period.write_to_slice(&mut payload[2..6]);
618
619 #[allow(unused_variables)]
620 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPeriod), &payload).await?;
621 Ok(())
622 }
623
624 pub async fn get_period(&mut self, servo_channel: u16) -> Result<u32, TinkerforgeError> {
626 let mut payload = [0; 2];
627 servo_channel.write_to_slice(&mut payload[0..2]);
628
629 #[allow(unused_variables)]
630 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPeriod), &payload).await?;
631 Ok(u32::from_le_byte_slice(result.body()))
632 }
633
634 pub async fn get_servo_current(&mut self, servo_channel: u16) -> Result<u16, TinkerforgeError> {
636 let mut payload = [0; 2];
637 servo_channel.write_to_slice(&mut payload[0..2]);
638
639 #[allow(unused_variables)]
640 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetServoCurrent), &payload).await?;
641 Ok(u16::from_le_byte_slice(result.body()))
642 }
643
644 pub async fn set_servo_current_configuration(&mut self, servo_channel: u16, averaging_duration: u8) -> Result<(), TinkerforgeError> {
646 let mut payload = [0; 3];
647 servo_channel.write_to_slice(&mut payload[0..2]);
648 averaging_duration.write_to_slice(&mut payload[2..3]);
649
650 #[allow(unused_variables)]
651 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetServoCurrentConfiguration), &payload).await?;
652 Ok(())
653 }
654
655 pub async fn get_servo_current_configuration(&mut self, servo_channel: u16) -> Result<u8, TinkerforgeError> {
658 let mut payload = [0; 2];
659 servo_channel.write_to_slice(&mut payload[0..2]);
660
661 #[allow(unused_variables)]
662 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetServoCurrentConfiguration), &payload).await?;
663 Ok(u8::from_le_byte_slice(result.body()))
664 }
665
666 pub async fn set_input_voltage_configuration(&mut self, averaging_duration: u8) -> Result<(), TinkerforgeError> {
668 let mut payload = [0; 1];
669 averaging_duration.write_to_slice(&mut payload[0..1]);
670
671 #[allow(unused_variables)]
672 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetInputVoltageConfiguration), &payload).await?;
673 Ok(())
674 }
675
676 pub async fn get_input_voltage_configuration(&mut self) -> Result<u8, TinkerforgeError> {
678 let payload = [0; 0];
679
680 #[allow(unused_variables)]
681 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetInputVoltageConfiguration), &payload).await?;
682 Ok(u8::from_le_byte_slice(result.body()))
683 }
684
685 pub async fn get_overall_current(&mut self) -> Result<u16, TinkerforgeError> {
687 let payload = [0; 0];
688
689 #[allow(unused_variables)]
690 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetOverallCurrent), &payload).await?;
691 Ok(u16::from_le_byte_slice(result.body()))
692 }
693
694 pub async fn get_input_voltage(&mut self) -> Result<u16, TinkerforgeError> {
697 let payload = [0; 0];
698
699 #[allow(unused_variables)]
700 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetInputVoltage), &payload).await?;
701 Ok(u16::from_le_byte_slice(result.body()))
702 }
703
704 pub async fn set_current_calibration(&mut self, offset: &[i16; 10]) -> Result<(), TinkerforgeError> {
708 let mut payload = [0; 20];
709 offset.write_to_slice(&mut payload[0..20]);
710
711 #[allow(unused_variables)]
712 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetCurrentCalibration), &payload).await?;
713 Ok(())
714 }
715
716 pub async fn get_current_calibration(&mut self) -> Result<Box<[i16; 10]>, TinkerforgeError> {
718 let payload = [0; 0];
719
720 #[allow(unused_variables)]
721 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetCurrentCalibration), &payload).await?;
722 Ok(Box::<[i16; 10]>::from_le_byte_slice(result.body()))
723 }
724
725 pub async fn set_position_reached_callback_configuration(&mut self, servo_channel: u16, enabled: bool) -> Result<(), TinkerforgeError> {
727 let mut payload = [0; 3];
728 servo_channel.write_to_slice(&mut payload[0..2]);
729 enabled.write_to_slice(&mut payload[2..3]);
730
731 #[allow(unused_variables)]
732 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetPositionReachedCallbackConfiguration), &payload).await?;
733 Ok(())
734 }
735
736 pub async fn get_position_reached_callback_configuration(&mut self, servo_channel: u16) -> Result<bool, TinkerforgeError> {
739 let mut payload = [0; 2];
740 servo_channel.write_to_slice(&mut payload[0..2]);
741
742 #[allow(unused_variables)]
743 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetPositionReachedCallbackConfiguration), &payload).await?;
744 Ok(bool::from_le_byte_slice(result.body()))
745 }
746
747 pub async fn get_spitfp_error_count(&mut self) -> Result<SpitfpErrorCount, TinkerforgeError> {
759 let payload = [0; 0];
760
761 #[allow(unused_variables)]
762 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetSpitfpErrorCount), &payload).await?;
763 Ok(SpitfpErrorCount::from_le_byte_slice(result.body()))
764 }
765
766 pub async fn set_bootloader_mode(&mut self, mode: u8) -> Result<u8, TinkerforgeError> {
789 let mut payload = [0; 1];
790 mode.write_to_slice(&mut payload[0..1]);
791
792 #[allow(unused_variables)]
793 let result = self.device.get(u8::from(ServoV2BrickletFunction::SetBootloaderMode), &payload).await?;
794 Ok(u8::from_le_byte_slice(result.body()))
795 }
796
797 pub async fn get_bootloader_mode(&mut self) -> Result<u8, TinkerforgeError> {
806 let payload = [0; 0];
807
808 #[allow(unused_variables)]
809 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetBootloaderMode), &payload).await?;
810 Ok(u8::from_le_byte_slice(result.body()))
811 }
812
813 pub async fn set_write_firmware_pointer(&mut self, pointer: u32) -> Result<(), TinkerforgeError> {
820 let mut payload = [0; 4];
821 pointer.write_to_slice(&mut payload[0..4]);
822
823 #[allow(unused_variables)]
824 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetWriteFirmwarePointer), &payload).await?;
825 Ok(())
826 }
827
828 pub async fn write_firmware(&mut self, data: &[u8; 64]) -> Result<u8, TinkerforgeError> {
837 let mut payload = [0; 64];
838 data.write_to_slice(&mut payload[0..64]);
839
840 #[allow(unused_variables)]
841 let result = self.device.get(u8::from(ServoV2BrickletFunction::WriteFirmware), &payload).await?;
842 Ok(u8::from_le_byte_slice(result.body()))
843 }
844
845 pub async fn set_status_led_config(&mut self, config: u8) -> Result<(), TinkerforgeError> {
859 let mut payload = [0; 1];
860 config.write_to_slice(&mut payload[0..1]);
861
862 #[allow(unused_variables)]
863 let result = self.device.set(u8::from(ServoV2BrickletFunction::SetStatusLedConfig), &payload).await?;
864 Ok(())
865 }
866
867 pub async fn get_status_led_config(&mut self) -> Result<u8, TinkerforgeError> {
875 let payload = [0; 0];
876
877 #[allow(unused_variables)]
878 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetStatusLedConfig), &payload).await?;
879 Ok(u8::from_le_byte_slice(result.body()))
880 }
881
882 pub async fn get_chip_temperature(&mut self) -> Result<i16, TinkerforgeError> {
889 let payload = [0; 0];
890
891 #[allow(unused_variables)]
892 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetChipTemperature), &payload).await?;
893 Ok(i16::from_le_byte_slice(result.body()))
894 }
895
896 pub async fn reset(&mut self) -> Result<(), TinkerforgeError> {
903 let payload = [0; 0];
904
905 #[allow(unused_variables)]
906 let result = self.device.set(u8::from(ServoV2BrickletFunction::Reset), &payload).await?;
907 Ok(())
908 }
909
910 pub async fn write_uid(&mut self, uid: u32) -> Result<(), TinkerforgeError> {
916 let mut payload = [0; 4];
917 uid.write_to_slice(&mut payload[0..4]);
918
919 #[allow(unused_variables)]
920 let result = self.device.set(u8::from(ServoV2BrickletFunction::WriteUid), &payload).await?;
921 Ok(())
922 }
923
924 pub async fn read_uid(&mut self) -> Result<u32, TinkerforgeError> {
927 let payload = [0; 0];
928
929 #[allow(unused_variables)]
930 let result = self.device.get(u8::from(ServoV2BrickletFunction::ReadUid), &payload).await?;
931 Ok(u32::from_le_byte_slice(result.body()))
932 }
933
934 pub async fn get_identity(&mut self) -> Result<Identity, TinkerforgeError> {
945 let payload = [0; 0];
946
947 #[allow(unused_variables)]
948 let result = self.device.get(u8::from(ServoV2BrickletFunction::GetIdentity), &payload).await?;
949 Ok(Identity::from_le_byte_slice(result.body()))
950 }
951}