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
//! 透传协议

#![no_std]

use log::warn;
use spin::RwLock;
use unmp::id::Id;
use unmp::net;
use unmp::protocol;
use unmp::Connection;

/// 协议ID
pub const PROTOCOL_ID: u8 = 0;

/// 接收到数据的回调函数格式
pub type RecvCallback = fn(Connection, &[u8]);
/// 透传协议的回调函数列表
struct CallbackContext {
    on_recv: Option<RecvCallback>,
}

/// 协议池
static CBCTX: RwLock<CallbackContext> = RwLock::new(CallbackContext { on_recv: None });

/// 透传协议
fn when_recv(conn: Connection, data: &[u8]) {
    if let Some(ref cb) = CBCTX.read().on_recv {
        cb(conn, data);
    } else {
        warn!("unmp_protocol_raw has not recv callback.");
    }
}

/// 初始化
pub fn init() {
    protocol::add_protocol(PROTOCOL_ID, when_recv);
}
/// 设置接收到数据后的回调函数
pub fn set_recv_cb(cb: RecvCallback) {
    CBCTX.write().on_recv = Some(cb);
}
/// 发送数据到指定设备
pub fn send(id: &Id, buf: &[u8]) {
    net::send(PROTOCOL_ID, &buf, id, None);
}