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
|
/* -*- c++ -*- */
/*
* Copyright 2004,2006,2009 Free Software Foundation, Inc.
*
* This file is part of GNU Radio
*
* GNU Radio 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, or (at your option)
* any later version.
*
* GNU Radio 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 GNU Radio; see the file COPYING. If not, write to
* the Free Software Foundation, Inc., 51 Franklin Street,
* Boston, MA 02110-1301, USA.
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <usrp_sink_c.h>
#include <gr_io_signature.h>
#include <usrp/usrp_standard.h>
#include <usrp/usrp_bytesex.h>
usrp_sink_c_sptr
usrp_make_sink_c (int which_board,
unsigned int interp_rate,
int nchan,
int mux,
int fusb_block_size,
int fusb_nblocks,
const std::string fpga_filename,
const std::string firmware_filename
) throw (std::runtime_error)
{
return usrp_sink_c_sptr (new usrp_sink_c (which_board,
interp_rate,
nchan,
mux,
fusb_block_size,
fusb_nblocks,
fpga_filename,
firmware_filename
));
}
usrp_sink_c::usrp_sink_c (int which_board,
unsigned int interp_rate,
int nchan,
int mux,
int fusb_block_size,
int fusb_nblocks,
const std::string fpga_filename,
const std::string firmware_filename
) throw (std::runtime_error)
: usrp_sink_base ("usrp_sink_c",
gr_make_io_signature (1, 1, sizeof (gr_complex)),
which_board, interp_rate, nchan, mux,
fusb_block_size, fusb_nblocks,
fpga_filename, firmware_filename)
{
}
usrp_sink_c::~usrp_sink_c ()
{
// NOP
}
/*
* Take one complex input stream and format it into interleaved short I & Q
* for the usrp.
*/
void
usrp_sink_c::copy_to_usrp_buffer (gr_vector_const_void_star &input_items,
int input_index,
int input_items_available,
int &input_items_consumed, // out
void *usrp_buffer,
int usrp_buffer_length,
int &bytes_written) // out
{
gr_complex *in = &((gr_complex *) input_items[0])[input_index];
short *dst = (short *) usrp_buffer;
static const int usrp_bytes_per_input_item = 2 * sizeof (short); // I & Q
int nitems = std::min (input_items_available,
usrp_buffer_length / usrp_bytes_per_input_item);
for (int i = 0; i < nitems; i++){
dst[2*i + 0] = host_to_usrp_short((short) real(in[i])); // FIXME saturate?
dst[2*i + 1] = host_to_usrp_short((short) imag(in[i])); // FIXME saturate?
}
input_items_consumed = nitems;
bytes_written = nitems * usrp_bytes_per_input_item;
}
|
