blob: f7f808cfc98f1f43c7bcb65fb9d5537311988f45 (
plain)
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
|
/*
* Copyright 2010 Ettus Research LLC
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include "pkt_ctrl.h"
#include "memory_map.h"
#include <stdint.h>
#include <stdbool.h>
#include <nonstdio.h>
static void set_control(uint32_t value, uint32_t mask){
static uint32_t ctrl_shadow = 0;
ctrl_shadow &= ~mask;
ctrl_shadow |= value & mask;
buffer_pool_ctrl->ctrl = ctrl_shadow;
}
void pkt_ctrl_set_routing_mode(pkt_ctrl_routing_mode_t mode){
switch(mode){
case PKT_CTRL_ROUTING_MODE_SLAVE:
set_control(0x0, 0x4);
break;
case PKT_CTRL_ROUTING_MODE_MASTER:
set_control(0x4, 0x4);
break;
}
}
void *pkt_ctrl_claim_incoming_buffer(size_t *num_lines){
if ((buffer_pool_status->status & 0x1) != 1) return NULL;
*num_lines = (buffer_pool_status->status >> 16) & 0xffff;
set_control(0x1, 0x1);
return buffer_ram(0);
}
void pkt_ctrl_release_incoming_buffer(void){
set_control(0x0, 0x1);
while ((buffer_pool_status->status & 0x1) != 0){}
}
void *pkt_ctrl_claim_outgoing_buffer(void){
while ((buffer_pool_status->status & 0x2) != 0x2){}
return buffer_ram(1);
}
void pkt_ctrl_commit_outgoing_buffer(size_t num_lines){
set_control(0x2 | (num_lines << 16), 0x2 | (0xffff << 16));
while ((buffer_pool_status->status & 0x2) != 0x0){}
set_control(0x0, 0x2);
}
|
