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
|
//
// Copyright 2013 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 <uhd/transport/nirio/nirio_driver_iface.h>
#include <stdio.h>
#include <errno.h>
#include <fcntl.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
namespace nirio_driver_iface {
struct nirio_ioctl_block_t
{
uint64_t in_buf;
uint64_t out_buf;
uint32_t in_buf_len;
uint32_t out_buf_len;
uint32_t bytes_returned;
uint32_t padding;
};
nirio_status rio_open(
const std::string& device_path,
rio_dev_handle_t& device_handle)
{
device_handle = ::open(device_path.c_str(), O_RDWR | O_CLOEXEC);
return (device_handle < 0) ? NiRio_Status_InvalidParameter : NiRio_Status_Success;
}
void rio_close(rio_dev_handle_t& device_handle)
{
::close(device_handle);
device_handle = -1;
}
bool rio_isopen(rio_dev_handle_t device_handle)
{
return (device_handle >= 0);
}
nirio_status rio_ioctl(
rio_dev_handle_t device_handle,
uint32_t ioctl_code,
const void *write_buf,
size_t write_buf_len,
void *read_buf,
size_t read_buf_len)
{
nirio_ioctl_block_t ioctl_block = {0,0,0,0,0,0};
// two-casts necessary to prevent pointer sign-extension
ioctl_block.in_buf = static_cast<uint64_t>(reinterpret_cast<uintptr_t>(write_buf));
ioctl_block.in_buf_len = write_buf_len;
ioctl_block.out_buf = static_cast<uint64_t>(reinterpret_cast<uintptr_t>(read_buf));
ioctl_block.out_buf_len = read_buf_len;
int status = ::ioctl(device_handle, ioctl_code, &ioctl_block);
if (status == -1) {
switch (errno) {
case EINVAL: return NiRio_Status_InvalidParameter;
case EFAULT: return NiRio_Status_MemoryFull;
default: return NiRio_Status_SoftwareFault;
}
} else {
return NiRio_Status_Success;
}
}
nirio_status rio_mmap(
rio_dev_handle_t device_handle,
uint16_t memory_type,
size_t size,
bool writable,
rio_mmap_t &map)
{
int access_mode = PROT_READ; //Write-only mode not supported
if (writable) access_mode |= PROT_WRITE;
map.addr = ::mmap(NULL, size, access_mode, MAP_SHARED, device_handle, (off_t) memory_type * sysconf(_SC_PAGESIZE));
map.size = size;
if (map.addr == MAP_FAILED) {
map.addr = NULL;
map.size = 0;
switch (errno) {
case EINVAL: return NiRio_Status_InvalidParameter;
case EFAULT: return NiRio_Status_MemoryFull;
default: return NiRio_Status_SoftwareFault;
}
}
return NiRio_Status_Success;
}
nirio_status rio_munmap(rio_mmap_t &map)
{
nirio_status status = 0;
if (map.addr != NULL) {
status = ::munmap(map.addr, map.size);
map.addr = NULL;
map.size = 0;
}
return status;
}
}
|
