-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathslaves_discovery_sequential.rs
58 lines (50 loc) · 2.17 KB
/
slaves_discovery_sequential.rs
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
use std::error::Error;
use etherage::{
EthernetSocket, SlaveAddress, CommunicationState,
master::Master,
sdo,
registers,
};
use bilge::prelude::u2;
#[tokio::main]
async fn main() -> Result<(), Box<dyn Error>> {
let master = Master::new(EthernetSocket::new("eno1")?);
master.reset_addresses().await;
// sequencial version
let mut iter = master.discover().await;
while let Some(mut slave) = iter.next().await {
let SlaveAddress::AutoIncremented(i) = slave.address()
else {panic!("slave already has a fixed address")};
let task = async {
slave.switch(CommunicationState::Init).await?;
slave.set_address(i+1).await?;
slave.init_coe().await?;
slave.switch(CommunicationState::PreOperational).await?;
let mut can = slave.coe().await;
let priority = u2::new(0);
let info = slave.physical_read(registers::dl::information).await?;
let mut name = [0; 50];
let mut hardware = [0; 50];
let mut software = [0; 50];
println!(" slave {}: {} - ecat type {:?} rev {:?} build {:?} - hardware {} software {}",
i,
can.sdo_read_slice(&sdo::device::name, priority, &mut name).await
.map(|s| std::str::from_utf8(s).unwrap().trim_end())
.unwrap_or("unidentified"),
info.ty(),
info.revision(),
info.build(),
can.sdo_read_slice(&sdo::device::hardware_version, priority, &mut hardware).await
.map(|s| std::str::from_utf8(s).unwrap().trim_end())
.unwrap_or("NA"),
can.sdo_read_slice(&sdo::device::software_version, priority, &mut software).await
.map(|s| std::str::from_utf8(s).unwrap().trim_end())
.unwrap_or("NA"),
);
Result::<_, Box<dyn Error>>::Ok(())
};
if let Err(err) = task.await
{println!("slave {}: failure: {:?}", i, err)}
}
Ok(())
}