libfranka-rs 0.8.0-alpha-1

Library to control Franka Emika robots
Documentation
// Copyright (c) 2021 Marco Boneberger
// Licensed under the EUPL-1.2-or-later
use crate::exception::FrankaException::ModelException;
use crate::network::Network;
use crate::robot::service_types::{
    LoadModelLibraryArchitecture, LoadModelLibraryRequest, LoadModelLibraryRequestWithHeader,
    LoadModelLibraryResponse, LoadModelLibrarySystem, RobotCommandEnum,
};
use crate::FrankaResult;
use std::fmt;
use std::fmt::Display;
use std::fmt::Formatter;
use std::fs::File;
use std::io::Write;
use std::mem::size_of;
use std::path::Path;

pub struct LibraryDownloader {}

impl LibraryDownloader {
    pub fn download(network: &mut Network, download_path: &Path) -> FrankaResult<()> {
        if cfg!(all(target_os = "linux", target_arch = "x86_64")) {
            let command = LoadModelLibraryRequestWithHeader {
                header: network.create_header_for_robot(
                    RobotCommandEnum::kLoadModelLibrary,
                    size_of::<LoadModelLibraryRequestWithHeader>(),
                ),
                request: LoadModelLibraryRequest {
                    architecture: LoadModelLibraryArchitecture::kX64,
                    system: LoadModelLibrarySystem::kLinux,
                },
            };
            let command_id: u32 = network.tcp_send_request(command);
            let mut buffer = Vec::<u8>::new();
            let _response: LoadModelLibraryResponse =
                network.tcp_blocking_receive_load_library_response(command_id, &mut buffer)?;
            let mut file = File::create(download_path).map_err(|_| ModelException {
                message: "Error writing model to disk:".to_string(),
            })?;
            file.write(&buffer).map_err(|_| ModelException {
                message: "Error writing model to disk:".to_string(),
            })?;
            Ok(())
        } else {
            Err(ModelException {
                message:
                    "Your platform is not yet supported for Downloading models. Please use Linux on\
                        x86_64 for now"
                        .to_string(),
            })
        }
    }
}

#[derive(Debug)]
pub struct UnsupportedPlatform {}

impl std::error::Error for UnsupportedPlatform {}

impl Display for UnsupportedPlatform {
    fn fmt(&self, f: &mut Formatter) -> fmt::Result {
        writeln!(
            f,
            "Your platform is not yet supported for Downloading models. Please use Linux on\
        x86_64 for now"
        )
    }
}