autd 9.0.1

AUTD library for Rust.
Documentation 
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
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145

/*
 * File: rx_global_header.rs
 * Project: src
 * Created Date: 21/11/2019
 * Author: Shun Suzuki
 * -----
 * Last Modified: 23/03/2021
 * Modified By: Shun Suzuki (suzuki@hapis.k.u-tokyo.ac.jp)
 * -----
 * Copyright (c) 2019 Hapis Lab. All rights reserved.
 *
 */

use std::{
    fmt,
    sync::atomic::{self, AtomicU8},
};

use super::consts::*;

const OP_MODE_MSG_ID_MIN: u8 = 0x20;
const OP_MODE_MSG_ID_MAX: u8 = 0xBF;

static MSG_ID: AtomicU8 = AtomicU8::new(OP_MODE_MSG_ID_MIN);

#[repr(u8)]
#[derive(Debug, Copy, Clone, PartialEq)]
pub enum CommandType {
    CmdOp = 0x00,
    _CmdBramWrite = 0x01,
    CmdReadCpuVerLsb = 0x02,
    CmdReadCpuVerMsb = 0x03,
    CmdReadFpgaVerLsb = 0x04,
    CmdReadFpgaVerMsb = 0x05,
    CmdSeqMode = 0x06,
    CmdInitRefClock = 0x07,
    CmdCalibSeqClock = 0x08,
    CmdClear = 0x09,
}

#[repr(C)]
pub struct RxGlobalHeader {
    pub msg_id: u8,
    pub ctrl_flag: RxGlobalControlFlags,
    pub command: CommandType,
    pub mod_size: u8,
    pub seq_size: u16,
    pub seq_div: u16,
    pub(crate) mod_data: [u8; MOD_FRAME_SIZE],
}

bitflags! {
pub struct RxGlobalControlFlags : u8 {
    const NONE = 0;
    const LOOP_BEGIN = 1;
    const LOOP_END = 1 << 1;
    //
    const SILENT = 1 << 3;
    const FORCE_FAN = 1 << 4;
    const SEQ_MODE = 1 << 5;
    const SEQ_BEGIN = 1 << 6;
    const SEQ_END = 1 << 7;
}
}

impl RxGlobalHeader {
    pub fn new_with_cmd(command: CommandType) -> RxGlobalHeader {
        RxGlobalHeader {
            msg_id: command as u8,
            ctrl_flag: RxGlobalControlFlags::NONE,
            command,
            mod_size: 0,
            seq_size: 0,
            seq_div: 0,
            mod_data: [0x00; MOD_FRAME_SIZE],
        }
    }

    pub fn new_op(ctrl_flag: RxGlobalControlFlags, data: &[u8]) -> RxGlobalHeader {
        MSG_ID.fetch_add(1, atomic::Ordering::SeqCst);
        let _ = MSG_ID.compare_exchange(
            OP_MODE_MSG_ID_MAX + 1,
            OP_MODE_MSG_ID_MIN,
            atomic::Ordering::SeqCst,
            atomic::Ordering::SeqCst,
        );

        let mut data_array = [0x00; MOD_FRAME_SIZE];
        data_array[..data.len()].clone_from_slice(&data[..]);

        RxGlobalHeader {
            msg_id: MSG_ID.load(atomic::Ordering::SeqCst),
            ctrl_flag,
            command: CommandType::CmdOp,
            mod_size: data.len() as u8,
            seq_size: 0,
            seq_div: 0,
            mod_data: data_array,
        }
    }

    pub fn new_seq(ctrl_flag: RxGlobalControlFlags, seq_size: u16, seq_div: u16) -> RxGlobalHeader {
        MSG_ID.fetch_add(1, atomic::Ordering::SeqCst);
        let _ = MSG_ID.compare_exchange(
            OP_MODE_MSG_ID_MAX + 1,
            OP_MODE_MSG_ID_MIN,
            atomic::Ordering::SeqCst,
            atomic::Ordering::SeqCst,
        );

        RxGlobalHeader {
            msg_id: MSG_ID.load(atomic::Ordering::SeqCst),
            ctrl_flag,
            command: CommandType::CmdSeqMode,
            mod_size: 0,
            seq_size,
            seq_div,
            mod_data: [0x00; MOD_FRAME_SIZE],
        }
    }
}

impl fmt::Debug for RxGlobalHeader {
    fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
        write!(
            f,
            r"RxGlobalHeader {{
    msg_id: {},
    ctrl_flag: {:?},
    command: {:?},
    mod_size: {},
    seq_size: {},
    seq_div: {},
    mod_data: {:?},
}}",
            self.msg_id,
            self.ctrl_flag,
            self.command,
            self.mod_size,
            self.seq_size,
            self.seq_div,
            &self.mod_data[..],
        )
    }
}