mirror of
https://github.com/gnss-sdr/gnss-sdr
synced 2024-12-16 05:00:35 +00:00
34f24562cf
Documented at .clang-format See http://clang.llvm.org/docs/ClangFormat.html and http://clang.llvm.org/docs/ClangFormatStyleOptions.html
96 lines
3.8 KiB
C
96 lines
3.8 KiB
C
/*!
|
|
* \file rtklib_lambda.h
|
|
* \brief Integer ambiguity resolution
|
|
* \authors <ul>
|
|
* <li> 2007-2008, T. Takasu
|
|
* <li> 2017, Javier Arribas
|
|
* <li> 2017, Carles Fernandez
|
|
* </ul>
|
|
*
|
|
* This is a derived work from RTKLIB http://www.rtklib.com/
|
|
* The original source code at https://github.com/tomojitakasu/RTKLIB is
|
|
* released under the BSD 2-clause license with an additional exclusive clause
|
|
* that does not apply here. This additional clause is reproduced below:
|
|
*
|
|
* " The software package includes some companion executive binaries or shared
|
|
* libraries necessary to execute APs on Windows. These licenses succeed to the
|
|
* original ones of these software. "
|
|
*
|
|
* Neither the executive binaries nor the shared libraries are required by, used
|
|
* or included in GNSS-SDR.
|
|
*
|
|
* -------------------------------------------------------------------------
|
|
* Copyright (C) 2007-2008, T. Takasu
|
|
* Copyright (C) 2017, Javier Arribas
|
|
* Copyright (C) 2017, Carles Fernandez
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are
|
|
* met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
*
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
* HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* References:
|
|
* [1] P.J.G.Teunissen, The least-square ambiguity decorrelation adjustment:
|
|
* a method for fast GPS ambiguity estimation, J.Geodesy, Vol.70, 65-82,
|
|
* 1995
|
|
* [2] X.-W.Chang, X.Yang, T.Zhou, MLAMBDA: A modified LAMBDA method for
|
|
* integer least-squares estimation, J.Geodesy, Vol.79, 552-565, 2005
|
|
*
|
|
*----------------------------------------------------------------------------*/
|
|
|
|
#ifndef GNSS_SDR_RTKLIB_LAMBDA_H_
|
|
#define GNSS_SDR_RTKLIB_LAMBDA_H_
|
|
|
|
|
|
#include "rtklib.h"
|
|
|
|
/* constants/macros ----------------------------------------------------------*/
|
|
const int LOOPMAX = 10000; /* maximum count of search loop */
|
|
#define SGN_LAMBDA(x) ((x) <= 0.0 ? -1.0 : 1.0)
|
|
#define ROUND_LAMBDA(x) (floor((x) + 0.5))
|
|
#define SWAP_LAMBDA(x, y) \
|
|
do \
|
|
{ \
|
|
double tmp_; \
|
|
tmp_ = x; \
|
|
x = y; \
|
|
y = tmp_; \
|
|
} \
|
|
while (0)
|
|
|
|
int LD(int n, const double *Q, double *L, double *D);
|
|
void gauss(int n, double *L, double *Z, int i, int j);
|
|
void perm(int n, double *L, double *D, int j, double del, double *Z);
|
|
void reduction(int n, double *L, double *D, double *Z);
|
|
int search(int n, int m, const double *L, const double *D,
|
|
const double *zs, double *zn, double *s);
|
|
|
|
int lambda(int n, int m, const double *a, const double *Q, double *F, double *s);
|
|
|
|
int lambda_reduction(int n, const double *Q, double *Z);
|
|
|
|
int lambda_search(int n, int m, const double *a, const double *Q,
|
|
double *F, double *s);
|
|
|
|
|
|
#endif
|