mirror of
https://github.com/DSheirer/sdrtrunk.git
synced 2026-11-12 08:37:25 -05:00
[WIP] new AFSK1200 decoder.
This commit is contained in:
@@ -1,17 +1,17 @@
|
||||
/*******************************************************************************
|
||||
* SDR Trunk
|
||||
* Copyright (C) 2014 Dennis Sheirer
|
||||
*
|
||||
*
|
||||
* 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/>
|
||||
******************************************************************************/
|
||||
@@ -20,113 +20,112 @@ package io.github.dsheirer.bits;
|
||||
|
||||
/**
|
||||
* Sync pattern matcher.
|
||||
*
|
||||
*
|
||||
* Note: works for sync patterns up to 63 bits (integer size - 1 ) long.
|
||||
* If a 64 bit or larger sync pattern is applied, then the wrapping feature
|
||||
* of the Long.rotate methods will wrap the MSB around to the LSB and
|
||||
* corrupt the matching value.
|
||||
*
|
||||
*/
|
||||
public class SyncPatternMatcher
|
||||
{
|
||||
private long mBits = 0;
|
||||
private long mMask = 0;
|
||||
private long mSync = 0;
|
||||
private boolean mSoftMode = false;
|
||||
private int mSoftModeErrorThreshold = 0;
|
||||
|
||||
public SyncPatternMatcher( boolean[] syncPattern )
|
||||
{
|
||||
//Setup a bit mask of all ones the length of the sync pattern
|
||||
mMask = (long)( ( Math.pow( 2, syncPattern.length ) ) - 1 );
|
||||
|
||||
//Convert the sync bits into a long value for comparison
|
||||
for( int x = 0; x < syncPattern.length; x++ )
|
||||
{
|
||||
if( syncPattern[ x ] )
|
||||
{
|
||||
mSync += 1l << ( syncPattern.length - 1 - x );
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
public SyncPatternMatcher( long sync )
|
||||
{
|
||||
mSync = sync;
|
||||
mMask = getMask( sync );
|
||||
}
|
||||
private long mBits = 0;
|
||||
private long mMask = 0;
|
||||
private long mSync = 0;
|
||||
private boolean mSoftMode = false;
|
||||
private int mSoftModeErrorThreshold = 0;
|
||||
|
||||
/**
|
||||
* Constructs the sync pattern matcher and defines the soft mode maximum
|
||||
* number of bit errors to allow in the pattern match.
|
||||
*
|
||||
* @param sync pattern
|
||||
* @param softModeErrorThreshold - maximum bit errors (ie pattern mismatch
|
||||
* positions) when considering a sync match
|
||||
*/
|
||||
public SyncPatternMatcher( long sync, int softModeErrorThreshold )
|
||||
{
|
||||
this( sync );
|
||||
|
||||
mSoftModeErrorThreshold = softModeErrorThreshold;
|
||||
}
|
||||
public SyncPatternMatcher(boolean[] syncPattern)
|
||||
{
|
||||
//Setup a bit mask of all ones the length of the sync pattern
|
||||
mMask = (long)((Math.pow(2, syncPattern.length)) - 1);
|
||||
|
||||
/**
|
||||
* Generates an all ones mask corresponding to the sync pattern
|
||||
*/
|
||||
private static long getMask( long sync )
|
||||
{
|
||||
long mask = sync;
|
||||
|
||||
for( int x = 1; x < 64; x *= 2 )
|
||||
{
|
||||
mask |= ( mask >> x );
|
||||
}
|
||||
|
||||
return mask;
|
||||
}
|
||||
|
||||
|
||||
public void receive( boolean bit )
|
||||
{
|
||||
//Left shift the previous value
|
||||
mBits = Long.rotateLeft( mBits, 1 );
|
||||
|
||||
//Apply the mask to erase the previous MSB
|
||||
mBits &= mMask;
|
||||
|
||||
//Add in the new bit
|
||||
if( bit )
|
||||
{
|
||||
mBits += 1;
|
||||
}
|
||||
}
|
||||
//Convert the sync bits into a long value for comparison
|
||||
for(int x = 0; x < syncPattern.length; x++)
|
||||
{
|
||||
if(syncPattern[x])
|
||||
{
|
||||
mSync += 1l << (syncPattern.length - 1 - x);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* Indicates if the most recently received bit sequence matches the
|
||||
* sync pattern
|
||||
*/
|
||||
public boolean matches()
|
||||
{
|
||||
if( mSoftMode )
|
||||
{
|
||||
long difference = mBits ^ mSync;
|
||||
|
||||
return difference == 0 ||
|
||||
Long.bitCount( difference ) <= mSoftModeErrorThreshold;
|
||||
}
|
||||
else
|
||||
{
|
||||
return ( mBits == mSync );
|
||||
}
|
||||
}
|
||||
public SyncPatternMatcher(long sync)
|
||||
{
|
||||
mSync = sync;
|
||||
mMask = getMask(sync);
|
||||
}
|
||||
|
||||
/**
|
||||
* Sets the sync pattern matcher in soft mode which allows up to the soft
|
||||
* mode threshold number of bit errors when considering a sync pattern match
|
||||
*/
|
||||
public void setSoftMode( boolean softMode )
|
||||
{
|
||||
mSoftMode = softMode;
|
||||
}
|
||||
/**
|
||||
* Constructs the sync pattern matcher and defines the soft mode maximum
|
||||
* number of bit errors to allow in the pattern match.
|
||||
*
|
||||
* @param sync pattern
|
||||
* @param softModeErrorThreshold - maximum bit errors (ie pattern mismatch
|
||||
* positions) when considering a sync match
|
||||
*/
|
||||
public SyncPatternMatcher(long sync, int softModeErrorThreshold)
|
||||
{
|
||||
this(sync);
|
||||
|
||||
mSoftModeErrorThreshold = softModeErrorThreshold;
|
||||
}
|
||||
|
||||
/**
|
||||
* Generates an all ones mask corresponding to the sync pattern
|
||||
*/
|
||||
private static long getMask(long sync)
|
||||
{
|
||||
long mask = sync;
|
||||
|
||||
for(int x = 1; x < 64; x *= 2)
|
||||
{
|
||||
mask |= (mask >> x);
|
||||
}
|
||||
|
||||
return mask;
|
||||
}
|
||||
|
||||
|
||||
public void receive(boolean bit)
|
||||
{
|
||||
//Left shift the previous value
|
||||
mBits = Long.rotateLeft(mBits, 1);
|
||||
|
||||
//Apply the mask to erase the previous MSB
|
||||
mBits &= mMask;
|
||||
|
||||
//Add in the new bit
|
||||
if(bit)
|
||||
{
|
||||
mBits += 1;
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* Indicates if the most recently received bit sequence matches the
|
||||
* sync pattern
|
||||
*/
|
||||
public boolean matches()
|
||||
{
|
||||
if(mSoftMode)
|
||||
{
|
||||
long difference = mBits ^ mSync;
|
||||
|
||||
return difference == 0 ||
|
||||
Long.bitCount(difference) <= mSoftModeErrorThreshold;
|
||||
}
|
||||
else
|
||||
{
|
||||
return (mBits == mSync);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* Sets the sync pattern matcher in soft mode which allows up to the soft
|
||||
* mode threshold number of bit errors when considering a sync pattern match
|
||||
*/
|
||||
public void setSoftMode(boolean softMode)
|
||||
{
|
||||
mSoftMode = softMode;
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user