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
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123

/*
 * Copyright (C) 2018 Kubos Corporation
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

use adcs_api::AdcsError;

#[repr(C)]
#[derive(Clone, Debug)]
pub enum KADCSStatus {
    Ok,
    Error,
    ErrorConfig,
    ErrorNoResponse,
    ErrorInternal,
    ErrorMutex,
    ErrorNotImplemented,
}

impl Default for KADCSStatus {
    fn default() -> Self {
        KADCSStatus::Ok
    }
}

pub fn adcs_status_to_err(status: &KADCSStatus) -> Result<(), AdcsError> {
    match status {
        KADCSStatus::Ok => Ok(()),
        KADCSStatus::Error => Err(AdcsError::Generic),
        KADCSStatus::ErrorConfig => Err(AdcsError::Config),
        KADCSStatus::ErrorNoResponse => Err(AdcsError::NoResponse),
        KADCSStatus::ErrorInternal => Err(AdcsError::Internal),
        KADCSStatus::ErrorMutex => Err(AdcsError::Mutex),
        KADCSStatus::ErrorNotImplemented => Err(AdcsError::NotImplemented),
    }
}

#[derive(Clone, Debug, Eq, Hash, PartialEq)]
#[repr(C)]
pub struct timespec {
    pub tv_sec: i32,
    pub tv_nsec: i64,
}

pub trait ImtqFFI: Clone {
    fn k_adcs_init(&self, bus: *const u8, addr: u16, timeout: i32) -> KADCSStatus;
    fn k_adcs_terminate(&self);
    fn k_adcs_passthrough(
        &self,
        tx: *const u8,
        tx_len: i32,
        rx: *mut u8,
        rx_len: i32,
        delay: *const timespec,
    ) -> KADCSStatus;
    fn k_imtq_reset(&self) -> KADCSStatus;
    fn k_imtq_watchdog_start(&self) -> KADCSStatus;
    fn k_imtq_watchdog_stop(&self) -> KADCSStatus;
}

#[derive(Debug, Clone)]
pub struct ImtqRaw {}

impl ImtqFFI for ImtqRaw {
    fn k_adcs_init(&self, bus: *const u8, addr: u16, timeout: i32) -> KADCSStatus {
        unsafe { k_adcs_init(bus, addr, timeout) }
    }

    fn k_adcs_terminate(&self) {
        unsafe {
            k_adcs_terminate();
        }
    }

    fn k_adcs_passthrough(
        &self,
        tx: *const u8,
        tx_len: i32,
        rx: *mut u8,
        rx_len: i32,
        delay: *const timespec,
    ) -> KADCSStatus {
        unsafe { k_adcs_passthrough(tx, tx_len, rx, rx_len, delay) }
    }

    fn k_imtq_reset(&self) -> KADCSStatus {
        unsafe { k_imtq_reset() }
    }

    fn k_imtq_watchdog_start(&self) -> KADCSStatus {
        unsafe { k_imtq_watchdog_start() }
    }

    fn k_imtq_watchdog_stop(&self) -> KADCSStatus {
        unsafe { k_imtq_watchdog_stop() }
    }
}

extern "C" {
    pub fn k_adcs_init(bus: *const u8, addr: u16, timeout: i32) -> KADCSStatus;
    pub fn k_adcs_terminate();
    pub fn k_adcs_passthrough(
        tx: *const u8,
        tx_len: i32,
        rx: *mut u8,
        rx_len: i32,
        delay: *const timespec,
    ) -> KADCSStatus;
    pub fn k_imtq_reset() -> KADCSStatus;
    pub fn k_imtq_watchdog_start() -> KADCSStatus;
    pub fn k_imtq_watchdog_stop() -> KADCSStatus;
}