mirror of https://github.com/pvnis/srsRAN_4G.git
Added AGC module
ismagom
10 years ago
parent
d99e4f5988
commit
ecb30a9014
@ -0,0 +1,69 @@
|
|||||||
|
/**
|
||||||
|
*
|
||||||
|
* \section COPYRIGHT
|
||||||
|
*
|
||||||
|
* Copyright 2013-2014 The libLTE Developers. See the
|
||||||
|
* COPYRIGHT file at the top-level directory of this distribution.
|
||||||
|
*
|
||||||
|
* \section LICENSE
|
||||||
|
*
|
||||||
|
* This file is part of the libLTE library.
|
||||||
|
*
|
||||||
|
* libLTE is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU Lesser General Public License as
|
||||||
|
* published by the Free Software Foundation, either version 3 of
|
||||||
|
* the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* libLTE 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 Lesser General Public License for more details.
|
||||||
|
*
|
||||||
|
* A copy of the GNU Lesser General Public License can be found in
|
||||||
|
* the LICENSE file in the top-level directory of this distribution
|
||||||
|
* and at http://www.gnu.org/licenses/.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
#ifndef AGC_
|
||||||
|
#define AGC_
|
||||||
|
|
||||||
|
#include <stdbool.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <complex.h>
|
||||||
|
|
||||||
|
#include "liblte/config.h"
|
||||||
|
|
||||||
|
/* Automatic Gain Control
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
typedef _Complex float cf_t;
|
||||||
|
|
||||||
|
#define AGC_DEFAULT_BW (1e-2f)
|
||||||
|
|
||||||
|
typedef struct LIBLTE_API{
|
||||||
|
float bandwidth;
|
||||||
|
float gain;
|
||||||
|
float y_out;
|
||||||
|
bool lock;
|
||||||
|
} agc_t;
|
||||||
|
|
||||||
|
LIBLTE_API int agc_init (agc_t *q);
|
||||||
|
|
||||||
|
LIBLTE_API void agc_free(agc_t *q);
|
||||||
|
|
||||||
|
LIBLTE_API void agc_set_bandwidth(agc_t *q,
|
||||||
|
float bandwidth);
|
||||||
|
|
||||||
|
LIBLTE_API float agc_get_rssi(agc_t *q);
|
||||||
|
|
||||||
|
LIBLTE_API void agc_lock(agc_t *q, bool enable);
|
||||||
|
|
||||||
|
LIBLTE_API void agc_push(agc_t *q,
|
||||||
|
cf_t *input,
|
||||||
|
cf_t *output,
|
||||||
|
uint32_t len);
|
||||||
|
|
||||||
|
#endif // AGC_
|
||||||
@ -0,0 +1,79 @@
|
|||||||
|
/**
|
||||||
|
*
|
||||||
|
* \section COPYRIGHT
|
||||||
|
*
|
||||||
|
* Copyright 2013-2014 The libLTE Developers. See the
|
||||||
|
* COPYRIGHT file at the top-level directory of this distribution.
|
||||||
|
*
|
||||||
|
* \section LICENSE
|
||||||
|
*
|
||||||
|
* This file is part of the libLTE library.
|
||||||
|
*
|
||||||
|
* libLTE is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU Lesser General Public License as
|
||||||
|
* published by the Free Software Foundation, either version 3 of
|
||||||
|
* the License, or (at your option) any later version.
|
||||||
|
*
|
||||||
|
* libLTE 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 Lesser General Public License for more details.
|
||||||
|
*
|
||||||
|
* A copy of the GNU Lesser General Public License can be found in
|
||||||
|
* the LICENSE file in the top-level directory of this distribution
|
||||||
|
* and at http://www.gnu.org/licenses/.
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
#include <string.h>
|
||||||
|
#include <strings.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <math.h>
|
||||||
|
#include <complex.h>
|
||||||
|
|
||||||
|
#include "liblte/phy/utils/debug.h"
|
||||||
|
|
||||||
|
#include "liblte/phy/agc/agc.h"
|
||||||
|
#include "liblte/phy/utils/vector.h"
|
||||||
|
#include "liblte/phy/utils/debug.h"
|
||||||
|
|
||||||
|
|
||||||
|
int agc_init (agc_t *q) {
|
||||||
|
bzero(q, sizeof(agc_t));
|
||||||
|
q->bandwidth = AGC_DEFAULT_BW;
|
||||||
|
q->lock = false;
|
||||||
|
q->gain = 1.0;
|
||||||
|
q->y_out = 1.0;
|
||||||
|
return LIBLTE_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
void agc_free(agc_t *q) {
|
||||||
|
bzero(q, sizeof(agc_t));
|
||||||
|
}
|
||||||
|
|
||||||
|
void agc_set_bandwidth(agc_t *q, float bandwidth) {
|
||||||
|
q->bandwidth = bandwidth;
|
||||||
|
}
|
||||||
|
|
||||||
|
float agc_get_rssi(agc_t *q) {
|
||||||
|
return 1.0/q->gain;
|
||||||
|
}
|
||||||
|
|
||||||
|
void agc_lock(agc_t *q, bool enable) {
|
||||||
|
q->lock = enable;
|
||||||
|
}
|
||||||
|
|
||||||
|
void agc_push(agc_t *q, cf_t *input, cf_t *output, uint32_t len) {
|
||||||
|
|
||||||
|
// Apply current gain to input signal
|
||||||
|
vec_sc_prod_cfc(input, q->gain, output, len);
|
||||||
|
|
||||||
|
// compute output energy estimate
|
||||||
|
float y = sqrtf(crealf(vec_dot_prod_conj_ccc(output, output, len))/len);
|
||||||
|
|
||||||
|
q->y_out = (1-q->bandwidth) * q->y_out + q->bandwidth * y;
|
||||||
|
if (!q->lock) {
|
||||||
|
q->gain *= expf(-0.5*q->bandwidth*logf(q->y_out));
|
||||||
|
}
|
||||||
|
}
|
||||||
Loading…
Reference in New Issue