mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-13 09:17:20 -05:00
Compare commits
78 Commits
rtl_overha
...
20230915
| Author | SHA1 | Date | |
|---|---|---|---|
|
|
8d522e25c4 | ||
|
|
b1013c15ad | ||
|
|
23d8d0cc77 | ||
|
|
6e60a4e7d1 | ||
|
|
48a3d55231 | ||
|
|
aef12ff74d | ||
|
|
2353601719 | ||
|
|
668f70c1ba | ||
|
|
ec292ae738 | ||
|
|
9e56356e27 | ||
|
|
3d2a68b4bb | ||
|
|
443c53e2ba | ||
|
|
6153f7bc4c | ||
|
|
4bbae54542 | ||
|
|
6e7f2962f0 | ||
|
|
d917f85926 | ||
|
|
76d2866498 | ||
|
|
2e098d52bc | ||
|
|
57629cefe4 | ||
|
|
fe3a135a92 | ||
|
|
8d33c2b3d1 | ||
|
|
593ffbbd66 | ||
|
|
592d57ad87 | ||
|
|
9a31678d9a | ||
|
|
7b3a257df8 | ||
|
|
55e792a925 | ||
|
|
755f77f96c | ||
|
|
1c17757a4e | ||
|
|
abe2e61cf2 | ||
|
|
c404825451 | ||
|
|
769168da5b | ||
|
|
14284c3cf1 | ||
|
|
51f971b68d | ||
|
|
02fdb7cd90 | ||
|
|
64541a1958 | ||
|
|
0a675d3f0f | ||
|
|
e79b6fd231 | ||
|
|
d356ed0dbc | ||
|
|
495eb71090 | ||
|
|
6bf96f1df5 | ||
|
|
3a2db53c3b | ||
|
|
e038016c30 | ||
|
|
7d6269efad | ||
|
|
152f0ea7f6 | ||
|
|
13443a25f3 | ||
|
|
528f7294d9 | ||
|
|
83e3fa1061 | ||
|
|
9b3a2d96e3 | ||
|
|
0829cdbdb0 | ||
|
|
9541aef382 | ||
|
|
4caf6bb153 | ||
|
|
dd77273218 | ||
|
|
3bd3edb36f | ||
|
|
6f1cf0a279 | ||
|
|
5d045b89e4 | ||
|
|
a2c4679632 | ||
|
|
986ed27d7d | ||
|
|
bae6a1545e | ||
|
|
5240f00441 | ||
|
|
f7511e0976 | ||
|
|
bc27344b04 | ||
|
|
db97eb82a1 | ||
|
|
3f1b8ff736 | ||
|
|
54b9017146 | ||
|
|
8ccaf2d261 | ||
|
|
209770175d | ||
|
|
602079e681 | ||
|
|
82267b9ec8 | ||
|
|
87bf997b6e | ||
|
|
0a43d3202d | ||
|
|
ee04cef6f2 | ||
|
|
b6fdfe48c1 | ||
|
|
7a4bd2833f | ||
|
|
432ad448ba | ||
|
|
61be710bb0 | ||
|
|
3be8aacf77 | ||
|
|
4feb21cf0a | ||
|
|
7d8162ab99 |
5
.gitignore
vendored
5
.gitignore
vendored
@@ -7,7 +7,4 @@ build
|
||||
examples
|
||||
*.bin
|
||||
*.ans
|
||||
*.patch
|
||||
*.zip
|
||||
result
|
||||
.cache
|
||||
*.patch
|
||||
@@ -10,25 +10,25 @@ SET(CMAKE_MODULE_PATH ${CMAKE_MODULE_PATH} "${PROJECT_SOURCE_DIR}/cmake/")
|
||||
set(CURSES_NEED_NCURSES TRUE)
|
||||
set(CURSES_NEED_WIDE TRUE)
|
||||
|
||||
#use cmake option -DCOLORS=OFF to disable color output (ncurses)
|
||||
#use cmake option -DAERO=ON to enable Aero Builds (OSS support and specific tweaks)
|
||||
option(AERO
|
||||
"Build for Aero Environments (Cygwin)" OFF)
|
||||
if (AERO)
|
||||
add_definitions(-DAERO_BUILD)
|
||||
endif ()
|
||||
|
||||
#use cmake option -DCOLORS=OFF to disable color output
|
||||
option(COLORS
|
||||
"Build with Colors Enabled" ON)
|
||||
if (COLORS)
|
||||
add_definitions(-DPRETTY_COLORS)
|
||||
endif ()
|
||||
|
||||
#use cmake option -DCOLORSLOGS=OFF to disable color output (terminal/logs)
|
||||
option(COLORSLOGS
|
||||
"Build with Colors Enabled" ON)
|
||||
if (COLORSLOGS)
|
||||
add_definitions(-DPRETTY_COLORS_LOGS)
|
||||
add_definitions(-DPRETTY_COLORS)
|
||||
endif ()
|
||||
|
||||
#use cmake option -DPVC=ON to enable Provoice Conventional Frame Sync
|
||||
option(PVC
|
||||
"Build with Provoice Conventional Frame Sync Enabled" OFF)
|
||||
if (PVC)
|
||||
add_definitions(-DPVCONVENTIONAL)
|
||||
add_definitions(-DPVCONVENTIONAL)
|
||||
endif ()
|
||||
|
||||
|
||||
@@ -36,17 +36,16 @@ endif ()
|
||||
option(LZ
|
||||
"Build with new LimaZulu Requested NXDN Tweaks Enabled" OFF)
|
||||
if (LZ)
|
||||
add_definitions(-DLIMAZULUTWEAKS)
|
||||
add_definitions(-DLIMAZULUTWEAKS)
|
||||
endif ()
|
||||
|
||||
#use cmake option -DSID=ON to enable P25p1 Soft ID decoding -- Experimental
|
||||
option(SID
|
||||
"Build with P25p1 LSD/Soft ID Enabled" OFF)
|
||||
if (SID)
|
||||
add_definitions(-DSOFTID)
|
||||
#use cmake option -DTONES to change default location of the tones.wav files (lwvmobile precompiled 'Aero' releases only)
|
||||
option(TN
|
||||
"Build with tone wav files in the dsd-fme folder and not in /usr/share/" OFF)
|
||||
if (TN)
|
||||
add_definitions(-DTONES)
|
||||
endif ()
|
||||
|
||||
|
||||
include(git_revision)
|
||||
git_describe(GIT_TAG)
|
||||
|
||||
@@ -54,12 +53,12 @@ find_package(LibSndFile REQUIRED)
|
||||
find_package(MBE REQUIRED)
|
||||
find_package(ITPP REQUIRED)
|
||||
find_package(RTLSDR)
|
||||
find_package(Curses REQUIRED)
|
||||
find_package(Curses REQUIRED)
|
||||
find_package(PulseAudio REQUIRED)
|
||||
find_package(CODEC2)
|
||||
|
||||
include_directories(SYSTEM ${LIBSNDFILE_INCLUDE_DIR} ${MBE_INCLUDE_DIR} ${ITPP_INCLUDE_DIR} ${PULSEAUDIO_INCLUDE_DIRS} ${CURSES_INCLUDE_DIRS})
|
||||
set(LIBS ${MBE_LIBRARY} ${LIBSNDFILE_LIBRARY} ${ITPP_LIBRARY} ${PULSEAUDIO_SIMPLE_LIBRARY} ${PULSEAUDIO_LIBRARY} ${CURSES_LIBRARIES})
|
||||
include_directories(SYSTEM ${LIBSNDFILE_INCLUDE_DIR} ${MBE_INCLUDE_DIR} ${ITPP_INCLUDE_DIR} ${PULSEAUDIO_INCLUDE_DIRS} ${CURSES_INCLUDE_DIR})
|
||||
set(LIBS ${MBE_LIBRARY} ${LIBSNDFILE_LIBRARY} ${ITPP_LIBRARY} ${PULSEAUDIO_SIMPLE_LIBRARY} ${CURSES_LIBRARY})
|
||||
|
||||
if(RTLSDR_FOUND)
|
||||
find_package(Threads)
|
||||
@@ -89,11 +88,6 @@ include_directories("${PROJECT_SOURCE_DIR}/include")
|
||||
ADD_EXECUTABLE(dsd-fme ${SRCS} ${HEADERS})
|
||||
TARGET_LINK_LIBRARIES(dsd-fme ${LIBS})
|
||||
|
||||
target_compile_options(dsd-fme PRIVATE -Wunused-but-set-variable -Wunused-variable -Wunused-parameter
|
||||
-Wempty-body -Wunused-label $<$<COMPILE_LANGUAGE:C>:-Wpointer-sign>
|
||||
-Wmisleading-indentation -Wparentheses -Wunused-value -Wreturn-type
|
||||
-Wtautological-compare)
|
||||
|
||||
include(GNUInstallDirs)
|
||||
install(TARGETS dsd-fme DESTINATION ${CMAKE_INSTALL_BINDIR})
|
||||
|
||||
|
||||
11
README.md
11
README.md
@@ -1,17 +1,18 @@
|
||||
|
||||
# Digital Speech Decoder - Florida Man Edition
|
||||
|
||||
DSD-FME is an evolution of the original DSD project from 'DSD Author' using the base code of [szechyjs](https://github.com/szechyjs/dsd "szechyjs"), some code and ideas from [LouisErigHerve](https://github.com/LouisErigHerve/dsd "LouisErigHerve"), [Boatbod OP25](https://github.com/boatbod/op25 "Boatbod OP25") and [Osmocom OP25](https://gitea.osmocom.org/op25/op25 "Osmocom OP25"), along with other snippets of code, information, and inspirations from other projects including [DSDcc](https://github.com/f4exb/dsdcc "DSDcc"), [SDRTRunk](https://github.com/DSheirer/sdrtrunk "SDRTrunk"), [MMDVMHost](https://github.com/g4klx/MMDVMHost "MMDVMHost"), [LFSR](https://github.com/mattames/LFSR "LFSR"), [OK-DMRlib](https://github.com/OK-DMR/ok-dmrlib "OK-DMRlib"), and [EZPWD-Reed-Solomon](https://github.com/pjkundert/ezpwd-reed-solomon "EZPWD"), Eric Cottrell, SP5WWP and others. Finally, this is all brought together with original code to extend the fuctionality and add new features including NCurses Terminal and Menu system, Pulse Audio, TCP Direct Link Audio, RIGCTL, Trunking Features, LRRP/GPS Mapping, P25 Phase 2, EDACS, YSF, M17, OP25 Capture Bin compatability, etc. DSD-FME is primarily focused with Linux Desktop users in mind, so please understand that this version may not compile, compile easily, or run correctly in other environments.
|
||||
DSD-FME is an evolution of the original DSD project from 'DSD Author' using the base code of [szechyjs](https://github.com/szechyjs/dsd "szechyjs"), some code and ideas from [LouisErigHerve](https://github.com/LouisErigHerve/dsd "LouisErigHerve"), [Boatbod OP25](https://github.com/boatbod/op25 "Boatbod OP25") and
|
||||
[Osmocom OP25](https://gitea.osmocom.org/op25/op25 "Osmocom OP25"), along with other snippets of code, information, and inspirations from other projects including [DSDcc](https://github.com/f4exb/dsdcc "DSDcc"), [SDRTRunk](https://github.com/DSheirer/sdrtrunk "SDRTrunk"), [MMDVMHost](https://github.com/g4klx/MMDVMHost "MMDVMHost"), [LFSR](https://github.com/mattames/LFSR "LFSR"), [OK-DMRlib](https://github.com/OK-DMR/ok-dmrlib "OK-DMRlib"), and [EZPWD-Reed-Solomon](https://github.com/pjkundert/ezpwd-reed-solomon "EZPWD"), Eric Cottrell, SP5WWP and others. Finally, this is all brought together with original code to extend the fuctionality and add new features including NCurses Terminal and Menu system, Pulse Audio, TCP Direct Link Audio, RIGCTL, Trunking Features, LRRP/GPS Mapping, P25 Phase 2, EDACS, YSF, OP25 Capture Bin compatability, etc. DSD-FME is primarily focused with Linux Desktop users in mind, so please understand that this version may not compile, compile easily, or run correctly in other environments.
|
||||
|
||||
This project wouldn't be possible without a few good people providing me plenty of sample audio files to run over and over again. Special thanks to jurek1111, KrisMar, noamlivne, racingfan360, iScottyBotty, LimaZulu, Forts, thewraithe2008, RayAir, Cretu, ilyacodes, and others for the many hours of wav samples and information provided by them. Most importantly, HRH17, whose insight, information, samples, and willingness to let me remote into a computer half-way across the globe in order to test trunking features are what make DSD-FME what it has become. I'd also like to thank mrscanner2008 for providing an additional remote where additional NXDN Type-C, 'Idas' Type-D, and XPT decoding and trunking could be sorted out. Thanks to volo-zyko for cleaning up a lot of code. Thank you everybody.
|
||||
This project wouldn't be possible without a few good people providing me plenty of sample audio files to run over and over again. Special thanks to jurek1111, KrisMar, noamlivne, racingfan360, iScottyBotty, LimaZulu, Forts, thewraithe2008, RayAir, Cretu, and others for the many hours of wav samples and information provided by them. Most importantly, HRH17, whose insight, information, samples, and willingness to let me remote into a computer half-way across the globe in order to test trunking features are what make DSD-FME what it has become. I'd also like to thank mrscanner2008 for providing an additional remote where additional NXDN Type-C, 'Idas' Type-D, and XPT decoding and trunking could be sorted out. Thank you everybody.
|
||||
|
||||

|
||||

|
||||
|
||||

|
||||

|
||||
|
||||
## Information
|
||||
|
||||
See the [examples](https://github.com/lwvmobile/dsd-fme/tree/audio_work/examples "examples") folder for information on [cloning and installing](https://github.com/lwvmobile/dsd-fme/blob/audio_work/examples/Install_Notes.md "cloning and installing"), [example usage](https://github.com/lwvmobile/dsd-fme/blob/audio_work/examples/Example_Usage.md "example usage"), and [trunking examples](https://github.com/lwvmobile/dsd-fme/blob/audio_work/examples/trunking.sh "trunking examples").
|
||||
See the [examples](https://github.com/lwvmobile/dsd-fme/tree/main/examples "examples") folder for information on [cloning and installing](https://github.com/lwvmobile/dsd-fme/blob/main/examples/Install_Notes.md "cloning and installing"), [example usage](https://github.com/lwvmobile/dsd-fme/blob/main/examples/Example_Usage.md "example usage"), and [trunking examples](https://github.com/lwvmobile/dsd-fme/blob/main/examples/trunking.sh "trunking examples").
|
||||
|
||||
## License
|
||||
Copyright (C) 2010 DSD Author
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
#
|
||||
#
|
||||
# Internal file for GetGitRevisionDescription.cmake
|
||||
#
|
||||
# Requires CMake 2.6 or newer (uses the 'function' command)
|
||||
|
||||
248
cyg_portable.sh
248
cyg_portable.sh
@@ -1,248 +0,0 @@
|
||||
#! /bin/bash
|
||||
#
|
||||
cdir=$(pwd)
|
||||
clear
|
||||
printf "DSD-FME Digital Speech Decoder - Florida Man Edition Portable Cygwin Creator\n"
|
||||
printf "Only use this in a Cygwin64 Environment. Will not work in a Linux Environment!\n"
|
||||
read -p "Do you want to make a portable copy? y/N " RELEASE
|
||||
RELEASE=$(printf "$RELEASE"|tr '[:upper:]' '[:lower:]')
|
||||
if [ "$RELEASE" = "y" ]; then
|
||||
|
||||
printf "Copying files to dsd-fme-portable folder and making zip file. Please wait!\n"
|
||||
cd ~
|
||||
|
||||
#create a dsd-fme-portable folder and copy all the needed items for a portable release version
|
||||
mkdir dsd-fme-portable
|
||||
cd dsd-fme-portable
|
||||
#all of these folders may not be necessary
|
||||
mkdir sourcecode
|
||||
mkdir bin
|
||||
mkdir dev
|
||||
cd dev
|
||||
mkdir shm
|
||||
cd ..
|
||||
mkdir dsd-fme
|
||||
mkdir logs
|
||||
mkdir WAV
|
||||
mkdir etc
|
||||
mkdir home
|
||||
mkdir lib
|
||||
mkdir tmp
|
||||
mkdir usr
|
||||
cd usr
|
||||
mkdir share
|
||||
cd share
|
||||
mkdir terminfo
|
||||
cd ~
|
||||
|
||||
#start copying things
|
||||
|
||||
#terminfo is needed for ncurses
|
||||
cp -r /usr/share/terminfo/* dsd-fme-portable/usr/share/terminfo
|
||||
|
||||
#copy required items from the root bin folder to release bin folder
|
||||
cp /bin/ls.exe dsd-fme-portable/bin/
|
||||
cp /bin/bash.exe dsd-fme-portable/bin/
|
||||
cp /bin/ncurses6-config dsd-fme-portable/bin/
|
||||
cp /bin/ncursesw6-config dsd-fme-portable/bin/
|
||||
cp /bin/pacat.exe dsd-fme-portable/bin/
|
||||
cp /bin/pactl.exe dsd-fme-portable/bin/
|
||||
cp /bin/padsp dsd-fme-portable/bin/
|
||||
cp /bin/pamon dsd-fme-portable/bin/
|
||||
cp /bin/paplay dsd-fme-portable/bin/
|
||||
cp /bin/parec dsd-fme-portable/bin/
|
||||
cp /bin/parecord dsd-fme-portable/bin/
|
||||
cp /bin/pulseaudio.exe dsd-fme-portable/bin/
|
||||
cp /bin/tty.exe dsd-fme-portable/bin/
|
||||
|
||||
#start copying things from the etc folder
|
||||
cp -r /etc/pulse/ dsd-fme-portable/etc/
|
||||
|
||||
#start copying things to the lib folder
|
||||
cp -r /lib/pulseaudio/ dsd-fme-portable/lib/
|
||||
|
||||
#start copying things into the dsd-fme folder
|
||||
cp dsd-fme/build/dsd-fme.exe dsd-fme-portable/dsd-fme/
|
||||
cp -r dsd-fme/examples dsd-fme-portable/dsd-fme/
|
||||
cp .bash_profile dsd-fme-portable/dsd-fme/
|
||||
cp .bashrc dsd-fme-portable/dsd-fme/
|
||||
cp .inputrc dsd-fme-portable/dsd-fme/
|
||||
cp .profile dsd-fme-portable/dsd-fme/
|
||||
|
||||
#move (cut) the bat files to the portable folder root and delete the other ones so users won't get confused
|
||||
mv dsd-fme-portable/dsd-fme/examples/cygwin_bat/start-dsd-fme.bat dsd-fme-portable/
|
||||
mv dsd-fme-portable/dsd-fme/examples/cygwin_bat/example_options.txt dsd-fme-portable/
|
||||
mv dsd-fme-portable/dsd-fme/examples/cygwin_bat/complete_usage_options.txt dsd-fme-portable/
|
||||
rm -rf dsd-fme-portable/dsd-fme/examples/cygwin_bat
|
||||
|
||||
#change .bat files permissions to be read/write/executable by all users (for some reason, this is not preserved)
|
||||
chmod 777 dsd-fme-portable/*.bat
|
||||
|
||||
#copy the license, copyright, source code, and things that should be included in all portable releases
|
||||
cp dsd-fme/COPYRIGHT dsd-fme-portable/sourcecode/
|
||||
cp dsd-fme/DSD_Author.pgp dsd-fme-portable/sourcecode/
|
||||
cp dsd-fme/dsd-fme-qgis-map.qgz dsd-fme-portable/sourcecode/
|
||||
cp dsd-fme/README.md dsd-fme-portable/sourcecode/
|
||||
cp dsd-fme/dsd-fme2.png dsd-fme-portable/sourcecode/
|
||||
cp dsd-fme/dsd-fme3.png dsd-fme-portable/sourcecode/
|
||||
|
||||
cp dsd-fme/CMakeLists.txt dsd-fme-portable/sourcecode/
|
||||
cp -r dsd-fme/src dsd-fme-portable/sourcecode/
|
||||
cp -r dsd-fme/include dsd-fme-portable/sourcecode/
|
||||
cp -r dsd-fme/cmake dsd-fme-portable/sourcecode/
|
||||
cp -r dsd-fme/patch dsd-fme-portable/sourcecode/
|
||||
|
||||
#compiled items into release dsd-fme folder
|
||||
cp codec2/build/src/cygcodec2* dsd-fme-portable/dsd-fme/
|
||||
cp itpp-4.3.1/build/itpp/cygitpp* dsd-fme-portable/dsd-fme/
|
||||
cp rtl-sdr/build/src/cyg* dsd-fme-portable/dsd-fme/
|
||||
cp mbelib/build/cygmbe* dsd-fme-portable/dsd-fme/
|
||||
|
||||
#bin items into release dsd-fme folder (uisng * where version numbering may exist, those may be upgraded if hard coded)
|
||||
cp /bin/bash.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cut.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygao* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygarchive* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygargp* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygassuan* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygasyncns* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygatomic* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygattr* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygavahi-client* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygavahi-common* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygavahi-wrap* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygblkid* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygbrotlicommon* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygbrotlidec* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygbz2* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygcares* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygcheck.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygcli.dll dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygcom_err* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygcrypt* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygcrypto* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygcurl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygdb_cxx* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygdb_sql* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygdb* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygdbus* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygedit* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygexpat* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfam* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfdisk* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygffi* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfftw3_threads* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfftw3* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfftw3f_threads* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfftw3f* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfftw3l_threads* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfftw3l* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygfido2* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygFLAC* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygformw* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggc* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggdbm_compat* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggdbm*.dll dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggio* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygglib* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggmodule* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggmp* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggnutls* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggobject* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggomp* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggpg-error* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggpgme* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggsasl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggsm* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggssapi_krb5* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyggthread* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygguile* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyghistory* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyghogweed* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygICE* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygiconv* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygid3tag* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygidn* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygintl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygisl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygjsoncpp* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygk5crypto* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygkrb5* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyglber* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygldap* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygltdl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyglz* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygma* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygmenuw* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygmeta* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygmp* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygncurses* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygnettle* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygnghttp* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygntlm* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygobjc* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygogg* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygopus* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygorc* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygp11* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpanel* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpath.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpcre* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygperl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpipe* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpkg* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpng* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpopt* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygprotocol* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpsl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygpulse* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygquadmath* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygreadline* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygrhash* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygrunsrv.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygsamplerate* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygsasl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygserver* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygSM* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygsmart* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygsndfile* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygsox* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygspeex* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygsqlite* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygssh* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygssl* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygstart.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygstdc* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygtasn* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygtdb* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygticw* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygtwo* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygunistring* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygusb* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyguuid* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cyguv* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygvorbis* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygwavpack* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygwin1.dll dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygwrap* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygX* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygx* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/cygz* dsd-fme-portable/dsd-fme/
|
||||
cp /bin/grep.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/ls.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/mintty.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/pacat.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/pacmd.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/pactl.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/padsp dsd-fme-portable/dsd-fme/
|
||||
cp /bin/pamon dsd-fme-portable/dsd-fme/
|
||||
cp /bin/paplay dsd-fme-portable/dsd-fme/
|
||||
cp /bin/parec dsd-fme-portable/dsd-fme/
|
||||
cp /bin/pulseaudio.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/tail.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/touch.exe dsd-fme-portable/dsd-fme/
|
||||
cp /bin/tty.exe dsd-fme-portable/dsd-fme/
|
||||
|
||||
zip -r dsd-fme-x86-64-cygwin-portable.zip dsd-fme-portable
|
||||
|
||||
fi
|
||||
@@ -1,14 +0,0 @@
|
||||
#! /bin/bash
|
||||
#
|
||||
clear
|
||||
printf "DSD-FME Digital Speech Decoder - Florida Man Edition
|
||||
Automatic Git Pull and Rebuild for Cygwin\n\n"
|
||||
sleep 1
|
||||
##Open your clone folder##
|
||||
git pull
|
||||
sleep 2
|
||||
##cd into your build folder##
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make install
|
||||
@@ -1,52 +1,67 @@
|
||||
#! /bin/bash
|
||||
#
|
||||
cdir=$(pwd)
|
||||
clear
|
||||
printf "Digital Speech Decoder: Florida Man Edition - Auto Installer For Arch Linux\n
|
||||
This will install the required packages, clone, build, and install DSD-FME only.
|
||||
This has been tested on Arch 2023.08.01 and Manjaro XFCE 22.1.3 Minimal.\n
|
||||
MBELib is considered a requirement on this build.
|
||||
You must view the Patent Notice prior to continuing.
|
||||
The Patent Notice can be found at the site below.
|
||||
https://github.com/lwvmobile/mbelib#readme
|
||||
Please confirm that you have viewed the patent notice by entering y below.\n\n"
|
||||
read -p "Have you viewed the patent notice? y/N " ANSWER
|
||||
ANSWER=$(printf "$ANSWER"|tr '[:upper:]' '[:lower:]')
|
||||
if [ "$ANSWER" = "y" ]; then
|
||||
echo DSD-FME Digital Speech Decoder - Florida Man Edition Auto Installer For Arch Linux
|
||||
echo This will install the required packages, clone, build, and install DSD-FME only.
|
||||
echo This has been tested on Arch 2023.08.01 and Manjaro XFCE 22.1.3 Minimal.
|
||||
echo
|
||||
echo MBELib is considered a requirement on this build.
|
||||
echo You must view this notice prior to continuing.
|
||||
echo The Patent Notice can be found at the site below.
|
||||
echo https://github.com/lwvmobile/mbelib#readme
|
||||
echo Please confirm that you have viewed the patent notice by entering y below.
|
||||
echo
|
||||
echo y/N
|
||||
read ANSWER
|
||||
Y='y'
|
||||
if [[ $Y == $ANSWER ]]; then
|
||||
|
||||
sudo pacman -Syu #always run a full update first, partial upgrades aren't supported in Arch -- including downloading dependencies, that may require an updated dependency, and breaks same dependency on another package, a.k.a, dependency hell
|
||||
sudo pacman -S libpulse cmake ncurses lapack perl fftw rtl-sdr codec2 base-devel libsndfile git wget
|
||||
sudo pacman -Syu #always run a full update first, partial upgrades aren't supported in Arch -- including downloading dependencies, that may require an updated dependency, and breaks same dependency on another package, a.k.a, dependency hell
|
||||
sudo pacman -S libpulse cmake ncurses lapack perl fftw rtl-sdr codec2 base-devel libsndfile git wget
|
||||
|
||||
printf "Installing itpp 4.3.1 from Arch Strike --Tested on Arch 2023.08.01 and Manjaro XFCE 22.1.3 Minimal\n"
|
||||
wget https://mirror.archstrike.org/x86_64/archstrike/itpp-4.3.1-3-x86_64.pkg.tar.xz
|
||||
sudo pacman -U itpp-4.3.1-3-x86_64.pkg.tar.xz
|
||||
sudo rm -R itpp-4.3.1-3-x86_64.pkg.tar.xz
|
||||
echo Installing itpp 4.3.1 from Arch Strike --Tested on Arch 2023.08.01 and Manjaro XFCE 22.1.3 Minimal
|
||||
wget https://mirror.archstrike.org/x86_64/archstrike/itpp-4.3.1-3-x86_64.pkg.tar.xz
|
||||
sudo pacman -U itpp-4.3.1-3-x86_64.pkg.tar.xz
|
||||
sudo rm -R itpp-4.3.1-3-x86_64.pkg.tar.xz
|
||||
|
||||
git clone https://github.com/lwvmobile/mbelib
|
||||
cd mbelib
|
||||
git checkout ambe_tones
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
sudo cp /usr/local/lib/libmbe.so /usr/lib/libmbe.so
|
||||
cd $cdir
|
||||
git clone https://github.com/lwvmobile/mbelib
|
||||
cd mbelib
|
||||
git checkout ambe_tones
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j `nproc`
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
#sudo cp /usr/local/lib/libmbe.a /usr/lib/libmbe.a
|
||||
sudo cp /usr/local/lib/libmbe.so /usr/lib/libmbe.so #this is the only one we need to copy
|
||||
#sudo cp /usr/local/lib/libmbe.so.1 /usr/lib/libmbe.so.1
|
||||
#sudo cp /usr/local/lib/libmbe.so.1.3 /usr/lib/libmbe.so.1.3
|
||||
cd ..
|
||||
cd ..
|
||||
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
### For branch audio_work - git clone --branch audio_work https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
#git checkout audio_work
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
### For branch v2.1b - git clone --branch v2.1b https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
git checkout v2.1b
|
||||
sudo cp tone8.wav /usr/share/
|
||||
sudo cp tone24.wav /usr/share/
|
||||
sudo cp tone48.wav /usr/share/
|
||||
sudo chmod 777 /usr/share/tone8.wav
|
||||
sudo chmod 777 /usr/share/tone24.wav
|
||||
sudo chmod 777 /usr/share/tone48.wav
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j `nproc`
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
sudo rm -R dsd-fme
|
||||
|
||||
printf "Any issues, Please report to either:\nhttps://github.com/lwvmobile/dsd-fme/issues or\nhttps://forums.radioreference.com/threads/dsd-fme.438137/\n\n"
|
||||
echo Any issues, Please report to either
|
||||
echo https://github.com/lwvmobile/dsd-fme/issues
|
||||
echo https://forums.radioreference.com/threads/dsd-fme.438137/
|
||||
|
||||
else
|
||||
printf "Sorry, you cannot build DSD-FME without acknowledging the Patent Notice.\n\n"
|
||||
fi
|
||||
echo
|
||||
echo Sorry, you cannot build DSD-FME without acknowledging the Patent Notice.
|
||||
fi
|
||||
|
||||
@@ -1,89 +0,0 @@
|
||||
#! /bin/bash
|
||||
#
|
||||
cdir=$(pwd)
|
||||
clear
|
||||
printf "Digital Speech Decoder: Florida Man Edition - Auto Installer For Cygwin\n
|
||||
This will install the required packages, clone, build, and install DSD-FME only.
|
||||
This has been tested on Cygwin x86-64 as of 20250211. This may take a while!\n
|
||||
MBELib is considered a requirement on this build.
|
||||
You must view the Patent Notice prior to continuing.
|
||||
The Patent Notice can be found at the site below.
|
||||
https://github.com/lwvmobile/mbelib#readme
|
||||
Please confirm that you have viewed the patent notice by entering y below.\n\n"
|
||||
read -p "Have you viewed the patent notice? y/N " ANSWER
|
||||
ANSWER=$(printf "$ANSWER"|tr '[:upper:]' '[:lower:]')
|
||||
if [ "$ANSWER" = "y" ]; then
|
||||
|
||||
#is this needed?
|
||||
LD_LIBRARY_PATH=/usr/local/lib
|
||||
export LD_LIBRARY_PATH
|
||||
echo $LD_LIBRARY_PATH
|
||||
|
||||
#ITPP
|
||||
cd $cdir
|
||||
printf "Installing itpp 4.3.1 from source http://sourceforge.net/projects/itpp/files/latest/download?source=files\n Please wait!\n"
|
||||
wget -O itpp-latest.tar.bz2 http://sourceforge.net/projects/itpp/files/latest/download?source=files
|
||||
tar xjf itpp-latest.tar.bz2
|
||||
cd itpp-4.3.1/
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make install
|
||||
|
||||
#MBELIB
|
||||
cd $cdir
|
||||
printf "Installing mbelib\n Please wait!\n"
|
||||
git clone https://github.com/lwvmobile/mbelib.git
|
||||
cd mbelib
|
||||
git checkout ambe_tones
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make install
|
||||
cp cygmbe-1.dll /bin
|
||||
|
||||
#CODEC2
|
||||
cd $cdir
|
||||
printf "Installing codec2\n Please wait!\n"
|
||||
git clone https://github.com/drowe67/codec2.git
|
||||
cd codec2
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make install
|
||||
|
||||
#RTL-SDR
|
||||
cd $cdir
|
||||
printf "Installing RTL-SDR\n Please wait!\n"
|
||||
git clone https://github.com/lwvmobile/rtl-sdr.git
|
||||
cd rtl-sdr
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make install
|
||||
|
||||
#DSD-FME
|
||||
cd $cdir
|
||||
printf "Installing DSD-FME\n Please wait!\n"
|
||||
git clone https://github.com/lwvmobile/dsd-fme.git
|
||||
cd dsd-fme
|
||||
#git checkout aw_dev
|
||||
mkdir build
|
||||
cd build
|
||||
cmake -DCOLORSLOGS=OFF ..
|
||||
make -j $(nproc)
|
||||
make install
|
||||
cd $cdir
|
||||
|
||||
#call the cyg_portable script
|
||||
sh dsd-fme/cyg_portable.sh
|
||||
|
||||
printf "Any issues, Please report to either:\nhttps://github.com/lwvmobile/dsd-fme/issues or\nhttps://forums.radioreference.com/threads/dsd-fme.438137/\n\n"
|
||||
|
||||
else
|
||||
printf "Sorry, you cannot build DSD-FME without acknowledging the Patent Notice.\n\n"
|
||||
fi
|
||||
@@ -1,17 +1,23 @@
|
||||
#! /bin/bash
|
||||
clear
|
||||
printf "\nDigital Speech Decoder: Florida Man Edition - Auto Installer\n
|
||||
This will clone, build, and install DSD-FME only.
|
||||
If DSD-FME has never been installed on this machine,
|
||||
then you will need to install the dependencies first!
|
||||
Please run download-and-install.sh instead.\n\n"
|
||||
read -p "Press Enter to continue..." x
|
||||
echo DSD-FME Digital Speech Decoder - Florida Man Edition Auto Installer
|
||||
echo This will clone, build, and install DSD-FME only.
|
||||
echo If you need dependencies installed, please run download-and-install.sh instead.
|
||||
echo
|
||||
|
||||
read -p "Press enter to continue"
|
||||
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
#git checkout audio_work
|
||||
sudo cp tone8.wav /usr/share/
|
||||
sudo cp tone24.wav /usr/share/
|
||||
sudo cp tone48.wav /usr/share/
|
||||
sudo chmod 777 /usr/share/tone8.wav
|
||||
sudo chmod 777 /usr/share/tone24.wav
|
||||
sudo chmod 777 /usr/share/tone48.wav
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make -j `nproc`
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
sudo ldconfig
|
||||
|
||||
@@ -1,44 +0,0 @@
|
||||
#! /bin/bash
|
||||
#
|
||||
cdir=$(pwd)
|
||||
clear
|
||||
printf "Digital Speech Decoder: Florida Man Edition - Auto Installer\n
|
||||
MBELib is considered a requirement on this build.
|
||||
You must view the Patent Notice prior to continuing.
|
||||
The Patent Notice can be found at the site below.
|
||||
https://github.com/lwvmobile/mbelib#readme
|
||||
Please confirm that you have viewed the patent notice by entering y below:\n\n"
|
||||
read -p "Have you viewed the patent notice? y/N " ANSWER
|
||||
ANSWER=$(printf "$ANSWER"|tr '[:upper:]' '[:lower:]')
|
||||
if [ "$ANSWER" = "y" ]; then
|
||||
sudo apt update
|
||||
sudo apt install libpulse-dev libsndfile1-dev libfftw3-dev liblapack-dev socat libusb-1.0-0-dev rtl-sdr librtlsdr-dev libusb-1.0-0-dev cmake git wget make build-essential libitpp-dev libncurses-dev libncurses6 libcodec2-dev
|
||||
chkitpp=$(dpkg -l libitpp-dev 2>/dev/null | awk '/^ii/ {print 1} END {if (NR == 0) print 0}')
|
||||
if [ "$chkitpp" -lt "1" ];then
|
||||
printf "\nFor some reason, ITPP did NOT install!\nYou may have to manually install it.\n\n"
|
||||
read -p "Press Enter to exit..." x
|
||||
exit 1
|
||||
fi
|
||||
git clone https://github.com/lwvmobile/mbelib
|
||||
cd mbelib
|
||||
git checkout ambe_tones
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
cd $cdir
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
#git checkout audio_work
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
else
|
||||
printf "\nSorry, you cannot build DSD-FME without acknowledging the Patent Notice.\nExiting...\n\n"
|
||||
exit 2
|
||||
fi
|
||||
@@ -1,44 +1,67 @@
|
||||
#! /bin/bash
|
||||
#
|
||||
cdir=$(pwd)
|
||||
clear
|
||||
printf "Digital Speech Decoder: Florida Man Edition - Auto Installer\n
|
||||
MBELib is considered a requirement on this build.
|
||||
You must view the Patent Notice prior to continuing.
|
||||
The Patent Notice can be found at the site below.
|
||||
https://github.com/lwvmobile/mbelib#readme
|
||||
Please confirm that you have viewed the patent notice by entering y below:\n\n"
|
||||
read -p "Have you viewed the patent notice? y/N " ANSWER
|
||||
ANSWER=$(printf "$ANSWER"|tr '[:upper:]' '[:lower:]')
|
||||
if [ "$ANSWER" = "y" ]; then
|
||||
sudo apt update
|
||||
sudo apt install libpulse-dev libsndfile1-dev libfftw3-dev liblapack-dev socat libusb-1.0-0-dev libncurses5 libncurses5-dev rtl-sdr librtlsdr-dev libusb-1.0-0-dev cmake git wget make build-essential libitpp-dev libncursesw5-dev libcodec2-dev
|
||||
chkitpp=$(dpkg -l libitpp-dev 2>/dev/null | awk '/^ii/ {print 1} END {if (NR == 0) print 0}')
|
||||
if [ "$chkitpp" -lt "1" ];then
|
||||
printf "\nFor some reason, ITPP did NOT install!\nYou may have to manually install it.\n\n"
|
||||
read -p "Press Enter to exit..." x
|
||||
exit 1
|
||||
fi
|
||||
git clone https://github.com/lwvmobile/mbelib
|
||||
cd mbelib
|
||||
git checkout ambe_tones
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
cd $cdir
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
#git checkout audio_work
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
echo DSD-FME Digital Speech Decoder - Florida Man Edition Auto Installer
|
||||
echo MBELib is considered a requirement on this build.
|
||||
echo You must view this notice prior to continuing.
|
||||
echo The Patent Notice can be found at the site below.
|
||||
echo https://github.com/lwvmobile/mbelib#readme
|
||||
echo Please confirm that you have viewed the patent notice by entering y below.
|
||||
echo
|
||||
echo y/N
|
||||
read ANSWER
|
||||
Y='y'
|
||||
if [[ $Y == $ANSWER ]]; then
|
||||
|
||||
sudo apt update
|
||||
sudo apt install libpulse-dev pavucontrol libsndfile1-dev libfftw3-dev liblapack-dev socat libusb-1.0-0-dev libncurses5 libncurses5-dev rtl-sdr librtlsdr-dev libusb-1.0-0-dev cmake git wget make build-essential libitpp-dev libncursesw5-dev libcodec2-dev
|
||||
|
||||
echo ITPP Manual Build and Install has been temporarily removed from this script due to issues with older versions of Ubuntu.
|
||||
echo Please check to see that libitpp-dev has successfully been downloaded and installed from the repo.
|
||||
read -p "Press enter to continue"
|
||||
|
||||
#wget -O itpp-latest.tar.bz2 http://sourceforge.net/projects/itpp/files/latest/download?source=files
|
||||
#tar xjf itpp*
|
||||
#if you can't cd into this folder, double check folder name first
|
||||
#cd itpp-4.3.1
|
||||
#mkdir build
|
||||
#cd build
|
||||
#cmake ..
|
||||
#make -j `nproc`
|
||||
#sudo make install
|
||||
#sudo ldconfig
|
||||
#cd ..
|
||||
#cd ..
|
||||
|
||||
git clone https://github.com/lwvmobile/mbelib
|
||||
cd mbelib
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j `nproc`
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
cd ..
|
||||
cd ..
|
||||
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
sudo cp tone8.wav /usr/share/
|
||||
sudo cp tone24.wav /usr/share/
|
||||
sudo cp tone48.wav /usr/share/
|
||||
sudo chmod 777 /usr/share/tone8.wav
|
||||
sudo chmod 777 /usr/share/tone24.wav
|
||||
sudo chmod 777 /usr/share/tone48.wav
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j `nproc`
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
|
||||
else
|
||||
printf "\nSorry, you cannot build DSD-FME without acknowledging the Patent Notice.\nExiting...\n\n"
|
||||
exit 2
|
||||
fi
|
||||
echo
|
||||
echo Sorry, you cannot build DSD-FME without acknowledging the Patent Notice.
|
||||
fi
|
||||
|
||||
|
||||
|
||||
|
||||
BIN
dsd-fme2.png
BIN
dsd-fme2.png
Binary file not shown.
|
Before Width: | Height: | Size: 725 KiB After Width: | Height: | Size: 125 KiB |
BIN
dsd-fme3.png
BIN
dsd-fme3.png
Binary file not shown.
|
Before Width: | Height: | Size: 109 KiB After Width: | Height: | Size: 251 KiB |
@@ -1,74 +0,0 @@
|
||||
|
||||
|
||||
## Audio Plumbing
|
||||
|
||||
While using DSD-FME to demodulate and decode RF Audio, you will find it necessary to properly plumb (or route) audio from each input source and output sink properly. This mini tutorial aims to help you do such when using Pulse Audio.
|
||||
|
||||
You will first want to locate and run the virtualsink.sh script file via `sh virtualsink.sh` command. This will create two null-sink, or 'virtual sinks' for us to plumb audio from point A to point B.
|
||||
|
||||
Here are screenshots of a proper setup using pavucontrol, or "Pulse Audio Volume Control", having voice input from the encoder listening to your microphone, the RF Output going into the "Virtual_Sink" null-sink, and on the playback side, playing back voice to our speakers, with RF modulated audio being monitored on "Virtual-Sink" null-sink.
|
||||
|
||||

|
||||
|
||||

|
||||
|
||||
The general idea is that we want to route RF modulated audio into our Virtual_Sink and have our decoder listen to the same sink. Voice Output should always be to Audio Hardware (speakers, headphones, etc).
|
||||
|
||||
Note, that using the virtualsink.sh will create these sinks for us for the duration of your computers boot. If you reboot, they will not persist. Configuration files can be modified to always have these sinks available, or the `virtualsink.sh` script can be executed on login, but you must do so at your own risk and own research, it is out of the scope of this tutorial to create persistent sinks.
|
||||
|
||||
In case of the usage of a headless environment and pavucontrol is not viable, you may use alternatives such as pulsemixer which is similar in functionality, just as a CLI tool and not a GUI tool.
|
||||
|
||||
Users can now use the `-O` CLI argument to list out all pulse audio input sources and output sinks and pass an optional argument alongside `pulse`, appending the name or index number to select the device each time. This method will work in both Linux environments as well as Cygwin builds (making sure to start the pulseaudio.exe server in the back first with the specified .bat file or command, see below).
|
||||
|
||||
For Example:
|
||||
|
||||
The Output (truncated) of `dsd-fme -O`
|
||||
|
||||
```
|
||||
=======[ Output Device #1 ]=======
|
||||
Description: Family 17h (Models 00h-0fh) HD Audio Controller Analog Stereo
|
||||
Name: alsa_output.pci-0000_0d_00.3.analog-stereo
|
||||
Index: 1
|
||||
|
||||
=======[ Output Device #4 ]=======
|
||||
Description: Virtual_Sink1
|
||||
Name: virtual_sink1
|
||||
Index: 4
|
||||
|
||||
=======[ Output Device #5 ]=======
|
||||
Description: Virtual_Sink2
|
||||
Name: virtual_sink2
|
||||
Index: 5
|
||||
|
||||
=======[ Input Device #2 ]=======
|
||||
Description: Family 17h (Models 00h-0fh) HD Audio Controller Analog Stereo
|
||||
Name: alsa_input.pci-0000_0d_00.3.analog-stereo
|
||||
Index: 2
|
||||
|
||||
=======[ Input Device #5 ]=======
|
||||
Description: Monitor of Virtual_Sink1
|
||||
Name: virtual_sink1.monitor
|
||||
Index: 5
|
||||
|
||||
=======[ Input Device #6 ]=======
|
||||
Description: Monitor of Virtual_Sink2
|
||||
Name: virtual_sink2.monitor
|
||||
Index: 6
|
||||
```
|
||||
|
||||
You might use any of the following for input and output options:
|
||||
|
||||
```
|
||||
-i pulse
|
||||
-i pulse:6
|
||||
-i pulse:virtual_sink2.monitor
|
||||
|
||||
-o pulse
|
||||
-o pulse:1
|
||||
-o pulse:alsa_output.pci-0000_0d_00.3.analog-stereo
|
||||
```
|
||||
|
||||
Something to keep in mind is that often times, you only need to set these values once, as a pulse audio server (or plugin) can often times remember these settings, even across reboots, as long as the same hardware is present for future use (real or null-sink).
|
||||
|
||||
<!-- TODO: Add This later -->
|
||||
<!-- Cygwin Note: Running the supplied `0p - start-pulse-audio-backend.bat` file will not only start up the pulse audio server for you, but also setup your null-sinks, and enumerate all devices for you to use, making it an easy selection for your start up .bat files. See any notes in the precomplied .zip file for more information. -->
|
||||
@@ -1,6 +1,6 @@
|
||||
### Example Usage and Notes!
|
||||
|
||||
`dsd-fme` is all you need to run for pulse input, pulse output, and auto detect for DMR BS/MS, and P25. To use other decoding methods which cannot be auto detected, please use the following command line switches.
|
||||
`dsd-fme` is all you need to run for pulse input, pulse output, and auto detect for DMR BS/MS, and P25. To use other decoding methods which cannot be auto detected, please use the following command line switches. Make sure to route audio into and out of DSD-FME using pavucontrol and virtual sinks as needed.
|
||||
|
||||
```
|
||||
-ft XDMA decoder class (P25p1 and p2, YSF, and DMR Stereo)
|
||||
@@ -8,23 +8,19 @@
|
||||
-fa Legacy Auto (not recommended)
|
||||
-fi NXDN48
|
||||
-fn NXDN96
|
||||
-fp Provoice
|
||||
-fh EDACS Standard / Network
|
||||
-fH EDACS Standard / Network with ESK
|
||||
-fe EDACS Extended Addresssing
|
||||
-fE EDACS Extended Addressing with ESK
|
||||
-fp ProVoice
|
||||
-fm dPMR, also may need to use -xd if inverted dPMR.
|
||||
-fr DMR Mono, also may need to use -xr if inverted DMR.
|
||||
-f1 P25P1
|
||||
-f2 P25P2 (may need to specify wacn/sys/nac manually if traffic channel)
|
||||
-f2 P25P2 (may need to specify wacn/sys/nac manually)
|
||||
-fx X2-TDMA
|
||||
-fy YSF
|
||||
-fz M17 Audio
|
||||
```
|
||||
|
||||
## Conventional Frequency Scanner
|
||||
This feature is used to allow DSD-FME to use RIGCTL or RTL input and cycle through frequencies to attain a frame sync.
|
||||
## Conventional Frequency "Fast Scanner"
|
||||
This feature is used to allow DSD-FME to use RIGCTL or RTL input and cycle through frequencies as fast as possible to attain a frame sync.
|
||||
|
||||
This works almost identically to how the trunkng methods work, but instead of locking onto a control channel and tuning based on its decoding, it tunes through all loaded frequencies in a CSV file and stops when it finds a frame sync. This method is meant for loading a bunch of conventional non-trunking frequencies that signal only when voice or short data bursts are present (DMR T2, Conventional P25 P1, Conventional NXDN, etc) and decode them until the frame sync stops and then resume its scan. This method uses SDR++ RIGCTL, or RTL internal handling to go through signal. -Y is the scan switch. Note: This method will NOT perform at a level similar to a real hardware scanner, SDR tuning is not nearly as fast or reliable at locking onto signal.
|
||||
This works almost identically to how the trunkng methods work, but instead of locking onto a control channel and tuning based on its decoding, it rapidly tunes through all loaded frequencies in a CSV file and stops when it finds a frame sync. This method is meant for loading a bunch of conventional non-trunking frequencies that signal only when voice or short data bursts are present (DMR T2, Conventional P25 P1, Conventional NXDN, etc) and decode them until the frame sync stops and then resume its scan. This method uses SDR++ RIGCTL, or RTL internal handling to go through signal. -Y is the fast scanner switch.
|
||||
|
||||
To scan through a mixture of DMR and P25 Conventional, use:
|
||||
`dsd-fme -i tcp -C channel_map.csv -G group.csv -Y -U 4532 -N 2> log.ans`
|
||||
@@ -35,9 +31,9 @@ To scan through NXDN48 only conventional, use:
|
||||
To scan through NXDN96 only conventional, use:
|
||||
`dsd-fme -fn -i tcp -C channel_map.csv -Y -U 4532 -N 2> log.ans`
|
||||
|
||||
The Channel Map setup will be identical to any of the channel maps found for trunking systems, channel numbers do not matter and can be arbitrarily organized, and frequencies can be duplicated to be 'scanned' more frequently in larger CSV files. Scan speed by default is 1 second, and is most stable at that speed. This can be adjusted by using the `-t 2` option, for example, to specify 2 seconds of hang time per frequency. ~~If activity occurs on a frequency, an additional 2 seconds of 'hangtime' will occur on that frequency for any follow up voice activity.~~ Using `-t 0` will forego the one second wait time, and this can work in some situations, but is not advised as it may skip during the middle of transmissions, or skip over them entirely without a framesync.
|
||||
The Channel Map setup will be identical to any of the channel maps found for trunking systems, channel numbers do not matter and can be arbitrarily organized, and frequencies can be duplicated to be 'scanned' more frequently in larger CSV files. Scan speed by default is 1 second, and is most stable at that speed. This can be adjusted by using the `-t 2` option, for example, to specify 2 seconds of hang time per frequency. ~~If activity occurs on a frequency, an additional 2 seconds of 'hangtime' will occur on that frequency for any follow up voice activity.~~
|
||||
|
||||
Please Note: DMR Simplex may not behave well on scan, I have not been able to test it as such, but given the nature of the on-off timeslot signalling on DMR Simplex, missed frame syncs and skipping/resuming scan may occur.
|
||||
Please Note: DMR Simplex may not behave well on fast scan, I have not been able to test it as such, but given the nature of the on-off timeslot signalling on DMR Simplex, missed frame syncs and skipping/resuming scan may occur.
|
||||
|
||||
## Trunking Examples
|
||||
Please see trunking.sh for sample start up scripts or scroll down to the bottom for more explanation.
|
||||
@@ -49,9 +45,7 @@ and in a second terminal tab, same folder, run
|
||||
|
||||
`tail -n 40 -f voice.log`
|
||||
|
||||
### Audio Plumbing
|
||||
|
||||
Please see [Audio Plumbing](https://github.com/lwvmobile/dsd-fme/blob/aw_dev/examples/Audio_Plumbing.md "Audio Plumbing") for general help with audio plumbing (routing from A to B).
|
||||
Then you can open up your pavucontrol "Pulse Audio Volume Control" or "Volume Control" application and route input into DSD-FME from any application and DSD-FME output to the left and right speakers respectively. (unlock the channel in the application stream and adjust left and right independently)
|
||||
|
||||
### Input ###
|
||||
|
||||
@@ -80,7 +74,7 @@ Detailed Setup:
|
||||
|
||||
```
|
||||
RTL-SDR options:
|
||||
Usage: rtl:dev:freq:gain:ppm:bw:sq:vol
|
||||
Usage: rtl:dev:freq:gain:ppm:bw:sq:udp
|
||||
NOTE: all arguments after rtl are optional now for trunking, but user configuration is recommended
|
||||
dev <num> RTL-SDR Device Index Number
|
||||
freq <num> RTL-SDR Frequency (851800000 or 851.8M)
|
||||
@@ -88,9 +82,9 @@ RTL-SDR options:
|
||||
ppm <num> RTL-SDR PPM Error (default = 0)
|
||||
bw <num> RTL-SDR Bandwidth kHz (default = 12)(8, 12, 16, 24)
|
||||
sq <num> RTL-SDR Squelch Level vs RMS Value (Optional)
|
||||
vol <num> RTL-SDR Sample 'Volume' Multiplier (default = 2)(1,2,3)
|
||||
Example: dsd-fme -fs -i rtl -C cap_plus_channel.csv -T
|
||||
Example: dsd-fme -fp -i rtl:0:851.375M:22:-2:24:0:2
|
||||
udp <num> RTL-SDR Legacy UDP Remote Port (Optional -- External Use Only)
|
||||
Example: dsd-fme-zdev -fs -i rtl -C cap_plus_channel.csv -T
|
||||
Example: dsd-fme-zdev -fp -i rtl:0:851.375M:22:-2:24:0:6021
|
||||
|
||||
```
|
||||
|
||||
@@ -106,11 +100,11 @@ and in a second terminal tab, same folder, run
|
||||
|
||||
EDACS Trunking (w/ channel map import)
|
||||
|
||||
--EDACS/PV Trunking using RIGCTL and TCP Direct Link Audio inside of SDR++ (see switches above for STD/NET, EA, and ESK modes)
|
||||
--EDACS/PV Trunking using RIGCTL and TCP Direct Link Audio inside of SDR++ (Tested and Working on EDACS/EDACS-EA with Provoice, Analog Voice Monitoring and Per Call is Experimental)
|
||||
|
||||
`dsd-fme -i tcp -fE -C channel_map.csv -G group.csv -T -U 4532 -N 2> log.ans`
|
||||
`dsd-fme -i tcp -fp -C channel_map.csv -G group.csv -T -U 4532 -N 2> log.ans`
|
||||
|
||||
--NXDN48 Trunking (Direct Frequency Assignment) with SDR++ (untested for frequency accuracy)
|
||||
--NXDN48 Trunking (standard band plan) with SDR++ (untested for frequency accuracy)
|
||||
|
||||
`dsd-fme -fi -i tcp -T -U 4532 -N 2> log.ans`
|
||||
|
||||
@@ -171,7 +165,7 @@ Some Keyboard Shortcuts have been implemented for testing to see how users like
|
||||
esc or arrow keys - ncurses menu
|
||||
q - quit
|
||||
c - toggle compact mode
|
||||
h - cycle event history short, long, or off
|
||||
h - toggle call history
|
||||
z - toggle console payloads
|
||||
a - toggle call alert beep
|
||||
4 - force privacy/scrambler key assertion over enc identifiers (dmr and nxdn)
|
||||
@@ -182,13 +176,14 @@ M - toggle c4fm/qpsk 8/3 (phase 2 tdma control channel)
|
||||
R - start capturing symbol capture bin (date/time name file)
|
||||
r - stop capturing symbol capture bin
|
||||
spacebar - replay last symbol capture bin (captures must be stopped first)
|
||||
s - stop playing symbol capture bin or wav input file (lower s)
|
||||
s - stop playing symbol capture bin or wav input file
|
||||
P - start per call decoded wav files (Capital P)
|
||||
p - stop per call decoded wav files (lower p)
|
||||
p - stop per call decoded wav files (Lower p)
|
||||
t - toggle trunking (needs either rtl input, or rigctl connection)
|
||||
y - toggle scanner (needs either rtl input, or rigctl connection)
|
||||
1 - Toggle Voice Synthesis in TDMA Slot 1 or FDMA Conventional Voice
|
||||
2 - Toggle Voice Synthesis in TDMA Slot 2
|
||||
1 - Lockout Tuning/Playback of TG in Slot 1 or Conventional -- Current Session Only if no group.csv file specified
|
||||
2 - Lockout Tuning/Playback of TG in Slot 2 -- Current Session Only if no group.csv file specified
|
||||
0 - Toggle Audio Smoothing - May produce crackling if enabled on RTL/TCP or wav/bin files
|
||||
w - Toggle Trunking/Playback White List (Allow A Groups Only) / Black List (Block B or DE groups only) Mode
|
||||
g - Toggle Trunking Tuning to Group Calls (DMR T3, Con+, Cap+, P25, NXDN)
|
||||
u - Toggle Trunking Tuning to Private Calls (DMR T3, Cap+, P25)
|
||||
@@ -198,39 +193,13 @@ e - Toggle Trunking Tuning to Encrypted Calls (P25)
|
||||
9 - Connect to SDR++ RIGCTL Server with Defaults/Retry RIGCTL Connection
|
||||
D - Reset DMR Site Parms/Call Strings, etc.
|
||||
Z - Simulate NoCarrier/No VC/CC sync (capital Z)
|
||||
|
||||
! - Lockout Tuning/Playback of TG in Slot 1 or Conventional -- Current Session Only if no group.csv file specified
|
||||
@ - Lockout Tuning/Playback of TG in Slot 2 -- Current Session Only if no group.csv file specified
|
||||
|
||||
k - Hold TG in Slot 1 or Conventional, or clear current hold
|
||||
l - Hold TG in Slot 2 on TDMA Systems, or clear current hold
|
||||
|
||||
C - Drop Call and Return to CC during trunking operation
|
||||
L - Manual Cycle Forward Channel Tuned when RIGCTL or using RTL input and channel csv loaded
|
||||
|
||||
S - Toggle between EDACS Standard/Network and Extended Addressing mode (Capital S)
|
||||
A - Toggle EDACS ESK Mask (none vs A0)
|
||||
|
||||
H - Toggle High Pass Filter on Digital Sythesized Voice
|
||||
V - Toggle Low Pass Filter on Analog Voice or Raw Signal Monitoring
|
||||
B - Toggle High Pass Filter on Analog Voice or Raw Signal Monitoring
|
||||
N - Toggle Passband Filter on Analog Voice or Raw Signal Monitoring
|
||||
|
||||
[ - Scroll backwards through Event History
|
||||
] - Scroll forwards through Event History
|
||||
\ - Switch between Slot 1 and Slot 2 Event History
|
||||
|
||||
v - Cycle RTL Input Volume Multiplier 1X, 2X, 3X (lower v)
|
||||
|
||||
```
|
||||
|
||||
## Sending Audio to a Icecast 2 Server via FFmpeg (Windows)
|
||||
|
||||
Make sure to enable "Stereo Mix" from Volume Control Panel and then disable Windows Sounds.
|
||||
|
||||
```
|
||||
ffmpeg -f dshow -i audio="Stereo Mix (Realtek High Definition Audio)" -c:a aac -b:a 64k -content_type 'audio/aac' -vn -f adts icecast://source:password@192.168.5.251:8844/DSDFME
|
||||
```
|
||||
`ffmpeg -f dshow -i audio="Stereo Mix (Realtek High Definition Audio)" -c:a aac -b:a 64k -content_type 'audio/aac' -vn -f adts icecast://source:password@192.168.5.251:8844/DSDFME`
|
||||
|
||||
## Sending Audio to a Icecast 2 Server via FFmpeg (Linux w/ Pulse Audio)
|
||||
|
||||
@@ -256,125 +225,3 @@ francis@12coresx:~$ ffmpeg -f pulse -i 0 -c:a libmp3lame -ab 64k -f mp3 icecast:
|
||||
|
||||
|
||||
```
|
||||
|
||||
Note: Do not run this command for ffmpeg/icecast piped to the main dsd-fme command, make sure these are running in seperate terminals.
|
||||
|
||||
## Sending Audio to UDP Target/Port
|
||||
|
||||
Audio can be sent to a target address on your local area network with the UDP blaster using the `-o udp:targetaddress:port` option.
|
||||
Note: Any analog audio monitoring will not function properly over UDP port (rate difference issues)
|
||||
|
||||
Example (Short 8k/2):
|
||||
`dsd-fme -fs -o udp:192.168.7.8:23470`
|
||||
|
||||
Receiving End (Short 8k/2):
|
||||
`socat stdio udp-listen:23470 | play --buffer 640 -q -b 16 -r 8000 -c2 -t s16 -`
|
||||
|
||||
Example (Short 8k/1):
|
||||
`dsd-fme -f1 -o udp:192.168.7.8:23469`
|
||||
|
||||
Receiving End (Short 8k/1):
|
||||
`socat stdio udp-listen:23469 | play --buffer 320 -q -b 16 -r 8000 -c1 -t s16 -`
|
||||
|
||||
Example (Float 8k/2):
|
||||
`dsd-fme -ft -y -o udp:192.168.7.8:23468`
|
||||
|
||||
Receiving End (Float 8k/2):
|
||||
`socat stdio udp-listen:23468 | play --buffer 1280 -q -b 16 -r 8000 -c2 -t f32 -`
|
||||
|
||||
Example (Float 8k/1):
|
||||
`dsd-fme -fi -y -o udp:192.168.7.8:23467`
|
||||
|
||||
Receiving End (Float 8k/1):
|
||||
`socat stdio udp-listen:23467 | play --buffer 640 -q -b 16 -r 8000 -c1 -t f32 -`
|
||||
|
||||
Note: --buffer option in play is calculated by (channels * samples * sizeof(samples)),
|
||||
where samples is 160 for mono, 320 for stereo, and short samples are 2 and float samples are 4.
|
||||
This is vital to prevent 'lag' or cut-off audio when the UDP audio doesn't fill the default buffer size.
|
||||
|
||||
Note2: Be sure to start the receiving end AFTER starting DSD-FME. If DSD-FME is restarted, make sure to restart the receiving end as well, as socat/UDP closes the UDP port listening when DSD-FME closes the UDP socket.
|
||||
|
||||
Note3: socat version 1.8 may have a `E xioopen_ipdgram_listen(): unknown address family 0` problem, downgrading to 1.7.4 is recommended if this occurs. `sudo downgrade socat`.
|
||||
|
||||
## Record 48k/1 audio with rtl_fm
|
||||
|
||||
You can record suitable audio to feed as input to dsd-fme with `-i` using rtl_fm:
|
||||
|
||||
`rtl_fm -M nfm -f [FREQ] -s 48k -g 42 -l 20 > input.wav`
|
||||
|
||||
You can also combine that with `socat` to send the audio to a remote dsd-fme instance in real time while keeping a local copy on the host where the RTL-SDR dongle is:
|
||||
|
||||
`rtl_fm -M fm -f [FREQ] -s 48k -g 42 -l 20 | tee input.wav | socat -u - TCP-LISTEN:1234,forever,reuseaddr`
|
||||
|
||||
On the remote side where dsd-fme is, use the TCP input:
|
||||
|
||||
`dsd-fme -i tcp:192.168.7.8:1234 -N`
|
||||
|
||||
Note: As always, when using rtl_fm, play with `-l` and `-g` to find a good squelch and gain values for your environment - you will know if the squelch is the right value when `input.wav` does not increase in size in the absence of useful signal on the monitored frequency.
|
||||
|
||||
## Using the Experimental M17 Encoder (and Decoder)
|
||||
|
||||
You can use the experimental M17 Voice Stream and Packet encoder with the following examples.
|
||||
|
||||
Encode/Decode Local Feedback Voice Stream (Single Session):
|
||||
|
||||
`dsd-fme -fZ -i pulse -o pulse -M M17:3:SP5WWP:BROADCAST:48000`
|
||||
|
||||
Using the `-8` option (raw audio monitor) will instead send encoded raw audio to output instead of decoded audio. For example,
|
||||
|
||||
To send a voice stream out of stdout into SOCAT TCP to a second/remote DSD-FME session to decode:
|
||||
|
||||
Encode (Upper Z):
|
||||
|
||||
`dsd-fme -fZ -8 -i pulse -M M17:9:LWVMOBILE:DSD-FME:48000 -o - | socat stdio tcp-listen:7355,forever,reuseaddr`
|
||||
|
||||
Decode (Lower z):
|
||||
|
||||
`dsd-fme -fz -i tcp:192.168.7.8:7355`
|
||||
|
||||
NOTE: When using tcp input for M17 decoding, DSD-FME will keep the TCP connection alive with constant retries, so no need to restart the decoding session on connection failure.
|
||||
|
||||
SMS Packet Encoder (Text Only):
|
||||
|
||||
`dsd-fme -fP -8 -S "This is a sample message sent over M17 Packet Data using DSD-FME to encode it."`
|
||||
|
||||
SMS Packet Encoder (over SOCAT TCP):
|
||||
|
||||
`dsd-fme -fP -8 -S "This is a sample message sent over M17 Packet Data using DSD-FME to encode it and SOCAT to send it over TCP." -o - | socat stdio tcp-listen:7355,forever,reuseaddr`
|
||||
|
||||
Many combinations of input and output can be used as well, and using features like raw audio saving with `-6 m17str.wav` will save a wav file of your encoded audio to be replayed later with `-i m17str.wav`
|
||||
Also note, features function similarly, like -Z for payload, and input options include pulse, oss, stdin, rtl, tcp, etc, using those as the mic in for voice encoding. With the right setup of input/output/input using SOCAT TCP pipes, it is conceivable to use DSD-FME to convert analog audio from NFM into M17 audio, or even change another digital format supported by DSD-FME into M17 audio, if desired (purely for research and fun purposes). Ncurses terminal will function with internal encoder/decoder and wav file creation, with toggle encode/tx with `\` key, but will not function with stdout properly.
|
||||
|
||||
The `-M` switch is used to specify user M17 variables, the string is in the format of M17:CAN:SRC:DST:INPUT_RATE.
|
||||
CAN 1-15; SRC and DST have to be no more than 9 UPPER base40 characters.
|
||||
BASE40: ' ABCDEFGHIJKLMNOPQRSTUVWXYZ0123456789-/.'
|
||||
Input Rate Default is 48000; Use Multiples of 8000 up to 48000.
|
||||
Values not entered into the M17: string are set to default values. M17:7:DSD-FME:DSD-FME:48000
|
||||
|
||||
Fun Example Transmuting OTA Analog Things into M17:
|
||||
|
||||
Start up in sequence.
|
||||
|
||||
Terminal #1 (RTL Input):
|
||||
`dsd-fme -fZ -8 -M M17:1:ANALOG:M17:48000 -i rtl:0:162.425M -o - | socat stdio tcp-listen:7310,forever,reuseaddr`
|
||||
|
||||
Terminal #2:
|
||||
`dsd-fme -fz -i tcp:127.0.0.1:7310`
|
||||
|
||||
Fun Example Transmuting OTA Digital Things into M17:
|
||||
|
||||
Start up all three of these in sequence.
|
||||
|
||||
Terminal #1 (connecting to SDR++):
|
||||
`dsd-fme -fi -i tcp:127.0.0.1:7355 -o - | socat stdio tcp-listen:7300,forever,reuseaddr`
|
||||
|
||||
Terminal #2:
|
||||
`dsd-fme -fZ -8 -M M17:2:NXDN:M17:8000 -i tcp:127.0.0.1:7300 -o - | socat stdio tcp-listen:7301,forever,reuseaddr`
|
||||
|
||||
Terminal #3:
|
||||
`dsd-fme -fz -i tcp:127.0.0.1:7301`
|
||||
|
||||
Note: Transmuting only carries over voice when audio is output, and will not carry any ID values, or any other data payloads.
|
||||
This mode is only meant for educational or fun purposes, please do not retransmit stuff that doesn't belong to you.
|
||||
|
||||
Information on this section will be updated as features are added or modified, etc. If you need help with a particular function and can't find a suitable answer, always open a new issue here, or make contact on the radio reference forum for additional examples, guidance, ideas, help, etc.
|
||||
@@ -1,28 +1,23 @@
|
||||
## How to clone and build this branch
|
||||
|
||||
### Ubuntu 22.04/20.04/LM20/Debian Bullseye:
|
||||
### Ubuntu 22.04/20.04/LM20/Debian Bullseye or Newer:
|
||||
|
||||
Using the included download-and-install.sh should make for a simple and painless clone, build, and install on newer Debian/Ubuntu/Mint/Pi systems. Simply acquire or copy the script, and run it. Update: Ubuntu 23.04 and RPi Bullseye 64-bit has been tested working with the installer script and functions appropriately.
|
||||
|
||||
If you need all dependencies build and installed first (only on Debian/Ubuntu/Mint/Pi), run:
|
||||
|
||||
```
|
||||
wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/audio_work/download-and-install.sh
|
||||
sh download-and-install.sh
|
||||
```
|
||||
|
||||
### Debian 12 (SID) / Ubuntu 24.04 LTS (Updated Ncurses Dependencies)
|
||||
|
||||
```
|
||||
wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/audio_work/download-and-install-ubuntu2404lts.sh
|
||||
sh download-and-install-ubuntu2404lts.sh
|
||||
wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/main/download-and-install.sh
|
||||
chmod +x download-and-install.sh
|
||||
./download-and-install.sh
|
||||
```
|
||||
|
||||
### Arch Based Distros:
|
||||
|
||||
```
|
||||
wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/audio_work/download-and-install-Arch.sh
|
||||
sh download-and-install-Arch.sh
|
||||
wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/v2.1b/download-and-install-Arch.sh
|
||||
chmod +x download-and-install-Arch.sh
|
||||
./download-and-install-Arch.sh
|
||||
```
|
||||
|
||||
### Other:
|
||||
@@ -30,8 +25,9 @@ sh download-and-install-Arch.sh
|
||||
If you have dependencies already installed, please run this instead:
|
||||
|
||||
```
|
||||
wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/audio_work/download-and-install-nodeps.sh
|
||||
sh download-and-install-nodeps.sh
|
||||
wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/main/download-and-install-nodeps.sh
|
||||
chmod +x download-and-install-nodeps.sh
|
||||
./download-and-install-nodeps.sh
|
||||
```
|
||||
|
||||
## Manual Install
|
||||
@@ -42,10 +38,7 @@ Debian/Mint/Ubuntu/Pi
|
||||
|
||||
```
|
||||
sudo apt update
|
||||
#Ubuntu 22.04 lts / Debian 11 and lower
|
||||
sudo apt install libpulse-dev pavucontrol libsndfile1-dev libfftw3-dev liblapack-dev socat libusb-1.0-0-dev libncurses5 libncurses5-dev rtl-sdr librtlsdr-dev libusb-1.0-0-dev cmake git wget make build-essential libitpp-dev libcodec2-dev
|
||||
#Ubuntu 24.04 lts / Debian 12
|
||||
#sudo apt install libpulse-dev pavucontrol libsndfile1-dev libfftw3-dev liblapack-dev socat libusb-1.0-0-dev rtl-sdr librtlsdr-dev libusb-1.0-0-dev cmake git wget make build-essential libitpp-dev libncurses-dev libncurses6 libcodec2-dev
|
||||
sudo apt install libpulse-dev pavucontrol libsndfile1-dev libfftw3-dev liblapack-dev socat libusb-1.0-0-dev libncurses5 libncurses5-dev rtl-sdr librtlsdr-dev libusb-1.0-0-dev cmake git wget make build-essential libitpp-dev libncursesw5-dev libcodec2-dev
|
||||
```
|
||||
|
||||
Fedora 36/37 -- from https://github.com/lwvmobile/dsd-fme/issues/99
|
||||
@@ -89,11 +82,10 @@ cd ..
|
||||
cd ..
|
||||
```
|
||||
|
||||
MBELib is considered a requirement in this build. You must read this notice prior to continuing. [MBElib Patent Notice](https://github.com/lwvmobile/mbelib#readme "MBElib Patent Notice")
|
||||
MBELib is considered a requirement in this build. You must read this notice prior to continuing. [MBElib Patent Notice](https://github.com/lwvmobile/mbelib#readme "MBElib Patent Notice") This version of MBELib is 1.3.2 and prints to STDERR, using the stock 1.3.0 MBElib may cause problems with print alignments if paired with this version of DSD-FME, or cause future compatibility issues.
|
||||
|
||||
```
|
||||
git clone https://github.com/lwvmobile/mbelib
|
||||
git checkout ambe_tones
|
||||
cd mbelib
|
||||
mkdir build
|
||||
cd build
|
||||
@@ -105,11 +97,20 @@ cd ..
|
||||
cd ..
|
||||
```
|
||||
|
||||
Note: Some environment/distro users (Cygwin, Arch, and others) may need to manually copy any libmbe files found in the build folder to the /usr/lib folder on root.
|
||||
`sudo cp libmbe* /usr/lib`
|
||||
|
||||
Finish by running these steps to clone and build DSD-FME.
|
||||
|
||||
```
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
sudo cp tone8.wav /usr/share/
|
||||
sudo cp tone24.wav /usr/share/
|
||||
sudo cp tone48.wav /usr/share/
|
||||
sudo chmod 777 /usr/share/tone8.wav
|
||||
sudo chmod 777 /usr/share/tone24.wav
|
||||
sudo chmod 777 /usr/share/tone48.wav
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
@@ -119,42 +120,40 @@ sudo ldconfig
|
||||
|
||||
```
|
||||
|
||||
### LD_PATH
|
||||
|
||||
Some environments may require an LD path to be set to /usr/local/lib, similar to:
|
||||
```
|
||||
LD_LIBRARY_PATH=/usr/local/lib
|
||||
export LD_LIBRARY_PATH
|
||||
```
|
||||
|
||||
### Windows Cygwin Builds
|
||||
|
||||
Cygwin builds now have an experimental semi-automatic installer, to run, follow steps below:
|
||||
If using RTL input support, you must install libusb-win32 before proceeding with Cygwin installation. You will also need to build and compile a version of librtlsdr, but this can be tricky, and personally, I had to resort to using a much older version of the source code to get it to build at all with the rtl support in the precompiled 'Aero' builds.
|
||||
|
||||
Open Windows PowerShell (not Command Prompt) and copy and paste all of this in all at once.
|
||||
Then install all dependencies available in the repo prior to building, either directly selecting them during setup with the setup-x86.exe or setup-x64.exe or by issuing a command similar to this:
|
||||
|
||||
```
|
||||
Invoke-WebRequest https://cygwin.com/setup-x86_64.exe -OutFile setup-x86_64.exe
|
||||
.\setup-x86_64.exe --packages nano,libpulse-devel,libpulse-mainloop-glib0,libpulse-simple0,libpulse0,pulseaudio,pulseaudio-debuginfo,pulseaudio-equalizer,pulseaudio-module-x11,pulseaudio-module-zeroconf,pulseaudio-utils,sox-fmt-pulseaudio,libusb0,libusb1.0,libusb1.0-debuginfo,libusb1.0-devel,libncurses++w10,libncurses-devel,libncursesw10,ncurses,cmake,gcc-core,gcc-debuginfo,gcc-objc,git,make,socat,sox,sox-fmt-ao,zip,unzip,wget,gcc-g++,libsndfile-devel
|
||||
|
||||
setup-x64.exe --packages libpulse-devel,libpulse-mainloop-glib0,libpulse-simple0,libpulse0,pulseaudio,pulseaudio-debuginfo,pulseaudio-equalizer,pulseaudio-module-x11,pulseaudio-module-zeroconf,pulseaudio-utils,sox-fmt-pulseaudio,xfce-pulseaudio-plugin,libusb0,libusb1.0,libusb1.0-debuginfo,libusb1.0-devel,libncurses++w10,libncurses-devel,libncursesw10,ncurses,cmake,gcc-core,gcc-debuginfo,gcc-objc,git,make,socat,sox,sox-fmt-ao,unzip,wget,gcc-g++,libsndfile-devel
|
||||
```
|
||||
|
||||
Pick a Mirror. http://www.gtlib.gatech.edu mirror seems relatively fast. Nurse the Cygwin installer by clicking next and waiting for it to finish. Ignore the warning popup telling you to install libusb from sourceforge. Install the [Zadig](https://zadig.akeo.ie/ "Zadig") driver instead, if you haven't already and have an RTL Dongle. After Cygwin finishes installing, the installer sh script will download and run, be patient, it may also take a little while.
|
||||
Then manually install ITPP and MBElib, see above install notes. Be sure to run `cp libmbe* /usr/lib` after compiling MBElib.
|
||||
|
||||
Then:
|
||||
Then you can build and install using
|
||||
|
||||
```
|
||||
C:\cygwin64\bin\mintty.exe /bin/bash -l -c "wget https://raw.githubusercontent.com/lwvmobile/dsd-fme/refs/heads/audio_work/download-and-install-cygwin.sh; sh download-and-install-cygwin.sh; dsd-fme;"
|
||||
|
||||
git clone https://github.com/lwvmobile/dsd-fme
|
||||
cd dsd-fme
|
||||
cp tone8.wav /usr/share/
|
||||
cp tone24.wav /usr/share/
|
||||
cp tone48.wav /usr/share/
|
||||
chmod 777 /usr/share/tone8.wav
|
||||
chmod 777 /usr/share/tone24.wav
|
||||
chmod 777 /usr/share/tone48.wav
|
||||
mkdir build
|
||||
cd build
|
||||
# -DAERO=ON is optional, but recommended if you want the older OSS support as well
|
||||
cmake -DAERO=ON ..
|
||||
make
|
||||
make install
|
||||
```
|
||||
|
||||
After the sh script finishes, dsd-fme should open. If not, then double click on the Cygwin Terminal desktop shortcut, and try running `dsd-fme`. If you chose to create a portable version, you will find the folder and zip file in the `C:\cygwin64\home\username` directory if using the default cygwin64 folder location.
|
||||
|
||||
You can also update your versions by using the cyg_rebuild.sh script `sh cyg_rebuild.sh`.
|
||||
|
||||
### Virtual Sinks
|
||||
|
||||
You may wish to direct sound into DSD-FME via Virtual Sinks. You may set up a Virtual Sink or two on your machine for routing audio in and out of applications to other applications using the following command, and opening up pavucontrol "PulseAudio Volume Control" in the menu (or `pulsemixer` in headless mode) to change line out of application to virtual sink, and line in of DSD-FME to monitor of virtual sink. This command will not persist past a reboot, so you will need to invoke them each time you reboot, or search for how to add this to your conf files for persistency if desired. Note: This setup is completely optional if using TCP Network Sink Audio and/or RTL Input. You may need to manually install either of these programs manually, if desired, or find suitable alternatives for pipewire-pulse such as pwvucontrol, or similar.
|
||||
You may wish to direct sound into DSD-FME via Virtual Sinks. You may set up a Virtual Sink or two on your machine for routing audio in and out of applications to other applications using the following command, and opening up pavucontrol "PulseAudio Volume Control" in the menu (or `pulsemixer` in headless mode) to change line out of application to virtual sink, and line in of DSD-FME to monitor of virtual sink. This command will not persist past a reboot, so you will need to invoke them each time you reboot, or search for how to add this to your conf files for persistency if desired. Note: This setup is completely optional if using TCP Network Sink Audio and/or RTL Input.
|
||||
|
||||
```
|
||||
pactl load-module module-null-sink sink_name=virtual_sink sink_properties=device.description=Virtual_Sink
|
||||
@@ -174,31 +173,13 @@ sudo make install
|
||||
sudo ldconfig
|
||||
```
|
||||
|
||||
### Applying Patches -- Recommended For Advanced Users Only
|
||||
|
||||
More experimental or potentially functionality changing or temperamental features may be included as seperate .patch files inside of the patch folder, and are not included in the source code by default.
|
||||
If users wish to try or use these patches, then they can apply patches and build/rebuild with the following procedure. Make sure you have changed to the dsd-fme directory first, either by the top
|
||||
command, or by otherwise opening the terminal to the clone folder.
|
||||
If the call alert wav files aren't playing, then make sure to run the following in the dsd-fme folder to copy the wav files to the /usr/share/ folder and give them adequate permission to be accessed.
|
||||
|
||||
```
|
||||
cd dsd-fme
|
||||
git apply patch/patchname.patch
|
||||
cd build
|
||||
make
|
||||
sudo make install
|
||||
```
|
||||
|
||||
If you later wish to update to the latest version via `git pull`, you may first need to reset any patches, perform the `git pull`, and then reapply patches.
|
||||
A procedure for this is similar to, but not limited to:
|
||||
|
||||
```
|
||||
cd dsd-fme
|
||||
git reset --hard
|
||||
git pull
|
||||
git apply patch/xyz.patch
|
||||
cd build
|
||||
make
|
||||
sudo make install
|
||||
```
|
||||
|
||||
NOTE: Patches can potential break over time with further changes to code, requiring merge resolution or other manual intervention to re-apply patches.
|
||||
sudo cp tone8.wav /usr/share/
|
||||
sudo cp tone24.wav /usr/share/
|
||||
sudo cp tone48.wav /usr/share/
|
||||
sudo chmod 777 /usr/share/tone8.wav
|
||||
sudo chmod 777 /usr/share/tone24.wav
|
||||
sudo chmod 777 /usr/share/tone48.wav
|
||||
```
|
||||
@@ -1,14 +0,0 @@
|
||||
@REM Shutdown pulseaudio and clean out any remenants in /dev/shm if left behind
|
||||
|
||||
cd dsd-fme
|
||||
pactl.exe exit
|
||||
|
||||
@REM now navigate to the /dev/shm folder and automatically remove any
|
||||
@REM remnants from other times pulse wasn't shut down properly
|
||||
|
||||
cd ..
|
||||
cd dev
|
||||
cd shm
|
||||
del pulse*
|
||||
|
||||
PAUSE
|
||||
@@ -1,34 +0,0 @@
|
||||
@REM Set the console / terminal to 90 columns, 50 lines
|
||||
@REM mode con: cols=90 lines=50
|
||||
|
||||
@ECHO OFF
|
||||
|
||||
@REM change directory into the dsd-fme folder
|
||||
cd dsd-fme
|
||||
|
||||
@REM Start the Pulse Audio backend with a 10 minute time out
|
||||
@REM start pulse audio server with 600 second idle time and no CPU limit (prevent closing while idle in menu)
|
||||
|
||||
@REM output from pulse server routed to NUL to supress "capabilities dropped, nag messages, etc" messages
|
||||
pulseaudio.exe --start --no-cpu-limit=TRUE --exit-idle-time=600 2> NUL
|
||||
|
||||
@REM End pulse start up
|
||||
|
||||
ECHO The Pulse Audio Server should now be active!
|
||||
|
||||
@REM Setup Some null-sinks (if desired, remove @REM below)
|
||||
|
||||
@REM pactl load-module module-null-sink sink_name=virtual_sink1 sink_properties=device.description=Virtual_Sink1
|
||||
@REM pactl load-module module-null-sink sink_name=virtual_sink2 sink_properties=device.description=Virtual_Sink2
|
||||
|
||||
@REM Setup Default Sink to device 0 (output)
|
||||
|
||||
pactl set-default-sink 0
|
||||
|
||||
@REM List Avaiable Pulse Audio Sinks and Sources
|
||||
|
||||
@ECHO ON
|
||||
|
||||
dsd-fme -O
|
||||
|
||||
PAUSE
|
||||
@@ -1,231 +0,0 @@
|
||||
Build Version: AW 2025-182-g24c1dd9
|
||||
MBElib Version: 1.3.4
|
||||
CODEC2 Support Enabled
|
||||
|
||||
Usage: dsd-fme [options] Decoder/Trunking Mode
|
||||
or: dsd-fme [options] -r <files> Read/Play saved mbe data from file(s)
|
||||
or: dsd-fme -h Show help
|
||||
|
||||
Display Options:
|
||||
-N Use NCurses Terminal
|
||||
dsd-fme -N 2> console_log.txt
|
||||
-Z Log MBE/PDU Payloads to console
|
||||
|
||||
Device Options:
|
||||
-O List All Pulse Audio Input Sources and Output Sinks (devices).
|
||||
|
||||
Input/Output options:
|
||||
-i <device> Audio input device (default is pulse)
|
||||
/dev/dsp for OSS audio (Depreciated: Will require padsp wrapper in Linux)
|
||||
pulse for pulse audio signal input
|
||||
pulse:6 or pulse:virtual_sink2.monitor for pulse audio signal input on virtual_sink2 (see -O)
|
||||
rtl for rtl dongle (Default Values -- see below)
|
||||
rtl:dev:freq:gain:ppm:bw:sq:vol for rtl dongle (see below)
|
||||
tcp for tcp client SDR++/GNURadio Companion/Other (Port 7355)
|
||||
tcp:192.168.7.5:7355 for custom address and port
|
||||
m17udp for M17 UDP/IP socket bind input (default host 127.0.0.1; default port 17000)
|
||||
m17udp:192.168.7.8:17001 for M17 UDP/IP bind input (Binding Address and Port
|
||||
filename.bin for OP25/FME capture bin files
|
||||
filename.wav for 48K/1 wav files (SDR++, GQRX)
|
||||
filename.wav -s 96000 for 96K/1 wav files (DSDPlus)
|
||||
(Use single quotes '/directory/audio file.wav' when directories/spaces are present)
|
||||
-s <rate> Sample Rate of wav input files (48000 or 96000) Mono only!
|
||||
-o <device> Audio output device (default is pulse)
|
||||
/dev/dsp for OSS audio (Depreciated: Will require padsp wrapper in Linux)
|
||||
pulse for pulse audio decoded voice or analog output
|
||||
pulse:1 or pulse:alsa_output.pci-0000_0d_00.3.analog-stereo for pulse audio decoded voice or analog output on device (see -O)
|
||||
null for no audio output
|
||||
udp for UDP socket blaster output (default host 127.0.0.1; default port 23456)
|
||||
udp:192.168.7.8:23470 for UDP socket blaster output (Target Address and Port
|
||||
m17udp for M17 UDP/IP socket blaster output (default host 127.0.0.1; default port 17000)
|
||||
m17udp:192.168.7.8:17001 for M17 UDP/IP blaster output (Target Address and Port
|
||||
-d <dir> Create mbe data files, use this directory (TDMA version is experimental)
|
||||
-r <files> Read/Play saved mbe data from file(s)
|
||||
-g <float> Audio Digital Output Gain (Default: 0 = Auto; )
|
||||
(Manual: 1 = 2%; 50 = 100%)
|
||||
-n <float> Audio Analog Output Gain (Default: 0 = Auto; 0-100% )
|
||||
-6 <file> Output raw audio .wav file (48K/1). (WARNING! Large File Sizes 1 Hour ~= 360 MB)
|
||||
-7 <dir> Create/Use Custom directory for Per Call decoded .wav file saving.
|
||||
(Use ./folder for Nested Directory!)
|
||||
(Use /path/to/folder for hard coded directory!)
|
||||
(Use Before the -P option!)
|
||||
-8 Enable Source Audio Monitor
|
||||
(Set Squelch in RTL, SDR++ or GQRX, etc, if monitoring mixed analog/digital)
|
||||
-w <file> Output synthesized speech to a single static .wav file. (Do not use with -P Per Call Switch)
|
||||
-P Enable Per Call WAV file saving. (Do not use with -w filename.wav single wav file switch)
|
||||
(Per Call works with everything now and doesn't require ncurses terminal!)
|
||||
-a Enable Call Alert Beep
|
||||
(Warning! Might be annoying.)
|
||||
-J <file> Specify Filename for Event Log Output.
|
||||
-L <file> Specify Filename for LRRP Data Output.
|
||||
-Q <file> Specify Filename for OK-DMRlib Structured File Output. (placed in DSP folder)
|
||||
-Q <file> Specify Filename for M17 Float Stream Output. (placed in DSP folder)
|
||||
-c <file> Output symbol capture to .bin file
|
||||
-q Reverse Mute - Mute Unencrypted Voice and Unmute Encrypted Voice
|
||||
-V <num> Enable TDMA Voice Synthesis on Slot 1 (1), Slot 2 (2), or Both (3); Default is 3;
|
||||
-z Set TDMA Voice Slot Preference when using /dev/dsp audio output (prevent lag and stuttering)
|
||||
-y Enable Experimental Pulse Audio Float Audio Output
|
||||
-v <hex> Set Filtering Bitmap Options (Advanced Option)
|
||||
1 1 1 1 (0xF): PBF/LPF/HPF/HPFD on
|
||||
|
||||
RTL-SDR options:
|
||||
Usage: rtl:dev:freq:gain:ppm:bw:sq:vol
|
||||
NOTE: all arguments after rtl are optional now for trunking, but user configuration is recommended
|
||||
dev <num> RTL-SDR Device Index Number or 8 Digit Serial Number, no strings! (default 0)
|
||||
freq <num> RTL-SDR Frequency (851800000 or 851.8M)
|
||||
gain <num> RTL-SDR Device Gain (0-49)(default = 0; Hardware AGC recommended)
|
||||
ppm <num> RTL-SDR PPM Error (default = 0)
|
||||
bw <num> RTL-SDR Bandwidth kHz (default = 12)(4, 6, 8, 12, 16, 24)
|
||||
sq <num> RTL-SDR Squelch Level vs RMS Value (Optional)
|
||||
vol <num> RTL-SDR Sample 'Volume' Multiplier (default = 2)(1,2,3)
|
||||
Example: dsd-fme -fs -i rtl -C cap_plus_channel.csv -T
|
||||
Example: dsd-fme -fp -i rtl:0:851.375M:22:-2:24:0:2
|
||||
|
||||
Encoder options:
|
||||
-fZ M17 Stream Voice Encoder
|
||||
Example: dsd-fme -fZ -M M17:9:DSD-FME:LWVMOBILE -i pulse -6 m17signal.wav -8 -N 2> m17encoderlog.txt
|
||||
Run M17 Encoding, listening to pulse audio server, with internal decode/playback and output to 48k/1 wav file
|
||||
|
||||
Example: dsd-fme -fZ -M M17:9:DSD-FME:LWVMOBILE -i tcp -o pulse -8 -N 2> m17encoderlog.txt
|
||||
Run M17 Encoding, listening to default tcp input, without internal decode/playback and output to 48k/1 analog output device
|
||||
|
||||
-fP M17 Packet Encoder
|
||||
Example: dsd-fme -fP -M M17:9:DSD-FME:LWVMOBILE -6 m17pkt.wav -8 -S 'Hello World'
|
||||
|
||||
-fB M17 BERT Encoder
|
||||
Example: dsd-fme -fB -M M17:9:DSD-FME:LWVMOBILE -6 m17bert.wav -8
|
||||
|
||||
-M M17 Encoding User Configuration String: M17:CAN:SRC:DST:INPUT_RATE:VOX (see examples above).
|
||||
CAN 1-15; SRC and DST have to be no more than 9 UPPER base40 characters.
|
||||
BASE40: ' ABCDEFGHIJKLMNOPQRSTUVWXYZ0123456789-/.'
|
||||
Input Rate Default is 48000; Use Multiples of 8000 up to 48000.
|
||||
VOX Enabled on 1; (Default = 0)
|
||||
Values not entered into the M17: string are set to default values.
|
||||
Decoder options:
|
||||
-fa Auto Detection
|
||||
-fA Passive Analog Audio Monitor
|
||||
-ft TDMA Trunking P25p1 Control and Voice, P25p2 Trunked Channels, and DMR
|
||||
-fs DMR TDMA BS and MS Simplex
|
||||
-f1 Decode only P25 Phase 1
|
||||
-f2 Decode only P25 Phase 2 (6000 sps) **
|
||||
-fd Decode only DSTAR
|
||||
-fx Decode only X2-TDMA
|
||||
-fy Decode only YSF
|
||||
-fz Decode only M17*
|
||||
-fU Decode only M17 UDP/IP Frame***
|
||||
-fi Decode only NXDN48* (6.25 kHz) / IDAS*
|
||||
-fn Decode only NXDN96* (12.5 kHz)
|
||||
-fp Decode only ProVoice*
|
||||
-fh Decode only EDACS Standard/ProVoice*
|
||||
-fH Decode only EDACS Standard/ProVoice with ESK 0xA0*
|
||||
-fh344 Decode only EDACS Standard/ProVoice and set AFS to 344 or similar custom 11-bit scheme*
|
||||
-fH434 Decode only EDACS Standard/ProVoice and set AFS to custom 11-bit scheme with ESK 0xA0*
|
||||
-fe Decode only EDACS EA/ProVoice*
|
||||
-fE Decode only EDACS EA/ProVoice with ESK 0xA0*
|
||||
-fm Decode only dPMR*
|
||||
-l Disable DMR, dPMR, NXDN, M17 input filtering
|
||||
-u <num> Unvoiced speech quality (default=3)
|
||||
-xx Expect non-inverted X2-TDMA signal
|
||||
-xr Expect inverted DMR signal
|
||||
-xd Expect inverted ICOM dPMR signal
|
||||
-xz Expect inverted M17 signal
|
||||
|
||||
* denotes frame types that cannot be auto-detected.
|
||||
** Phase 2 Single Frequency may require user to manually set WACN/SYSID/CC parameters if MAC_SIGNAL not present.
|
||||
*** configure UDP Input with -i m17:127.0.0.1:17000
|
||||
|
||||
Advanced Decoder options:
|
||||
-X <hex> Manually Set P2 Parameters (WACN, SYSID, CC/NAC)
|
||||
(-X BEE00ABC123)
|
||||
-D <dec> Manually Set TIII DMR Location Area n bit len (0-10)(10 max)
|
||||
(Value defaults to max n bit value for site model size)
|
||||
(Setting 0 will show full Site ID, no area/subarea)
|
||||
|
||||
-ma Auto-select modulation optimizations
|
||||
-mc Use only C4FM modulation optimizations (default)
|
||||
-mg Use only GFSK modulation optimizations
|
||||
-mq Use only QPSK modulation optimizations
|
||||
-m2 Use P25p2 6000 sps QPSK modulation optimizations
|
||||
-F Relax P25 Phase 2 MAC_SIGNAL CRC Checksum Pass/Fail
|
||||
Use this feature to allow MAC_SIGNAL even if CRC errors.
|
||||
-F Relax DMR RAS/CRC CSBK/DATA Pass/Fail
|
||||
Enabling on some systems could lead to bad channel assignments/site data decoding if bad or marginal signal
|
||||
-F Relax M17 LSF/PKT CRC Error Checking
|
||||
|
||||
-b <dec> Manually Enter Basic Privacy Key (Decimal Value of Key Number)
|
||||
(NOTE: This used to be the 'K' option!
|
||||
|
||||
-H <hex> Manually Enter Hytera 10/32/64 Char Basic Privacy Hex Key (see example below)
|
||||
Encapulate in Single Quotation Marks; Space every 16 chars.
|
||||
-H 0B57935150
|
||||
-H '736B9A9C5645288B 243AD5CB8701EF8A'
|
||||
-H '20029736A5D91042 C923EB0697484433 005EFC58A1905195 E28E9C7836AA2DB8'
|
||||
|
||||
-H <hex> Manually Enter AES-128 or AES-256 Hex Key (see example below)
|
||||
Encapulate in Single Quotation Marks; Space every 16 chars.
|
||||
-H '736B9A9C5645288B 243AD5CB8701EF8A'
|
||||
-H '20029736A5D91042 C923EB0697484433 005EFC58A1905195 E28E9C7836AA2DB8'
|
||||
|
||||
-R <dec> Manually Enter dPMR or NXDN EHR Scrambler Key Value (Decimal Value)
|
||||
|
||||
-1 <hex> Manually Enter RC4 or DES Key Value (DMR, P25, NXDN) (Hex Value)
|
||||
|
||||
-2 <hex> Manually Enter and Enforce TYT 16-bit BP Key Value (DMR) (Hex Value)
|
||||
|
||||
-! <hex> Manually Enter and Enforce TYT Advanced Privacy (PC4) AP Hex Key (see example below)
|
||||
Encapulate in Single Quotation Marks; Space every 16 chars.
|
||||
-! '736B9A9C5645288B 243AD5CB8701EF8A'
|
||||
|
||||
-5 <hex> Manually Enter and Enforce TYT Enhanced Privacy (AES-128) EP Hex Key (see example below)
|
||||
Encapulate in Single Quotation Marks; Space every 16 chars.
|
||||
-5 '736B9A9C5645288B 243AD5CB8701EF8A'
|
||||
|
||||
-9 <dec> Manually Enter and Enforce Kenwood 15-bit Scrambler Key Value (DMR) (Dec Value)
|
||||
|
||||
-A <hex> Manually Enter and Enforce Anytone 16-bit BP Key Value (DMR) (Hex Value)
|
||||
|
||||
-S <str> Manually Enter and Enforce Generic Static Keystream -> Length and BYTE PACKED / ALIGNED String for AMBE (up to 882 bits)
|
||||
For Example, enter 16-bit Keystream 0909 as:
|
||||
-S 16:0909
|
||||
For Example, enter 49-bit Keystream as:
|
||||
-S 49:123456789ABC80
|
||||
For Example, enter 49-bit Keystream (MBP 70) as:
|
||||
-S 49:ED0AED4AED4AED4A
|
||||
|
||||
-k <file> Import Key List from csv file (Decimal Format) -- Lower Case 'k'.
|
||||
Only supports NXDN, DMR Basic Privacy (decimal value).
|
||||
(dPMR and Hytera 32/64 char not supported, DMR uses TG value as key id -- EXPERIMENTAL!!).
|
||||
|
||||
-K <file> Import Key List from csv file (Hexidecimal Format) -- Capital 'K'.
|
||||
Use for Hex Value Hytera 10-char BP keys, RC4 10-char, DES 16-char Hex Keys, and AES128/256 32/64-char keys.
|
||||
|
||||
-4 Force Privacy Key over Encryption Identifiers (DMR MBP/HBP and NXDN Scrambler)
|
||||
|
||||
-0 Force RC4 Key over Missing PI header/LE Encryption Identifiers (DMR)
|
||||
|
||||
-3 Disable DMR Late Entry Encryption Identifiers (VC6 Single Burst)
|
||||
Note: Disable this if false positives on Voice ENC occur.
|
||||
|
||||
Trunking Options:
|
||||
-C <file> Import Channel to Frequency Map (channum, freq) from csv file. (Capital C)
|
||||
(See channel_map.csv for example)
|
||||
-G <file> Import Group List Allow/Block and Label from csv file.
|
||||
(See group.csv for example)
|
||||
-T Enable Trunking Features (NXDN/P25/EDACS/DMR) with RIGCTL/TCP or RTL Input
|
||||
-Y Enable Scanning Mode with RIGCTL/TCP or RTL Input
|
||||
Experimental -- Can only scan for sync with enabled decoders, don't mix NXDN and DMR/P25!
|
||||
This is not a Trunking Feature, just scans through conventional frequencies fast!
|
||||
-W Use Imported Group List as a Trunking Allow/White List -- Only Tune with Mode A
|
||||
-p Disable Tune to Private Calls (DMR TIII, P25, NXDN Type-C and Type-D)
|
||||
-E Disable Tune to Group Calls (DMR TIII, Con+, Cap+, P25, NXDN Type-C, and Type-D)
|
||||
-e Enable Tune to Data Calls (DMR TIII, Cap+, NXDN Type-C)
|
||||
(NOTE: No Clear Distinction between Cap+ Private Voice Calls and Data Calls -- Both enabled with Data Calls
|
||||
-I <dec> Specify TG to Hold During Trunking (DMR, P25, NXDN Type-C Trunking)
|
||||
-U <port> Enable RIGCTL/TCP; Set TCP Port for RIGCTL. (4532 on SDR++)
|
||||
-B <Hertz> Set RIGCTL Setmod Bandwidth in Hertz (0 - default - OFF)
|
||||
P25 - 12000; NXDN48 - 7000; NXDN96: 12000; DMR - 7000-12000; EDACS/PV - 12000-24000;
|
||||
May vary based on system stregnth, etc.
|
||||
-t <secs> Set Trunking or Scan Speed VC/sync loss hangtime in seconds. (default = 1 second)
|
||||
|
||||
Trunking Example TCP: dsd-fme -fs -i tcp -U 4532 -T -C dmr_t3_chan.csv -G group.csv -N 2> log.txt
|
||||
Trunking Example RTL: dsd-fme -fs -i rtl:0:450M:26:-2:8 -T -C connect_plus_chan.csv -G group.csv -N 2> log.txt
|
||||
@@ -1,97 +0,0 @@
|
||||
This example options contains numerous options put into the start-dsd-fme.bat file in the option string
|
||||
feel free to experiment and mix and match example options for your bat files option string.
|
||||
|
||||
Trunking Option Examples:
|
||||
|
||||
P25 (Phase 1 Control) Trunking with SDR++ Network Sink input, RIGCTL, /dev/dsp output,
|
||||
per call wav files, ncurses terminal
|
||||
-ft -i tcp:127.0.0.1:7355 -U 4532 -T -P -N
|
||||
|
||||
P25 (Phase 2 Control) Trunking with SDR++ Network Sink input, RIGCTL, /dev/dsp output,
|
||||
per call wav files, ncurses terminal
|
||||
-f2 -i tcp:127.0.0.1:7355 -U 4532 -T -P -N
|
||||
|
||||
DMR Trunking with RTL input, /dev/dsp output, channel map import,
|
||||
per call wav files, ncurses terminal, payload dump to console
|
||||
-fs -i rtl:0:450M:0:-2:12 -T -C examples\dmr_t3_chan.csv -P -N -Z
|
||||
|
||||
DMR Trunking with SDR++ input, RIGCTL, /dev/dsp output, RAS enabled CSBK (-F),
|
||||
channel map import, per call wav files, ncurses terminal, payload dump to console
|
||||
-fs -F -i tcp -U 4532 -T -C examples\capacity_plus_chan.csv -P -N -Z
|
||||
|
||||
NXDN48 v2.0 DFA (Direct Frequency Assignment) Trunking with SDR++ input, RIGCTL, /dev/dsp output,
|
||||
scrambler key import (decimal), per call wav files, ncurses terminal, payload dump to console
|
||||
-fi -i tcp -U 4532 -T -P -N -Z -k examples\nxdn_sc_key.csv
|
||||
|
||||
NXDN96 Trunking with SDR++ input, RIGCTL, /dev/dsp output,
|
||||
channel map import, per call wav files, ncurses terminal, payload dump to console
|
||||
-fn -i tcp -U 4532 -T -C examples\nxdn_chan_map.csv -P -N -Z
|
||||
|
||||
EDACS Standard Network Analog and Digital
|
||||
-fh -i tcp -U 4532 -T -C edacs_channel_map.csv -G group.csv -N
|
||||
-fh -i rtl:0:850M:44:-2:24 -T -C edacs_channel_map.csv -G group.csv -N
|
||||
|
||||
EDACS Extended Address Analog and Digital (with ESK)
|
||||
-fE -i tcp:192.168.7.5:7355 -U 4532 -T -C edacs_channel_map.csv -G group.csv -N
|
||||
-fE -i rtl:0:850M:44:-2:24 -T -C edacs_channel_map.csv -G group.csv -N
|
||||
|
||||
Scanning Option Examples:
|
||||
|
||||
Scanning will not perform quickly like a real scanner, but can be used with any
|
||||
supported decoding type and analog as well, and will require a channel_map to scan frequencies
|
||||
channel numbers do not matter, but use unique ones for each frequeny
|
||||
-t 0 will scan as fast as possible, but may miss frame sync, -t 1 is stable, but needs 1 second between tuning
|
||||
|
||||
P25/DMR/Analog Scanning with RTL input, /dev/dsp output, channel map import,
|
||||
per call wav files, ncurses terminal, payload dump to console, raw audio signal monitoring
|
||||
-ft -i rtl:0:450M:0:-2:12 -Y -t 1 -C examples\dmr_t3_chan.csv -P -8 -N -Z
|
||||
|
||||
P25/DMR/Analog Scanning with SDR++ input (use squelch), RIGCTL, /dev/dsp output, channel map import,
|
||||
per call wav files, ncurses terminal, payload dump to console, raw audio signal monitoring
|
||||
-ft -i tcp:127.0.0.1:7355 -U 4532 -Y -t 1 -C examples\dmr_t3_chan.csv -P -8 -N -Z
|
||||
|
||||
NXDN48/Analog Scanning with SDR++ input (use squelch), RIGCTL, /dev/dsp output, channel map import,
|
||||
per call wav files, ncurses terminal, payload dump to console, raw audio signal monitoring
|
||||
-fi -i tcp:127.0.0.1:7355 -U 4532 -Y -t 1-C examples\nxdn_chan_map.csv -P -8 -N -Z
|
||||
|
||||
Analog Scanning with SDR++ input (use squelch), RIGCTL, /dev/dsp output, channel map import
|
||||
-fA -i tcp:127.0.0.1:7355 -U 4532 -Y -t 0 -C examples\nxdn_chan_map.csv -8
|
||||
|
||||
Encryption Option Examples:
|
||||
|
||||
DMR with default /dev/dsp input and output, use basic privacy key 70
|
||||
-fs -b 70
|
||||
|
||||
DMR with default /dev/dsp input and output, load .csv file with decimal basic privacy keys loaded by TG value,
|
||||
-fs -k examples\multi_key.csv
|
||||
|
||||
DMR with default /dev/dsp input and output, use Hytera basic privacy key (10, 32, and 64 hex char versions)
|
||||
-fs -H 1111111111
|
||||
-fs -H '2222222222222222 3333333333333333'
|
||||
-fs -H '2222222222222222 3333333333333333 4444444444444444 5555555555555555'
|
||||
|
||||
DMR with default /dev/dsp input and output, use RC4 key 0x7777777777
|
||||
-fs -1 7777777777
|
||||
|
||||
DMR with default /dev/dsp input and output, use RC4 key 0x7777777777,
|
||||
Force RC4 Key over Missing PI header/LE Encryption Identifiers (-0)
|
||||
Disable Late Entry Encryption Signalling Identifiers (-3)
|
||||
-fs -0 -3 -1 7777777777
|
||||
|
||||
DMR with default /dev/dsp input and output, load RC4 and 10-char HBP keys from .csv file (hexidecimal format)
|
||||
-fs -K dsd-fme\examples\multi_key_hex.csv
|
||||
|
||||
P25 with default /dev/dsp input and output, use RC4 key 0x7777777777
|
||||
-ft -1 7777777777
|
||||
|
||||
NXDN48 with default /dev/dsp input and output, use Scrambler key 32767
|
||||
-fi -R 32767
|
||||
|
||||
NXDN96 with default /dev/dsp input and output, use Scrambler key 15000
|
||||
-fn -R 15000
|
||||
|
||||
dPMR with default /dev/dsp input and output, use Scrambler key 32767
|
||||
-fm -R 32767
|
||||
|
||||
NXDN48 with default /dev/dsp input and output, load scrambler keys from .csv file (decimal format)
|
||||
-fi -k dsd-fme\examples\nxdn_sc_key.csv
|
||||
@@ -1 +0,0 @@
|
||||
These .bat files are ONLY for use on the portable cygwin builds, do not use these in any other build environments!
|
||||
@@ -1,74 +0,0 @@
|
||||
@REM Digital Speech Decoder: Florida Man Edition
|
||||
@REM DSD-FME Cygwin Windows Portable Builds
|
||||
@REM
|
||||
@REM The source code of this software can be downloaded here:
|
||||
@REM https://github.com/lwvmobile/dsd-fme
|
||||
@REM
|
||||
@REM If you paid for, or were otherwise fleeced for this software, DEMAND YOUR MONEY BACK!
|
||||
@REM
|
||||
@REM This software is designed to be used with an SDR receiver (like SDR++ or SDR#) with TCP input,
|
||||
@REM RTL Input, media file playback over virtual cables or null-sinks, or a Discriminator Tap input
|
||||
@REM
|
||||
@REM The complete options list can be seen by viewing complete_usage_options.txt
|
||||
@REM Many examples can be found in example_options.txt
|
||||
@REM
|
||||
@REM Enjoy!
|
||||
|
||||
@REM Regarding the options string (or any string in .bat files)
|
||||
@REM If your string may contain spaces, set the first '"' before options, and then an ending '"'
|
||||
@REM Incorrect: set options="-fs -N -Z"
|
||||
@REM Correct: set "options=-fs -N -Z"
|
||||
|
||||
@REM set options to pass to dsd-fme
|
||||
set "options= -N -Z "
|
||||
|
||||
@REM Set Date Time for log (sourced from: https://stackoverflow.com/questions/1192476/format-date-and-time-in-a-windows-batch-script)
|
||||
@echo off
|
||||
REM "%date: =0%" replaces spaces with zeros
|
||||
set d=%date: =0%
|
||||
REM "set yyyy=%d:~-4%" pulls the last 4 characters
|
||||
set yyyy=%d:~-4%
|
||||
set mm=%d:~4,2%
|
||||
set dd=%d:~7,2%
|
||||
set dow=%d:~0,3%
|
||||
set d=%yyyy%%mm%%dd%
|
||||
|
||||
set t=%TIME: =0%
|
||||
REM "%t::=%" removes semi-colons
|
||||
REM Instead of above, you could use "%t::=-%" to
|
||||
REM replace semi-colons with hyphens (or any
|
||||
REM non-special character)
|
||||
set t=%t::=%
|
||||
set t=%t:.=%
|
||||
|
||||
set datetimestr=%d%_%t%
|
||||
@REM @echo Long date time str = %datetimestr%
|
||||
|
||||
@REM random number is used so that two log files don't share the same name
|
||||
set rnd=%RANDOM%
|
||||
|
||||
@REM set log file relative filepath
|
||||
set "clog=.\logs\console_log_%datetimestr%_%rnd%.txt"
|
||||
set "elog=.\logs\event_log_%datetimestr%_%rnd%.txt"
|
||||
|
||||
@REM create the log file now with touch
|
||||
.\dsd-fme\touch.exe %clog%
|
||||
.\dsd-fme\touch.exe %elog%
|
||||
|
||||
@REM Launch Tail to display the console log and event log in a seperate console windows
|
||||
start .\dsd-fme\tail.exe -n 40 -f %clog%
|
||||
start .\dsd-fme\tail.exe -n 40 -f %elog%
|
||||
|
||||
@REM start dsd-fme with options and logs
|
||||
.\dsd-fme\dsd-fme.exe %options% -J %elog% 2> %clog%
|
||||
|
||||
echo ----------------------------------------------------------------------------------
|
||||
echo ----------------------------------------------------------------------------------
|
||||
echo For any errors, see: %clog%
|
||||
echo Forward %clog% and Options: "%options%"
|
||||
echo to developer on Github or Radio Reference for troubleshooting.
|
||||
echo ----------------------------------------------------------------------------------
|
||||
echo ----------------------------------------------------------------------------------
|
||||
|
||||
@REM Set pause to diplay above message
|
||||
PAUSE
|
||||
@@ -1,7 +0,0 @@
|
||||
keyid(hex), keyvalue(hex)
|
||||
0001,0000000000000000,0000000000000000,0000000000000000,0000002823d87923
|
||||
0003,0101010101010101,0101010101010101
|
||||
0004,0101010101010101,0101010101010101,0101010101010101,0101010101010101
|
||||
C197,A753BC945DE5E0F1,EC1970F8565154E6,D9DF2FAC6278FA93,B531D2CC046E93A2
|
||||
0067,0000000000000000,0000000000000000,0000000000000000,DEADBEEFBAADF00D
|
||||
0000,0000000000000000,0000000000000000,0000000000000000,0000000000000001
|
||||
|
@@ -1,4 +1,4 @@
|
||||
DEC,Mode(A- Allow; B - Block; DE - Digital Enc),Name of Group,Tag (do not delete this line or won't import properly)
|
||||
DEC,Mode(A- Allow, B - Block, DE - Digital Enc),Name of Group,Tag (do not delete this line or won't import properly)
|
||||
100,B,Example Name,Tag
|
||||
1449,A,Fire Dispatch,Fire
|
||||
929,A,Fire Tac,Fire
|
||||
|
||||
|
Binary file not shown.
|
Before Width: | Height: | Size: 26 KiB |
Binary file not shown.
|
Before Width: | Height: | Size: 68 KiB |
@@ -1,112 +0,0 @@
|
||||
#!/bin/bash
|
||||
# Force bash for better compatibility (I think)
|
||||
#
|
||||
# Digital Speech Decoder: Florida Man Edition
|
||||
#
|
||||
# The source code of this software can be downloaded here:
|
||||
# https://github.com/lwvmobile/dsd-fme
|
||||
#
|
||||
# If you paid for, or were otherwise fleeced for this software, DEMAND YOUR MONEY BACK!
|
||||
#
|
||||
# This software is designed to be used with an SDR receiver (like SDR++ or SDR#) with TCP input,
|
||||
# RTL Input, media file playback over virtual cables or null-sinks, or a Discriminator Tap input
|
||||
#
|
||||
# The complete options list can be seen by viewing complete_usage_options.ans
|
||||
# Many examples can be found in example_options.ans
|
||||
#
|
||||
# Enjoy!
|
||||
###
|
||||
#### IMPORTANT! Set your dsd-fme options here! ####
|
||||
# Example : opts=' -ft -i rtl:0:460.350M:0:-1:8 -N -Z '
|
||||
####
|
||||
# set options to pass to dsd-fme
|
||||
opts=' -N -Z '
|
||||
####
|
||||
# Initialize variables
|
||||
xe="0"
|
||||
gt="0"
|
||||
xt="0"
|
||||
ko="0"
|
||||
# Functions to check for available terminals
|
||||
chk_xe(){
|
||||
# Check if x-terminal-emulator is installed
|
||||
xe=$(which x-terminal-emulator 2>/dev/null)
|
||||
if [ -z $xe ];then xe="0";else xe="1";fi
|
||||
}
|
||||
chk_gt(){
|
||||
# Check if gnome-terminal is installed
|
||||
gt=$(which gnome-terminal 2>/dev/null)
|
||||
if [ -z $gt ];then gt="0";else gt="1";fi
|
||||
}
|
||||
chk_ko(){
|
||||
# Check if Konsole is installed
|
||||
ko=$(which konsole 2>/dev/null)
|
||||
if [ -z $ko ];then ko="0";else ko="1";fi
|
||||
}
|
||||
chk_xt(){
|
||||
# Check if xterm is installed
|
||||
xt=$(which xterm 2>/dev/null)
|
||||
if [ -z $xt ];then xt="0";else xt="1";fi
|
||||
}
|
||||
# Check for and set terminal
|
||||
chk_xe
|
||||
if [ $xe = "1" ];then
|
||||
term=$(which x-terminal-emulator 2>/dev/null)
|
||||
printf "Using X-Terminal-Emulator!\n"
|
||||
else
|
||||
chk_gt
|
||||
fi
|
||||
if [ $gt = "1" ];then
|
||||
term=$(which gnome-terminal 2>/dev/null)
|
||||
printf "Using Gnome-Terminal!\n"
|
||||
elif [ $xe = "0" ]&&[ $gt = "0" ];then
|
||||
chk_xt
|
||||
fi
|
||||
if [ $xt = "1" ];then
|
||||
term=$(which xterm 2>/dev/null)
|
||||
printf "Using XTerm!\n"
|
||||
elif [ $xe = "0" ]&&[ $gt = "0" ]&&[ $xt = "0" ];then
|
||||
chk_ko
|
||||
fi
|
||||
if [ $ko = "1" ];then
|
||||
term=$(which konsole 2>/dev/null)
|
||||
printf "Using Konsole!\n"
|
||||
fi
|
||||
# Bail if no terminal found
|
||||
if [ "$ko" -eq "0" ]&&[ "$gt" -eq "0" ]&&[ "$xt" -eq "0" ]&&[ "$xe" -eq "0" ];then printf "No known terminals available!\n";exit 1;fi
|
||||
# Get current directory
|
||||
wd=$(pwd)
|
||||
# Set date/time
|
||||
# dt=$(date +%F_%H%M-%S-%N) #with hyphens
|
||||
dt=$(date +%Y%m%d_%H%M%S) #just an underscore between date and time
|
||||
if [ ! -d "logs" ]; then
|
||||
mkdir logs
|
||||
fi
|
||||
# set log file relative filepath
|
||||
clog="$wd/logs/console_log_$dt.txt"
|
||||
elog="$wd/logs/event_log_$dt.txt"
|
||||
# create the log file now with touch
|
||||
touch $clog
|
||||
touch $elog
|
||||
# open new terminal windows to watch live log files
|
||||
if [ "$term" == "$(which konsole)" ]||[ "$term" == "$(which xterm)" ];then
|
||||
$term -e "tail -n 40 -f $clog" 2>/dev/null
|
||||
$term -e "tail -n 40 -f $elog" 2>/dev/null
|
||||
else
|
||||
$term --window -e "tail -n 40 -f $clog" 2>/dev/null
|
||||
$term --window -e "tail -n 40 -f $elog" 2>/dev/null
|
||||
fi
|
||||
# start dsd-fme with options and log files
|
||||
dsd-fme $opts -J $elog 2> $clog
|
||||
echo -------------------------------------------------------------------------------
|
||||
echo -------------------------------------------------------------------------------
|
||||
echo For any errors, see: $clog
|
||||
echo Forward $clog and
|
||||
echo Options: \" $opts \"
|
||||
echo to developer on Github or Radio Reference for troubleshooting.
|
||||
echo -------------------------------------------------------------------------------
|
||||
echo -------------------------------------------------------------------------------
|
||||
|
||||
# Set pause to diplay above message
|
||||
read -p "Press ENTER to continue... " x
|
||||
|
||||
@@ -9,6 +9,10 @@
|
||||
#dsd-fme -i tcp:192.168.7.8:7355 -U 4532 -T -mq -N 2> log.ans
|
||||
#dsd-fme -i rtl:0:855.625M:0:-2:12 -T -mq -N 2> log.ans
|
||||
|
||||
#P25 P2 TDMA CC with QPSK (Simulcast)
|
||||
#dsd-fme -i tcp:192.168.7.8:7355 -U 4532 -T -f2 -m2 -N 2> log.ans
|
||||
#dsd-fme -i rtl:0:855.625M:0:-2:12 -T -f2 -m2 -N 2> log.ans
|
||||
|
||||
#P25 P2 TDMA CC with C4FM
|
||||
#dsd-fme -i tcp:192.168.7.8:7355 -U 4532 -T -f2 -N 2> log.ans
|
||||
#dsd-fme -i rtl:0:855.625M:0:-2:12 -T -f2 -m2 -N 2> log.ans
|
||||
@@ -17,21 +21,9 @@
|
||||
dsd-fme -fs -i tcp -U 4532 -T -C dmr_t3_chan.csv -G group.csv -N 2> log.ans
|
||||
#dsd-fme -fs -i rtl:0:450M:44:-2:8 -T -C connect_plus_chan.csv -G group.csv -N 2> log.ans
|
||||
|
||||
#EDACS Standard Network Analog and Digital
|
||||
#dsd-fme -fh -i tcp:192.168.7.5:7355 -U 4532 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
#dsd-fme -fh -i rtl:0:850M:44:-2:24 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
|
||||
#EDACS Standard Network Analog and Digital (with ESK)
|
||||
#dsd-fme -fH -i tcp:192.168.7.5:7355 -U 4532 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
#dsd-fme -fH -i rtl:0:850M:44:-2:24 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
|
||||
#EDACS Extended Address Analog and Digital
|
||||
#dsd-fme -fe -i tcp:192.168.7.5:7355 -U 4532 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
#dsd-fme -fe -i rtl:0:850M:44:-2:24 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
|
||||
#EDACS Extended Address Analog and Digital (with ESK)
|
||||
#dsd-fme -fE -i tcp:192.168.7.5:7355 -U 4532 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
#dsd-fme -fE -i rtl:0:850M:44:-2:24 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
#EDACS/EDACS-EA Digital Only
|
||||
#dsd-fme -fp -i tcp:192.168.7.5:7355 -U 4532 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
#dsd-fme -fp -i rtl:0:850M:44:-2:24 -T -C edacs_channel_map.csv -G group.csv -N 2> log.ans
|
||||
|
||||
#NXDN48 Type-C or Type-D Trunking with Channel Map
|
||||
#dsd-fme -fi -i tcp -T -U 4532 -C nxdn_channel_map.csv -N 2> log.ans
|
||||
|
||||
64
flake.lock
generated
64
flake.lock
generated
@@ -1,64 +0,0 @@
|
||||
{
|
||||
"nodes": {
|
||||
"flake-parts": {
|
||||
"inputs": {
|
||||
"nixpkgs-lib": "nixpkgs-lib"
|
||||
},
|
||||
"locked": {
|
||||
"lastModified": 1709336216,
|
||||
"narHash": "sha256-Dt/wOWeW6Sqm11Yh+2+t0dfEWxoMxGBvv3JpIocFl9E=",
|
||||
"owner": "hercules-ci",
|
||||
"repo": "flake-parts",
|
||||
"rev": "f7b3c975cf067e56e7cda6cb098ebe3fb4d74ca2",
|
||||
"type": "github"
|
||||
},
|
||||
"original": {
|
||||
"owner": "hercules-ci",
|
||||
"repo": "flake-parts",
|
||||
"type": "github"
|
||||
}
|
||||
},
|
||||
"nixpkgs": {
|
||||
"locked": {
|
||||
"lastModified": 1711163522,
|
||||
"narHash": "sha256-YN/Ciidm+A0fmJPWlHBGvVkcarYWSC+s3NTPk/P+q3c=",
|
||||
"owner": "NixOS",
|
||||
"repo": "nixpkgs",
|
||||
"rev": "44d0940ea560dee511026a53f0e2e2cde489b4d4",
|
||||
"type": "github"
|
||||
},
|
||||
"original": {
|
||||
"owner": "NixOS",
|
||||
"ref": "nixos-unstable",
|
||||
"repo": "nixpkgs",
|
||||
"type": "github"
|
||||
}
|
||||
},
|
||||
"nixpkgs-lib": {
|
||||
"locked": {
|
||||
"dir": "lib",
|
||||
"lastModified": 1709237383,
|
||||
"narHash": "sha256-cy6ArO4k5qTx+l5o+0mL9f5fa86tYUX3ozE1S+Txlds=",
|
||||
"owner": "NixOS",
|
||||
"repo": "nixpkgs",
|
||||
"rev": "1536926ef5621b09bba54035ae2bb6d806d72ac8",
|
||||
"type": "github"
|
||||
},
|
||||
"original": {
|
||||
"dir": "lib",
|
||||
"owner": "NixOS",
|
||||
"ref": "nixos-unstable",
|
||||
"repo": "nixpkgs",
|
||||
"type": "github"
|
||||
}
|
||||
},
|
||||
"root": {
|
||||
"inputs": {
|
||||
"flake-parts": "flake-parts",
|
||||
"nixpkgs": "nixpkgs"
|
||||
}
|
||||
}
|
||||
},
|
||||
"root": "root",
|
||||
"version": 7
|
||||
}
|
||||
18
flake.nix
18
flake.nix
@@ -1,18 +0,0 @@
|
||||
{
|
||||
description = "Digital Speech Decoder - Florida Man Edition ";
|
||||
|
||||
inputs = {
|
||||
flake-parts.url = "github:hercules-ci/flake-parts";
|
||||
nixpkgs.url = "github:NixOS/nixpkgs/nixos-unstable";
|
||||
};
|
||||
|
||||
outputs = inputs@{ flake-parts, ... }:
|
||||
flake-parts.lib.mkFlake { inherit inputs; } {
|
||||
systems = [ "x86_64-linux" "aarch64-linux" "aarch64-darwin" "x86_64-darwin" ];
|
||||
perSystem = { config, pkgs, ... }: {
|
||||
packages.default = config.packages.dsd-fme;
|
||||
|
||||
packages.dsd-fme = pkgs.callPackage ./package.nix { };
|
||||
};
|
||||
};
|
||||
}
|
||||
71
include/bp.h
71
include/bp.h
@@ -1,71 +0,0 @@
|
||||
#ifndef BP_H
|
||||
#define BP_H
|
||||
|
||||
static const uint16_t BPK[256] = {
|
||||
//000
|
||||
0x0000, 0x1F00, 0xE300, 0xFC00, 0x2503, 0x3A03, 0xC603, 0xD903,
|
||||
//008
|
||||
0x4A05, 0x5505, 0xA905, 0xB605, 0x6F06, 0x7006, 0x8C06, 0x9306,
|
||||
//016
|
||||
0x2618, 0x3918, 0xC518, 0xDA18, 0x031B, 0x1C1B, 0xE01B, 0xFF1B,
|
||||
//024
|
||||
0x6C1D, 0x731D, 0x8F1D, 0x901D, 0x491E, 0x561E, 0xAA1E, 0xB51E,
|
||||
//032
|
||||
0x4B28, 0x5428, 0xA828, 0xB728, 0x6E2B, 0x712B, 0x8D2B, 0x922B,
|
||||
//040
|
||||
0x012D, 0x1E2D, 0xE22D, 0xFD2D, 0x242E, 0x3B2E, 0xC72E, 0xD82E,
|
||||
//048
|
||||
0x6D30, 0x7230, 0x8E30, 0x9130, 0x4833, 0x5733, 0xAB33, 0xB433,
|
||||
//056
|
||||
0x2735, 0x3835, 0xC435, 0xDB35, 0x0236, 0x1D36, 0xE136, 0xFE36,
|
||||
//064
|
||||
0x2B49, 0x3449, 0xC849, 0xD749, 0x0E4A, 0x114A, 0xED4A, 0xF24A,
|
||||
//072
|
||||
0x614C, 0x7E4C, 0x824C, 0x9D4C, 0x444F, 0x5B4F, 0xA74F, 0xB84F,
|
||||
//080
|
||||
0x0D51, 0x1251, 0xEE51, 0xF151, 0x2852, 0x3752, 0xCB52, 0xD452,
|
||||
//088
|
||||
0x4754, 0x5854, 0xA454, 0xBB54, 0x6257, 0x7D57, 0x8157, 0x9E57,
|
||||
//096
|
||||
0x6061, 0x7F61, 0x8361, 0x9C61, 0x4562, 0x5A62, 0xA662, 0xB962,
|
||||
//104
|
||||
0x2A64, 0x3564, 0xC964, 0xD664, 0x0F67, 0x1067, 0xEC67, 0xF367,
|
||||
//112
|
||||
0x4679, 0x5979, 0xA579, 0xBA79, 0x637A, 0x7C7A, 0x807A, 0x9F7A,
|
||||
//120
|
||||
0x0C7C, 0x137C, 0xEF7C, 0xF07C, 0x297F, 0x367F, 0xCA7F, 0xD57F,
|
||||
//128
|
||||
0x4D89, 0x5289, 0xAE89, 0xB189, 0x688A, 0x778A, 0x8B8A, 0x948A,
|
||||
//136
|
||||
0x078C, 0x188C, 0xE48C, 0xFB8C, 0x228F, 0x3D8F, 0xC18F, 0xDE8F,
|
||||
//144
|
||||
0x6B91, 0x7491, 0x8891, 0x9791, 0x4E92, 0x5192, 0xAD92, 0xB292,
|
||||
//152
|
||||
0x2194, 0x3E94, 0xC294, 0xDD94, 0x0497, 0x1B97, 0xE797, 0xF897,
|
||||
//160
|
||||
0x06A1, 0x19A1, 0xE5A1, 0xFAA1, 0x23A2, 0x3CA2, 0xC0A2, 0xDFA2,
|
||||
//168
|
||||
0x4CA4, 0x53A4, 0xAFA4, 0xB0A4, 0x69A7, 0x76A7, 0x8AA7, 0x95A7,
|
||||
//176
|
||||
0x20B9, 0x3FB9, 0xC3B9, 0xDCB9, 0x05BA, 0x1ABA, 0xE6BA, 0xF9BA,
|
||||
//184
|
||||
0x6ABC, 0x75BC, 0x89BC, 0x96BC, 0x4FBF, 0x50BF, 0xACBF, 0xB3BF,
|
||||
//192
|
||||
0x66C0, 0x79C0, 0x85C0, 0x9AC0, 0x43C3, 0x5CC3, 0xA0C3, 0xBFC3,
|
||||
//200
|
||||
0x2CC5, 0x33C5, 0xCFC5, 0xD0C5, 0x09C6, 0x16C6, 0xEAC6, 0xF5C6,
|
||||
//208
|
||||
0x84D0, 0x85DF, 0x8AD3, 0x8BDC, 0xB6D5, 0xB7DA, 0xB8D6, 0xB9D9,
|
||||
//216
|
||||
0xD0DA, 0xD1D5, 0xDED9, 0xDFD6, 0xE2DF, 0xE3D0, 0xECDC, 0xEDD3,
|
||||
//224
|
||||
0x2DE8, 0x32E8, 0xCEE8, 0xD1E8, 0x08EB, 0x17EB, 0xEBEB, 0xF4EB,
|
||||
//232
|
||||
0x67ED, 0x78ED, 0x84ED, 0x9BED, 0x42EE, 0x5DEE, 0xA1EE, 0xBEEE,
|
||||
//240
|
||||
0x0BF0, 0x14F0, 0xE8F0, 0xF7F0, 0x2EF3, 0x31F3, 0xCDF3, 0xD2F3,
|
||||
//248
|
||||
0x41F5, 0x5EF5, 0xA2F5, 0xBDF5, 0x64F6, 0x7BF6, 0x87F6, 0x98F6
|
||||
};
|
||||
|
||||
#endif
|
||||
@@ -17,7 +17,7 @@
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*/
|
||||
|
||||
|
||||
// This code was originally written by JOnathan Naylor, G4KLX, as part
|
||||
// of the "pcrepeatercontroller" project
|
||||
// More info:
|
||||
@@ -52,39 +52,39 @@ int traceBack (int * out, int * m_pathMemory0, int * m_pathMemory1, int * m_path
|
||||
state = S2; // lower path
|
||||
} else {
|
||||
state = S0; // upper path
|
||||
} // end else - if
|
||||
}; // end else - if
|
||||
out[loop]=0;
|
||||
break;
|
||||
|
||||
|
||||
case S1: // if state S1
|
||||
if (m_pathMemory1[loop]) {
|
||||
state = S2; // lower path
|
||||
} else {
|
||||
state = S0; // upper path
|
||||
} // end else - if
|
||||
}; // end else - if
|
||||
out[loop]=1;
|
||||
break;
|
||||
|
||||
|
||||
case S2: // if state S2
|
||||
if (m_pathMemory2[loop]) {
|
||||
state = S3; // lower path
|
||||
} else {
|
||||
state = S1; // upper path
|
||||
} // end else - if
|
||||
}; // end else - if
|
||||
out[loop]=0;
|
||||
break;
|
||||
|
||||
|
||||
case S3: // if state S3
|
||||
if (m_pathMemory3[loop]) {
|
||||
state = S3; // lower path
|
||||
} else {
|
||||
state = S1; // upper path
|
||||
} // end else - if
|
||||
}; // end else - if
|
||||
out[loop]=1;
|
||||
break;
|
||||
|
||||
} // end switch
|
||||
} // end for
|
||||
|
||||
}; // end switch
|
||||
}; // end for
|
||||
|
||||
return(length);
|
||||
}; // end function
|
||||
@@ -161,7 +161,7 @@ void viterbiDecode (int n, int *data, int *m_pathMemory0, int *m_pathMemory1, in
|
||||
}; // end function ViterbiDecode
|
||||
|
||||
|
||||
// function FECdecoder
|
||||
// function FECdecoder
|
||||
// returns outlen
|
||||
int FECdecoder (int * in, int * out) {
|
||||
int outLen;
|
||||
|
||||
606
include/dsd.h
606
include/dsd.h
File diff suppressed because it is too large
Load Diff
@@ -16,7 +16,7 @@
|
||||
*/
|
||||
|
||||
/*
|
||||
* dstar interleave experiments
|
||||
* dstar interleave experiments
|
||||
*/
|
||||
|
||||
#ifndef _MAIN
|
||||
|
||||
@@ -1,6 +1,6 @@
|
||||
/* fcs.h */
|
||||
|
||||
// Viterbi decoder using Traceback method.
|
||||
// Viterbi decoder using Traceback method.
|
||||
|
||||
// Original Source was written by Sho Tamaoki and Tom Wada
|
||||
// See http://www.lsi.ie.u-ryukyu.ac.jp/~sho/midterm/
|
||||
@@ -75,7 +75,7 @@ for (loop=0; loop < size; loop++) {
|
||||
|
||||
m_crc = (m_crc >> 8) ^ ccittTab[tmp];
|
||||
|
||||
} // end for
|
||||
}; // end for
|
||||
|
||||
// calculate and save crc-value in fields 54 and 55 of dvframe
|
||||
m_crc = ~m_crc;
|
||||
@@ -86,4 +86,4 @@ m_crc = (m_crc << 8) | (tmp >> 8 & 0xFF);
|
||||
|
||||
// done
|
||||
return(m_crc);
|
||||
}; // end function
|
||||
}; // end function
|
||||
|
||||
1448
include/fec.h
Normal file
1448
include/fec.h
Normal file
File diff suppressed because it is too large
Load Diff
@@ -5,12 +5,12 @@
|
||||
// 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.
|
||||
//
|
||||
//
|
||||
// OP25 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 OP25; see the file COPYING. If not, write to the Free
|
||||
// Software Foundation, Inc., 51 Franklin Street, Boston, MA
|
||||
|
||||
@@ -1,95 +0,0 @@
|
||||
#include <stdint.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#ifndef TYT_AP
|
||||
#define TYT_AP
|
||||
|
||||
#define nbround 254
|
||||
#define n1 264
|
||||
|
||||
#define UNUSEDPC4(x) ((void)x)
|
||||
|
||||
/* Structure holding all PC4 state variables */
|
||||
typedef struct {
|
||||
short bits[49], temp[49];
|
||||
uint8_t ptconvert;
|
||||
uint8_t convert[7];
|
||||
uint8_t perm[16][256];
|
||||
uint8_t new1[256];
|
||||
uint8_t array[49];
|
||||
uint8_t array2[49];
|
||||
uint8_t decal[nbround];
|
||||
uint8_t rngxor[nbround][3];
|
||||
uint8_t rngxor2[nbround][3];
|
||||
uint8_t rounds;
|
||||
uint8_t tab[256];
|
||||
uint8_t inv[256];
|
||||
uint8_t permut[3][3];
|
||||
uint64_t bb;
|
||||
uint64_t x;
|
||||
uint8_t tot[3];
|
||||
uint8_t l[2][3], r[2][3];
|
||||
uint8_t y, totb;
|
||||
uint32_t result;
|
||||
uint8_t xyz, count;
|
||||
uint8_t keys[16];
|
||||
unsigned char array_arc4[256];
|
||||
int i_arc4, j_arc4;
|
||||
int x1, x2, i;
|
||||
unsigned char h2[n1];
|
||||
unsigned char h1[n1*3];
|
||||
} PC4Context;
|
||||
|
||||
/* Global context accessible from all .c files */
|
||||
extern PC4Context ctx;
|
||||
|
||||
/* Public API */
|
||||
void create_keys(PC4Context *ctx, unsigned char key1[], size_t size1);
|
||||
void pc4encrypt(PC4Context *ctx);
|
||||
void pc4decrypt(PC4Context *ctx);
|
||||
void binhex(PC4Context *ctx, short *z, int length);
|
||||
void hexbin(PC4Context *ctx, short *q, uint8_t w, uint8_t hex);
|
||||
static void u64_to_bytes_be(uint64_t val, unsigned char *out);
|
||||
|
||||
/* Encrypt a 49-bit frame (original flow) */
|
||||
static void encrypt_frame_49(short frame_bits_in[49]) {
|
||||
for (int i = 0; i < 49; i++) ctx.bits[i] = frame_bits_in[i];
|
||||
for (int i = 0; i < 49; i++) ctx.temp[i] = ctx.bits[ctx.array[i]];
|
||||
for (int i = 0; i < 49; i++) ctx.bits[i] = ctx.temp[i];
|
||||
ctx.ptconvert = 0;
|
||||
binhex(&ctx, ctx.bits, 48);
|
||||
pc4encrypt(&ctx);
|
||||
for (int q = 0; q < 6; q++) {
|
||||
uint8_t w = (uint8_t)(q * 8);
|
||||
hexbin(&ctx, ctx.bits, w, ctx.convert[q]);
|
||||
}
|
||||
ctx.bits[48] = (short)(ctx.bits[48] ^ ctx.totb);
|
||||
for (int i = 0; i < 49; i++) ctx.temp[ctx.array2[i]] = ctx.bits[i];
|
||||
for (int i = 0; i < 49; i++) ctx.bits[i] = ctx.temp[i];
|
||||
}
|
||||
|
||||
/* Decrypt a 49-bit frame (original flow) */
|
||||
static void decrypt_frame_49(short frame_bits_in[49]) {
|
||||
for (int i = 0; i < 49; i++) ctx.bits[i] = frame_bits_in[i];
|
||||
for (int i = 0; i < 49; i++) ctx.temp[i] = ctx.bits[ctx.array2[i]];
|
||||
for (int i = 0; i < 49; i++) ctx.bits[i] = ctx.temp[i];
|
||||
ctx.ptconvert = 0;
|
||||
binhex(&ctx, ctx.bits, 48);
|
||||
pc4decrypt(&ctx);
|
||||
for (int q = 0; q < 6; q++) {
|
||||
uint8_t w = (uint8_t)(q * 8);
|
||||
hexbin(&ctx, ctx.bits, w, ctx.convert[q]);
|
||||
}
|
||||
ctx.bits[48] = (short)(ctx.bits[48] ^ ctx.totb);
|
||||
for (int i = 0; i < 49; i++) ctx.temp[ctx.array[i]] = ctx.bits[i];
|
||||
for (int i = 0; i < 49; i++) ctx.bits[i] = ctx.temp[i];
|
||||
}
|
||||
|
||||
/* Convert 64-bit integer to bytes (big-endian) */
|
||||
static void u64_to_bytes_be(uint64_t val, unsigned char *out) {
|
||||
for (int i = 0; i < 8; i++) {
|
||||
out[i] = (unsigned char)((val >> (56 - 8 * i)) & 0xFF);
|
||||
}
|
||||
}
|
||||
|
||||
#endif
|
||||
@@ -1,48 +0,0 @@
|
||||
#ifndef SYNCTYPE_H
|
||||
#define SYNCTYPE_H
|
||||
|
||||
static const char * SyncTypes[44] = {
|
||||
"P25p1",
|
||||
"P25p1",
|
||||
"X2TDMA DATA",
|
||||
"X2TDMA DATA",
|
||||
"X2TDMA VOICE",
|
||||
"X2TDMA VOICE",
|
||||
"DSTAR", //voice
|
||||
"DSTAR", //voice
|
||||
"M17",
|
||||
"M17",
|
||||
"DMR", //10
|
||||
"DMR",
|
||||
"DMR",
|
||||
"DMR",
|
||||
"EDACS/PV",
|
||||
"EDACS/PV",
|
||||
"M17", //M17 Voice Stream
|
||||
"M17", //M17 Voice Stream
|
||||
"DSTAR", //header
|
||||
"DSTAR", //header
|
||||
"dPMR", //20
|
||||
"dPMR",
|
||||
"dPMR",
|
||||
"dPMR",
|
||||
"dPMR",
|
||||
"dPMR",
|
||||
"dPMR",
|
||||
"dPMR",
|
||||
"NXDN",
|
||||
"NXDN",
|
||||
"YSF", //30
|
||||
"YSF", //31
|
||||
"DMR",
|
||||
"DMR",
|
||||
"DMR",
|
||||
"P25p2",
|
||||
"P25p2",
|
||||
"EDACS/PV", //37
|
||||
"EDACS/PV", //38
|
||||
"ANALOG", //39 Generic Sync Types
|
||||
"DIGITAL" //40 Generic Sync Types
|
||||
};
|
||||
|
||||
#endif
|
||||
12
install.sh
12
install.sh
@@ -1,8 +1,12 @@
|
||||
#!/bin/bash
|
||||
#
|
||||
sudo cp tone8.wav /usr/share/
|
||||
sudo cp tone24.wav /usr/share/
|
||||
sudo cp tone48.wav /usr/share/
|
||||
sudo chmod 777 /usr/share/tone8.wav
|
||||
sudo chmod 777 /usr/share/tone24.wav
|
||||
sudo chmod 777 /usr/share/tone48.wav
|
||||
mkdir build
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make -j `nproc`
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
sudo ldconfig
|
||||
|
||||
46
package.nix
46
package.nix
@@ -1,46 +0,0 @@
|
||||
{ lib
|
||||
, stdenv
|
||||
, cmake
|
||||
, mbelib
|
||||
, libsndfile
|
||||
, ncurses
|
||||
, pulseaudio
|
||||
, rtl-sdr
|
||||
, itpp
|
||||
, codec2
|
||||
, portaudioSupport ? true
|
||||
, portaudio ? null
|
||||
}:
|
||||
|
||||
assert portaudioSupport -> portaudio != null;
|
||||
|
||||
stdenv.mkDerivation {
|
||||
name = "dsd-fme";
|
||||
|
||||
src = ./.;
|
||||
|
||||
nativeBuildInputs = [ cmake ];
|
||||
buildInputs = [
|
||||
mbelib
|
||||
libsndfile
|
||||
itpp
|
||||
rtl-sdr
|
||||
ncurses.dev
|
||||
pulseaudio.dev
|
||||
codec2
|
||||
] ++ lib.optionals portaudioSupport [ portaudio ];
|
||||
|
||||
doCheck = true;
|
||||
|
||||
meta = with lib; {
|
||||
description = "Digital Speech Decoder - Florida Man Edition";
|
||||
longDescription = ''
|
||||
DSD is able to decode several digital voice formats from discriminator
|
||||
tap audio and synthesize the decoded speech. Speech synthesis requires
|
||||
mbelib, which is a separate package.
|
||||
'';
|
||||
homepage = "https://github.com/szechyjs/dsd";
|
||||
license = licenses.mit;
|
||||
platforms = platforms.unix;
|
||||
};
|
||||
}
|
||||
@@ -1,330 +0,0 @@
|
||||
diff --git a/include/dsd.h b/include/dsd.h
|
||||
index 4a75702..3cf085e 100644
|
||||
--- a/include/dsd.h
|
||||
+++ b/include/dsd.h
|
||||
@@ -317,6 +317,7 @@ typedef struct
|
||||
long int rtl_rms;
|
||||
int monitor_input_audio;
|
||||
int analog_only;
|
||||
+ int ghosts_only;
|
||||
int pulse_raw_rate_in;
|
||||
int pulse_raw_rate_out;
|
||||
int pulse_digi_rate_in;
|
||||
@@ -1342,6 +1343,8 @@ void rtl_udp_tune(dsd_opts * opts, dsd_state * state, long int frequency);
|
||||
long int GetCurrentFreq(int sockfd);
|
||||
bool SetFreq(int sockfd, long int freq);
|
||||
bool SetModulation(int sockfd, int bandwidth);
|
||||
+bool SetModulationWFM(int sockfd, int bandwidth);
|
||||
+void death (dsd_opts * opts, dsd_state * state);
|
||||
//commands below unique to GQRX only, not usable on SDR++
|
||||
bool GetSignalLevel(int sockfd, double *dBFS);
|
||||
bool GetSquelchLevel(int sockfd, double *dBFS);
|
||||
diff --git a/src/3.c b/src/3.c
|
||||
index e104993..b9033bd 100644
|
||||
--- a/src/3.c
|
||||
+++ b/src/3.c
|
||||
@@ -591,4 +591,176 @@ long int raw_rms(int16_t *samples, int len, int step) //use samplespersymbol as
|
||||
rms = (long int)sqrt((p-err) / len);
|
||||
if (rms < 0) rms = 150;
|
||||
return rms;
|
||||
-}
|
||||
\ No newline at end of file
|
||||
+}
|
||||
+
|
||||
+
|
||||
+//Ghosts
|
||||
+void death (dsd_opts * opts, dsd_state * state)
|
||||
+{
|
||||
+ int i, x, result = 0;
|
||||
+ short ghosts[960];
|
||||
+ short spooks[960];
|
||||
+ short demons[960];
|
||||
+ short sample = 0;
|
||||
+
|
||||
+ memset (ghosts, 0, 960*sizeof(short));
|
||||
+ memset (spooks, 0, 960*sizeof(short));
|
||||
+ memset (demons, 0, 960*sizeof(short));
|
||||
+
|
||||
+ while (!exitflag) //while the software is running
|
||||
+ {
|
||||
+ //death on speaks at 48k/1 short output
|
||||
+ if (opts->audio_in_type == 0)
|
||||
+ {
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ pa_simple_read(opts->pulse_digi_dev_in, &sample, 2, NULL );
|
||||
+ ghosts[i] = sample;
|
||||
+ }
|
||||
+
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ pa_simple_read(opts->pulse_digi_dev_in, &sample, 2, NULL );
|
||||
+ spooks[i] = sample;
|
||||
+ }
|
||||
+
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ pa_simple_read(opts->pulse_digi_dev_in, &sample, 2, NULL );
|
||||
+ demons[i] = sample;
|
||||
+ }
|
||||
+ }
|
||||
+
|
||||
+ if (opts->audio_in_type == 8)
|
||||
+ {
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ result = sf_read_short(opts->tcp_file_in, &sample, 1);
|
||||
+ if (result == 0)
|
||||
+ {
|
||||
+ sf_close(opts->tcp_file_in);
|
||||
+ fprintf (stderr, "Connection to the Underworld Severed.\n");
|
||||
+ fprintf (stderr, "Closing Death Speech Decoder.\n");
|
||||
+ cleanupAndExit(opts, state);
|
||||
+ }
|
||||
+ ghosts[i] = sample;
|
||||
+ }
|
||||
+
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ result = sf_read_short(opts->tcp_file_in, &sample, 1);
|
||||
+ if (result == 0)
|
||||
+ {
|
||||
+ sf_close(opts->tcp_file_in);
|
||||
+ fprintf (stderr, "Connection to the Underworld Severed.\n");
|
||||
+ fprintf (stderr, "Closing Death Speech Decoder.\n");
|
||||
+ cleanupAndExit(opts, state);
|
||||
+ }
|
||||
+ spooks[i] = sample;
|
||||
+ }
|
||||
+
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ result = sf_read_short(opts->tcp_file_in, &sample, 1);
|
||||
+ if (result == 0)
|
||||
+ {
|
||||
+ sf_close(opts->tcp_file_in);
|
||||
+ fprintf (stderr, "Connection to the Underworld Severed.\n");
|
||||
+ fprintf (stderr, "Closing Death Speech Decoder.\n");
|
||||
+ cleanupAndExit(opts, state);
|
||||
+ }
|
||||
+ demons[i] = sample;
|
||||
+ }
|
||||
+ }
|
||||
+
|
||||
+ //RTL Input
|
||||
+ #ifdef USE_RTLSDR
|
||||
+ if (opts->audio_in_type == 3)
|
||||
+ {
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ get_rtlsdr_sample(&sample, opts, state);
|
||||
+ ghosts[i] = sample;
|
||||
+ }
|
||||
+
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ get_rtlsdr_sample(&sample, opts, state);
|
||||
+ spooks[i] = sample;
|
||||
+ }
|
||||
+
|
||||
+ for (i = 0; i < 960; i++)
|
||||
+ {
|
||||
+ get_rtlsdr_sample(&sample, opts, state);
|
||||
+ demons[i] = sample;
|
||||
+ }
|
||||
+ }
|
||||
+ #endif
|
||||
+
|
||||
+ //The Dead Don't Like OSS input yet
|
||||
+
|
||||
+ //Listen to the Howls of the Deceased
|
||||
+ if (opts->audio_out_type == 0 && opts->slot1_on == 1)
|
||||
+ {
|
||||
+ pa_simple_write(opts->pulse_raw_dev_out, ghosts, 960*2, NULL);
|
||||
+ pa_simple_write(opts->pulse_raw_dev_out, spooks, 960*2, NULL);
|
||||
+ pa_simple_write(opts->pulse_raw_dev_out, demons, 960*2, NULL);
|
||||
+ }
|
||||
+
|
||||
+ if (opts->audio_out_type == 8) //UDP Audio
|
||||
+ {
|
||||
+ udp_socket_blasterA (opts, state, 960*2, ghosts);
|
||||
+ udp_socket_blasterA (opts, state, 960*2, spooks);
|
||||
+ udp_socket_blasterA (opts, state, 960*2, demons);
|
||||
+ }
|
||||
+
|
||||
+ //added a condition check so that if OSS output and 8K, switches to 48K when opening OSS
|
||||
+ if (opts->audio_out_type == 5 && opts->floating_point == 0 && opts->slot1_on == 1)
|
||||
+ {
|
||||
+ write (opts->audio_out_fd, ghosts, 960*2);
|
||||
+ write (opts->audio_out_fd, spooks, 960*2);
|
||||
+ write (opts->audio_out_fd, demons, 960*2);
|
||||
+ }
|
||||
+
|
||||
+ //STDOUT -- I don't see the harm of adding this here, will be fine for analog only or digital only (non-mixed analog and digital)
|
||||
+ if (opts->audio_out_type == 1 && opts->floating_point == 0 && opts->slot1_on == 1)
|
||||
+ {
|
||||
+ write (opts->audio_out_fd, ghosts, 960*2);
|
||||
+ write (opts->audio_out_fd, spooks, 960*2);
|
||||
+ write (opts->audio_out_fd, demons, 960*2);
|
||||
+ }
|
||||
+
|
||||
+ //Undulate the Crystal Ball
|
||||
+ if (x >= opts->trunk_hangtime)
|
||||
+ {
|
||||
+ long int spook_channel = state->trunk_lcn_freq[0];
|
||||
+
|
||||
+ //rigctl
|
||||
+ if (opts->use_rigctl == 1)
|
||||
+ {
|
||||
+ if (opts->setmod_bw != 0 ) SetModulationWFM(opts->rigctl_sockfd, opts->setmod_bw);
|
||||
+ SetFreq(opts->rigctl_sockfd, spook_channel);
|
||||
+ }
|
||||
+
|
||||
+ //rtl
|
||||
+ if (opts->audio_in_type == 3)
|
||||
+ {
|
||||
+ #ifdef USE_RTLSDR
|
||||
+ rtl_dev_tune(opts, spook_channel);
|
||||
+ #endif
|
||||
+ }
|
||||
+
|
||||
+ //
|
||||
+ state->trunk_lcn_freq[0] += 200000;
|
||||
+
|
||||
+ if (state->trunk_lcn_freq[0] > 106100000)
|
||||
+ state->trunk_lcn_freq[0] = 87900000;
|
||||
+
|
||||
+ x = 0;
|
||||
+
|
||||
+ }
|
||||
+
|
||||
+ x++;
|
||||
+
|
||||
+ } //end while loop
|
||||
+} //end ghosts
|
||||
\ No newline at end of file
|
||||
diff --git a/src/dsd_main.c b/src/dsd_main.c
|
||||
index ca878e9..f14995d 100644
|
||||
--- a/src/dsd_main.c
|
||||
+++ b/src/dsd_main.c
|
||||
@@ -696,6 +696,7 @@ initOpts (dsd_opts * opts)
|
||||
|
||||
opts->monitor_input_audio = 0; //enable with -8
|
||||
opts->analog_only = 0; //only turned on with -fA
|
||||
+ opts->ghosts_only = 0; //ghostbox mode with -fG
|
||||
|
||||
opts->inverted_p2 = 0;
|
||||
opts->p2counter = 0;
|
||||
@@ -1358,6 +1359,7 @@ usage ()
|
||||
printf ("Decoder options:\n");
|
||||
printf (" -fa Auto Detection\n");
|
||||
printf (" -fA Passive Analog Audio Monitor\n");
|
||||
+ printf (" -fG Ghosts, Demons, Specters, Ghouls, and Skeletons (Ghost Box)\n");
|
||||
printf (" -ft TDMA Trunking P25p1 Control and Voice, P25p2 Trunked Channels, and DMR\n");
|
||||
printf (" -fs DMR TDMA BS and MS Simplex\n");
|
||||
printf (" -f1 Decode only P25 Phase 1\n");
|
||||
@@ -2172,6 +2174,35 @@ main (int argc, char **argv)
|
||||
sprintf (opts.output_name, "Analog Monitor");
|
||||
fprintf (stderr,"Only Monitoring Passive Analog Signal\n");
|
||||
}
|
||||
+ else if (optarg[0] == 'G') //listen to spooky scary skeletons
|
||||
+ {
|
||||
+ opts.frame_dstar = 0;
|
||||
+ opts.frame_x2tdma = 0;
|
||||
+ opts.frame_p25p1 = 0;
|
||||
+ opts.frame_p25p2 = 0;
|
||||
+ opts.frame_nxdn48 = 0;
|
||||
+ opts.frame_nxdn96 = 0;
|
||||
+ opts.frame_dmr = 0;
|
||||
+ opts.frame_dpmr = 0;
|
||||
+ opts.frame_provoice = 0;
|
||||
+ opts.frame_ysf = 0;
|
||||
+ opts.frame_m17 = 0;
|
||||
+ opts.pulse_digi_rate_out = 8000;
|
||||
+ opts.pulse_digi_out_channels = 1;
|
||||
+ opts.dmr_stereo = 0;
|
||||
+ state.dmr_stereo = 0;
|
||||
+ opts.dmr_mono = 0;
|
||||
+ state.rf_mod = 0;
|
||||
+ opts.monitor_input_audio = 1;
|
||||
+ opts.ghosts_only = 1;
|
||||
+ state.trunk_lcn_freq[0] = 87900000; //everybody knows ghosts live on the Broadcast FM band
|
||||
+ opts.setmod_bw = 150000; //Ghosts annunciate clearly with about 150,000 PB
|
||||
+ opts.trunk_hangtime = 0;
|
||||
+ opts.rtlsdr_center_freq = 850000000;
|
||||
+ opts.rtl_bandwidth = 48;
|
||||
+ sprintf (opts.output_name, "Ghost Box");
|
||||
+ fprintf (stderr,"Sounds of the Dead.\n");
|
||||
+ }
|
||||
else if (optarg[0] == 'd')
|
||||
{
|
||||
opts.frame_dstar = 1;
|
||||
@@ -3462,6 +3493,22 @@ main (int argc, char **argv)
|
||||
processM17IPF(&opts, &state);
|
||||
}
|
||||
|
||||
+ else if (opts.ghosts_only == 1)
|
||||
+ {
|
||||
+ #ifdef USE_RTLSDR
|
||||
+ if(opts.audio_in_type == 3)
|
||||
+ open_rtlsdr_stream(&opts);
|
||||
+ #endif
|
||||
+
|
||||
+ if (opts.audio_in_type == 0)
|
||||
+ openPulseInput(&opts);
|
||||
+
|
||||
+ if (opts.audio_out_type == 0)
|
||||
+ openPulseOutput(&opts);
|
||||
+
|
||||
+ death(&opts, &state);
|
||||
+ }
|
||||
+
|
||||
else
|
||||
{
|
||||
|
||||
diff --git a/src/dsd_rigctl.c b/src/dsd_rigctl.c
|
||||
index 820ac7e..f12bacc 100644
|
||||
--- a/src/dsd_rigctl.c
|
||||
+++ b/src/dsd_rigctl.c
|
||||
@@ -163,6 +163,28 @@ bool SetModulation(int sockfd, int bandwidth)
|
||||
return true;
|
||||
}
|
||||
|
||||
+bool SetModulationWFM(int sockfd, int bandwidth)
|
||||
+{
|
||||
+ char buf[BUFSIZE];
|
||||
+ //the bandwidth is now a user/system based configurable variable
|
||||
+ sprintf (buf, "M WFM %d\n", bandwidth); //SDR++ has changed the token from FM to NFM, even if Ryzerth fixes it later, users may still have an older version
|
||||
+ Send(sockfd, buf);
|
||||
+ Recv(sockfd, buf);
|
||||
+
|
||||
+ //if it fails the first time, send the other token instead
|
||||
+ if (strcmp(buf, "RPRT 1\n") == 0 ) //sdr++ has a linebreak here, is that in all versions of the protocol?
|
||||
+ {
|
||||
+ sprintf (buf, "M WFM %d\n", bandwidth); //anything not SDR++
|
||||
+ Send(sockfd, buf);
|
||||
+ Recv(sockfd, buf);
|
||||
+ }
|
||||
+
|
||||
+ if (strcmp(buf, "RPRT 1\n") == 0 )
|
||||
+ return false;
|
||||
+
|
||||
+ return true;
|
||||
+}
|
||||
+
|
||||
bool GetSignalLevel(int sockfd, double *dBFS)
|
||||
{
|
||||
char buf[BUFSIZE];
|
||||
diff --git a/src/rtl_sdr_fm.cpp b/src/rtl_sdr_fm.cpp
|
||||
index ad04667..dd6566c 100644
|
||||
--- a/src/rtl_sdr_fm.cpp
|
||||
+++ b/src/rtl_sdr_fm.cpp
|
||||
@@ -1034,7 +1034,7 @@ void open_rtlsdr_stream(dsd_opts *opts)
|
||||
//init with low pass if decoding P25 or EDACS/Provoice
|
||||
if (opts->frame_p25p1 == 1 || opts->frame_p25p2 == 1 || opts->frame_provoice == 1)
|
||||
demod_init_ro2(&demod);
|
||||
- else if (opts->analog_only == 1 || opts->m17encoder == 1)
|
||||
+ else if (opts->analog_only == 1 || opts->m17encoder == 1 || opts->ghosts_only == 1)
|
||||
demod_init_analog(&demod);
|
||||
else demod_init(&demod);
|
||||
output_init(&output);
|
||||
@@ -1,257 +0,0 @@
|
||||
diff --git a/include/dsd.h b/include/dsd.h
|
||||
index 4a75702..355837f 100644
|
||||
--- a/include/dsd.h
|
||||
+++ b/include/dsd.h
|
||||
@@ -357,6 +357,8 @@ typedef struct
|
||||
int frame_m17;
|
||||
int inverted_m17;
|
||||
|
||||
+ int frame_typeii;
|
||||
+
|
||||
FILE *symbolfile;
|
||||
int call_alert;
|
||||
|
||||
@@ -989,6 +991,10 @@ typedef struct
|
||||
#define INV_DPMR_FRAME_SYNC_3 "311313111133"
|
||||
#define INV_DPMR_FRAME_SYNC_4 "111333331133131131111313"
|
||||
|
||||
+//Motorola Type II Sync Pattern 0xAC binary 1010 1100
|
||||
+#define TYPE_II_SYNC "13131133" //baesd on what getDibit returns
|
||||
+#define TYPE_II_SINV "31313311" //baesd on what getDibit returns
|
||||
+
|
||||
/*
|
||||
* function prototypes
|
||||
*/
|
||||
@@ -1357,6 +1363,9 @@ void edacs(dsd_opts * opts, dsd_state * state);
|
||||
unsigned long long int edacs_bch (unsigned long long int message);
|
||||
void eot_cc(dsd_opts * opts, dsd_state * state); //end of TX return to CC
|
||||
|
||||
+//Type II
|
||||
+void type_ii(dsd_opts * opts, dsd_state * state);
|
||||
+
|
||||
//Generic Tuning Functions
|
||||
void return_to_cc (dsd_opts * opts, dsd_state * state);
|
||||
|
||||
diff --git a/src/dsd_dibit.c b/src/dsd_dibit.c
|
||||
index 5424f7a..9b403cf 100644
|
||||
--- a/src/dsd_dibit.c
|
||||
+++ b/src/dsd_dibit.c
|
||||
@@ -222,13 +222,14 @@ invert_dibit(int dibit)
|
||||
int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
{
|
||||
// determine dibit state
|
||||
- if ((state->synctype == 6) || (state->synctype == 14)|| (state->synctype == 18) || (state->synctype == 37))
|
||||
+ if ((state->synctype == 6) || (state->synctype == 14)|| (state->synctype == 18) || (state->synctype == 37) || (state->synctype == 40))
|
||||
|
||||
{
|
||||
// 6 +D-STAR
|
||||
// 14 +ProVoice
|
||||
// 18 +D-STAR_HD
|
||||
// 37 +EDACS
|
||||
+ // 41 +TypeII
|
||||
|
||||
if (symbol > state->center)
|
||||
{
|
||||
@@ -243,12 +244,13 @@ int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
return (1); // +3
|
||||
}
|
||||
}
|
||||
- else if ((state->synctype == 7) || (state->synctype == 15)|| (state->synctype == 19) || (state->synctype == 38))
|
||||
+ else if ((state->synctype == 7) || (state->synctype == 15)|| (state->synctype == 19) || (state->synctype == 38) || (state->synctype == 41))
|
||||
{
|
||||
// 7 -D-STAR
|
||||
// 15 -ProVoice
|
||||
// 19 -D-STAR_HD
|
||||
// 38 -EDACS
|
||||
+ // 41 -TypeII
|
||||
|
||||
if (symbol > state->center)
|
||||
{
|
||||
diff --git a/src/dsd_frame.c b/src/dsd_frame.c
|
||||
index 577169c..58fa07c 100644
|
||||
--- a/src/dsd_frame.c
|
||||
+++ b/src/dsd_frame.c
|
||||
@@ -269,6 +269,12 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
processYSF(opts, state);
|
||||
return;
|
||||
}
|
||||
+ //TypeII
|
||||
+ else if (state->synctype == 40 || state->synctype == 41)
|
||||
+ {
|
||||
+ type_ii(opts, state);
|
||||
+ return;
|
||||
+ }
|
||||
//M17
|
||||
else if ((state->synctype == 16) || (state->synctype == 9) || (state->synctype == 17) || (state->synctype == 8) ||
|
||||
(state->synctype == 76) || (state->synctype == 77) || (state->synctype == 86) || (state->synctype == 87) ||
|
||||
diff --git a/src/dsd_frame_sync.c b/src/dsd_frame_sync.c
|
||||
index e10f3cc..7f5fbf5 100644
|
||||
--- a/src/dsd_frame_sync.c
|
||||
+++ b/src/dsd_frame_sync.c
|
||||
@@ -117,6 +117,8 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
* 36 = -P25 P2
|
||||
* 37 = +EDACS
|
||||
* 38 = -EDACS
|
||||
+ * 40 = +Type2
|
||||
+ * 41 = -Type2
|
||||
*/
|
||||
|
||||
|
||||
@@ -205,7 +207,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
t_max = 12; //based on Frame_Sync_2 pattern
|
||||
}
|
||||
- else if (opts->frame_m17 == 1)
|
||||
+ else if (opts->frame_m17 == 1 || opts->frame_typeii == 1)
|
||||
{
|
||||
t_max = 8;
|
||||
}
|
||||
@@ -581,6 +583,40 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
//end YSF sync
|
||||
|
||||
+ //Motorola Type II
|
||||
+ strncpy(synctest8, (synctest_p - 7), 8);
|
||||
+ if (opts->frame_typeii == 1)
|
||||
+ {
|
||||
+ if (strcmp(synctest8, TYPE_II_SYNC) == 0)
|
||||
+ {
|
||||
+ if (state->lastsynctype == 40)
|
||||
+ {
|
||||
+ printFrameSync (opts, state, "+Type II", synctest_pos + 1, modulation);
|
||||
+ state->carrier = 1;
|
||||
+ state->offset = synctest_pos;
|
||||
+ state->max = ((state->max) + lmax) / 2;
|
||||
+ state->min = ((state->min) + lmin) / 2;
|
||||
+ state->lastsynctype = 40;
|
||||
+ return (40);
|
||||
+ }
|
||||
+ else state->lastsynctype = 40;
|
||||
+ }
|
||||
+ else if (strcmp(synctest8, TYPE_II_SINV) == 0)
|
||||
+ {
|
||||
+ if (state->lastsynctype == 41)
|
||||
+ {
|
||||
+ printFrameSync (opts, state, "-Type II", synctest_pos + 1, modulation);
|
||||
+ state->carrier = 1;
|
||||
+ state->offset = synctest_pos;
|
||||
+ state->max = ((state->max) + lmax) / 2;
|
||||
+ state->min = ((state->min) + lmin) / 2;
|
||||
+ state->lastsynctype = 41;
|
||||
+ return (41);
|
||||
+ }
|
||||
+ else state->lastsynctype = 41;
|
||||
+ }
|
||||
+ }
|
||||
+
|
||||
//M17 Sync -- Just STR and LSF for now
|
||||
strncpy(synctest16, (synctest_p - 15), 16);
|
||||
strncpy(synctest8, (synctest_p - 7), 8);
|
||||
diff --git a/src/dsd_main.c b/src/dsd_main.c
|
||||
index ca878e9..c5a3e95 100644
|
||||
--- a/src/dsd_main.c
|
||||
+++ b/src/dsd_main.c
|
||||
@@ -622,6 +622,7 @@ initOpts (dsd_opts * opts)
|
||||
opts->frame_provoice = 0;
|
||||
opts->frame_ysf = 1;
|
||||
opts->frame_m17 = 0;
|
||||
+ opts->frame_typeii = 0;
|
||||
opts->mod_c4fm = 1;
|
||||
opts->mod_qpsk = 0;
|
||||
opts->mod_gfsk = 0;
|
||||
@@ -1377,6 +1378,7 @@ usage ()
|
||||
printf (" -fe Decode only EDACS EA/ProVoice*\n");
|
||||
printf (" -fE Decode only EDACS EA/ProVoice with ESK 0xA0*\n");
|
||||
printf (" -fm Decode only dPMR*\n");
|
||||
+ printf (" -fT Decode only Type II (Smartnet/Smartzone)*\n");
|
||||
printf (" -l Disable DMR, dPMR, NXDN, M17 input filtering\n");
|
||||
printf (" -u <num> Unvoiced speech quality (default=3)\n");
|
||||
printf (" -xx Expect non-inverted X2-TDMA signal\n");
|
||||
@@ -2431,6 +2433,39 @@ main (int argc, char **argv)
|
||||
opts.rtl_bandwidth = 24;
|
||||
// opts.rtl_gain_value = 36;
|
||||
}
|
||||
+ else if (optarg[0] == 'T') //Motorola Type II
|
||||
+ {
|
||||
+ opts.frame_dstar = 0;
|
||||
+ opts.frame_x2tdma = 0;
|
||||
+ opts.frame_p25p1 = 0;
|
||||
+ opts.frame_p25p2 = 0;
|
||||
+ opts.frame_nxdn48 = 0;
|
||||
+ opts.frame_nxdn96 = 0;
|
||||
+ opts.frame_dmr = 0;
|
||||
+ opts.frame_dpmr = 0;
|
||||
+ opts.frame_provoice = 0;
|
||||
+ opts.frame_ysf = 0;
|
||||
+ opts.frame_m17 = 0;
|
||||
+ opts.frame_typeii = 1;
|
||||
+ ////to maintain 10/4 sample per symbol rate, we need to run at 36000
|
||||
+ //to hit TypeII's 3600 bps rating. BW values in rtl_fm are also modified
|
||||
+ //similarly, but testing will need to be done, this MAY NOT be viable in DSD-FME.
|
||||
+ opts.pulse_digi_rate_in = 36000;
|
||||
+ opts.wav_sample_rate = 36000;
|
||||
+ opts.mod_c4fm = 1;
|
||||
+ opts.mod_qpsk = 0;
|
||||
+ opts.mod_gfsk = 0; //might still be better as gfsk
|
||||
+ state.rf_mod = 2;
|
||||
+ opts.pulse_digi_rate_out = 8000;
|
||||
+ opts.pulse_digi_out_channels = 1;
|
||||
+ opts.dmr_stereo = 0;
|
||||
+ opts.dmr_mono = 0;
|
||||
+ state.dmr_stereo = 0;
|
||||
+ // opts.setmod_bw = 12500;
|
||||
+ sprintf (opts.output_name, "Type II");
|
||||
+ // fprintf (stderr,"Setting symbol rate to 4800 / second\n");
|
||||
+ fprintf (stderr,"Decoding Motorola Type II frames.\n");
|
||||
+ }
|
||||
else if (optarg[0] == '1')
|
||||
{
|
||||
opts.frame_dstar = 0;
|
||||
diff --git a/src/rtl_sdr_fm.cpp b/src/rtl_sdr_fm.cpp
|
||||
index ad04667..954c6dc 100644
|
||||
--- a/src/rtl_sdr_fm.cpp
|
||||
+++ b/src/rtl_sdr_fm.cpp
|
||||
@@ -1025,6 +1025,7 @@ void rtlsdr_sighandler()
|
||||
void open_rtlsdr_stream(dsd_opts *opts)
|
||||
{
|
||||
int r;
|
||||
+ if (opts->frame_typeii == 1) bandwidth_divisor = 36000;
|
||||
rtl_bandwidth = opts->rtl_bandwidth * 1000; //reverted back to straight value
|
||||
bandwidth_multiplier = (bandwidth_divisor / rtl_bandwidth);
|
||||
volume_multiplier = 1; //moved to external handling to be more dynamic
|
||||
diff --git a/src/typeII.c b/src/typeII.c
|
||||
new file mode 100644
|
||||
index 0000000..eb0cd56
|
||||
--- /dev/null
|
||||
+++ b/src/typeII.c
|
||||
@@ -0,0 +1,29 @@
|
||||
+/*-------------------------------------------------------------------------------
|
||||
+ * typeII.c
|
||||
+ * Motorola Type II Decoder (WIP)
|
||||
+ *
|
||||
+ *
|
||||
+ *
|
||||
+ *
|
||||
+ * LWVMOBILE
|
||||
+ * 2024-03 DSD-FME Florida Man Edition
|
||||
+ *-----------------------------------------------------------------------------*/
|
||||
+
|
||||
+#include "dsd.h"
|
||||
+
|
||||
+//Type II
|
||||
+void type_ii(dsd_opts * opts, dsd_state * state)
|
||||
+{
|
||||
+ int i;
|
||||
+ uint8_t t2[80]; memset(t2, 0, sizeof(t2));
|
||||
+
|
||||
+ for (i = 0; i < 76; i++)
|
||||
+ t2[i] = getDibit(opts, state);
|
||||
+
|
||||
+ //debug dump collected bits
|
||||
+ fprintf (stderr, "Frame:");
|
||||
+ for (i = 0; i < 10; i++)
|
||||
+ fprintf (stderr, " %02X", (uint8_t)ConvertBitIntoBytes(&t2[i*8], 8));
|
||||
+
|
||||
+ fprintf (stderr, "\n");
|
||||
+}
|
||||
\ No newline at end of file
|
||||
11
rebuild.sh
11
rebuild.sh
@@ -1,8 +1,8 @@
|
||||
#! /bin/bash
|
||||
#
|
||||
clear
|
||||
printf "DSD-FME Digital Speech Decoder - Florida Man Edition
|
||||
Automatic Git Pull and Rebuild\n\n"
|
||||
echo DSD-FME Digital Speech Decoder - Florida Man Edition
|
||||
echo Automatic Git Pull and Rebuild
|
||||
echo
|
||||
sleep 1
|
||||
##Open your clone folder##
|
||||
git pull
|
||||
@@ -10,6 +10,7 @@ sleep 2
|
||||
##cd into your build folder##
|
||||
cd build
|
||||
cmake ..
|
||||
make -j $(nproc)
|
||||
make -j `nproc`
|
||||
sudo make install
|
||||
sudo ldconfig
|
||||
sudo ldconfig
|
||||
|
||||
|
||||
922
src/crypt-aes.c
922
src/crypt-aes.c
@@ -1,922 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* aes.c Tinier AES
|
||||
* Easy To Use (and configurable) AES Output and Utility Bit/Byte Functions
|
||||
*
|
||||
* Modified Tiny AES code for more variable nk/nr/nb values, all in one file
|
||||
* https://github.com/kokke/tiny-AES-c
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*
|
||||
This is free and unencumbered software released into the public domain.
|
||||
|
||||
Anyone is free to copy, modify, publish, use, compile, sell, or
|
||||
distribute this software, either in source code form or as a compiled
|
||||
binary, for any purpose, commercial or non-commercial, and by any
|
||||
means.
|
||||
|
||||
In jurisdictions that recognize copyright laws, the author or authors
|
||||
of this software dedicate any and all copyright interest in the
|
||||
software to the public domain. We make this dedication for the benefit
|
||||
of the public at large and to the detriment of our heirs and
|
||||
successors. We intend this dedication to be an overt act of
|
||||
relinquishment in perpetuity of all present and future rights to this
|
||||
software under copyright law.
|
||||
|
||||
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
|
||||
IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR
|
||||
OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
|
||||
ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
|
||||
OTHER DEALINGS IN THE SOFTWARE.
|
||||
|
||||
For more information, please refer to <http://unlicense.org/>
|
||||
|
||||
*/
|
||||
|
||||
#include <string.h>
|
||||
#include <stdint.h>
|
||||
#include <stddef.h>
|
||||
#include "dsd.h"
|
||||
|
||||
#define AES_BLOCKLEN 16
|
||||
unsigned Nb = 4;
|
||||
unsigned Nk = 8;
|
||||
unsigned Nr = 14;
|
||||
|
||||
struct AES_ctx
|
||||
{
|
||||
uint8_t RoundKey[240];
|
||||
uint8_t Iv[16];
|
||||
};
|
||||
|
||||
//internal function prototypes
|
||||
void AES_init_ctx(struct AES_ctx* ctx, const uint8_t* key);
|
||||
void AES_init_ctx_iv(struct AES_ctx* ctx, const uint8_t* key, const uint8_t* iv);
|
||||
void AES_ctx_set_iv(struct AES_ctx* ctx, const uint8_t* iv);
|
||||
void AES_ECB_encrypt(const struct AES_ctx* ctx, uint8_t* buf);
|
||||
void AES_ECB_decrypt(const struct AES_ctx* ctx, uint8_t* buf);
|
||||
void AES_CBC_encrypt_buffer(struct AES_ctx* ctx, uint8_t* buf, size_t length);
|
||||
void AES_CBC_decrypt_buffer(struct AES_ctx* ctx, uint8_t* buf, size_t length);
|
||||
void AES_CTR_xcrypt_buffer(struct AES_ctx* ctx, uint8_t* buf, size_t length);
|
||||
|
||||
typedef uint8_t state_t[4][4];
|
||||
|
||||
static const uint8_t sbox[256] = {
|
||||
//0 1 2 3 4 5 6 7 8 9 A B C D E F
|
||||
0x63, 0x7c, 0x77, 0x7b, 0xf2, 0x6b, 0x6f, 0xc5, 0x30, 0x01, 0x67, 0x2b, 0xfe, 0xd7, 0xab, 0x76,
|
||||
0xca, 0x82, 0xc9, 0x7d, 0xfa, 0x59, 0x47, 0xf0, 0xad, 0xd4, 0xa2, 0xaf, 0x9c, 0xa4, 0x72, 0xc0,
|
||||
0xb7, 0xfd, 0x93, 0x26, 0x36, 0x3f, 0xf7, 0xcc, 0x34, 0xa5, 0xe5, 0xf1, 0x71, 0xd8, 0x31, 0x15,
|
||||
0x04, 0xc7, 0x23, 0xc3, 0x18, 0x96, 0x05, 0x9a, 0x07, 0x12, 0x80, 0xe2, 0xeb, 0x27, 0xb2, 0x75,
|
||||
0x09, 0x83, 0x2c, 0x1a, 0x1b, 0x6e, 0x5a, 0xa0, 0x52, 0x3b, 0xd6, 0xb3, 0x29, 0xe3, 0x2f, 0x84,
|
||||
0x53, 0xd1, 0x00, 0xed, 0x20, 0xfc, 0xb1, 0x5b, 0x6a, 0xcb, 0xbe, 0x39, 0x4a, 0x4c, 0x58, 0xcf,
|
||||
0xd0, 0xef, 0xaa, 0xfb, 0x43, 0x4d, 0x33, 0x85, 0x45, 0xf9, 0x02, 0x7f, 0x50, 0x3c, 0x9f, 0xa8,
|
||||
0x51, 0xa3, 0x40, 0x8f, 0x92, 0x9d, 0x38, 0xf5, 0xbc, 0xb6, 0xda, 0x21, 0x10, 0xff, 0xf3, 0xd2,
|
||||
0xcd, 0x0c, 0x13, 0xec, 0x5f, 0x97, 0x44, 0x17, 0xc4, 0xa7, 0x7e, 0x3d, 0x64, 0x5d, 0x19, 0x73,
|
||||
0x60, 0x81, 0x4f, 0xdc, 0x22, 0x2a, 0x90, 0x88, 0x46, 0xee, 0xb8, 0x14, 0xde, 0x5e, 0x0b, 0xdb,
|
||||
0xe0, 0x32, 0x3a, 0x0a, 0x49, 0x06, 0x24, 0x5c, 0xc2, 0xd3, 0xac, 0x62, 0x91, 0x95, 0xe4, 0x79,
|
||||
0xe7, 0xc8, 0x37, 0x6d, 0x8d, 0xd5, 0x4e, 0xa9, 0x6c, 0x56, 0xf4, 0xea, 0x65, 0x7a, 0xae, 0x08,
|
||||
0xba, 0x78, 0x25, 0x2e, 0x1c, 0xa6, 0xb4, 0xc6, 0xe8, 0xdd, 0x74, 0x1f, 0x4b, 0xbd, 0x8b, 0x8a,
|
||||
0x70, 0x3e, 0xb5, 0x66, 0x48, 0x03, 0xf6, 0x0e, 0x61, 0x35, 0x57, 0xb9, 0x86, 0xc1, 0x1d, 0x9e,
|
||||
0xe1, 0xf8, 0x98, 0x11, 0x69, 0xd9, 0x8e, 0x94, 0x9b, 0x1e, 0x87, 0xe9, 0xce, 0x55, 0x28, 0xdf,
|
||||
0x8c, 0xa1, 0x89, 0x0d, 0xbf, 0xe6, 0x42, 0x68, 0x41, 0x99, 0x2d, 0x0f, 0xb0, 0x54, 0xbb, 0x16 };
|
||||
|
||||
static const uint8_t rsbox[256] = {
|
||||
0x52, 0x09, 0x6a, 0xd5, 0x30, 0x36, 0xa5, 0x38, 0xbf, 0x40, 0xa3, 0x9e, 0x81, 0xf3, 0xd7, 0xfb,
|
||||
0x7c, 0xe3, 0x39, 0x82, 0x9b, 0x2f, 0xff, 0x87, 0x34, 0x8e, 0x43, 0x44, 0xc4, 0xde, 0xe9, 0xcb,
|
||||
0x54, 0x7b, 0x94, 0x32, 0xa6, 0xc2, 0x23, 0x3d, 0xee, 0x4c, 0x95, 0x0b, 0x42, 0xfa, 0xc3, 0x4e,
|
||||
0x08, 0x2e, 0xa1, 0x66, 0x28, 0xd9, 0x24, 0xb2, 0x76, 0x5b, 0xa2, 0x49, 0x6d, 0x8b, 0xd1, 0x25,
|
||||
0x72, 0xf8, 0xf6, 0x64, 0x86, 0x68, 0x98, 0x16, 0xd4, 0xa4, 0x5c, 0xcc, 0x5d, 0x65, 0xb6, 0x92,
|
||||
0x6c, 0x70, 0x48, 0x50, 0xfd, 0xed, 0xb9, 0xda, 0x5e, 0x15, 0x46, 0x57, 0xa7, 0x8d, 0x9d, 0x84,
|
||||
0x90, 0xd8, 0xab, 0x00, 0x8c, 0xbc, 0xd3, 0x0a, 0xf7, 0xe4, 0x58, 0x05, 0xb8, 0xb3, 0x45, 0x06,
|
||||
0xd0, 0x2c, 0x1e, 0x8f, 0xca, 0x3f, 0x0f, 0x02, 0xc1, 0xaf, 0xbd, 0x03, 0x01, 0x13, 0x8a, 0x6b,
|
||||
0x3a, 0x91, 0x11, 0x41, 0x4f, 0x67, 0xdc, 0xea, 0x97, 0xf2, 0xcf, 0xce, 0xf0, 0xb4, 0xe6, 0x73,
|
||||
0x96, 0xac, 0x74, 0x22, 0xe7, 0xad, 0x35, 0x85, 0xe2, 0xf9, 0x37, 0xe8, 0x1c, 0x75, 0xdf, 0x6e,
|
||||
0x47, 0xf1, 0x1a, 0x71, 0x1d, 0x29, 0xc5, 0x89, 0x6f, 0xb7, 0x62, 0x0e, 0xaa, 0x18, 0xbe, 0x1b,
|
||||
0xfc, 0x56, 0x3e, 0x4b, 0xc6, 0xd2, 0x79, 0x20, 0x9a, 0xdb, 0xc0, 0xfe, 0x78, 0xcd, 0x5a, 0xf4,
|
||||
0x1f, 0xdd, 0xa8, 0x33, 0x88, 0x07, 0xc7, 0x31, 0xb1, 0x12, 0x10, 0x59, 0x27, 0x80, 0xec, 0x5f,
|
||||
0x60, 0x51, 0x7f, 0xa9, 0x19, 0xb5, 0x4a, 0x0d, 0x2d, 0xe5, 0x7a, 0x9f, 0x93, 0xc9, 0x9c, 0xef,
|
||||
0xa0, 0xe0, 0x3b, 0x4d, 0xae, 0x2a, 0xf5, 0xb0, 0xc8, 0xeb, 0xbb, 0x3c, 0x83, 0x53, 0x99, 0x61,
|
||||
0x17, 0x2b, 0x04, 0x7e, 0xba, 0x77, 0xd6, 0x26, 0xe1, 0x69, 0x14, 0x63, 0x55, 0x21, 0x0c, 0x7d };
|
||||
|
||||
static const uint8_t Rcon[11] = {
|
||||
0x8d, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x1b, 0x36 };
|
||||
|
||||
#define getSBoxValue(num) (sbox[(num)])
|
||||
|
||||
static void KeyExpansion(uint8_t* RoundKey, const uint8_t* Key)
|
||||
{
|
||||
unsigned i, j, k;
|
||||
uint8_t tempa[4]; // Used for the column/row operations
|
||||
|
||||
// The first round key is the key itself.
|
||||
for (i = 0; i < Nk; ++i)
|
||||
{
|
||||
RoundKey[(i * 4) + 0] = Key[(i * 4) + 0];
|
||||
RoundKey[(i * 4) + 1] = Key[(i * 4) + 1];
|
||||
RoundKey[(i * 4) + 2] = Key[(i * 4) + 2];
|
||||
RoundKey[(i * 4) + 3] = Key[(i * 4) + 3];
|
||||
}
|
||||
|
||||
// All other round keys are found from the previous round keys.
|
||||
for (i = Nk; i < Nb * (Nr + 1); ++i)
|
||||
{
|
||||
{
|
||||
k = (i - 1) * 4;
|
||||
tempa[0]=RoundKey[k + 0];
|
||||
tempa[1]=RoundKey[k + 1];
|
||||
tempa[2]=RoundKey[k + 2];
|
||||
tempa[3]=RoundKey[k + 3];
|
||||
|
||||
}
|
||||
|
||||
if (i % Nk == 0)
|
||||
{
|
||||
// This function shifts the 4 bytes in a word to the left once.
|
||||
// [a0,a1,a2,a3] becomes [a1,a2,a3,a0]
|
||||
|
||||
// Function RotWord()
|
||||
{
|
||||
const uint8_t u8tmp = tempa[0];
|
||||
tempa[0] = tempa[1];
|
||||
tempa[1] = tempa[2];
|
||||
tempa[2] = tempa[3];
|
||||
tempa[3] = u8tmp;
|
||||
}
|
||||
|
||||
// SubWord() is a function that takes a four-byte input word and
|
||||
// applies the S-box to each of the four bytes to produce an output word.
|
||||
|
||||
// Function Subword()
|
||||
{
|
||||
tempa[0] = getSBoxValue(tempa[0]);
|
||||
tempa[1] = getSBoxValue(tempa[1]);
|
||||
tempa[2] = getSBoxValue(tempa[2]);
|
||||
tempa[3] = getSBoxValue(tempa[3]);
|
||||
}
|
||||
|
||||
tempa[0] = tempa[0] ^ Rcon[i/Nk];
|
||||
}
|
||||
|
||||
if (Nk == 8) //only run if using AES256 (Nk == 8)
|
||||
{
|
||||
if (i % Nk == 4)
|
||||
{
|
||||
// Function Subword()
|
||||
{
|
||||
tempa[0] = getSBoxValue(tempa[0]);
|
||||
tempa[1] = getSBoxValue(tempa[1]);
|
||||
tempa[2] = getSBoxValue(tempa[2]);
|
||||
tempa[3] = getSBoxValue(tempa[3]);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
j = i * 4; k=(i - Nk) * 4;
|
||||
RoundKey[j + 0] = RoundKey[k + 0] ^ tempa[0];
|
||||
RoundKey[j + 1] = RoundKey[k + 1] ^ tempa[1];
|
||||
RoundKey[j + 2] = RoundKey[k + 2] ^ tempa[2];
|
||||
RoundKey[j + 3] = RoundKey[k + 3] ^ tempa[3];
|
||||
}
|
||||
}
|
||||
|
||||
//input bit array, return output as up to a 64-bit value
|
||||
uint64_t convert_bits_into_output_ta(uint8_t * input, int len)
|
||||
{
|
||||
int i;
|
||||
uint64_t output = 0;
|
||||
for(i = 0; i < len; i++)
|
||||
{
|
||||
output <<= 1;
|
||||
output |= (uint64_t)(input[i] & 1);
|
||||
}
|
||||
return output;
|
||||
}
|
||||
|
||||
//take x amount of bits and pack into len amount of bytes (symmetrical)
|
||||
void pack_bit_array_into_byte_array_ta (uint8_t * input, uint8_t * output, int len)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < len; i++)
|
||||
output[i] = (uint8_t)convert_bits_into_output_ta(&input[i*8], 8);
|
||||
}
|
||||
|
||||
//take len amount of bytes and unpack back into a bit array
|
||||
void unpack_byte_array_into_bit_array_ta (uint8_t * input, uint8_t * output, int len)
|
||||
{
|
||||
int i = 0, k = 0;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
output[k++] = (input[i] >> 7) & 1;
|
||||
output[k++] = (input[i] >> 6) & 1;
|
||||
output[k++] = (input[i] >> 5) & 1;
|
||||
output[k++] = (input[i] >> 4) & 1;
|
||||
output[k++] = (input[i] >> 3) & 1;
|
||||
output[k++] = (input[i] >> 2) & 1;
|
||||
output[k++] = (input[i] >> 1) & 1;
|
||||
output[k++] = (input[i] >> 0) & 1;
|
||||
}
|
||||
}
|
||||
|
||||
void AES_init_ctx(struct AES_ctx* ctx, const uint8_t* key)
|
||||
{
|
||||
KeyExpansion(ctx->RoundKey, key);
|
||||
}
|
||||
void AES_init_ctx_iv(struct AES_ctx* ctx, const uint8_t* key, const uint8_t* iv)
|
||||
{
|
||||
KeyExpansion(ctx->RoundKey, key);
|
||||
memcpy (ctx->Iv, iv, AES_BLOCKLEN);
|
||||
}
|
||||
void AES_ctx_set_iv(struct AES_ctx* ctx, const uint8_t* iv)
|
||||
{
|
||||
memcpy (ctx->Iv, iv, AES_BLOCKLEN);
|
||||
}
|
||||
|
||||
static void AddRoundKey(uint8_t round, state_t* state, const uint8_t* RoundKey)
|
||||
{
|
||||
uint8_t i,j;
|
||||
for (i = 0; i < 4; ++i)
|
||||
{
|
||||
for (j = 0; j < 4; ++j)
|
||||
{
|
||||
(*state)[i][j] ^= RoundKey[(round * Nb * 4) + (i * Nb) + j];
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void SubBytes(state_t* state)
|
||||
{
|
||||
uint8_t i, j;
|
||||
for (i = 0; i < 4; ++i)
|
||||
{
|
||||
for (j = 0; j < 4; ++j)
|
||||
{
|
||||
(*state)[j][i] = getSBoxValue((*state)[j][i]);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void ShiftRows(state_t* state)
|
||||
{
|
||||
uint8_t temp;
|
||||
|
||||
// Rotate first row 1 columns to left
|
||||
temp = (*state)[0][1];
|
||||
(*state)[0][1] = (*state)[1][1];
|
||||
(*state)[1][1] = (*state)[2][1];
|
||||
(*state)[2][1] = (*state)[3][1];
|
||||
(*state)[3][1] = temp;
|
||||
|
||||
// Rotate second row 2 columns to left
|
||||
temp = (*state)[0][2];
|
||||
(*state)[0][2] = (*state)[2][2];
|
||||
(*state)[2][2] = temp;
|
||||
|
||||
temp = (*state)[1][2];
|
||||
(*state)[1][2] = (*state)[3][2];
|
||||
(*state)[3][2] = temp;
|
||||
|
||||
// Rotate third row 3 columns to left
|
||||
temp = (*state)[0][3];
|
||||
(*state)[0][3] = (*state)[3][3];
|
||||
(*state)[3][3] = (*state)[2][3];
|
||||
(*state)[2][3] = (*state)[1][3];
|
||||
(*state)[1][3] = temp;
|
||||
}
|
||||
|
||||
static uint8_t xtime(uint8_t x)
|
||||
{
|
||||
return ((x<<1) ^ (((x>>7) & 1) * 0x1b));
|
||||
}
|
||||
|
||||
static void MixColumns(state_t* state)
|
||||
{
|
||||
uint8_t i;
|
||||
uint8_t Tmp, Tm, t;
|
||||
for (i = 0; i < 4; ++i)
|
||||
{
|
||||
t = (*state)[i][0];
|
||||
Tmp = (*state)[i][0] ^ (*state)[i][1] ^ (*state)[i][2] ^ (*state)[i][3] ;
|
||||
Tm = (*state)[i][0] ^ (*state)[i][1] ; Tm = xtime(Tm); (*state)[i][0] ^= Tm ^ Tmp ;
|
||||
Tm = (*state)[i][1] ^ (*state)[i][2] ; Tm = xtime(Tm); (*state)[i][1] ^= Tm ^ Tmp ;
|
||||
Tm = (*state)[i][2] ^ (*state)[i][3] ; Tm = xtime(Tm); (*state)[i][2] ^= Tm ^ Tmp ;
|
||||
Tm = (*state)[i][3] ^ t ; Tm = xtime(Tm); (*state)[i][3] ^= Tm ^ Tmp ;
|
||||
}
|
||||
}
|
||||
|
||||
#define Multiply(x, y) \
|
||||
( ((y & 1) * x) ^ \
|
||||
((y>>1 & 1) * xtime(x)) ^ \
|
||||
((y>>2 & 1) * xtime(xtime(x))) ^ \
|
||||
((y>>3 & 1) * xtime(xtime(xtime(x)))) ^ \
|
||||
((y>>4 & 1) * xtime(xtime(xtime(xtime(x)))))) \
|
||||
|
||||
|
||||
#define getSBoxInvert(num) (rsbox[(num)])
|
||||
|
||||
static void InvMixColumns(state_t* state)
|
||||
{
|
||||
int i;
|
||||
uint8_t a, b, c, d;
|
||||
for (i = 0; i < 4; ++i)
|
||||
{
|
||||
a = (*state)[i][0];
|
||||
b = (*state)[i][1];
|
||||
c = (*state)[i][2];
|
||||
d = (*state)[i][3];
|
||||
|
||||
(*state)[i][0] = Multiply(a, 0x0e) ^ Multiply(b, 0x0b) ^ Multiply(c, 0x0d) ^ Multiply(d, 0x09);
|
||||
(*state)[i][1] = Multiply(a, 0x09) ^ Multiply(b, 0x0e) ^ Multiply(c, 0x0b) ^ Multiply(d, 0x0d);
|
||||
(*state)[i][2] = Multiply(a, 0x0d) ^ Multiply(b, 0x09) ^ Multiply(c, 0x0e) ^ Multiply(d, 0x0b);
|
||||
(*state)[i][3] = Multiply(a, 0x0b) ^ Multiply(b, 0x0d) ^ Multiply(c, 0x09) ^ Multiply(d, 0x0e);
|
||||
}
|
||||
}
|
||||
|
||||
static void InvSubBytes(state_t* state)
|
||||
{
|
||||
uint8_t i, j;
|
||||
for (i = 0; i < 4; ++i)
|
||||
{
|
||||
for (j = 0; j < 4; ++j)
|
||||
{
|
||||
(*state)[j][i] = getSBoxInvert((*state)[j][i]);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void InvShiftRows(state_t* state)
|
||||
{
|
||||
uint8_t temp;
|
||||
|
||||
// Rotate first row 1 columns to right
|
||||
temp = (*state)[3][1];
|
||||
(*state)[3][1] = (*state)[2][1];
|
||||
(*state)[2][1] = (*state)[1][1];
|
||||
(*state)[1][1] = (*state)[0][1];
|
||||
(*state)[0][1] = temp;
|
||||
|
||||
// Rotate second row 2 columns to right
|
||||
temp = (*state)[0][2];
|
||||
(*state)[0][2] = (*state)[2][2];
|
||||
(*state)[2][2] = temp;
|
||||
|
||||
temp = (*state)[1][2];
|
||||
(*state)[1][2] = (*state)[3][2];
|
||||
(*state)[3][2] = temp;
|
||||
|
||||
// Rotate third row 3 columns to right
|
||||
temp = (*state)[0][3];
|
||||
(*state)[0][3] = (*state)[1][3];
|
||||
(*state)[1][3] = (*state)[2][3];
|
||||
(*state)[2][3] = (*state)[3][3];
|
||||
(*state)[3][3] = temp;
|
||||
}
|
||||
|
||||
// Cipher is the main function that encrypts the PlainText,
|
||||
// or produces a keystream, depending on application.
|
||||
static void Cipher(state_t* state, const uint8_t* RoundKey)
|
||||
{
|
||||
uint8_t round = 0;
|
||||
|
||||
// Add the First round key to the state before starting the rounds.
|
||||
AddRoundKey(0, state, RoundKey);
|
||||
|
||||
// There will be Nr rounds.
|
||||
// The first Nr-1 rounds are identical.
|
||||
// These Nr rounds are executed in the loop below.
|
||||
// Last one without MixColumns()
|
||||
for (round = 1; ; ++round)
|
||||
{
|
||||
SubBytes(state);
|
||||
ShiftRows(state);
|
||||
if (round == Nr) {
|
||||
break;
|
||||
}
|
||||
MixColumns(state);
|
||||
AddRoundKey(round, state, RoundKey);
|
||||
}
|
||||
// Add round key to last round
|
||||
AddRoundKey(Nr, state, RoundKey);
|
||||
}
|
||||
|
||||
static void InvCipher(state_t* state, const uint8_t* RoundKey)
|
||||
{
|
||||
uint8_t round = 0;
|
||||
|
||||
// Add the First round key to the state before starting the rounds.
|
||||
AddRoundKey(Nr, state, RoundKey);
|
||||
|
||||
// There will be Nr rounds.
|
||||
// The first Nr-1 rounds are identical.
|
||||
// These Nr rounds are executed in the loop below.
|
||||
// Last one without InvMixColumn()
|
||||
for (round = (Nr - 1); ; --round)
|
||||
{
|
||||
InvShiftRows(state);
|
||||
InvSubBytes(state);
|
||||
AddRoundKey(round, state, RoundKey);
|
||||
if (round == 0) {
|
||||
break;
|
||||
}
|
||||
InvMixColumns(state);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void AES_ECB_encrypt(const struct AES_ctx* ctx, uint8_t* buf)
|
||||
{
|
||||
// The next function call encrypts the PlainText with the Key using AES algorithm.
|
||||
Cipher((state_t*)buf, ctx->RoundKey);
|
||||
}
|
||||
|
||||
void AES_ECB_decrypt(const struct AES_ctx* ctx, uint8_t* buf)
|
||||
{
|
||||
// The next function call decrypts the PlainText with the Key using AES algorithm.
|
||||
InvCipher((state_t*)buf, ctx->RoundKey);
|
||||
}
|
||||
|
||||
static void XorWithIv(uint8_t* buf, const uint8_t* Iv)
|
||||
{
|
||||
uint8_t i;
|
||||
for (i = 0; i < AES_BLOCKLEN; ++i)
|
||||
{
|
||||
buf[i] ^= Iv[i];
|
||||
}
|
||||
}
|
||||
|
||||
void AES_CBC_encrypt_buffer(struct AES_ctx *ctx, uint8_t* buf, size_t length)
|
||||
{
|
||||
size_t i;
|
||||
uint8_t *Iv = ctx->Iv;
|
||||
for (i = 0; i < length; i += AES_BLOCKLEN)
|
||||
{
|
||||
XorWithIv(buf, Iv);
|
||||
Cipher((state_t*)buf, ctx->RoundKey);
|
||||
Iv = buf;
|
||||
buf += AES_BLOCKLEN;
|
||||
}
|
||||
/* store Iv in ctx for next call */
|
||||
memcpy(ctx->Iv, Iv, AES_BLOCKLEN);
|
||||
}
|
||||
|
||||
void AES_CBC_decrypt_buffer(struct AES_ctx* ctx, uint8_t* buf, size_t length)
|
||||
{
|
||||
size_t i;
|
||||
uint8_t storeNextIv[AES_BLOCKLEN];
|
||||
for (i = 0; i < length; i += AES_BLOCKLEN)
|
||||
{
|
||||
memcpy(storeNextIv, buf, AES_BLOCKLEN);
|
||||
InvCipher((state_t*)buf, ctx->RoundKey);
|
||||
XorWithIv(buf, ctx->Iv);
|
||||
memcpy(ctx->Iv, storeNextIv, AES_BLOCKLEN);
|
||||
buf += AES_BLOCKLEN;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/* Symmetrical operation: same function for encrypting as for decrypting. Note any IV/nonce should never be reused with the same key */
|
||||
void AES_CTR_xcrypt_buffer(struct AES_ctx* ctx, uint8_t* buf, size_t length)
|
||||
{
|
||||
uint8_t buffer[AES_BLOCKLEN];
|
||||
|
||||
size_t i;
|
||||
int bi;
|
||||
for (i = 0, bi = AES_BLOCKLEN; i < length; ++i, ++bi)
|
||||
{
|
||||
if (bi == AES_BLOCKLEN) /* we need to regen xor compliment in buffer */
|
||||
{
|
||||
|
||||
memcpy(buffer, ctx->Iv, AES_BLOCKLEN);
|
||||
Cipher((state_t*)buffer,ctx->RoundKey);
|
||||
|
||||
/* Increment Iv and handle overflow */
|
||||
for (bi = (AES_BLOCKLEN - 1); bi >= 0; --bi)
|
||||
{
|
||||
/* inc will overflow */
|
||||
if (ctx->Iv[bi] == 255)
|
||||
{
|
||||
ctx->Iv[bi] = 0;
|
||||
continue;
|
||||
}
|
||||
ctx->Iv[bi] += 1;
|
||||
break;
|
||||
}
|
||||
bi = 0;
|
||||
}
|
||||
|
||||
buf[i] = (buf[i] ^ buffer[bi]);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//byte-wise output of AES OFB Keystream
|
||||
//input iv is a 16-byte uint8_t array of initialization vector
|
||||
//input key is up to 32-byte uint8_t array of key value
|
||||
//input type is the type/key len of AES required (0-128, 1-192, 2-256)
|
||||
//input nblocks is the number of rounds of 16-byte keystream output blocks requried
|
||||
//output is a uint8_t bytewise array, each round filled with 16-bytes from aes keystream output
|
||||
void aes_ofb_keystream_output (uint8_t * iv, uint8_t * key, uint8_t * output, int type, int nblocks)
|
||||
{
|
||||
|
||||
int i;
|
||||
uint8_t input_register[16]; //OFB Input Register
|
||||
memset (input_register, 0, sizeof(input_register));
|
||||
|
||||
//Set values specific to type (128/192/256)
|
||||
if (type == 0) //128
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 4;
|
||||
Nr = 10;
|
||||
}
|
||||
else if (type == 1) //192
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 6;
|
||||
Nr = 12;
|
||||
}
|
||||
else //if (type == 2) //256
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 8;
|
||||
Nr = 14;
|
||||
}
|
||||
|
||||
struct AES_ctx ctx;
|
||||
|
||||
//load first round of input_register with received IV (OFB First Input Register)
|
||||
memcpy (input_register, iv, 16*sizeof(uint8_t) );
|
||||
|
||||
//initialize the key variable for the Cipher function
|
||||
memset (ctx.RoundKey, 0, 240*sizeof(uint8_t));
|
||||
KeyExpansion(ctx.RoundKey, key);
|
||||
|
||||
//execute the cipher function, and copy ciphered input_register to output for required number of rounds
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
Cipher((state_t*)input_register, ctx.RoundKey); //input_register is returned as output, and is put back in as object feedback
|
||||
memcpy (output+(i*16), input_register, 16*sizeof(uint8_t) ); //copy ciphered input_register to output
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//byte-wise AES CFB (Cipher Feedback) Payload operating in 128-bit block mode
|
||||
//input in is a uint8_t bytewise array,is the input to be ciphered (encrypted or decrypted)
|
||||
//input iv is a 16-byte uint8_t array of initialization vector
|
||||
//input key is up to 32-byte uint8_t array of key value
|
||||
//input type is the type/key len of AES required (0-128, 1-192, 2-256)
|
||||
//input nblocks is the number of rounds of 16-byte payload blocks requried (last block will need padding if not flush)
|
||||
//output out is a uint8_t bytewise array, each round filled with 16-bytes of cfb ciphered output (encrypted or decrypted)
|
||||
//de is a bit-flag signalling to run Cipher (encrypt) on 1, or InvCipher (decrypt) on 0
|
||||
void aes_cfb_bytewise_payload_crypt (uint8_t * iv, uint8_t * key, uint8_t * in, uint8_t * out, int type, int nblocks, int de)
|
||||
{
|
||||
|
||||
int i, j;
|
||||
uint8_t input_register[16]; //Input Register
|
||||
memset (input_register, 0, sizeof(input_register));
|
||||
|
||||
//Set values specific to type (128/192/256)
|
||||
if (type == 0) //128
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 4;
|
||||
Nr = 10;
|
||||
}
|
||||
else if (type == 1) //192
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 6;
|
||||
Nr = 12;
|
||||
}
|
||||
else //if (type == 2) //256
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 8;
|
||||
Nr = 14;
|
||||
}
|
||||
|
||||
struct AES_ctx ctx;
|
||||
|
||||
//load first round of input_register with received IV (CFB First Input Register)
|
||||
memcpy (input_register, iv, 16*sizeof(uint8_t) );
|
||||
|
||||
//initialize the key variable for the Cipher function
|
||||
memset (ctx.RoundKey, 0, 240*sizeof(uint8_t));
|
||||
KeyExpansion(ctx.RoundKey, key);
|
||||
|
||||
//execute the cipher function, and copy ciphered input_register to output for required number of rounds
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
|
||||
//the cipher is always run in the foward, or encryption mode
|
||||
Cipher((state_t*)input_register, ctx.RoundKey);
|
||||
|
||||
//xor the current input 'in' to the current state of the input_register for cipher feedback
|
||||
for (j = 0; j < 16; j++)
|
||||
input_register[j] ^= in[j+(i*16)];
|
||||
|
||||
//copy ciphered/xor'd input_register to output 'out'
|
||||
memcpy (out+(i*16), input_register, 16*sizeof(uint8_t) );
|
||||
|
||||
//if running in decryption mode, we feed in the next round of input
|
||||
if (!de)
|
||||
memcpy(input_register, in+(i*16), 16*sizeof(uint8_t));
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//byte-wise AES CBC (Cipher Block Chaining) //Yeah, I know this already exists, but wanted a custom convenience wrapper version
|
||||
//input in is a uint8_t bytewise array,is the input to be ciphered (encrypted or decrypted)
|
||||
//input iv is a 16-byte uint8_t array of initialization vector
|
||||
//input key is up to 32-byte uint8_t array of key value
|
||||
//input type is the type/key len of AES required (0-128, 1-192, 2-256)
|
||||
//input nblocks is the number of rounds of 16-byte payload blocks requried (last block will need padding if not flush)
|
||||
//output out is a uint8_t bytewise array, each round filled with 16-bytes of cfb ciphered output (encrypted or decrypted)
|
||||
//de is a bit-flag signalling to run Cipher (encrypt) on 1, or InvCipher (decrypt) on 0
|
||||
void aes_cbc_bytewise_payload_crypt (uint8_t * iv, uint8_t * key, uint8_t * in, uint8_t * out, int type, int nblocks, int de)
|
||||
{
|
||||
|
||||
int i, j;
|
||||
uint8_t input_register[16]; //Input Register
|
||||
memset (input_register, 0, sizeof(input_register));
|
||||
|
||||
//Set values specific to type (128/192/256)
|
||||
if (type == 0) //128
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 4;
|
||||
Nr = 10;
|
||||
}
|
||||
else if (type == 1) //192
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 6;
|
||||
Nr = 12;
|
||||
}
|
||||
else //if (type == 2) //256
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 8;
|
||||
Nr = 14;
|
||||
}
|
||||
|
||||
struct AES_ctx ctx;
|
||||
|
||||
//load first round of input_register accordingly
|
||||
if (de)
|
||||
memcpy (input_register, iv, 16*sizeof(uint8_t) );
|
||||
else memcpy (input_register, in, 16*sizeof(uint8_t) );
|
||||
|
||||
//initialize the key variable for the Cipher function
|
||||
memset (ctx.RoundKey, 0, 240*sizeof(uint8_t));
|
||||
KeyExpansion(ctx.RoundKey, key);
|
||||
|
||||
//
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
|
||||
//run encryption or decryption depending on de value
|
||||
if (de) //encrypt
|
||||
{
|
||||
|
||||
//xor the current input 'in' pt to the current state of the input_register for cbc feedback
|
||||
for (j = 0; j < 16; j++)
|
||||
input_register[j] ^= in[j+(i*16)];
|
||||
|
||||
Cipher((state_t*)input_register, ctx.RoundKey);
|
||||
|
||||
//copy ciphered input_register to output 'out'
|
||||
memcpy (out+(i*16), input_register, 16*sizeof(uint8_t) );
|
||||
|
||||
}
|
||||
|
||||
else //decrypt
|
||||
{
|
||||
|
||||
InvCipher((state_t*)input_register, ctx.RoundKey);
|
||||
|
||||
//copy ciphered input_register to output 'out'
|
||||
memcpy (out+(i*16), input_register, 16*sizeof(uint8_t) );
|
||||
|
||||
//xor the current output by IV, or by last received CT
|
||||
if (i == 0)
|
||||
{
|
||||
for (j = 0; j < 16; j++)
|
||||
out[j] ^= iv[j];
|
||||
}
|
||||
else
|
||||
{
|
||||
for (j = 0; j < 16; j++)
|
||||
out[j+(i*16)] ^= in[j+((i-1)*16)];
|
||||
}
|
||||
|
||||
//copy in next segment for input_register (if not last)
|
||||
if (i < nblocks)
|
||||
memcpy(input_register, in+((i+1)*16), 16*sizeof(uint8_t) );
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//byte-wise AES CBC_MAC (Cipher Block Chaining Message Authentication) //This is slightly different than above, no IV is present,
|
||||
//but if iv is desireable, it will need to be pre-XOR'd with the first plaintext input block by the calling function
|
||||
//input in is a uint8_t bytewise array, is the input to be ciphered.
|
||||
//input key is up to 32-byte uint8_t array of key value
|
||||
//input type is the type/key len of AES required (0-128, 1-192, 2-256)
|
||||
//input nblocks is the number of rounds of 16-byte payload blocks requried (last block will need padding if not flush)
|
||||
//output out is a uint8_t bytewise array, with only the final round output as the MAC octets
|
||||
//NOTE: When doing a cbc_mac, you should only run it in the forward (encryption) mode to get the mac bytes
|
||||
void aes_cbc_mac_generator (uint8_t * key, uint8_t * in, uint8_t * out, int type, int nblocks)
|
||||
{
|
||||
|
||||
int i, j;
|
||||
uint8_t input_register[16]; //Input Register
|
||||
memset (input_register, 0, sizeof(input_register));
|
||||
|
||||
//Set values specific to type (128/192/256)
|
||||
if (type == 0) //128
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 4;
|
||||
Nr = 10;
|
||||
}
|
||||
else if (type == 1) //192
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 6;
|
||||
Nr = 12;
|
||||
}
|
||||
else //if (type == 2) //256
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 8;
|
||||
Nr = 14;
|
||||
}
|
||||
|
||||
struct AES_ctx ctx;
|
||||
|
||||
//initialize the key variable for the Cipher function
|
||||
memset (ctx.RoundKey, 0, 240*sizeof(uint8_t));
|
||||
KeyExpansion(ctx.RoundKey, key);
|
||||
|
||||
//
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
|
||||
//xor the current input 'in' pt to the current state of the input_register for cbc feedback
|
||||
//if this is the first iteration, this will load the first round plain text instead
|
||||
for (j = 0; j < 16; j++)
|
||||
input_register[j] ^= in[j+((i+0)*16)];
|
||||
|
||||
Cipher((state_t*)input_register, ctx.RoundKey);
|
||||
|
||||
//debug, load out all intermediate output register values
|
||||
// memcpy (out+(i*16), input_register, 16*sizeof(uint8_t) );
|
||||
|
||||
}
|
||||
|
||||
//copy final ciphered input_register to output 'out', user will determine how many bytes of output they want for MAC
|
||||
memcpy (out, input_register, 16*sizeof(uint8_t) );
|
||||
|
||||
}
|
||||
|
||||
//byte-wise output of AES ECB Ciphering/Deciphering
|
||||
//input is uint8_t byte-wise (16-bytes) data to be ciphered or deciphered
|
||||
//input key is up to 32-byte uint8_t array of key value
|
||||
//input type is the type/len of AES required (0-128, 1-192, 2-256)
|
||||
//output is a uint8_t bytewise array of ciphered or deciphered input
|
||||
//de is a bit-flag signalling to run Cipher (encrypt) on 1, or InvCipher (decrypt) on 0
|
||||
void aes_ecb_bytewise_payload_crypt (uint8_t * input, uint8_t * key, uint8_t * output, int type, int de)
|
||||
{
|
||||
|
||||
uint8_t input_register[16]; //ECB Input Register
|
||||
memset (input_register, 0, sizeof(input_register));
|
||||
|
||||
//Set values specific to type (128/192/256)
|
||||
if (type == 0) //128
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 4;
|
||||
Nr = 10;
|
||||
}
|
||||
else if (type == 1) //192
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 6;
|
||||
Nr = 12;
|
||||
}
|
||||
else //if (type == 2) //256
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 8;
|
||||
Nr = 14;
|
||||
}
|
||||
|
||||
struct AES_ctx ctx;
|
||||
|
||||
//load input_register with received input (ECB Payload)
|
||||
memcpy (input_register, input, 16*sizeof(uint8_t) );
|
||||
|
||||
//initialize the key variable for the Cipher function
|
||||
memset (ctx.RoundKey, 0, 240*sizeof(uint8_t));
|
||||
KeyExpansion(ctx.RoundKey, key);
|
||||
|
||||
//run encryption or decryption depending on de value
|
||||
if (de) //encrypt
|
||||
Cipher((state_t*)input_register, ctx.RoundKey);
|
||||
else //decrypt
|
||||
InvCipher((state_t*)input_register, ctx.RoundKey);
|
||||
|
||||
//copy ciphered/deciphered input_register to output
|
||||
memcpy (output, input_register, 16*sizeof(uint8_t) );
|
||||
|
||||
}
|
||||
|
||||
//symmetrical ctr mode payload encryption and decryption
|
||||
void aes_ctr_bitwise_payload_crypt (uint8_t * iv, uint8_t * key, uint8_t * payload, int type)
|
||||
{
|
||||
|
||||
//Set values specific to type (128/192/256)
|
||||
if (type == 0) //128
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 4;
|
||||
Nr = 10;
|
||||
}
|
||||
else if (type == 1) //192
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 6;
|
||||
Nr = 12;
|
||||
}
|
||||
else //if (type == 2) //256
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 8;
|
||||
Nr = 14;
|
||||
}
|
||||
|
||||
struct AES_ctx ctx;
|
||||
|
||||
//init and set the iv and key variables
|
||||
memset (ctx.RoundKey, 0, 240*sizeof(uint8_t));
|
||||
memset (ctx.Iv, 0, 16*sizeof(uint8_t));
|
||||
|
||||
KeyExpansion(ctx.RoundKey, key);
|
||||
memcpy (ctx.Iv, iv, AES_BLOCKLEN);
|
||||
|
||||
//pack input bit-wise payload to byte array
|
||||
uint8_t payload_bytes[16];
|
||||
memset (payload_bytes, 0, sizeof(payload_bytes));
|
||||
pack_bit_array_into_byte_array_ta (payload, payload_bytes, 16);
|
||||
|
||||
//pass to internal CTR handler for payload
|
||||
AES_CTR_xcrypt_buffer(&ctx, payload_bytes, 16);
|
||||
|
||||
//unpack output bytes back to bits
|
||||
unpack_byte_array_into_bit_array_ta(payload_bytes, payload, 16);
|
||||
|
||||
}
|
||||
|
||||
//symmetrical ctr mode payload encryption and decryption
|
||||
void aes_ctr_bytewise_payload_crypt (uint8_t * iv, uint8_t * key, uint8_t * payload, int type)
|
||||
{
|
||||
|
||||
//Set values specific to type (128/192/256)
|
||||
if (type == 0) //128
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 4;
|
||||
Nr = 10;
|
||||
}
|
||||
else if (type == 1) //192
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 6;
|
||||
Nr = 12;
|
||||
}
|
||||
else //if (type == 2) //256
|
||||
{
|
||||
Nb = 4;
|
||||
Nk = 8;
|
||||
Nr = 14;
|
||||
}
|
||||
|
||||
struct AES_ctx ctx;
|
||||
|
||||
//init and set the iv and key variables
|
||||
memset (ctx.RoundKey, 0, 240*sizeof(uint8_t));
|
||||
memset (ctx.Iv, 0, 16*sizeof(uint8_t));
|
||||
|
||||
KeyExpansion(ctx.RoundKey, key);
|
||||
memcpy (ctx.Iv, iv, AES_BLOCKLEN);
|
||||
|
||||
//pass to internal CTR handler for payload
|
||||
AES_CTR_xcrypt_buffer(&ctx, payload, 16);
|
||||
|
||||
}
|
||||
|
||||
832
src/crypt-des.c
832
src/crypt-des.c
@@ -1,832 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* des.c Crypthings
|
||||
* DES Alg
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include <string.h>
|
||||
#include <stdint.h>
|
||||
#include <stddef.h>
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <stdio.h>
|
||||
#include "dsd.h"
|
||||
|
||||
//NOTE: The SLUT boxes are S boxes with additional calculations so we don't have
|
||||
//to manually sort out row and column values and can cut down on operations
|
||||
|
||||
uint8_t SLUT1[64] = {
|
||||
0xE0,0x00,0x40,0xF0,0xD0,0x70,0x10,0x40,
|
||||
0x20,0xE0,0xF0,0x20,0xB0,0xD0,0x80,0x10,
|
||||
0x30,0xA0,0xA0,0x60,0x60,0xC0,0xC0,0xB0,
|
||||
0x50,0x90,0x90,0x50,0x00,0x30,0x70,0x80,
|
||||
0x40,0xF0,0x10,0xC0,0xE0,0x80,0x80,0x20,
|
||||
0xD0,0x40,0x60,0x90,0x20,0x10,0xB0,0x70,
|
||||
0xF0,0x50,0xC0,0xB0,0x90,0x30,0x70,0xE0,
|
||||
0x30,0xA0,0xA0,0x00,0x50,0x60,0x00,0xD0
|
||||
};
|
||||
|
||||
uint8_t SLUT2[64] = {
|
||||
0x0F,0x03,0x01,0x0D,0x08,0x04,0x0E,0x07,
|
||||
0x06,0x0F,0x0B,0x02,0x03,0x08,0x04,0x0E,
|
||||
0x09,0x0C,0x07,0x00,0x02,0x01,0x0D,0x0A,
|
||||
0x0C,0x06,0x00,0x09,0x05,0x0B,0x0A,0x05,
|
||||
0x00,0x0D,0x0E,0x08,0x07,0x0A,0x0B,0x01,
|
||||
0x0A,0x03,0x04,0x0F,0x0D,0x04,0x01,0x02,
|
||||
0x05,0x0B,0x08,0x06,0x0C,0x07,0x06,0x0C,
|
||||
0x09,0x00,0x03,0x05,0x02,0x0E,0x0F,0x09
|
||||
};
|
||||
|
||||
uint8_t SLUT3[64] = {
|
||||
0xA0,0xD0,0x00,0x70,0x90,0x00,0xE0,0x90,
|
||||
0x60,0x30,0x30,0x40,0xF0,0x60,0x50,0xA0,
|
||||
0x10,0x20,0xD0,0x80,0xC0,0x50,0x70,0xE0,
|
||||
0xB0,0xC0,0x40,0xB0,0x20,0xF0,0x80,0x10,
|
||||
0xD0,0x10,0x60,0xA0,0x40,0xD0,0x90,0x00,
|
||||
0x80,0x60,0xF0,0x90,0x30,0x80,0x00,0x70,
|
||||
0xB0,0x40,0x10,0xF0,0x20,0xE0,0xC0,0x30,
|
||||
0x50,0xB0,0xA0,0x50,0xE0,0x20,0x70,0xC0
|
||||
};
|
||||
|
||||
uint8_t SLUT4[64] = {
|
||||
0x07,0x0D,0x0D,0x08,0x0E,0x0B,0x03,0x05,
|
||||
0x00,0x06,0x06,0x0F,0x09,0x00,0x0A,0x03,
|
||||
0x01,0x04,0x02,0x07,0x08,0x02,0x05,0x0C,
|
||||
0x0B,0x01,0x0C,0x0A,0x04,0x0E,0x0F,0x09,
|
||||
0x0A,0x03,0x06,0x0F,0x09,0x00,0x00,0x06,
|
||||
0x0C,0x0A,0x0B,0x01,0x07,0x0D,0x0D,0x08,
|
||||
0x0F,0x09,0x01,0x04,0x03,0x05,0x0E,0x0B,
|
||||
0x05,0x0C,0x02,0x07,0x08,0x02,0x04,0x0E
|
||||
};
|
||||
|
||||
uint8_t SLUT5[64] = {
|
||||
0x20,0xE0,0xC0,0xB0,0x40,0x20,0x10,0xC0,
|
||||
0x70,0x40,0xA0,0x70,0xB0,0xD0,0x60,0x10,
|
||||
0x80,0x50,0x50,0x00,0x30,0xF0,0xF0,0xA0,
|
||||
0xD0,0x30,0x00,0x90,0xE0,0x80,0x90,0x60,
|
||||
0x40,0xB0,0x20,0x80,0x10,0xC0,0xB0,0x70,
|
||||
0xA0,0x10,0xD0,0xE0,0x70,0x20,0x80,0xD0,
|
||||
0xF0,0x60,0x90,0xF0,0xC0,0x00,0x50,0x90,
|
||||
0x60,0xA0,0x30,0x40,0x00,0x50,0xE0,0x30
|
||||
};
|
||||
|
||||
uint8_t SLUT6[64] = {
|
||||
0x0C,0x0A,0x01,0x0F,0x0A,0x04,0x0F,0x02,
|
||||
0x09,0x07,0x02,0x0C,0x06,0x09,0x08,0x05,
|
||||
0x00,0x06,0x0D,0x01,0x03,0x0D,0x04,0x0E,
|
||||
0x0E,0x00,0x07,0x0B,0x05,0x03,0x0B,0x08,
|
||||
0x09,0x04,0x0E,0x03,0x0F,0x02,0x05,0x0C,
|
||||
0x02,0x09,0x08,0x05,0x0C,0x0F,0x03,0x0A,
|
||||
0x07,0x0B,0x00,0x0E,0x04,0x01,0x0A,0x07,
|
||||
0x01,0x06,0x0D,0x00,0x0B,0x08,0x06,0x0D
|
||||
};
|
||||
|
||||
uint8_t SLUT7[64] = {
|
||||
0x40,0xD0,0xB0,0x00,0x20,0xB0,0xE0,0x70,
|
||||
0xF0,0x40,0x00,0x90,0x80,0x10,0xD0,0xA0,
|
||||
0x30,0xE0,0xC0,0x30,0x90,0x50,0x70,0xC0,
|
||||
0x50,0x20,0xA0,0xF0,0x60,0x80,0x10,0x60,
|
||||
0x10,0x60,0x40,0xB0,0xB0,0xD0,0xD0,0x80,
|
||||
0xC0,0x10,0x30,0x40,0x70,0xA0,0xE0,0x70,
|
||||
0xA0,0x90,0xF0,0x50,0x60,0x00,0x80,0xF0,
|
||||
0x00,0xE0,0x50,0x20,0x90,0x30,0x20,0xC0
|
||||
};
|
||||
|
||||
uint8_t SLUT8[64] = {
|
||||
0x0D,0x01,0x02,0x0F,0x08,0x0D,0x04,0x08,
|
||||
0x06,0x0A,0x0F,0x03,0x0B,0x07,0x01,0x04,
|
||||
0x0A,0x0C,0x09,0x05,0x03,0x06,0x0E,0x0B,
|
||||
0x05,0x00,0x00,0x0E,0x0C,0x09,0x07,0x02,
|
||||
0x07,0x02,0x0B,0x01,0x04,0x0E,0x01,0x07,
|
||||
0x09,0x04,0x0C,0x0A,0x0E,0x08,0x02,0x0D,
|
||||
0x00,0x0F,0x06,0x0C,0x0A,0x09,0x0D,0x00,
|
||||
0x0F,0x03,0x03,0x05,0x05,0x06,0x08,0x0B
|
||||
};
|
||||
|
||||
//initial permutation IP (on input)
|
||||
uint8_t initial_register_permutation[64] = {
|
||||
58, 50, 42, 34, 26, 18, 10, 2,
|
||||
60, 52, 44, 36, 28, 20, 12, 4,
|
||||
62, 54, 46, 38, 30, 22, 14, 6,
|
||||
64, 56, 48, 40, 32, 24, 16, 8,
|
||||
57, 49, 41, 33, 25, 17, 9, 1,
|
||||
59, 51, 43, 35, 27, 19, 11, 3,
|
||||
61, 53, 45, 37, 29, 21, 13, 5,
|
||||
63, 55, 47, 39, 31, 23, 15, 7};
|
||||
|
||||
//D-Box Expansion (sometimes noted as E BIT-SELECTION TABLE)
|
||||
uint8_t message_expansion[48] = {
|
||||
32, 1, 2, 3, 4, 5,
|
||||
4, 5, 6, 7, 8, 9,
|
||||
8, 9, 10, 11, 12, 13,
|
||||
12, 13, 14, 15, 16, 17,
|
||||
16, 17, 18, 19, 20, 21,
|
||||
20, 21, 22, 23, 24, 25,
|
||||
24, 25, 26, 27, 28, 29,
|
||||
28, 29, 30, 31, 32, 1};
|
||||
|
||||
// (sometimes noted as simply 'P')
|
||||
uint8_t right_half_permutation[32] = {
|
||||
16, 7, 20, 21,
|
||||
29, 12, 28, 17,
|
||||
1, 15, 23, 26,
|
||||
5, 18, 31, 10,
|
||||
2, 8, 24, 14,
|
||||
32, 27, 3, 9,
|
||||
19, 13, 30, 6,
|
||||
22, 11, 4, 25};
|
||||
|
||||
//inverse initial PI, a.k.a. final permutation (on output)
|
||||
uint8_t final_register_permutation[64] = {
|
||||
40, 8, 48, 16, 56, 24, 64, 32,
|
||||
39, 7, 47, 15, 55, 23, 63, 31,
|
||||
38, 6, 46, 14, 54, 22, 62, 30,
|
||||
37, 5, 45, 13, 53, 21, 61, 29,
|
||||
36, 4, 44, 12, 52, 20, 60, 28,
|
||||
35, 3, 43, 11, 51, 19, 59, 27,
|
||||
34, 2, 42, 10, 50, 18, 58, 26,
|
||||
33, 1, 41, 9, 49, 17, 57, 25};
|
||||
|
||||
//initial key permutation
|
||||
uint8_t pc1_key_permutation[56] = {
|
||||
57, 49, 41, 33, 25, 17, 9,
|
||||
1, 58, 50, 42, 34, 26, 18,
|
||||
10, 2, 59, 51, 43, 35, 27,
|
||||
19, 11, 3, 60, 52, 44, 36,
|
||||
63, 55, 47, 39, 31, 23, 15,
|
||||
7, 62, 54, 46, 38, 30, 22,
|
||||
14, 6, 61, 53, 45, 37, 29,
|
||||
21, 13, 5, 28, 20, 12, 4};
|
||||
|
||||
//sub c and d key permutation
|
||||
uint8_t pc2_key_permutation[48] = {
|
||||
//c bits
|
||||
14,17,11,24,1,5,
|
||||
3,28,15,6,21,10,
|
||||
23,19,12,4,26,8,
|
||||
16,7,27,20,13,2,
|
||||
//d bits (with -28 offset to simply/only have one permute function)
|
||||
13,24,3,9,19,27,
|
||||
2,12,23,17,5,20,
|
||||
16,21,11,28,6,25,
|
||||
18,14,22,8,1,4
|
||||
};
|
||||
|
||||
uint8_t key_shift_sizes[17] = {
|
||||
1,
|
||||
1, 1, 2, 2,
|
||||
2, 2, 2, 2,
|
||||
1, 2, 2, 2,
|
||||
2, 2, 2, 1};
|
||||
|
||||
uint8_t key_shift_bytes[17] = {
|
||||
0x80,
|
||||
0x80, 0x80, 0xC0, 0xC0,
|
||||
0xC0, 0xC0, 0xC0, 0xC0,
|
||||
0x80, 0xC0, 0xC0, 0xC0,
|
||||
0xC0, 0xC0, 0xC0, 0x80};
|
||||
|
||||
uint8_t key_shift_x[4] = {8,8,8,4};
|
||||
|
||||
uint8_t key_shift_y[4] = {1,2,3,0};
|
||||
|
||||
//input is byte-wise array, output is byte-wise array
|
||||
void permute(uint8_t * input, uint8_t * output, uint8_t * table, uint8_t start, uint8_t end)
|
||||
{
|
||||
|
||||
for (uint8_t i = start; i < end; i++)
|
||||
{
|
||||
uint8_t tdiv = (table[i] - 1) / 8;
|
||||
uint8_t tmod = (table[i] - 1) % 8;
|
||||
uint8_t idiv = i/8;
|
||||
uint8_t imod = i%8;
|
||||
|
||||
//need a way to simplify or get rid of all these shifts
|
||||
uint8_t bit = (((input[tdiv] & (0x80 >> tmod)) << tmod) >> imod);
|
||||
output[idiv] |= bit;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void rotate_sub_keys(uint8_t * Kc, uint8_t * Kd, uint8_t shift_size, uint8_t shift_byte)
|
||||
{
|
||||
|
||||
uint8_t sb1[4]; memset(sb1, 0, sizeof(sb1));
|
||||
uint8_t sb2[4]; memset(sb2, 0, sizeof(sb2));
|
||||
|
||||
for (uint8_t i = 0; i < 4; i++)
|
||||
{
|
||||
sb1[i] = shift_byte & Kc[i];
|
||||
sb2[i] = shift_byte & Kd[i];
|
||||
}
|
||||
|
||||
for (uint8_t i = 0; i < 4; i++)
|
||||
{
|
||||
|
||||
uint8_t x = key_shift_x[i];
|
||||
uint8_t y = key_shift_y[i];
|
||||
|
||||
Kc[i] <<= shift_size;
|
||||
Kd[i] <<= shift_size;
|
||||
|
||||
Kc[i] |= (sb1[y] >> (x - shift_size));
|
||||
Kd[i] |= (sb2[y] >> (x - shift_size));
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
void des_cipher (uint8_t * main_key, uint8_t * input_register, uint8_t * output_register, uint8_t de)
|
||||
{
|
||||
|
||||
//starting and ending permutations
|
||||
uint8_t initial_permutation[8]; memset(initial_permutation, 0, sizeof(initial_permutation));
|
||||
uint8_t pre_end_permutation[8]; memset(pre_end_permutation, 0, sizeof(pre_end_permutation));
|
||||
|
||||
//intermediate left, right, and expansion/selection arrays
|
||||
uint8_t left[4]; memset(left, 0, sizeof(left));
|
||||
uint8_t right[4]; memset(right, 0, sizeof(right));
|
||||
uint8_t rperm[4]; memset(rperm, 0, sizeof(rperm));
|
||||
uint8_t exp[6]; memset(exp, 0, sizeof(exp));
|
||||
uint8_t sel[4]; memset(sel, 0, sizeof(sel));
|
||||
|
||||
//key sets
|
||||
uint8_t Ks[16][7]; memset(Ks, 0, sizeof(Ks));
|
||||
uint8_t Kc[4]; memset(Kc, 0, sizeof(Kc));
|
||||
uint8_t Kd[4]; memset(Kd, 0, sizeof(Kd));
|
||||
|
||||
//initial Ks permutation and shuffle to Kc and Kd
|
||||
permute (main_key, Ks[0], pc1_key_permutation, 0, 56);
|
||||
for (uint8_t i = 0; i < 3; i++)
|
||||
{
|
||||
Kc[i] = Ks[0][i];
|
||||
}
|
||||
Kc[3] = Ks[0][3] & 0xF0;
|
||||
for (uint8_t i = 0; i < 3; i++)
|
||||
{
|
||||
Kd[i] = (Ks[0][i+3] & 0x0F) << 4;
|
||||
Kd[i] |= (Ks[0][i+4] & 0xF0) >> 4;
|
||||
}
|
||||
Kd[3] = (Ks[0][6] & 0x0F) << 4;
|
||||
|
||||
//reset Ks
|
||||
memset(Ks, 0, sizeof(Ks));
|
||||
|
||||
//create the 16 Ks rounds
|
||||
for (uint8_t i = 0; i < 16; i++)
|
||||
{
|
||||
uint8_t shift_size = key_shift_sizes[i+1];
|
||||
uint8_t shift_byte = key_shift_bytes[i+1];
|
||||
rotate_sub_keys(Kc, Kd, shift_size, shift_byte);
|
||||
permute (Kc, Ks[i], pc2_key_permutation, 0, 24);
|
||||
permute (Kd, Ks[i], pc2_key_permutation, 24, 48);
|
||||
}
|
||||
|
||||
//permute the input_register with the ip (initial_register_permutation) table
|
||||
permute (input_register, initial_permutation, initial_register_permutation, 0, 64);
|
||||
|
||||
//copy the initial permutation to left and right half arrays
|
||||
memcpy (left, initial_permutation+0, sizeof(left));
|
||||
memcpy (right, initial_permutation+4, sizeof(right));
|
||||
|
||||
//16 fiestel rounds
|
||||
for (uint8_t f = 0; f < 16; f++)
|
||||
{
|
||||
|
||||
//reset rperm and exp arrays
|
||||
memset(rperm, 0, sizeof(rperm));
|
||||
memset(exp, 0, sizeof(exp));
|
||||
|
||||
//expand right half from 32-bit to 48-bit
|
||||
permute (right, exp, message_expansion, 0, 48);
|
||||
|
||||
//apply current iteration keyset to the expanded array (encryption cycles Ks forward, decryption goes in reverse)
|
||||
if (de == 1)
|
||||
{
|
||||
for (uint8_t i = 0; i < 6; i++)
|
||||
exp[i] ^= Ks[f][i];
|
||||
}
|
||||
else
|
||||
{
|
||||
for (uint8_t i = 0; i < 6; i++)
|
||||
exp[i] ^= Ks[15-f][i];
|
||||
}
|
||||
|
||||
//extract 6 bits for each sbox swap from the expanded array
|
||||
uint8_t e1 = exp[0] >> 2;
|
||||
uint8_t e2 = ((exp[0] & 0x3) << 4) | (exp[1] >> 4);
|
||||
uint8_t e3 = ((exp[1] & 0xF) << 2) | (exp[2] >> 6);
|
||||
uint8_t e4 = exp[2] & 0x3F;
|
||||
|
||||
uint8_t e5 = exp[3] >> 2;
|
||||
uint8_t e6 = ((exp[3] & 0x3) << 4) | (exp[4] >> 4);
|
||||
uint8_t e7 = ((exp[4] & 0xF) << 2) | (exp[5] >> 6);
|
||||
uint8_t e8 = exp[5] & 0x3F;
|
||||
|
||||
//select 32-bits of each 48-bit expansion via modified S Box Look Up Tables
|
||||
//swap the 6 bits for 4 bits via SLUT tables and OR them together into a selection array
|
||||
sel[0] = SLUT1[e1] | SLUT2[e2];
|
||||
sel[1] = SLUT3[e3] | SLUT4[e4];
|
||||
sel[2] = SLUT5[e5] | SLUT6[e6];
|
||||
sel[3] = SLUT7[e7] | SLUT8[e8];
|
||||
|
||||
//permute the selected 32-bits into a new right half
|
||||
permute (sel, rperm, right_half_permutation, 0, 32);
|
||||
|
||||
//xor new right half against left half
|
||||
for (uint8_t i = 0; i < 4; i++)
|
||||
rperm[i] ^= left[i];
|
||||
|
||||
//swap old right half to left, set new right half to rperm
|
||||
memcpy (left, right, sizeof(left));
|
||||
memcpy (right, rperm, sizeof(right));
|
||||
|
||||
} //end fiestel rounds f
|
||||
|
||||
//combine right and left into the pre_end_permutation array
|
||||
memcpy (pre_end_permutation+0, right, sizeof(right));
|
||||
memcpy (pre_end_permutation+4, left, sizeof(left));
|
||||
|
||||
//carry out the final permuation to get the completed output_register for this cipher iteration
|
||||
permute (pre_end_permutation, output_register, final_register_permutation, 0, 64);
|
||||
|
||||
}
|
||||
|
||||
void des56_ofb_keystream_output (uint8_t * main_key, uint8_t * iv, uint8_t * ks_bytes, uint8_t de, int16_t nblocks)
|
||||
{
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//copy the IV to the input_register (make copy so we don't manipulate the calling functions copy)
|
||||
memcpy(input_register, iv, sizeof(input_register));
|
||||
|
||||
//execute the des_cipher in output feedback mode
|
||||
for (int16_t i = 0; i < nblocks; i++)
|
||||
{
|
||||
//de should be 1 here for encryption mode
|
||||
des_cipher(main_key, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input register
|
||||
memcpy(ks_bytes+(i*8), output_register, sizeof(output_register)); //copy output_register to ks_bytes + iteration offset of times 8
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//the des_cipher function is already ECB mode, this convenience wrapper is just available as a reminder to illustrate that point
|
||||
void des56_ecb_payload_crypt (uint8_t * main_key, uint8_t * input_register, uint8_t * output_register, uint8_t de)
|
||||
{
|
||||
//de 1 for encryption mode, 0 for decryption mode
|
||||
des_cipher(main_key, input_register, output_register, de);
|
||||
}
|
||||
|
||||
//TDEA, or triple data encryption algorithm, or triple DES, in electronic codebook mode
|
||||
void tdea_ecb_payload_crypt (uint8_t * K1, uint8_t * K2, uint8_t * K3, uint8_t * input, uint8_t * output, uint8_t de)
|
||||
{
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//copy the input to the input_register (make copy so we don't manipulate the calling functions copy)
|
||||
memcpy(input_register, input, sizeof(input_register));
|
||||
|
||||
//For TDEA, the cipher alternates between encryption and decryption to the payload
|
||||
//so, for example, K1 is run as de=1, K2 is run as de=0, and K3 is run as de=1,
|
||||
//K1 and K3 will always use the same mode and K2 will be the opposite
|
||||
|
||||
//NOTE: If running ECB mode in decryption, make sure to send the keys in reverse order
|
||||
//so that its K3, K2, and K1 for decryption, and K1, K2, K3 for encryption
|
||||
|
||||
//K1
|
||||
des_cipher(K1, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K2
|
||||
de = (de ^ 1) & 1; //flip the de bit
|
||||
des_cipher(K2, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K3
|
||||
de = (de ^ 1) & 1; //flip the de bit back
|
||||
des_cipher(K3, input_register, output_register, de);
|
||||
|
||||
//copy payload out
|
||||
memcpy(output, output_register, sizeof(output_register)); //copy output_register to output
|
||||
|
||||
}
|
||||
|
||||
//TDEA, or triple data encryption algorithm, or triple DES, in cipher block chain mode (64-bit)
|
||||
//same as usual inputs (byte wise), also, if needing DES56, just feed the same key into K1, K2, and K3
|
||||
//if running in decryption mode, this will reverse the key bundle order from (K1, K2, K3) to (K3, K2, K1) on this end
|
||||
void tdea_cbc_payload_crypt (uint8_t * K1, uint8_t * K2, uint8_t * K3, uint8_t * iv, uint8_t * in, uint8_t * out, int16_t nblocks, uint8_t de)
|
||||
{
|
||||
|
||||
int16_t i, j;
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//load first round of input_register accordingly
|
||||
if (de)
|
||||
memcpy (input_register, iv, sizeof(input_register)); //load the IV as first input_register if encrypting
|
||||
else memcpy (input_register, in, sizeof(input_register)); //load first cipher text as input_register is decrypting
|
||||
|
||||
//run payload for number of payload nblocks required
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
|
||||
if (de)
|
||||
{
|
||||
|
||||
//xor the current input 'in' pt to the current state of the input_register for cbc feedback
|
||||
for (j = 0; j < 8; j++)
|
||||
input_register[j] ^= in[j+(i*8)];
|
||||
|
||||
//K1
|
||||
des_cipher(K1, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K2
|
||||
de = (de ^ 1) & 1; //flip the de bit
|
||||
des_cipher(K2, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K3
|
||||
de = (de ^ 1) & 1; //flip the de bit back
|
||||
des_cipher(K3, input_register, output_register, de);
|
||||
memcpy (input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
|
||||
//copy ciphered output_register to output 'out'
|
||||
memcpy (out+(i*8), output_register, sizeof(output_register));
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
}
|
||||
else
|
||||
{
|
||||
|
||||
//K3
|
||||
des_cipher(K3, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K2
|
||||
de = (de ^ 1) & 1; //flip the de bit
|
||||
des_cipher(K2, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K1
|
||||
de = (de ^ 1) & 1; //flip the de bit back
|
||||
des_cipher(K1, input_register, output_register, de);
|
||||
memcpy (input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
|
||||
//copy ciphered input_register to output 'out'
|
||||
memcpy (out+(i*8), output_register, sizeof(output_register));
|
||||
|
||||
//xor the current output by IV, or by last received CT, depending on round
|
||||
if (i == 0)
|
||||
{
|
||||
for (j = 0; j < 8; j++)
|
||||
out[j] ^= iv[j];
|
||||
}
|
||||
else
|
||||
{
|
||||
for (j = 0; j < 8; j++)
|
||||
out[j+(i*8)] ^= in[j+((i-1)*8)];
|
||||
}
|
||||
|
||||
//copy in next segment for input_register (if not last)
|
||||
if (i < nblocks)
|
||||
memcpy(input_register, in+((i+1)*8), sizeof(input_register));
|
||||
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//TDEA, or triple data encryption algorithm, or triple DES, in cipher block chain mode (64-bit)
|
||||
//same as usual inputs (byte wise), also, if needing DES56, just feed the same key into K1, K2, and K3
|
||||
//only the last output_register is returned for the variable len MAC bytes, always run in encryption mode
|
||||
//but if iv is desireable, it will need to be pre-XOR'd with the first plaintext input block by the calling function
|
||||
void tdea_cbc_mac_generator (uint8_t * K1, uint8_t * K2, uint8_t * K3, uint8_t * in, uint8_t * out, int16_t nblocks)
|
||||
{
|
||||
|
||||
int16_t i, j;
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//run payload for number of payload nblocks required
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
|
||||
//the cipher is always run in the foward, or encryption mode (1,0,1)
|
||||
|
||||
//xor the current input 'in' pt to the current state of the input_register for cbc feedback
|
||||
for (j = 0; j < 8; j++)
|
||||
input_register[j] ^= in[j+(i*8)];
|
||||
|
||||
//K1
|
||||
des_cipher(K1, input_register, output_register, 1);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K2
|
||||
des_cipher(K2, input_register, output_register, 0);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K3
|
||||
des_cipher(K3, input_register, output_register, 1);
|
||||
memcpy (input_register, output_register, sizeof(output_register));
|
||||
|
||||
//copy ciphered output_register to output 'out'
|
||||
//Since we only want the last output_register,
|
||||
//this will overwrite the out until completion
|
||||
memcpy (out, output_register, sizeof(output_register));
|
||||
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//TDEA, or triple data encryption algorithm, or triple DES, in cihper feedback mode (64-bit)
|
||||
//same as usual inputs (byte wise), also, if needing DES56, just feed the same key into K1, K2, and K3
|
||||
void tdea_cfb_payload_crypt (uint8_t * K1, uint8_t * K2, uint8_t * K3, uint8_t * iv, uint8_t * in, uint8_t * out, int16_t nblocks, uint8_t de)
|
||||
{
|
||||
|
||||
int16_t i, j;
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//copy the IV to the input_register (make copy so we don't manipulate the calling functions copy)
|
||||
memcpy(input_register, iv, sizeof(input_register));
|
||||
|
||||
//execute the des_cipher in output feedback mode 3 times using each key and transferring output to input each time
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
|
||||
//the cipher is always run in the foward, or encryption mode (1,0,1)
|
||||
|
||||
//K1
|
||||
des_cipher(K1, input_register, output_register, 1);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K2
|
||||
des_cipher(K2, input_register, output_register, 0);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K3
|
||||
des_cipher(K3, input_register, output_register, 1);
|
||||
|
||||
//xor the current input 'in' to the current state of the input_register for cipher feedback
|
||||
for (j = 0; j < 8; j++)
|
||||
output_register[j] ^= in[j+(i*8)];
|
||||
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
|
||||
//copy keystream out and reset
|
||||
memcpy(out+(i*8), output_register, sizeof(output_register)); //copy output_register to ks_bytes + iteration offset of times 8
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//if running in decryption mode, we feed in the next round of input
|
||||
if (!de)
|
||||
memcpy(input_register, in+(i*8), sizeof(input_register));
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//TDEA, or triple data encryption algorithm, or triple DES, in IV counter mode (tested, working)
|
||||
void tdea_ctr_payload_crypt (uint8_t * K1, uint8_t * K2, uint8_t * K3, uint8_t * iv, uint8_t * input, uint8_t * output, int16_t nblocks)
|
||||
{
|
||||
|
||||
int16_t i, j;
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//copy the IV to the input_register (ctr mode will manipulate the IV, since it needs to keep a rolling counter
|
||||
memcpy(input_register, iv, sizeof(input_register));
|
||||
|
||||
//execute the des_cipher in counter mode 3 times using each key and transferring output to input each time
|
||||
//then the IV is iterated and fed back into the input_register to start the next nblocks loop
|
||||
for (i = 0; i < nblocks; i++)
|
||||
{
|
||||
|
||||
//CTR mode cipher should always run in the forward (encryption) mode
|
||||
|
||||
//K1
|
||||
des_cipher(K1, input_register, output_register, 1);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K2
|
||||
des_cipher(K2, input_register, output_register, 0);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K3
|
||||
des_cipher(K3, input_register, output_register, 1);
|
||||
|
||||
//set output at current pointer to the xor of input current pointer and the output_register
|
||||
for (j = 0; j < 8; j++)
|
||||
output[j+(i*8)] = input[j+(i*8)] ^ output_register[j];
|
||||
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//increment the IV, and handle roll over (uint8_t will rollover to 0 after 0xFF)
|
||||
for (j = 7; j >= 0; j--)
|
||||
{
|
||||
iv[j]++;
|
||||
if (iv[j] == 0)
|
||||
continue;
|
||||
else break;
|
||||
}
|
||||
|
||||
//debug IV iteration
|
||||
// fprintf (stderr, "\n IV: ");
|
||||
// for (j = 0; j < 8; j++)
|
||||
// fprintf (stderr, "%02X", iv[j]);
|
||||
|
||||
//feed the new IV into the input register
|
||||
memcpy (input_register, iv, sizeof(input_register));
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//TDEA, or triple data encryption algorithm, or triple DES, in output feedback mode
|
||||
void tdea_tofb_keystream_output (uint8_t * K1, uint8_t * K2, uint8_t * K3, uint8_t * iv, uint8_t * ks_bytes, uint8_t de, int16_t nblocks)
|
||||
{
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//copy the IV to the input_register (make copy so we don't manipulate the calling functions copy)
|
||||
memcpy(input_register, iv, sizeof(input_register));
|
||||
|
||||
//execute the des_cipher in output feedback mode 3 times using each key and transferring output to input each time
|
||||
for (int16_t i = 0; i < nblocks; i++)
|
||||
{
|
||||
//K1
|
||||
des_cipher(K1, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K2
|
||||
de = (de ^ 1) & 1; //flip the de bit
|
||||
des_cipher(K2, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
|
||||
//K3
|
||||
de = (de ^ 1) & 1; //flip the de bit back
|
||||
des_cipher(K3, input_register, output_register, de);
|
||||
memcpy(input_register, output_register, sizeof(output_register)); //recycle output_register back into input_register
|
||||
|
||||
//copy keystream out and reset
|
||||
memcpy(ks_bytes+(i*8), output_register, sizeof(output_register)); //copy output_register to ks_bytes + iteration offset of times 8
|
||||
memset(output_register, 0, sizeof(output_register)); //reset output register
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//a linear feedback shift register with maximal taps on 64-bit values that can be run to any specified len,
|
||||
//its input is a byte array of up to 8 bytes, and its output is same array packed with new LFSR value in it.
|
||||
uint64_t lfsr_64_to_len_ca(uint8_t * iv, int16_t len)
|
||||
{
|
||||
|
||||
uint64_t lfsr = 0, bit = 0;
|
||||
|
||||
lfsr = ((uint64_t)iv[0] << 56ULL) + ((uint64_t)iv[1] << 48ULL) + ((uint64_t)iv[2] << 40ULL) + ((uint64_t)iv[3] << 32ULL) +
|
||||
((uint64_t)iv[4] << 24ULL) + ((uint64_t)iv[5] << 16ULL) + ((uint64_t)iv[6] << 8ULL) + ((uint64_t)iv[7] << 0ULL);
|
||||
|
||||
memset (iv, 0, 8*sizeof(uint8_t));
|
||||
|
||||
for(int16_t cnt = 0; cnt < len; cnt++)
|
||||
{
|
||||
//63,61,45,37,27,14
|
||||
// Polynomial is C(x) = x^64 + x^62 + x^46 + x^38 + x^27 + x^15 + 1
|
||||
bit = ((lfsr >> 63) ^ (lfsr >> 61) ^ (lfsr >> 45) ^ (lfsr >> 37) ^ (lfsr >> 26) ^ (lfsr >> 14)) & 0x1;
|
||||
lfsr = (lfsr << 1) | bit;
|
||||
}
|
||||
|
||||
for (int16_t i = 0; i < 8; i++)
|
||||
iv[i] = (lfsr >> (56-(i*8))) & 0xFF;
|
||||
|
||||
// fprintf (stderr, "\n IV(%02d): ", len);
|
||||
// for (int16_t i = 0; i < 8; i++)
|
||||
// fprintf (stderr, "%02X", iv[i]);
|
||||
|
||||
return bit;
|
||||
|
||||
}
|
||||
|
||||
void des56_ca_keystream_output (uint8_t * main_key, uint8_t * iv, uint8_t * ks_bytes, uint8_t de, int16_t ff, int16_t nbits)
|
||||
{
|
||||
|
||||
//cipher input and output
|
||||
uint8_t input_register[8]; memset(input_register, 0, sizeof(input_register));
|
||||
uint8_t output_register[8]; memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
//copy the IV to the input_register (make copy so we don't manipulate the calling functions copy)
|
||||
memcpy(input_register, iv, sizeof(input_register));
|
||||
|
||||
//fast forward the current input_register state
|
||||
lfsr_64_to_len_ca(input_register, ff);
|
||||
|
||||
//execute the des_cipher in (CA) mode with 1-bit output
|
||||
for (int16_t i = 0; i < nbits; i++)
|
||||
{
|
||||
|
||||
//de should be 1 here for encryption mode
|
||||
des_cipher(main_key, input_register, output_register, de);
|
||||
|
||||
//keystream accumulation, shift current byte and append
|
||||
//single bit from current output register's most significant bit
|
||||
ks_bytes[i/8] <<= 1;
|
||||
ks_bytes[i/8] |= ((output_register[0] >> 7) & 1);
|
||||
|
||||
//advance the input_register with the lfsr 1 time
|
||||
lfsr_64_to_len_ca(input_register, 1);
|
||||
|
||||
//reset output register
|
||||
memset(output_register, 0, sizeof(output_register));
|
||||
|
||||
}
|
||||
|
||||
// fprintf (stderr, "\n IR: ");
|
||||
// for (int16_t i = 0; i < 8; i++)
|
||||
// fprintf (stderr, "%02X", input_register[i]);
|
||||
|
||||
}
|
||||
|
||||
//transitional function mainly to load key and iv into an array
|
||||
void des_multi_keystream_output (unsigned long long int mi, unsigned long long int key_ulli, uint8_t * output, int type, int len)
|
||||
{
|
||||
int i = 0;
|
||||
uint8_t iv[8]; memset (iv, 0, sizeof(iv));
|
||||
uint8_t key[8]; memset(key, 0, sizeof(key));
|
||||
|
||||
//convert unsinged long long int values into array values
|
||||
for (i = 7; i >= 0; i--)
|
||||
iv[7-i] = (mi >> (8*i)) & 0xFF;
|
||||
|
||||
for (i = 7; i >= 0; i--)
|
||||
key[7-i] = (key_ulli >> (8*i)) & 0xFF;
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "\n IV: ");
|
||||
// for (i = 0; i < 8; i++)
|
||||
// fprintf (stderr, "%02X", iv[i]);
|
||||
// fprintf (stderr, "\n Key: ");
|
||||
// for (i = 0; i < 8; i++)
|
||||
// fprintf (stderr, "%02X", key[i]);
|
||||
|
||||
//types: 1 = DES56 OFB; 2 = DES56 CA (XL)
|
||||
if (type == 2)
|
||||
{
|
||||
if (len == 0)
|
||||
des56_ca_keystream_output(key, iv, output, 1, 110+696, 1704);
|
||||
else des56_ca_keystream_output(key, iv, output, 1, 110+000, 1704);
|
||||
}
|
||||
else des56_ofb_keystream_output(key, iv, output, 1, len);
|
||||
|
||||
}
|
||||
|
||||
//transitional function mainly to load iv into an array
|
||||
void tdea_multi_keystream_output (unsigned long long int mi, uint8_t * key, uint8_t * output, int type, int len)
|
||||
{
|
||||
int i = 0;
|
||||
uint8_t iv[8]; memset (iv, 0, sizeof(iv));
|
||||
|
||||
//convert unsinged long long int values into array values
|
||||
for (i = 7; i >= 0; i--)
|
||||
iv[7-i] = (mi >> (8*i)) & 0xFF;
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "\n IV: ");
|
||||
// for (i = 0; i < 8; i++)
|
||||
// fprintf (stderr, "%02X", iv[i]);
|
||||
|
||||
//type 1 = TDEA TOFB //TODO: Add more types like 2DES?
|
||||
if (type == 1)
|
||||
tdea_tofb_keystream_output(key, key+8, key+16, iv, output, 1, len);
|
||||
else tdea_tofb_keystream_output(key, key+8, key+16, iv, output, 1, len);
|
||||
|
||||
}
|
||||
126
src/crypt-etc.c
126
src/crypt-etc.c
@@ -1,126 +0,0 @@
|
||||
#include "dsd.h"
|
||||
|
||||
void ken_dmr_scrambler_keystream_creation(dsd_state * state, char * input)
|
||||
{
|
||||
/*
|
||||
SLOT 1 Protected LC FLCO=0x00 FID=0x20 <--this link appears to indicate scrambler usage from Kenwood on DMR
|
||||
DMR PDU Payload [80][20][40][00][00][01][00][00][01] SB: 00000000000 - 000;
|
||||
|
||||
SLOT 1 TGT=1 SRC=1 FLCO=0x00 FID=0x00 SVC=0x00 Group Call <--different call, no scrambler from same Kenwood Radio
|
||||
DMR PDU Payload [00][00][00][00][00][01][00][00][01]
|
||||
|
||||
For This, we could possible transition this to not be enforced
|
||||
since we may have a positive indicator in link control,
|
||||
but needs further samples and validation
|
||||
*/
|
||||
|
||||
int lfsr = 0, bit = 0;
|
||||
sscanf (input, "%d", &lfsr);
|
||||
fprintf (stderr,"DMR Kenwood 15-bit Scrambler Key %05d with Forced Application\n", lfsr);
|
||||
|
||||
for (int i = 0; i < 882; i++)
|
||||
{
|
||||
state->static_ks_bits[0][i] = lfsr & 0x1;
|
||||
state->static_ks_bits[1][i] = lfsr & 0x1;
|
||||
bit = ( (lfsr >> 1) ^ (lfsr >> 0) ) & 1;
|
||||
lfsr = ( (lfsr >> 1 ) | (bit << 14) );
|
||||
}
|
||||
|
||||
state->ken_sc = 1;
|
||||
|
||||
}
|
||||
|
||||
void anytone_bp_keystream_creation(dsd_state * state, char * input)
|
||||
{
|
||||
uint16_t key = 0;
|
||||
uint16_t kperm = 0;
|
||||
|
||||
sscanf (input, "%hX", &key);
|
||||
key &= 0xFFFF; //truncate to 16-bits
|
||||
|
||||
//calculate key permutation using simple operations
|
||||
uint8_t nib1, nib2, nib3, nib4;
|
||||
|
||||
//nib 1 and 3 are simple inversions
|
||||
nib1 = ~(key >> 12) & 0xF;
|
||||
nib3 = ~(key >> 4) & 0xF;
|
||||
|
||||
//nib 2 and 4 are +8 and mod 16 (& 0xF)
|
||||
nib2 = (((key >> 8) & 0xF) + 8) % 16;
|
||||
nib4 = (((key >> 0) & 0xF) + 8) % 16;
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "{%01X, %01X, %01X, %01X}", nib1, nib2, nib3, nib4);
|
||||
|
||||
kperm = nib1;
|
||||
kperm <<= 4;
|
||||
kperm |= nib2;
|
||||
kperm <<= 4;
|
||||
kperm |= nib3;
|
||||
kperm <<= 4;
|
||||
kperm |= nib4;
|
||||
|
||||
//load bits into static keystream
|
||||
for (int i = 0; i < 16; i++)
|
||||
{
|
||||
state->static_ks_bits[0][i] = (kperm >> (15-i)) & 1;
|
||||
state->static_ks_bits[1][i] = (kperm >> (15-i)) & 1;
|
||||
}
|
||||
|
||||
fprintf (stderr,"DMR Anytone Basic 16-bit Key 0x%04X with Forced Application\n", key);
|
||||
state->any_bp = 1;
|
||||
|
||||
}
|
||||
|
||||
void straight_mod_xor_keystream_creation(dsd_state * state, char * input)
|
||||
{
|
||||
uint16_t len = 0;
|
||||
char * curr;
|
||||
curr = strtok(input, ":"); //should be len (mod) of key (decimal)
|
||||
if (curr != NULL)
|
||||
sscanf (curr, "%hd", &len);
|
||||
else goto END_KS;
|
||||
|
||||
//len sanity check, can't be greater than 882
|
||||
if (len > 882)
|
||||
len = 882;
|
||||
|
||||
curr = strtok(NULL, ":"); //should be key in hex
|
||||
if (curr != NULL)
|
||||
{
|
||||
//continue
|
||||
}
|
||||
else goto END_KS;
|
||||
|
||||
uint8_t ks_bytes[112];
|
||||
memset (ks_bytes, 0, sizeof(ks_bytes));
|
||||
parse_raw_user_string(curr, ks_bytes);
|
||||
|
||||
uint8_t ks_bits[896];
|
||||
memset(ks_bits, 0, sizeof(ks_bits));
|
||||
|
||||
uint16_t unpack_len = len / 8;
|
||||
if (len % 8)
|
||||
unpack_len++;
|
||||
unpack_byte_array_into_bit_array(ks_bytes, ks_bits, unpack_len);
|
||||
|
||||
for (uint16_t i = 0; i < len; i++)
|
||||
{
|
||||
state->static_ks_bits[0][i] = ks_bits[i];
|
||||
state->static_ks_bits[1][i] = ks_bits[i];
|
||||
}
|
||||
|
||||
fprintf (stderr,"AMBE Straight XOR %d-bit Keystream: ", len);
|
||||
for (uint16_t i = 0; i < unpack_len; i++)
|
||||
fprintf (stderr, "%02X", ks_bytes[i]);
|
||||
fprintf (stderr, " with Forced Application \n");
|
||||
|
||||
state->straight_ks = 1;
|
||||
state->straight_mod = (int)len;
|
||||
|
||||
END_KS:
|
||||
|
||||
if (curr == NULL)
|
||||
fprintf (stderr, "Straight KS String Malformed! No KS Created!\n");
|
||||
|
||||
}
|
||||
392
src/crypt-pc4.c
392
src/crypt-pc4.c
@@ -1,392 +0,0 @@
|
||||
#include "pc4.h"
|
||||
|
||||
/* Global PC4 context instance */
|
||||
PC4Context ctx;
|
||||
|
||||
/* ---------------------------------
|
||||
Internal utility functions
|
||||
----------------------------------- */
|
||||
|
||||
/* Rotate right */
|
||||
static uint32_t ror(uint32_t x, int shift, int bits) {
|
||||
uint32_t m0 = (1u << (bits - shift)) - 1u;
|
||||
uint32_t m1 = (1u << shift) - 1u;
|
||||
return ((x >> shift) & m0) | ((x & m1) << (bits - shift));
|
||||
}
|
||||
|
||||
/* Rotate left */
|
||||
static uint32_t rol(uint32_t x, int shift, int bits) {
|
||||
uint32_t m0 = (1u << (bits - shift)) - 1u;
|
||||
uint32_t m1 = (1u << shift) - 1u;
|
||||
return ((x & m0) << shift) | ((x >> (bits - shift)) & m1);
|
||||
}
|
||||
|
||||
/* SplitMix64 random number generator */
|
||||
static uint64_t next_rng(PC4Context *ctx) {
|
||||
uint64_t z = (ctx->x += 0x9e3779b97f4a7c15ULL);
|
||||
z = (z ^ (z >> 30)) * 0xbf58476d1ce4e5b9ULL;
|
||||
z = (z ^ (z >> 27)) * 0x94d049bb133111ebULL;
|
||||
return z ^ (z >> 31);
|
||||
}
|
||||
|
||||
/* ARC4 initialization */
|
||||
static void arc4_init(PC4Context *ctx, unsigned char key[]) {
|
||||
int tmp;
|
||||
for (ctx->i_arc4 = 0; ctx->i_arc4 < 256; ctx->i_arc4++)
|
||||
ctx->array_arc4[ctx->i_arc4] = (unsigned char)ctx->i_arc4;
|
||||
|
||||
ctx->j_arc4 = 0;
|
||||
for (ctx->i_arc4 = 0; ctx->i_arc4 < 256; ctx->i_arc4++) {
|
||||
ctx->j_arc4 = (ctx->j_arc4 + ctx->array_arc4[ctx->i_arc4] + key[ctx->i_arc4 % 256]) % 256;
|
||||
tmp = ctx->array_arc4[ctx->i_arc4];
|
||||
ctx->array_arc4[ctx->i_arc4] = ctx->array_arc4[ctx->j_arc4];
|
||||
ctx->array_arc4[ctx->j_arc4] = tmp;
|
||||
}
|
||||
ctx->i_arc4 = 0;
|
||||
ctx->j_arc4 = 0;
|
||||
}
|
||||
|
||||
/* ARC4 output combined with SplitMix64 stream */
|
||||
static unsigned char arc4_output(PC4Context *ctx) {
|
||||
uint8_t rndbyte, decal;
|
||||
int tmp, t;
|
||||
|
||||
ctx->i_arc4 = (ctx->i_arc4 + 1) % 256;
|
||||
ctx->j_arc4 = (ctx->j_arc4 + ctx->array_arc4[ctx->i_arc4]) % 256;
|
||||
tmp = ctx->array_arc4[ctx->i_arc4];
|
||||
ctx->array_arc4[ctx->i_arc4] = ctx->array_arc4[ctx->j_arc4];
|
||||
ctx->array_arc4[ctx->j_arc4] = tmp;
|
||||
t = (ctx->array_arc4[ctx->i_arc4] + ctx->array_arc4[ctx->j_arc4]) % 256;
|
||||
|
||||
if (ctx->xyz == 0) ctx->bb = next_rng(ctx);
|
||||
decal = (uint8_t)(56 - (8 * ctx->xyz));
|
||||
rndbyte = (uint8_t)((ctx->bb >> decal) & 0xffu);
|
||||
ctx->xyz++;
|
||||
if (ctx->xyz == 8) ctx->xyz = 0;
|
||||
|
||||
if (ctx->count == 0) {
|
||||
rndbyte = (uint8_t)(rndbyte ^ ctx->array_arc4[t]);
|
||||
ctx->count = 1;
|
||||
} else {
|
||||
rndbyte = (uint8_t)(rndbyte + ctx->array_arc4[t]);
|
||||
ctx->count = 0;
|
||||
}
|
||||
return rndbyte;
|
||||
}
|
||||
|
||||
/* Initialize MD2-II state */
|
||||
static void md2_init(PC4Context *ctx) {
|
||||
ctx->x1 = 0;
|
||||
ctx->x2 = 0;
|
||||
for (ctx->i = 0; ctx->i < n1; ctx->i++) ctx->h2[ctx->i] = 0;
|
||||
for (ctx->i = 0; ctx->i < n1; ctx->i++) ctx->h1[ctx->i] = 0;
|
||||
}
|
||||
|
||||
/* MD2-II hashing */
|
||||
static void md2_hashing(PC4Context *ctx, unsigned char t1[], size_t b6) {
|
||||
static const unsigned char s4[256] = {
|
||||
13,199,11,67,237,193,164,77,115,184,141,222,73,38,147,36,150,87,21,104,12,61,156,101,111,145,
|
||||
119,22,207,35,198,37,171,167,80,30,219,28,213,121,86,29,214,242,6,4,89,162,110,175,19,157,3,
|
||||
88,234,94,144,118,159,239,100,17,182,173,238,68,16,79,132,54,163,52,9,58,57,55,229,192,170,226,
|
||||
56,231,187,158,70,224,233,245,26,47,32,44,247,8,251,20,197,185,109,153,204,218,93,178,212,137,84,
|
||||
174,24,120,130,149,72,180,181,208,255,189,152,18,143,176,60,249,27,227,128,139,243,253,59,123,172,
|
||||
108,211,96,138,10,215,42,225,40,81,65,90,25,98,126,154,64,124,116,122,5,1,168,83,190,131,191,244,
|
||||
240,235,177,155,228,125,66,43,201,248,220,129,188,230,62,75,71,78,34,31,216,254,136,91,114,106,46,
|
||||
217,196,92,151,209,133,51,236,33,252,127,179,69,7,183,105,146,97,39,15,205,112,200,166,223,45,48,
|
||||
246,186,41,148,140,107,76,85,95,194,142,50,49,134,23,135,169,221,210,203,63,165,82,161,202,53,14,
|
||||
206,232,103,102,195,117,250,99,0,74,160,241,2,113};
|
||||
|
||||
int b1, b2, b3, b4, b5;
|
||||
b4 = 0;
|
||||
while (b6) {
|
||||
for (; b6 && ctx->x2 < n1; b6--, ctx->x2++) {
|
||||
b5 = t1[b4++];
|
||||
ctx->h1[ctx->x2 + n1] = (unsigned char)b5;
|
||||
ctx->h1[ctx->x2 + (n1 * 2)] = (unsigned char)(b5 ^ ctx->h1[ctx->x2]);
|
||||
ctx->x1 = ctx->h2[ctx->x2] ^= s4[b5 ^ ctx->x1];
|
||||
}
|
||||
if (ctx->x2 == n1) {
|
||||
b2 = 0;
|
||||
ctx->x2 = 0;
|
||||
for (b3 = 0; b3 < (n1 + 2); b3++) {
|
||||
for (b1 = 0; b1 < (n1 * 3); b1++)
|
||||
b2 = ctx->h1[b1] ^= s4[b2];
|
||||
b2 = (b2 + b3) % 256;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* Finalize MD2-II */
|
||||
static void md2_end(PC4Context *ctx, unsigned char h4[n1]) {
|
||||
unsigned char h3[n1];
|
||||
int i, n4 = n1 - ctx->x2;
|
||||
for (i = 0; i < n4; i++) h3[i] = (unsigned char)n4;
|
||||
md2_hashing(ctx, h3, (size_t)n4);
|
||||
md2_hashing(ctx, ctx->h2, sizeof(ctx->h2));
|
||||
for (i = 0; i < n1; i++) h4[i] = ctx->h1[i];
|
||||
}
|
||||
|
||||
/* Generate a random index */
|
||||
static int mixy(PC4Context *ctx, int nn2) {
|
||||
return arc4_output(ctx) % nn2;
|
||||
}
|
||||
|
||||
/* Fisher-Yates shuffle */
|
||||
static void mixer(PC4Context *ctx, uint8_t *mixu, int nn) {
|
||||
int ii, jj, tmmp;
|
||||
for (ii = nn - 1; ii > 0; ii--) {
|
||||
jj = mixy(ctx, ii + 1);
|
||||
tmmp = mixu[jj];
|
||||
mixu[jj] = mixu[ii];
|
||||
mixu[ii] = (uint8_t)tmmp;
|
||||
}
|
||||
}
|
||||
|
||||
/* Key schedule and S-box generation */
|
||||
void create_keys(PC4Context *ctx, unsigned char key1[], size_t size1) {
|
||||
int i, w, k;
|
||||
unsigned char h4[n1];
|
||||
|
||||
md2_init(ctx);
|
||||
md2_hashing(ctx, key1, size1);
|
||||
md2_end(ctx, h4);
|
||||
|
||||
for (i = 0; i < 16; i++) ctx->keys[i] = h4[i];
|
||||
arc4_init(ctx, h4);
|
||||
|
||||
ctx->x = 0;
|
||||
for (i = 0; i < 8; i++) ctx->x = (ctx->x << 8) + (uint64_t)(h4[256 + i] & 0xffu);
|
||||
|
||||
ctx->xyz = 0;
|
||||
ctx->count = 0;
|
||||
|
||||
for (i = 0; i < 20000; i++) (void)arc4_output(ctx);
|
||||
|
||||
uint8_t numbers[256];
|
||||
|
||||
for (w = 0; w < 16; w++) {
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (i = 0; i < 256; i++) numbers[i] = (uint8_t)i;
|
||||
mixer(ctx, numbers, 256);
|
||||
for (i = 0; i < 256; i++) ctx->perm[w][i] = numbers[i];
|
||||
}
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (i = 0; i < 256; i++) numbers[i] = (uint8_t)i;
|
||||
mixer(ctx, numbers, 256);
|
||||
for (i = 0; i < 256; i++) ctx->new1[i] = numbers[i];
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (i = 0; i < 49; i++) numbers[i] = (uint8_t)i;
|
||||
mixer(ctx, numbers, 49);
|
||||
for (i = 0; i < 49; i++) ctx->array[i] = numbers[i];
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (i = 0; i < nbround; i++) ctx->decal[i] = (uint8_t)((arc4_output(ctx) % 23) + 1);
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (w = 0; w < 3; w++)
|
||||
for (i = 0; i < nbround; i++)
|
||||
ctx->rngxor[i][w] = arc4_output(ctx);
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (i = 0; i < 49; i++) numbers[i] = (uint8_t)i;
|
||||
mixer(ctx, numbers, 49);
|
||||
for (i = 0; i < 49; i++) ctx->array2[i] = numbers[i];
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (i = 0; i < 256; i++) numbers[i] = (uint8_t)i;
|
||||
mixer(ctx, numbers, 256);
|
||||
for (i = 0; i < 256; i++) {
|
||||
ctx->tab[i] = numbers[i];
|
||||
ctx->inv[ctx->tab[i]] = (unsigned char)i;
|
||||
}
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (w = 0; w < 3; w++) {
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (i = 0; i < 3; i++) numbers[i] = (uint8_t)i;
|
||||
mixer(ctx, numbers, 3);
|
||||
for (i = 0; i < 3; i++) ctx->permut[w][i] = numbers[i];
|
||||
}
|
||||
|
||||
k = arc4_output(ctx) + 256;
|
||||
for (i = 0; i < k; i++) (void)arc4_output(ctx);
|
||||
for (w = 0; w < 3; w++)
|
||||
for (i = 0; i < nbround; i++)
|
||||
ctx->rngxor2[i][w] = arc4_output(ctx);
|
||||
}
|
||||
|
||||
/* Compute round transformation */
|
||||
static void compute(PC4Context *ctx, uint8_t *tab1, uint8_t round) {
|
||||
ctx->tot[0] = (uint8_t)((ctx->perm[round][tab1[ctx->permut[0][0]]] +
|
||||
ctx->perm[round][tab1[ctx->permut[0][1]]]) ^
|
||||
ctx->perm[round][tab1[ctx->permut[0][2]]]);
|
||||
ctx->tot[0] = (uint8_t)(ctx->tot[0] + ctx->new1[ctx->tot[0]]);
|
||||
ctx->tot[1] = (uint8_t)((ctx->perm[round][tab1[ctx->permut[1][0]]] +
|
||||
ctx->perm[round][tab1[ctx->permut[1][1]]]) ^
|
||||
ctx->perm[round][tab1[ctx->permut[1][2]]]);
|
||||
ctx->tot[1] = (uint8_t)(ctx->tot[1] + ctx->new1[ctx->tot[1]]);
|
||||
ctx->tot[2] = (uint8_t)((ctx->perm[round][tab1[ctx->permut[2][0]]] +
|
||||
ctx->perm[round][tab1[ctx->permut[2][1]]]) ^
|
||||
ctx->perm[round][tab1[ctx->permut[2][2]]]);
|
||||
ctx->tot[2] = (uint8_t)(ctx->tot[2] + ctx->new1[ctx->tot[2]]);
|
||||
}
|
||||
|
||||
/* Convert bits to bytes */
|
||||
void binhex(PC4Context *ctx, short *z, int length) {
|
||||
short *b = (short *)z;
|
||||
uint8_t i, j;
|
||||
for (i = 0; i < length; i = j) {
|
||||
uint8_t a = 0;
|
||||
for (j = i; j < i + 8; ++j) {
|
||||
a |= (uint8_t)(b[((short)(7 - (j % 8)) + j) - (j % 8)] << (j - i));
|
||||
}
|
||||
ctx->convert[ctx->ptconvert] = a;
|
||||
ctx->ptconvert++;
|
||||
}
|
||||
}
|
||||
|
||||
/* Convert byte to bits */
|
||||
void hexbin(PC4Context *ctx, short *q, uint8_t w, uint8_t hex) { // warning: unused parameter ‘ctx’ [-Wunused-parameter]
|
||||
short *bits = (short *)q;
|
||||
for (uint8_t i = 0; i < 8; ++i) {
|
||||
bits[(short)(7 + w) - i] = (short)((hex >> i) & 1u);
|
||||
}
|
||||
|
||||
UNUSEDPC4(ctx); //fix above warning
|
||||
}
|
||||
|
||||
/* Encrypt one block */
|
||||
void pc4encrypt(PC4Context *ctx) {
|
||||
int i;
|
||||
ctx->totb = 0;
|
||||
|
||||
for (i = 0; i < 3; i++) {
|
||||
ctx->l[0][i] = ctx->convert[i];
|
||||
ctx->r[0][i] = ctx->convert[i + 3];
|
||||
}
|
||||
|
||||
for (i = 1; i <= ctx->rounds; i++) {
|
||||
ctx->totb ^= ctx->r[(i - 1) % 2][0];
|
||||
ctx->totb ^= ctx->r[(i - 1) % 2][1];
|
||||
ctx->totb ^= ctx->r[(i - 1) % 2][2];
|
||||
|
||||
ctx->r[(i - 1) % 2][0] += (uint8_t)(~ctx->rngxor2[ctx->rounds - i][0]);
|
||||
ctx->r[(i - 1) % 2][1] ^= (uint8_t)(~ctx->rngxor2[ctx->rounds - i][1]);
|
||||
ctx->r[(i - 1) % 2][2] += (uint8_t)(~ctx->rngxor2[ctx->rounds - i][2]);
|
||||
|
||||
ctx->result = 0;
|
||||
ctx->result += ((uint32_t)ctx->r[(i - 1) % 2][0] << 16);
|
||||
ctx->result += ((uint32_t)ctx->r[(i - 1) % 2][1] << 8);
|
||||
ctx->result += ctx->r[(i - 1) % 2][2];
|
||||
|
||||
ctx->result = rol(ctx->result, ctx->decal[i - 1], 24);
|
||||
|
||||
ctx->r[(i - 1) % 2][0] = (uint8_t)(ctx->result >> 16);
|
||||
ctx->r[(i - 1) % 2][1] = (uint8_t)((ctx->result >> 8) & 0xffu);
|
||||
ctx->r[(i - 1) % 2][2] = (uint8_t)(ctx->result & 0xffu);
|
||||
|
||||
ctx->r[(i - 1) % 2][0] = ctx->tab[ctx->r[(i - 1) % 2][0]];
|
||||
ctx->r[(i - 1) % 2][0] ^= ctx->rngxor[i - 1][0];
|
||||
|
||||
ctx->r[(i - 1) % 2][1] = ctx->inv[ctx->r[(i - 1) % 2][1]];
|
||||
ctx->r[(i - 1) % 2][1] -= ctx->rngxor[i - 1][1];
|
||||
|
||||
ctx->r[(i - 1) % 2][2] = ctx->tab[ctx->r[(i - 1) % 2][2]];
|
||||
ctx->r[(i - 1) % 2][2] ^= ctx->rngxor[i - 1][2];
|
||||
|
||||
compute(ctx, ctx->r[(i - 1) % 2], (uint8_t)((i - 1) % 16));
|
||||
|
||||
ctx->l[i % 2][0] = ctx->r[(i - 1) % 2][0];
|
||||
ctx->r[i % 2][0] = ctx->l[(i - 1) % 2][0] - ctx->tot[0];
|
||||
|
||||
ctx->l[i % 2][1] = ctx->r[(i - 1) % 2][1];
|
||||
ctx->r[i % 2][1] = ctx->l[(i - 1) % 2][1] ^ ctx->tot[1];
|
||||
|
||||
ctx->l[i % 2][2] = ctx->r[(i - 1) % 2][2];
|
||||
ctx->r[i % 2][2] = ctx->l[(i - 1) % 2][2] - ctx->tot[2];
|
||||
}
|
||||
|
||||
for (i = 0; i < 3; i++) {
|
||||
ctx->convert[i + 3] = ctx->l[(ctx->rounds - 1) % 2][i];
|
||||
ctx->convert[i] = ctx->r[(ctx->rounds - 1) % 2][i];
|
||||
}
|
||||
|
||||
ctx->totb %= 2;
|
||||
}
|
||||
|
||||
/* Decrypt one block */
|
||||
void pc4decrypt(PC4Context *ctx) {
|
||||
int i;
|
||||
ctx->totb = 0;
|
||||
|
||||
for (i = 0; i < 3; i++) {
|
||||
ctx->l[0][i] = ctx->convert[i];
|
||||
ctx->r[0][i] = ctx->convert[i + 3];
|
||||
}
|
||||
|
||||
ctx->y = (uint8_t)((ctx->rounds - 1) % 16);
|
||||
if (ctx->y == 0) ctx->y = 16;
|
||||
|
||||
for (i = 1; i <= ctx->rounds; i++) {
|
||||
ctx->y--;
|
||||
compute(ctx, ctx->r[(i - 1) % 2], ctx->y);
|
||||
if (ctx->y == 0) ctx->y = 16;
|
||||
|
||||
ctx->result = 0;
|
||||
|
||||
ctx->l[(i - 1) % 2][0] ^= ctx->rngxor[ctx->rounds - i][0];
|
||||
ctx->l[(i - 1) % 2][0] = ctx->inv[ctx->l[(i - 1) % 2][0]];
|
||||
|
||||
ctx->l[(i - 1) % 2][1] += ctx->rngxor[ctx->rounds - i][1];
|
||||
ctx->l[(i - 1) % 2][1] = ctx->tab[ctx->l[(i - 1) % 2][1]];
|
||||
|
||||
ctx->l[(i - 1) % 2][2] ^= ctx->rngxor[ctx->rounds - i][2];
|
||||
ctx->l[(i - 1) % 2][2] = ctx->inv[ctx->l[(i - 1) % 2][2]];
|
||||
|
||||
ctx->result += ((uint32_t)ctx->l[(i - 1) % 2][0] << 16);
|
||||
ctx->result += ((uint32_t)ctx->l[(i - 1) % 2][1] << 8);
|
||||
ctx->result += ctx->l[(i - 1) % 2][2];
|
||||
|
||||
ctx->result = ror(ctx->result, ctx->decal[ctx->rounds - i], 24);
|
||||
|
||||
ctx->l[(i - 1) % 2][0] = (uint8_t)(ctx->result >> 16);
|
||||
ctx->l[(i - 1) % 2][1] = (uint8_t)((ctx->result >> 8) & 0xffu);
|
||||
ctx->l[(i - 1) % 2][2] = (uint8_t)(ctx->result & 0xffu);
|
||||
|
||||
ctx->l[(i - 1) % 2][0] -= (uint8_t)(~ctx->rngxor2[i - 1][0]);
|
||||
ctx->l[(i - 1) % 2][1] ^= (uint8_t)(~ctx->rngxor2[i - 1][1]);
|
||||
ctx->l[(i - 1) % 2][2] -= (uint8_t)(~ctx->rngxor2[i - 1][2]);
|
||||
|
||||
ctx->totb ^= ctx->l[(i - 1) % 2][0];
|
||||
ctx->totb ^= ctx->l[(i - 1) % 2][1];
|
||||
ctx->totb ^= ctx->l[(i - 1) % 2][2];
|
||||
|
||||
ctx->l[i % 2][0] = ctx->r[(i - 1) % 2][0];
|
||||
ctx->r[i % 2][0] = ctx->l[(i - 1) % 2][0] + ctx->tot[0];
|
||||
|
||||
ctx->l[i % 2][1] = ctx->r[(i - 1) % 2][1];
|
||||
ctx->r[i % 2][1] = ctx->l[(i - 1) % 2][1] ^ ctx->tot[1];
|
||||
|
||||
ctx->l[i % 2][2] = ctx->r[(i - 1) % 2][2];
|
||||
ctx->r[i % 2][2] = ctx->l[(i - 1) % 2][2] + ctx->tot[2];
|
||||
}
|
||||
|
||||
for (i = 0; i < 3; i++) {
|
||||
ctx->convert[i + 3] = ctx->l[(ctx->rounds - 1) % 2][i];
|
||||
ctx->convert[i] = ctx->r[(ctx->rounds - 1) % 2][i];
|
||||
}
|
||||
|
||||
ctx->totb %= 2;
|
||||
}
|
||||
146
src/crypt-rc4.c
146
src/crypt-rc4.c
@@ -1,146 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* rc4.c Crypthings
|
||||
* RC4 Alg
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
//this version is for voice, going to transition to a block output version
|
||||
void rc4_voice_decrypt(int drop, uint8_t keylength, uint8_t messagelength, uint8_t key[], uint8_t cipher[], uint8_t plain[])
|
||||
{
|
||||
int i, j, count;
|
||||
uint8_t t, b;
|
||||
|
||||
//init Sbox
|
||||
uint8_t S[256];
|
||||
for(int i = 0; i < 256; i++) S[i] = i;
|
||||
|
||||
//Key Scheduling
|
||||
j = 0;
|
||||
for(i = 0; i < 256; i++)
|
||||
{
|
||||
j = (j + S[i] + key[i % keylength]) % 256;
|
||||
t = S[i];
|
||||
S[i] = S[j];
|
||||
S[j] = t;
|
||||
}
|
||||
|
||||
//Drop Bytes and Cipher Byte XOR
|
||||
i = j = 0;
|
||||
for(count = 0; count < (messagelength + drop); count++)
|
||||
{
|
||||
i = (i + 1) % 256;
|
||||
j = (j + S[i]) % 256;
|
||||
t = S[i];
|
||||
S[i] = S[j];
|
||||
S[j] = t;
|
||||
b = S[(S[i] + S[j]) % 256];
|
||||
|
||||
//return mbe payload byte here
|
||||
if (count >= drop)
|
||||
plain[count - drop] = b^cipher[count - drop];
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//this is for PDU usage
|
||||
void rc4_block_output (int drop, int keylen, int meslen, uint8_t * key, uint8_t * output_blocks)
|
||||
{
|
||||
int i, j, x, count;
|
||||
unsigned int keylength = (unsigned int)keylen;
|
||||
unsigned int messagelength = (unsigned int)meslen;
|
||||
unsigned int S[256];
|
||||
|
||||
for(i=0; i<256; i++)
|
||||
S[i] = i;
|
||||
|
||||
j = 0;
|
||||
for(i = 0; i<256; i++)
|
||||
{
|
||||
j = (j + S[i] + key[i % keylength]) % 256;
|
||||
unsigned int temp = S[i];
|
||||
S[i] = S[j];
|
||||
S[j] = temp;
|
||||
}
|
||||
|
||||
//Generate Keystream
|
||||
i = 0;
|
||||
j = 0;
|
||||
x = 0;
|
||||
unsigned int byte;
|
||||
|
||||
// fprintf (stderr, " Keystream Octets = ");
|
||||
for(count = 0; count < (messagelength + drop); count++)
|
||||
{
|
||||
i = (i + 1) % 256;
|
||||
j = (j + S[i]) % 256;
|
||||
unsigned int temp = S[i];
|
||||
S[i] = S[j];
|
||||
S[j] = temp;
|
||||
byte = S[(S[i] + S[j]) % 256];
|
||||
|
||||
//Collect Output blocks
|
||||
if (count >= drop)
|
||||
output_blocks[x++] = byte;
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//This is now verified to work after changing the drop byte value from 256 to 0.
|
||||
//also, had to change the application to not skip the additional 7 bits like DMRA or P25 does.
|
||||
void hytera_enhanced_rc4_setup(dsd_opts * opts, dsd_state * state, unsigned long long int key_value, unsigned long long int mi_value)
|
||||
{
|
||||
|
||||
UNUSED(opts);
|
||||
uint8_t key[5]; memset (key, 0, sizeof(key));
|
||||
uint8_t kiv[5]; memset (kiv, 0, sizeof(kiv));
|
||||
uint8_t mi[5]; memset (mi, 0, sizeof(mi));
|
||||
uint8_t ks[135]; memset (ks, 0, sizeof(ks));
|
||||
|
||||
//load key_value into key array
|
||||
key[0] = ((key_value & 0xFF00000000) >> 32UL);
|
||||
key[1] = ((key_value & 0xFF000000) >> 24);
|
||||
key[2] = ((key_value & 0xFF0000) >> 16);
|
||||
key[3] = ((key_value & 0xFF00) >> 8);
|
||||
key[4] = ((key_value & 0xFF) >> 0);
|
||||
|
||||
//load mi_value into mi array
|
||||
mi[0] = ((mi_value & 0xFF00000000) >> 32UL);
|
||||
mi[1] = ((mi_value & 0xFF000000) >> 24);
|
||||
mi[2] = ((mi_value & 0xFF0000) >> 16);
|
||||
mi[3] = ((mi_value & 0xFF00) >> 8);
|
||||
mi[4] = ((mi_value & 0xFF) >> 0);
|
||||
|
||||
//pointer to the ks_octet storage
|
||||
uint8_t * ks_octets;
|
||||
if (state->currentslot == 0)
|
||||
ks_octets = state->ks_octetL;
|
||||
else ks_octets = state->ks_octetR;
|
||||
|
||||
//NOTE: Drop Byte value is 0
|
||||
rc4_block_output(0, 5, 135, key, ks);
|
||||
|
||||
for (int i = 0; i < 5; i++)
|
||||
kiv[i] = key[i] ^ mi[i];
|
||||
|
||||
for (int i = 0; i < 135; i++)
|
||||
ks_octets[i] = kiv[i%5] ^ ks[i];
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, " KS: ");
|
||||
// for (int i = 0; i < 135; i++)
|
||||
// {
|
||||
// if ((i != 0) && ((i%7) == 0))
|
||||
// fprintf (stderr, " ");
|
||||
// fprintf (stderr, "%02X", ks[i]); //ks_octets
|
||||
// }
|
||||
|
||||
//NULL pointer to ks_octets
|
||||
ks_octets = NULL;
|
||||
|
||||
//end line break
|
||||
// fprintf (stderr, "\n");
|
||||
|
||||
}
|
||||
241
src/crypt-tyt.c
241
src/crypt-tyt.c
@@ -1,241 +0,0 @@
|
||||
#include "dsd.h"
|
||||
#include "dmr_const.h"
|
||||
#include "pc4.h"
|
||||
|
||||
//interleaved code words for AMBE+2 (as it arrives over the air)
|
||||
void ambe2_codeword_print_i (dsd_opts * opts, char ambe_fr[4][24])
|
||||
{
|
||||
uint8_t interleaved[72];
|
||||
memset (interleaved, 0, sizeof(interleaved));
|
||||
|
||||
//reinterleave the frame
|
||||
const int *w, *x, *y, *z;
|
||||
w = rW; x = rX; y = rY; z = rZ;
|
||||
|
||||
for (int8_t i = 0; i < 36; i++)
|
||||
{
|
||||
interleaved[(i*2)+0] = (uint8_t)ambe_fr[*w][*x];
|
||||
interleaved[(i*2)+1] = (uint8_t)ambe_fr[*y][*z];
|
||||
|
||||
w++;
|
||||
x++;
|
||||
y++;
|
||||
z++;
|
||||
}
|
||||
|
||||
uint8_t bytes[9]; memset(bytes, 0, sizeof(bytes));
|
||||
|
||||
//pack
|
||||
pack_bit_array_into_byte_array(interleaved, bytes, 9);
|
||||
|
||||
if (opts->payload == 1)
|
||||
{
|
||||
fprintf (stderr, " AMBE HEX(72) INT: ");
|
||||
for (int8_t i = 0; i < 9; i++)
|
||||
fprintf (stderr, "%02X", bytes[i]);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//de-interleaved code words for AMBE+2
|
||||
void ambe2_codeword_print_b (dsd_opts * opts, char ambe_fr[4][24])
|
||||
{
|
||||
uint8_t fr_reverse[4][24]; memset(fr_reverse, 0, sizeof(fr_reverse));
|
||||
for (int i = 0; i < 24; i++)
|
||||
fr_reverse[0][i] = ambe_fr[0][23-i];
|
||||
for (int i = 0; i < 23; i++)
|
||||
fr_reverse[1][i] = ambe_fr[1][22-i];
|
||||
for (int i = 0; i < 11; i++)
|
||||
fr_reverse[2][i] = ambe_fr[2][10-i];
|
||||
for (int i = 0; i < 14; i++)
|
||||
fr_reverse[3][i] = ambe_fr[3][13-i];
|
||||
|
||||
uint32_t v0 = (uint32_t)convert_bits_into_output((uint8_t *)fr_reverse[0], 24); //24
|
||||
uint32_t v1 = (uint32_t)convert_bits_into_output((uint8_t *)fr_reverse[1], 23); //23
|
||||
uint32_t v2 = (uint32_t)convert_bits_into_output((uint8_t *)fr_reverse[2], 11); //11
|
||||
uint32_t v3 = (uint32_t)convert_bits_into_output((uint8_t *)fr_reverse[3], 14); //14
|
||||
|
||||
uint32_t c0 = (uint32_t)convert_bits_into_output((uint8_t *)fr_reverse[0], 12);
|
||||
uint32_t c1 = (uint32_t)convert_bits_into_output((uint8_t *)fr_reverse[1], 12);
|
||||
|
||||
//72 bit version
|
||||
unsigned long long int hex1 = ((unsigned long long int)v0 << 40ULL) + ((unsigned long long int)v1 << 17ULL) + ((unsigned long long int)v2 << 6ULL) + (v3 >> 8);
|
||||
unsigned long long int hex2 = v3 & 0xFF;
|
||||
|
||||
//49 bit version prior to golay correction and c1 demodulation pN
|
||||
unsigned long long int hex49 = ((unsigned long long int)c0 << 37ULL) + ((unsigned long long int)c1 << 25ULL) + ((unsigned long long int)v2 << 14ULL) + v3;
|
||||
|
||||
UNUSED(opts);
|
||||
|
||||
if (opts->payload == 1)
|
||||
{
|
||||
fprintf (stderr, " AMBE HEX(72): %016llX%02llX \n", hex1, hex2);
|
||||
fprintf (stderr, " AMBE HEX(49): %014llX\n", hex49 << 7);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//de-interleaved code words for AMBE+2
|
||||
void ambe2_codeword_print_f (dsd_opts * opts, char ambe_fr[4][24])
|
||||
{
|
||||
uint32_t v0 = (uint32_t)convert_bits_into_output((uint8_t *)ambe_fr[0], 24); //24
|
||||
uint32_t v1 = (uint32_t)convert_bits_into_output((uint8_t *)ambe_fr[1], 23); //23
|
||||
uint32_t v2 = (uint32_t)convert_bits_into_output((uint8_t *)ambe_fr[2], 11); //11
|
||||
uint32_t v3 = (uint32_t)convert_bits_into_output((uint8_t *)ambe_fr[3], 14); //14
|
||||
|
||||
// if (opts->payload == 1)
|
||||
// fprintf (stderr, " AMBE V0: %06X; V1: %06X; V2: %03X; V3: %04X; \n", v0, v1, v2, v3);
|
||||
|
||||
unsigned long long int hex1 = ((unsigned long long int)v0 << 40ULL) + ((unsigned long long int)v1 << 17ULL) + ((unsigned long long int)v2 << 6ULL) + (v3 >> 8);
|
||||
unsigned long long int hex2 = v3 & 0xFF;
|
||||
|
||||
if (opts->payload == 1)
|
||||
fprintf (stderr, " AMBE HEX(72): %016llX%02llX \n", hex1, hex2);
|
||||
|
||||
}
|
||||
|
||||
//NOTE: This mode DOES NOT work over a repeater, simplex only
|
||||
//repeaters may or will attempt to correct the frame errors
|
||||
void tyt16_ambe2_codeword_keystream(dsd_state * state, char ambe_fr[4][24], int fnum)
|
||||
{
|
||||
|
||||
char interleaved[72];
|
||||
memset (interleaved, 0, sizeof(interleaved));
|
||||
|
||||
//interleave the frame
|
||||
const int *w, *x, *y, *z;
|
||||
w = rW; x = rX; y = rY; z = rZ;
|
||||
|
||||
for (int8_t i = 0; i < 36; i++)
|
||||
{
|
||||
interleaved[(i*2)+0] = ambe_fr[*w][*x];
|
||||
interleaved[(i*2)+1] = ambe_fr[*y][*z];
|
||||
|
||||
w++;
|
||||
x++;
|
||||
y++;
|
||||
z++;
|
||||
}
|
||||
|
||||
uint8_t ks_bytes[10]; memset(ks_bytes, 0, sizeof(ks_bytes));
|
||||
uint8_t ks[80]; memset(ks, 0, sizeof(ks));
|
||||
|
||||
ks_bytes[0] = (state->H >> 8) & 0xFF;
|
||||
ks_bytes[1] = (state->H >> 0) & 0xFF;
|
||||
|
||||
//copy same bytes into rest of byte array
|
||||
for (int16_t i = 2; i < 10; i++)
|
||||
ks_bytes[i] = ks_bytes[i%2];
|
||||
|
||||
//convert byte array into a bit array
|
||||
unpack_byte_array_into_bit_array(ks_bytes, ks, 10);
|
||||
|
||||
//set ks idx position (-1)
|
||||
int idx = 0;
|
||||
if (fnum == 0)
|
||||
idx = 79;
|
||||
else idx = 71;
|
||||
|
||||
//apply keystream to interleave
|
||||
for (int8_t i = 0; i < 72; i++)
|
||||
interleaved[i] ^= ks[idx--];
|
||||
|
||||
//deinterleave back into ambe_fr frame
|
||||
w = rW; x = rX; y = rY; z = rZ;
|
||||
int k = 0;
|
||||
for (int8_t i = 0; i < 36; i++)
|
||||
{
|
||||
ambe_fr[*w][*x] = interleaved[k++];
|
||||
ambe_fr[*y][*z] = interleaved[k++];
|
||||
|
||||
w++;
|
||||
x++;
|
||||
y++;
|
||||
z++;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void tyt_ap_pc4_keystream_creation(dsd_state * state, char * input)
|
||||
{
|
||||
unsigned char key1[16] = {0};
|
||||
unsigned char key2[16] = {0};
|
||||
|
||||
char buf[1024];
|
||||
strncpy(buf, input, sizeof(buf) - 1);
|
||||
buf[sizeof(buf) - 1] = '\0';
|
||||
|
||||
char *pEnd;
|
||||
uint64_t K1 = strtoull(buf, &pEnd, 16);
|
||||
uint64_t K2 = strtoull(pEnd, &pEnd, 16);
|
||||
|
||||
u64_to_bytes_be(K1, &key1[0]);
|
||||
u64_to_bytes_be(K2, &key1[8]);
|
||||
|
||||
for (int i=0;i<16;i++) key2[i] = key1[15-i];
|
||||
|
||||
/* Create key schedule */
|
||||
create_keys(&ctx, key2, sizeof(key2));
|
||||
ctx.rounds = nbround;
|
||||
|
||||
fprintf (stderr,"DMR TYT AP (PC4) 128-bit Key %016llX%016llX with Forced Application\n", (unsigned long long int)K1, (unsigned long long int)K2);
|
||||
state->tyt_ap = 1;
|
||||
|
||||
}
|
||||
|
||||
void tyt_ep_aes_keystream_creation(dsd_state * state, char * input)
|
||||
{
|
||||
char buf[1024];
|
||||
strncpy(buf, input, 1023);
|
||||
buf[1023] = '\0';
|
||||
|
||||
char *pEnd;
|
||||
unsigned long long int K1 = strtoull (buf, &pEnd, 16);
|
||||
unsigned long long int K2 = strtoull (pEnd, &pEnd, 16);
|
||||
|
||||
//
|
||||
uint8_t static_key[32];
|
||||
memset(static_key, 0, sizeof(static_key));
|
||||
|
||||
//static key value
|
||||
static_key[0]=0x6e; static_key[1]=0x02; static_key[2]=0x8d; static_key[3]=0x8a;
|
||||
static_key[4]=0xca; static_key[5]=0xeb; static_key[6]=0x9b; static_key[7]=0xbe;
|
||||
static_key[8]=0x42; static_key[9]=0x72; static_key[10]=0xfb; static_key[11]=0x82;
|
||||
static_key[12]=0x64; static_key[13]=0x56; static_key[14]=0x31; static_key[15]=0xfa;
|
||||
|
||||
//the key value provided by user
|
||||
uint8_t user_key[16];
|
||||
memset(user_key, 0, sizeof(user_key));
|
||||
|
||||
//Load user key into array to manipulate
|
||||
for (int i = 0; i < 8; i++)
|
||||
{
|
||||
user_key[i+0] = (K1 >> (56-(i*8))) & 0xFF;
|
||||
user_key[i+8] = (K2 >> (56-(i*8))) & 0xFF;
|
||||
}
|
||||
|
||||
uint8_t input_register[16];
|
||||
memset(input_register, 0, sizeof(input_register));
|
||||
|
||||
//manipulate user provided key by loading bytes in reverse order into the input_register
|
||||
for (int i = 0; i < 16; i++)
|
||||
input_register[15-i] = user_key[i];
|
||||
|
||||
uint8_t ks_bytes[16];
|
||||
memset(ks_bytes, 0, sizeof(ks_bytes));
|
||||
|
||||
//create keystream
|
||||
aes_ofb_keystream_output(input_register, static_key, ks_bytes, 0, 1);
|
||||
uint8_t ks_bits[128];
|
||||
memset(ks_bits, 0, sizeof(ks_bits));
|
||||
unpack_byte_array_into_bit_array(ks_bytes, ks_bits, 16);
|
||||
|
||||
//load static keystream into ctx.bits since that isn't ever zeroed out
|
||||
for (int i = 0; i < 49; i++)
|
||||
ctx.bits[i] = ks_bits[i];
|
||||
|
||||
fprintf (stderr,"DMR TYT EP (AES-128) Key %016llX%016llX with Forced Application\n", K1, K2);
|
||||
state->tyt_ep = 1;
|
||||
|
||||
}
|
||||
144
src/dmr_34.c
144
src/dmr_34.c
@@ -1,9 +1,9 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dmr_34.c
|
||||
* DMR (and P25) 3/4 Rate Simple Trellis Decoder
|
||||
* DMR 3/4 Rate Simple Trellis Decoder
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2023-12 DSD-FME Florida Man Edition
|
||||
* 2023-08 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
@@ -14,14 +14,14 @@ uint8_t interleave[98] = {
|
||||
4, 5, 12, 13, 20, 21, 28, 29, 36, 37, 44, 45, 52, 53, 60, 61, 68, 69, 76, 77, 84, 85, 92, 93,
|
||||
6, 7, 14, 15, 22, 23, 30, 31, 38, 39, 46, 47, 54, 55, 62, 63, 70, 71, 78, 79, 86, 87, 94, 95};
|
||||
|
||||
//this is a convertion table for converting the dibit pairs into constellation points
|
||||
//this is a convertion table for converting the dibit pairs into contellation points
|
||||
uint8_t constellation_map[16] = {
|
||||
11, 12, 0, 7, 14, 9, 5, 2, 10, 13, 1, 6, 15, 8, 4, 3
|
||||
};
|
||||
|
||||
//digitized dibit to OTA symbol conversion for reference
|
||||
//0 = +1; 1 = +3;
|
||||
//2 = -1; 3 = -3;
|
||||
//0 = +1; 1 = +3;
|
||||
//2 = -1; 3 = -3;
|
||||
|
||||
//finite state machine values
|
||||
uint8_t fsm[64] = {
|
||||
@@ -34,92 +34,10 @@ uint8_t fsm[64] = {
|
||||
2, 10, 6, 14, 0, 8, 4, 12,
|
||||
6, 14, 0, 8, 4, 12, 2, 10};
|
||||
|
||||
//attempt to find the surviving path, or the 'best' path available (most positions gained)
|
||||
uint8_t fix_34(uint8_t * p, uint8_t state, int position)
|
||||
{
|
||||
int i, j, k, counter, best_p, best_v, survivors;
|
||||
uint8_t temp_s, tri, t;
|
||||
|
||||
//status of surviving paths -- debug
|
||||
int s[8];
|
||||
memset (s, 0, 8*sizeof(int));
|
||||
|
||||
//assign all potentially correct points to temporary storage
|
||||
uint8_t temp_p[8];
|
||||
temp_p[0] = (p[position] ^ 1) & 0xF;
|
||||
temp_p[1] = (p[position] ^ 3) & 0xF;
|
||||
temp_p[2] = (p[position] ^ 5) & 0xF;
|
||||
temp_p[3] = (p[position] ^ 7) & 0xF;
|
||||
temp_p[4] = (p[position] ^ 9) & 0xF;
|
||||
temp_p[5] = (p[position] ^ 11) & 0xF;
|
||||
temp_p[6] = (p[position] ^ 13) & 0xF;
|
||||
temp_p[7] = (p[position] ^ 15) & 0xF;
|
||||
|
||||
best_p = 0; //best position
|
||||
best_v = 0; //best path value
|
||||
|
||||
for (k = 0; k < 8; k++)
|
||||
{
|
||||
temp_s = state;
|
||||
counter = 0;
|
||||
tri = 0;
|
||||
for (i = position; i < 49; i++)
|
||||
{
|
||||
//assign temp t either as our temp_p, or next point of i
|
||||
if (i == position) t = temp_p[k];
|
||||
else t = p[i];
|
||||
|
||||
if (tri != 0xFF) //while the path survives
|
||||
{
|
||||
tri = 0xFF;
|
||||
for (j = 0; j < 8; j++)
|
||||
{
|
||||
if ( fsm[(temp_s*8)+j] == t )
|
||||
{
|
||||
//return our tribit value and state for the next point
|
||||
tri = temp_s = (uint8_t)j;
|
||||
counter++;
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
if (counter > best_p)
|
||||
{
|
||||
best_p = counter;
|
||||
best_v = k; //if we make it further on current path, assign as best path
|
||||
}
|
||||
|
||||
// surviving path -- made it to 49
|
||||
if (i == 48) s[k] = 1;
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//NOTE: If there are no surviving paths, then that means there is another bit/point err
|
||||
//Ideally, at the end of a single or multiple fixes, there should only be one survivor, but in practice,
|
||||
//I've seen up to 4 surviving paths and somehow, get a good CRC and a good LRRP or LOCN decode
|
||||
//multiple survivors seems common when the starting err position is very close to 49
|
||||
|
||||
//tally number of surviving paths
|
||||
survivors = 0;
|
||||
for (k = 0; k < 8; k++)
|
||||
{
|
||||
if (s[k] == 1) survivors++;
|
||||
}
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "START: %d; BEST_P: %d; BEST_V: %d; Survivors: %d; Point: %d; ", position, best_p, best_v, survivors, temp_p[best_v]);
|
||||
|
||||
return temp_p[best_v]; //return the point value of the best path's starting point value
|
||||
}
|
||||
|
||||
uint32_t dmr_34(uint8_t * input, uint8_t treturn[18])
|
||||
{
|
||||
int i, j;
|
||||
uint32_t irr_err = 0; //irrecoverable errors
|
||||
uint32_t irr_err = 0;
|
||||
|
||||
uint8_t deinterleaved_dibits[98];
|
||||
memset (deinterleaved_dibits, 0, sizeof(deinterleaved_dibits));
|
||||
@@ -139,14 +57,17 @@ uint32_t dmr_34(uint8_t * input, uint8_t treturn[18])
|
||||
uint8_t point[49];
|
||||
memset (point, 0xFF, sizeof(point));
|
||||
|
||||
for (i = 0; i < 49; i++)
|
||||
for (i = 0; i < 49; i++)
|
||||
point[i] = constellation_map[nibs[i]];
|
||||
|
||||
//debug view points
|
||||
//debug view points -- point[0] should be zero
|
||||
// fprintf (stderr, "\n P =");
|
||||
// for (i = 0; i < 49; i++)
|
||||
// for (i = 0; i < 49; i++)
|
||||
// fprintf (stderr, " %02d", point[i]);
|
||||
|
||||
//free-bee on err correction, point[0] should always be zero (flush bits)
|
||||
point[0] = 0;
|
||||
|
||||
//convert constellation points into tribit values using the FSM
|
||||
uint8_t state = 0;
|
||||
uint32_t tribits[49];
|
||||
@@ -170,45 +91,46 @@ uint32_t dmr_34(uint8_t * input, uint8_t treturn[18])
|
||||
{
|
||||
irr_err++; //tally number of errors
|
||||
|
||||
//debug point, position of error, and state value
|
||||
// fprintf (stderr, "\n P: %d, %d:%d; ", point[i], i, state);
|
||||
|
||||
//attempt to fix point by looking for the best path from here
|
||||
point[i] = fix_34(point, state, i);
|
||||
//debug position of error and state value
|
||||
// fprintf (stderr, " %d:%d;", i, state);
|
||||
|
||||
//Make a hard decision and flip point to fit in current state
|
||||
// point[i] ^= 7; //lucky number 7 (0111) //fallback
|
||||
point[i] ^= 7; //lucky number 7 (0111)
|
||||
|
||||
//decrement one and resume decoding
|
||||
i--;
|
||||
//NOTE: Ideally, a full path metric to find the surviving path
|
||||
//is the best way to correct this, but it is also complex and no garauntee to fix errs
|
||||
|
||||
//decrement one and try again
|
||||
if (i != 0) i--;
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//debug view tribits/states
|
||||
// fprintf (stderr, "\n T =");
|
||||
// for (i = 0; i < 49; i++)
|
||||
// for (i = 0; i < 49; i++)
|
||||
// fprintf (stderr, " %02d", tribits[i]);
|
||||
|
||||
//convert tribits into a return payload
|
||||
uint32_t temp = 0;
|
||||
|
||||
//break into chunks of 24 bit values and shuffle into 8-bit (byte) treturn values
|
||||
for (i = 0; i < 6; i++)
|
||||
if (1 == 1) //irr_err == 0
|
||||
{
|
||||
temp = (tribits[(i*8)+0] << 21) + (tribits[(i*8)+1] << 18) + (tribits[(i*8)+2] << 15) + (tribits[(i*8)+3] << 12) +
|
||||
(tribits[(i*8)+4] << 9) + (tribits[(i*8)+5] << 6) + (tribits[(i*8)+6] << 3) + (tribits[(i*8)+7] << 0);
|
||||
//break into chunks of 24 bit values and shuffle into 8-bit (byte) treturn values
|
||||
for (i = 0; i < 6; i++)
|
||||
{
|
||||
temp = (tribits[(i*8)+0] << 21) + (tribits[(i*8)+1] << 18) + (tribits[(i*8)+2] << 15) + (tribits[(i*8)+3] << 12) + (tribits[(i*8)+4] << 9) + (tribits[(i*8)+5] << 6) + (tribits[(i*8)+6] << 3) + (tribits[(i*8)+7] << 0);
|
||||
|
||||
treturn[(i*3)+0] = (temp >> 16) & 0xFF;
|
||||
treturn[(i*3)+1] = (temp >> 8) & 0xFF;
|
||||
treturn[(i*3)+2] = (temp >> 0) & 0xFF;
|
||||
treturn[(i*3)+0] = (temp >> 16) & 0xFF;
|
||||
treturn[(i*3)+1] = (temp >> 8) & 0xFF;
|
||||
treturn[(i*3)+2] = (temp >> 0) & 0xFF;
|
||||
}
|
||||
}
|
||||
|
||||
//trellis point/state err tally
|
||||
// if (irr_err != 0)
|
||||
// fprintf (stderr, " P_ERR = %d", irr_err);
|
||||
if (irr_err != 0)
|
||||
fprintf (stderr, " ERR = %d", irr_err);
|
||||
|
||||
return (0);
|
||||
return (irr_err);
|
||||
}
|
||||
|
||||
|
||||
1155
src/dmr_block.c
1155
src/dmr_block.c
File diff suppressed because it is too large
Load Diff
564
src/dmr_bs.c
564
src/dmr_bs.c
@@ -9,15 +9,13 @@
|
||||
#include "dsd.h"
|
||||
#include "dmr_const.h"
|
||||
|
||||
// #define PRINT_AMBE72 //enable to view 72-bit AMBE codewords
|
||||
|
||||
//A subroutine for processing each TDMA frame individually to allow for
|
||||
//processing voice and/or data on both BS slots (channels) simultaneously
|
||||
void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
char * timestr = NULL;
|
||||
|
||||
int i, dibit;
|
||||
int i, j, k, l, dibit;
|
||||
int *dibit_p;
|
||||
|
||||
char ambe_fr[4][24];
|
||||
char ambe_fr2[4][24];
|
||||
char ambe_fr3[4][24];
|
||||
@@ -27,22 +25,18 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
char redundancyB[36];
|
||||
|
||||
//memcpy of ambe_fr for late entry
|
||||
uint8_t m1[4][24];
|
||||
uint8_t m2[4][24];
|
||||
uint8_t m3[4][24];
|
||||
|
||||
char m1[4][24];
|
||||
char m2[4][24];
|
||||
char m3[4][24];
|
||||
|
||||
const int *w, *x, *y, *z;
|
||||
char sync[25];
|
||||
uint8_t syncdata[48];
|
||||
memset (syncdata, 0, sizeof(syncdata));
|
||||
|
||||
uint8_t emb_pdu[16];
|
||||
memset (emb_pdu, 0, sizeof(emb_pdu));
|
||||
char syncdata[48];
|
||||
char EmbeddedSignalling[16];
|
||||
|
||||
uint8_t emb_ok = 0;
|
||||
uint8_t tact_okay = 0;
|
||||
uint8_t cach_err = 0;
|
||||
UNUSED(cach_err);
|
||||
|
||||
uint8_t internalslot;
|
||||
uint8_t vc1;
|
||||
@@ -52,11 +46,27 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
uint8_t cc = 25;
|
||||
uint8_t power = 9; //power and pre-emption indicator
|
||||
uint8_t lcss = 9;
|
||||
UNUSED2(cc, lcss);
|
||||
|
||||
|
||||
//would be ideal to grab all dibits and break them into bits to pass to new data handler?
|
||||
uint8_t dummy_bits[196];
|
||||
uint8_t dummy_bits[196];
|
||||
memset (dummy_bits, 0, sizeof(dummy_bits));
|
||||
|
||||
//add time to mirror printFrameSync
|
||||
time_t now;
|
||||
char * getTime(void) //get pretty hh:mm:ss timestamp
|
||||
{
|
||||
time_t t = time(NULL);
|
||||
|
||||
char * curr;
|
||||
char * stamp = asctime(localtime( & t));
|
||||
|
||||
curr = strtok(stamp, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
|
||||
return curr;
|
||||
}
|
||||
|
||||
//Init slot lights
|
||||
sprintf (state->slot1light, " slot1 ");
|
||||
@@ -65,30 +75,20 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
//Init the color code status
|
||||
state->color_code_ok = 0;
|
||||
|
||||
//if coming from the bootsrap, then the slot will still be assigned the last value
|
||||
//we want to set only that vc value to 2, the other to 7
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
vc1 = 2;
|
||||
vc2 = 7;
|
||||
}
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
vc1 = 7;
|
||||
vc2 = 2;
|
||||
}
|
||||
vc1 = 2;
|
||||
vc2 = 2;
|
||||
|
||||
short int loop = 1;
|
||||
short int skipcount = 0;
|
||||
|
||||
//cach
|
||||
uint8_t cachdata[25];
|
||||
char cachdata[25];
|
||||
int cachInterleave[24] =
|
||||
{0, 7, 8, 9, 1, 10,
|
||||
11, 12, 2, 13, 14,
|
||||
15, 3, 16, 4, 17, 18,
|
||||
19, 5, 20, 21, 22, 6, 23
|
||||
};
|
||||
};
|
||||
|
||||
//cach tact bits
|
||||
uint8_t tact_bits[7];
|
||||
@@ -96,18 +96,9 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
//Run Loop while the getting is good
|
||||
while (loop == 1) {
|
||||
|
||||
if (exitflag == 1)
|
||||
{
|
||||
cleanupAndExit (opts, state);
|
||||
}
|
||||
|
||||
timestr = getTimeC();
|
||||
|
||||
memset (ambe_fr, 0, sizeof(ambe_fr));
|
||||
memset (ambe_fr2, 0, sizeof(ambe_fr2));
|
||||
memset (ambe_fr3, 0, sizeof(ambe_fr3));
|
||||
memset (emb_pdu, 0, sizeof(emb_pdu));
|
||||
memset (syncdata, 0, sizeof(syncdata));
|
||||
|
||||
internalslot = -1; //reset here so we know if this value is being set properly
|
||||
for(i = 0; i < 12; i++)
|
||||
@@ -196,19 +187,19 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
dibit = getDibit(opts, state);
|
||||
state->dmr_stereo_payload[i+66] = dibit;
|
||||
sync[i] = (dibit | 1) + 48; //Sync Burst String as ones and threes
|
||||
sync[i] = (dibit | 1) + 48; //how does this work again?
|
||||
|
||||
syncdata[(2*i)] = (1 & (dibit >> 1)); // bit 1
|
||||
syncdata[(2*i)+1] = (1 & dibit); // bit 0
|
||||
|
||||
//embedded link control
|
||||
if(internalslot == 0 && vc1 > 1 && vc1 < 7) //grab on vc1 values 2-5 B C D E, and F
|
||||
if(internalslot == 0 && vc1 > 1 && vc1 < 7) //grab on vc1 values 2-5 B C D and E
|
||||
{
|
||||
state->dmr_embedded_signalling[internalslot][vc1-1][i*2] = (1 & (dibit >> 1)); // bit 1
|
||||
state->dmr_embedded_signalling[internalslot][vc1-1][i*2+1] = (1 & dibit); // bit 0
|
||||
}
|
||||
|
||||
if(internalslot == 1 && vc2 > 1 && vc2 < 7) //grab on vc2 values 2-5 B C D E, and F
|
||||
if(internalslot == 1 && vc2 > 1 && vc2 < 7) //grab on vc2 values 2-5 B C D and E
|
||||
{
|
||||
state->dmr_embedded_signalling[internalslot][vc2-1][i*2] = (1 & (dibit >> 1)); // bit 1
|
||||
state->dmr_embedded_signalling[internalslot][vc2-1][i*2+1] = (1 & dibit); // bit 0
|
||||
@@ -217,8 +208,8 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
sync[24] = 0;
|
||||
|
||||
for(i = 0; i < 8; i++) emb_pdu[i + 0] = syncdata[i];
|
||||
for(i = 0; i < 8; i++) emb_pdu[i + 8] = syncdata[i + 40];
|
||||
for(i = 0; i < 8; i++) EmbeddedSignalling[i] = syncdata[i];
|
||||
for(i = 0; i < 8; i++) EmbeddedSignalling[i + 8] = syncdata[i + 40];
|
||||
|
||||
//Continue Second AMBE Frame, 18 after Sync or EmbeddedSignalling
|
||||
for(i = 0; i < 18; i++)
|
||||
@@ -267,8 +258,8 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
//check for sync pattern here after collected the rest of the payload, decide what to do with it
|
||||
if ( strcmp (sync, DMR_BS_DATA_SYNC) == 0 )
|
||||
{
|
||||
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
|
||||
fprintf (stderr,"%s ", getTime());
|
||||
if (internalslot == 0)
|
||||
{
|
||||
if (opts->inverted_dmr == 0)
|
||||
@@ -276,11 +267,11 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
fprintf (stderr,"Sync: +DMR ");
|
||||
}
|
||||
else fprintf (stderr,"Sync: -DMR ");
|
||||
|
||||
vc1 = 7; //set to 7 so we can see that we should not be on a VC unless a framesync comes in for it first
|
||||
|
||||
vc1 = 1;
|
||||
|
||||
//close MBEout file - slot 1
|
||||
if (opts->mbe_out_f != NULL) closeMbeOutFile (opts, state);
|
||||
if (opts->mbe_out_f != NULL) closeMbeOutFile (opts, state);
|
||||
}
|
||||
if (internalslot == 1)
|
||||
{
|
||||
@@ -290,7 +281,7 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
else fprintf (stderr,"Sync: -DMR ");
|
||||
|
||||
vc2 = 7; //set to 7 so we can see that we should not be on a VC unless a framesync comes in for it first
|
||||
vc2 = 1;
|
||||
|
||||
//close MBEout file - slot 2
|
||||
if (opts->mbe_out_fR != NULL) closeMbeOutFileR (opts, state);
|
||||
@@ -301,138 +292,26 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
goto SKIP;
|
||||
}
|
||||
|
||||
//ETSI TS 102 361-1 V2.6.1 Table E.2 and E.4
|
||||
//check for a rc burst with bptc or 34 rate data in it (testing only)
|
||||
// #define RC_TESTING //disable if not in use
|
||||
#ifdef RC_TESTING
|
||||
|
||||
//skip the vc counter, just look at the QR and P/Pi if not voice or data sync pattern
|
||||
if ( (strcmp (sync, DMR_BS_DATA_SYNC) != 0) && (strcmp (sync, DMR_BS_VOICE_SYNC) != 0) )
|
||||
//only play voice on no data sync
|
||||
if (strcmp (sync, DMR_BS_DATA_SYNC) != 0) //we already have a tact ecc check, so we won't get here without that, see if there is any other eccs we can run just to make sure
|
||||
{
|
||||
|
||||
//Golay_20_8_decode FEC for the burst type (SlotType)
|
||||
unsigned char SlotType[20];
|
||||
memset (SlotType, 0, sizeof(SlotType));
|
||||
uint8_t k = 61;
|
||||
for (uint8_t i = 0; i < 5; i++)
|
||||
{
|
||||
SlotType[(i*2)+0] = (state->dmr_stereo_payload[k+0] >> 1) & 1;
|
||||
SlotType[(i*2)+1] = (state->dmr_stereo_payload[k++] >> 0) & 1;
|
||||
}
|
||||
k = 90;
|
||||
for (uint8_t i = 0; i < 5; i++)
|
||||
{
|
||||
SlotType[(i*2)+10] = (state->dmr_stereo_payload[k+0] >> 1) & 1;
|
||||
SlotType[(i*2)+11] = (state->dmr_stereo_payload[k++] >> 0) & 1;
|
||||
}
|
||||
|
||||
//if the QR FEC is good, tact/cach FEC is good, and slot type burst FEC is good, and the P/PI bit is on for RC
|
||||
//NOTE: This can still trigger on bad signal when it should be a data sync pattern but signal drops out or
|
||||
//occassionally on p_clear with trunking tuner logic active and partial stale dibits in the buffer
|
||||
if (QR_16_7_6_decode(emb_pdu) && emb_pdu[4] && tact_okay == 1) //during voice test
|
||||
{
|
||||
|
||||
if (Golay_20_8_decode(SlotType))
|
||||
{
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
if (opts->inverted_dmr == 0)
|
||||
fprintf (stderr,"Sync: +RC ");
|
||||
else fprintf (stderr,"Sync: -RC ");
|
||||
|
||||
dmr_data_sync (opts, state);
|
||||
}
|
||||
|
||||
for (i = 0; i < 48; i++)
|
||||
state->dmr_embedded_signalling[internalslot][5][i] = syncdata[i];
|
||||
|
||||
dmr_sbrc (opts, state, emb_pdu[4]);
|
||||
|
||||
emb_ok = 1;
|
||||
|
||||
//give an audio cue when this happens (low, high)
|
||||
beeper (opts, state, internalslot, 40, 86, 3);
|
||||
beeper (opts, state, internalslot, 80, 86, 3);
|
||||
|
||||
//put into Event History
|
||||
state->event_history_s[0].Event_History_Items[internalslot].color_pair = 4;
|
||||
watchdog_event_datacall (opts, state, 0, 0, "DMR Reverse Channel P/PI Indicator On (FEC Okay);", internalslot);
|
||||
push_event_history (&state->event_history_s[internalslot]);
|
||||
init_event_history (&state->event_history_s[internalslot], 0, 1);
|
||||
|
||||
if (Golay_20_8_decode(SlotType))
|
||||
{
|
||||
skipcount++;
|
||||
goto SKIP;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
#endif //RC_TESTING
|
||||
|
||||
//check to see if we are expecting a VC at this point vc > 7
|
||||
if (strcmp (sync, DMR_BS_DATA_SYNC) != 0 && internalslot == 0 && vc1 > 6)
|
||||
{
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
|
||||
//simplifying things
|
||||
// char polarity[3];
|
||||
char light[18];
|
||||
|
||||
sprintf (light, "%s", " [SLOT1] slot2 ");
|
||||
fprintf (stderr,"Sync: DMR %s", light);
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, "| Frame Sync Err: %d", vc1);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
fprintf (stderr, "\n");
|
||||
vc1++;
|
||||
//this should give it enough time to find the next frame sync pattern, if it exists, if not, then trigger a resync
|
||||
if ( vc1 > 13 ) goto END;
|
||||
else goto SKIP;
|
||||
}
|
||||
|
||||
//check to see if we are expecting a VC at this point vc > 7
|
||||
if (strcmp (sync, DMR_BS_DATA_SYNC) != 0 && internalslot == 1 && vc2 > 6)
|
||||
{
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
|
||||
//simplifying things
|
||||
// char polarity[3];
|
||||
char light[18];
|
||||
|
||||
sprintf (light, "%s", " slot1 [SLOT2] ");
|
||||
fprintf (stderr,"Sync: DMR %s", light);
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, "| Frame Sync Err: %d", vc2);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
fprintf (stderr, "\n");
|
||||
vc2++;
|
||||
//this should give it enough time to find the next frame sync pattern, if it exists, if not, then trigger a resync
|
||||
if ( vc2 > 13 ) goto END;
|
||||
else goto SKIP;
|
||||
}
|
||||
|
||||
//only play voice on no data sync, and VC values are within expected values 1-6
|
||||
if (strcmp (sync, DMR_BS_DATA_SYNC) != 0) //we already have a tact ecc check, so we won't get here without that, see if there is any other eccs we can run just to make sure
|
||||
{
|
||||
|
||||
//check the embedded signalling, if bad at this point, we probably aren't quite in sync
|
||||
if(QR_16_7_6_decode(emb_pdu)) emb_ok = 1;
|
||||
//check the embedded signalling, if bad at this point, we probably aren't quite in sync
|
||||
if(QR_16_7_6_decode(EmbeddedSignalling)) emb_ok = 1;
|
||||
else emb_ok = 0;
|
||||
|
||||
//disable the goto END; if this causes more problems than fixing on late entry dual voices i.e., lots of forced resyncs
|
||||
if ( (strcmp (sync, DMR_BS_VOICE_SYNC) != 0) && emb_ok == 0) goto END; //fprintf (stderr, "EMB BAD? ");
|
||||
else if (emb_ok == 1)
|
||||
{
|
||||
cc = ((emb_pdu[0] << 3) + (emb_pdu[1] << 2) + (emb_pdu[2] << 1) + emb_pdu[3]);
|
||||
power = emb_pdu[4];
|
||||
lcss = ((emb_pdu[5] << 1) + emb_pdu[6]);
|
||||
state->dmr_color_code = state->color_code = cc;
|
||||
cc = ((EmbeddedSignalling[0] << 3) + (EmbeddedSignalling[1] << 2) + (EmbeddedSignalling[2] << 1) + EmbeddedSignalling[3]);
|
||||
power = EmbeddedSignalling[4];
|
||||
lcss = ((EmbeddedSignalling[5] << 1) + EmbeddedSignalling[6]);
|
||||
}
|
||||
|
||||
|
||||
skipcount = 0; //reset skip count if processing voice frames
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
fprintf (stderr,"%s ", getTime());
|
||||
|
||||
//simplifying things
|
||||
char polarity[3];
|
||||
@@ -445,7 +324,7 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
sprintf (light, "%s", " [SLOT1] slot2 ");
|
||||
//open MBEout file - slot 1
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL)) openMbeOutFile (opts, state);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
state->dmrburstR = 16;
|
||||
@@ -453,18 +332,14 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
sprintf (light, "%s", " slot1 [SLOT2] ");
|
||||
//open MBEout file - slot 2
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_fR == NULL)) openMbeOutFileR (opts, state);
|
||||
}
|
||||
}
|
||||
if (opts->inverted_dmr == 0) sprintf (polarity, "%s", "+");
|
||||
else sprintf (polarity, "%s", "-");
|
||||
if (state->dmr_color_code != 16)
|
||||
fprintf (stderr,"Sync: %sDMR %s| Color Code=%02d | VC%d ", polarity, light, state->dmr_color_code, vc);
|
||||
else fprintf (stderr,"Sync: %sDMR %s| Color Code=XX | VC%d ", polarity, light, vc);
|
||||
|
||||
if (internalslot == 0 && vc1 == 6)
|
||||
fprintf (stderr,"Sync: %sDMR %s| Color Code=%02d | VC%d ", polarity, light, state->dmr_color_code, vc);
|
||||
|
||||
if (internalslot == 0 && vc1 == 6)
|
||||
{
|
||||
//this needs to run prior to embedded link control
|
||||
if (state->payload_algid == 0x02)
|
||||
hytera_enhanced_alg_refresh(state);
|
||||
//process embedded link control
|
||||
fprintf (stderr, "\n");
|
||||
dmr_data_burst_handler(opts, state, (uint8_t *)dummy_bits, 0xEB);
|
||||
@@ -473,11 +348,8 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
}
|
||||
|
||||
if (internalslot == 1 && vc2 == 6)
|
||||
if (internalslot == 1 && vc2 == 6)
|
||||
{
|
||||
//this needs to run prior to embedded link control
|
||||
if (state->payload_algidR == 0x02)
|
||||
hytera_enhanced_alg_refresh(state);
|
||||
//process embedded link control
|
||||
fprintf (stderr, "\n");
|
||||
dmr_data_burst_handler(opts, state, (uint8_t *)dummy_bits, 0xEB);
|
||||
@@ -488,74 +360,42 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
if (opts->payload == 1) fprintf (stderr, "\n"); //extra line break necessary here
|
||||
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//we go to do correction on them there too
|
||||
memcpy (m1, ambe_fr, sizeof(m1));
|
||||
memcpy (m2, ambe_fr2, sizeof(m2));
|
||||
memcpy (m3, ambe_fr3, sizeof(m3));
|
||||
|
||||
if (state->tyt_bp == 1)
|
||||
{
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr, 0);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr2, 1);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr3, 0);
|
||||
}
|
||||
|
||||
#ifdef PRINT_AMBE72
|
||||
ambe2_codeword_print_i(opts, ambe_fr);
|
||||
ambe2_codeword_print_i(opts, ambe_fr2);
|
||||
ambe2_codeword_print_i(opts, ambe_fr3);
|
||||
#endif
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
||||
if(internalslot == 0)
|
||||
{
|
||||
memcpy(state->f_l4[0], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[0], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[0], state->s_lu, sizeof(state->s_lu));
|
||||
}
|
||||
|
||||
else
|
||||
{
|
||||
memcpy(state->f_r4[0], state->audio_out_temp_bufR, sizeof(state->audio_out_temp_bufR));
|
||||
memcpy(state->s_r4[0], state->s_r, sizeof(state->s_r));
|
||||
memcpy(state->s_r4u[0], state->s_ru, sizeof(state->s_ru));
|
||||
}
|
||||
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
if(internalslot == 0)
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
|
||||
//run sbrc here to look for the late entry key and alg after we observe potential errors in VC6
|
||||
if (internalslot == 0 && vc1 == 6) dmr_sbrc (opts, state, power);
|
||||
if (internalslot == 1 && vc2 == 6) dmr_sbrc (opts, state, power);
|
||||
|
||||
cach_err = dmr_cach (opts, state, cachdata);
|
||||
if (opts->payload == 0) fprintf (stderr, "\n");
|
||||
|
||||
// run alg refresh after vc6 ambe processing
|
||||
if (internalslot == 0 && vc1 == 6) dmr_alg_refresh (opts, state);
|
||||
if (internalslot == 1 && vc2 == 6) dmr_alg_refresh (opts, state);
|
||||
|
||||
dmr_late_entry_mi_fragment (opts, state, vc, m1, m2, m3);
|
||||
|
||||
//increment the vc counters
|
||||
if (internalslot == 0) vc1++;
|
||||
if (internalslot == 1) vc2++;
|
||||
|
||||
//update cc amd vc sync time for trunking purposes (particularly Con+)
|
||||
if (opts->p25_is_tuned == 1)
|
||||
{
|
||||
memcpy(state->f_l4[1], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[1], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[1], state->s_lu, sizeof(state->s_lu));
|
||||
state->last_vc_sync_time = time(NULL);
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
}
|
||||
|
||||
else
|
||||
{
|
||||
memcpy(state->f_r4[1], state->audio_out_temp_bufR, sizeof(state->audio_out_temp_bufR));
|
||||
memcpy(state->s_r4[1], state->s_r, sizeof(state->s_r));
|
||||
memcpy(state->s_r4u[1], state->s_ru, sizeof(state->s_ru));
|
||||
}
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
if(internalslot == 0)
|
||||
{
|
||||
memcpy(state->f_l4[2], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[2], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[2], state->s_lu, sizeof(state->s_lu));
|
||||
}
|
||||
|
||||
else
|
||||
{
|
||||
memcpy(state->f_r4[2], state->audio_out_temp_bufR, sizeof(state->audio_out_temp_bufR));
|
||||
memcpy(state->s_r4[2], state->s_r, sizeof(state->s_r));
|
||||
memcpy(state->s_r4u[2], state->s_ru, sizeof(state->s_ru));
|
||||
}
|
||||
|
||||
|
||||
//'DSP' output to file -- run before sbrc
|
||||
//'DSP' output to file
|
||||
if (opts->use_dsp_output == 1)
|
||||
{
|
||||
FILE * pFile; //file pointer
|
||||
@@ -573,41 +413,13 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
fprintf (pFile, "%X", dsp_byte);
|
||||
}
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
//run sbrc here to look for the late entry key and alg after we observe potential errors in VC6
|
||||
if (internalslot == 0 && vc1 == 6) dmr_sbrc (opts, state, power);
|
||||
if (internalslot == 1 && vc2 == 6) dmr_sbrc (opts, state, power);
|
||||
|
||||
cach_err = dmr_cach (opts, state, cachdata);
|
||||
if (opts->payload == 0) fprintf (stderr, "\n");
|
||||
|
||||
// run alg refresh after vc6 ambe processing
|
||||
if (internalslot == 0 && vc1 == 6) dmr_alg_refresh (opts, state);
|
||||
if (internalslot == 1 && vc2 == 6) dmr_alg_refresh (opts, state);
|
||||
|
||||
if (internalslot == 0 && vc1 == 6) state->static_ks_counter[0] = 0;
|
||||
if (internalslot == 1 && vc2 == 6) state->static_ks_counter[1] = 0;
|
||||
|
||||
if (opts->dmr_le != 2) //if not Hytera Enhanced
|
||||
dmr_late_entry_mi_fragment (opts, state, vc%7, m1, m2, m3);
|
||||
|
||||
//increment the vc counters
|
||||
if (internalslot == 0) vc1++;
|
||||
if (internalslot == 1) vc2++;
|
||||
|
||||
//update cc amd vc sync time for trunking purposes (particularly Con+)
|
||||
if (opts->p25_is_tuned == 1)
|
||||
{
|
||||
state->last_vc_sync_time = time(NULL);
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
}
|
||||
}
|
||||
|
||||
//reset err checks
|
||||
cach_err = 1;
|
||||
tact_okay = 0;
|
||||
emb_ok = 0;
|
||||
|
||||
|
||||
//reset emb components
|
||||
cc = 25;
|
||||
power = 9;
|
||||
@@ -620,17 +432,9 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
|
||||
SKIP:
|
||||
|
||||
//both working now, will need support added for ENC audio and no key
|
||||
//NOTE: We want this to play regardless of whether the slot is voice or data, to play silence in one slot and voice in the second, or voices in both
|
||||
if (internalslot == 1 && opts->floating_point == 1 && opts->pulse_digi_rate_out == 8000)
|
||||
playSynthesizedVoiceFS3 (opts, state); //Float Stereo Mix 3v2
|
||||
if (internalslot == 1 && opts->floating_point == 0 && opts->pulse_digi_rate_out == 8000)
|
||||
playSynthesizedVoiceSS3 (opts, state); //Short Stereo Mix 3v2
|
||||
|
||||
if (skipcount > 3) //after 3 onsecutive data frames, drop back to getFrameSync and process with dmr_data_sync (need one more in order to push last voice on slot 2 only voice)
|
||||
if (skipcount > 2) //after 2 consecutive data frames, drop back to getFrameSync and process with dmr_data_sync
|
||||
{
|
||||
//set tests to all good so we don't get a bogus/redundant voice error
|
||||
//set tests to all good so we don't get a bogus/redundant voice error
|
||||
cach_err = 0;
|
||||
tact_okay = 1;
|
||||
emb_ok = 1;
|
||||
@@ -643,21 +447,6 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
ncursesPrinter(opts, state);
|
||||
}
|
||||
|
||||
//slot 1
|
||||
watchdog_event_history(opts, state, 0);
|
||||
watchdog_event_current(opts, state, 0);
|
||||
|
||||
//slot 2 for TDMA systems
|
||||
watchdog_event_history(opts, state, 1);
|
||||
watchdog_event_current(opts, state, 1);
|
||||
|
||||
//
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
|
||||
} // while loop
|
||||
|
||||
END:
|
||||
@@ -671,17 +460,11 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
if (opts->mbe_out_f != NULL) closeMbeOutFile (opts, state);
|
||||
if (opts->mbe_out_fR != NULL) closeMbeOutFileR (opts, state);
|
||||
|
||||
//clear out any stale audio storage buffers
|
||||
memset (state->f_l4, 0.0f, sizeof(state->f_l4));
|
||||
memset (state->f_r4, 0.0f, sizeof(state->f_r4));
|
||||
memset (state->s_l4, 0, sizeof(state->s_l4));
|
||||
memset (state->s_r4, 0, sizeof(state->s_r4));
|
||||
|
||||
//if we have a tact or emb err, then produce sync pattern/err message
|
||||
if (tact_okay != 1 || emb_ok != 1)
|
||||
{
|
||||
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
fprintf (stderr,"%s ", getTime());
|
||||
fprintf (stderr,"Sync: DMR ");
|
||||
fprintf (stderr, "%s", KRED);
|
||||
fprintf (stderr, "| VOICE CACH/EMB ERR");
|
||||
@@ -693,46 +476,23 @@ void dmrBS (dsd_opts * opts, dsd_state * state)
|
||||
state->currentslot = 0;
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
else if (state->payload_algid == 0x02)
|
||||
{
|
||||
hytera_enhanced_alg_refresh(state);
|
||||
state->currentslot = 0;
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
if (state->payload_algidR >= 0x21)
|
||||
if (state->payload_algidR >= 0x21)
|
||||
{
|
||||
state->currentslot = 1;
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
else if (state->payload_algidR == 0x02)
|
||||
{
|
||||
hytera_enhanced_alg_refresh(state);
|
||||
state->currentslot = 1;
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
|
||||
|
||||
//failsafe to reset all data header and blocks when bad tact or emb
|
||||
dmr_reset_blocks (opts, state);
|
||||
|
||||
dmr_reset_blocks (opts, state);
|
||||
|
||||
}
|
||||
|
||||
//
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
|
||||
//reset static ks counter
|
||||
state->static_ks_counter[0] = 0;
|
||||
state->static_ks_counter[1] = 0;
|
||||
|
||||
}
|
||||
|
||||
//Process buffered half frame and 2nd half and then jump to full BS decoding
|
||||
void dmrBSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
int i, dibit;
|
||||
int i, j, k, l, dibit;
|
||||
int *dibit_p;
|
||||
char ambe_fr[4][24];
|
||||
char ambe_fr2[4][24];
|
||||
@@ -743,28 +503,41 @@ void dmrBSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
memset (ambe_fr3, 0, sizeof(ambe_fr3));
|
||||
|
||||
//memcpy of ambe_fr for late entry
|
||||
uint8_t m1[4][24];
|
||||
uint8_t m2[4][24];
|
||||
uint8_t m3[4][24];
|
||||
char m1[4][24];
|
||||
char m2[4][24];
|
||||
char m3[4][24];
|
||||
|
||||
const int *w, *x, *y, *z;
|
||||
char sync[25];
|
||||
uint8_t tact_okay = 0;
|
||||
uint8_t cach_err = 0;
|
||||
uint8_t sync_okay = 1;
|
||||
UNUSED(cach_err);
|
||||
|
||||
uint8_t internalslot;
|
||||
|
||||
uint8_t cachdata[25];
|
||||
char cachdata[25];
|
||||
int cachInterleave[24] =
|
||||
{0, 7, 8, 9, 1, 10,
|
||||
11, 12, 2, 13, 14,
|
||||
15, 3, 16, 4, 17, 18,
|
||||
19, 5, 20, 21, 22, 6, 23
|
||||
};
|
||||
};
|
||||
//add time to mirror printFrameSync
|
||||
time_t now;
|
||||
char * getTime(void) //get pretty hh:mm:ss timestamp
|
||||
{
|
||||
time_t t = time(NULL);
|
||||
|
||||
char * timestr = getTimeC();
|
||||
char * curr;
|
||||
char * stamp = asctime(localtime( & t));
|
||||
|
||||
curr = strtok(stamp, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
|
||||
return curr;
|
||||
}
|
||||
|
||||
//payload buffer
|
||||
//CACH + First Half Payload + Sync = 12 + 54 + 24
|
||||
@@ -797,9 +570,6 @@ void dmrBSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
internalslot = state->currentslot = tact_bits[1];
|
||||
|
||||
//reset static ks counter
|
||||
state->static_ks_counter[internalslot] = 0;
|
||||
|
||||
//Setup for first AMBE Frame
|
||||
|
||||
//Interleave Schedule
|
||||
@@ -916,7 +686,7 @@ void dmrBSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
fprintf (stderr,"%s ", getTime());
|
||||
char polarity[3];
|
||||
char light[18];
|
||||
|
||||
@@ -925,95 +695,34 @@ void dmrBSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
sprintf (light, "%s", " [SLOT1] slot2 ");
|
||||
//open MBEout file - slot 1
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL)) openMbeOutFile (opts, state);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
sprintf (light, "%s", " slot1 [SLOT2] ");
|
||||
//open MBEout file - slot 2
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_fR == NULL)) openMbeOutFileR (opts, state);
|
||||
}
|
||||
}
|
||||
if (opts->inverted_dmr == 0) sprintf (polarity, "%s", "+");
|
||||
else sprintf (polarity, "%s", "-");
|
||||
if (state->dmr_color_code != 16)
|
||||
fprintf (stderr,"Sync: %sDMR %s| Color Code=%02d | VC1*", polarity, light, state->dmr_color_code);
|
||||
else fprintf (stderr,"Sync: %sDMR %s| Color Code=XX | VC1*", polarity, light);
|
||||
|
||||
fprintf (stderr,"Sync: %sDMR %s| Color Code=%02d | VC1*", polarity, light, state->dmr_color_code);
|
||||
|
||||
dmr_alg_reset (opts, state);
|
||||
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//we go to do correction on them there too
|
||||
memcpy (m1, ambe_fr, sizeof(m1));
|
||||
memcpy (m2, ambe_fr2, sizeof(m2));
|
||||
memcpy (m3, ambe_fr3, sizeof(m3));
|
||||
|
||||
if (state->tyt_bp == 1)
|
||||
{
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr, 0);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr2, 1);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr3, 0);
|
||||
}
|
||||
|
||||
#ifdef PRINT_AMBE72
|
||||
ambe2_codeword_print_i(opts, ambe_fr);
|
||||
ambe2_codeword_print_i(opts, ambe_fr2);
|
||||
ambe2_codeword_print_i(opts, ambe_fr3);
|
||||
#endif
|
||||
|
||||
if (opts->payload == 1) fprintf (stderr, "\n"); //extra line break necessary here
|
||||
// processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
||||
// processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
// processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
||||
if(internalslot == 0)
|
||||
{
|
||||
memcpy(state->f_l4[0], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[0], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[0], state->s_lu, sizeof(state->s_lu));
|
||||
}
|
||||
|
||||
else
|
||||
{
|
||||
memcpy(state->f_r4[0], state->audio_out_temp_bufR, sizeof(state->audio_out_temp_bufR));
|
||||
memcpy(state->s_r4[0], state->s_r, sizeof(state->s_r));
|
||||
memcpy(state->s_r4u[0], state->s_ru, sizeof(state->s_ru));
|
||||
}
|
||||
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
if(internalslot == 0)
|
||||
{
|
||||
memcpy(state->f_l4[1], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[1], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[1], state->s_lu, sizeof(state->s_lu));
|
||||
}
|
||||
|
||||
else
|
||||
{
|
||||
memcpy(state->f_r4[1], state->audio_out_temp_bufR, sizeof(state->audio_out_temp_bufR));
|
||||
memcpy(state->s_r4[1], state->s_r, sizeof(state->s_r));
|
||||
memcpy(state->s_r4u[1], state->s_ru, sizeof(state->s_ru));
|
||||
}
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
if(internalslot == 0)
|
||||
{
|
||||
memcpy(state->f_l4[2], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[2], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[2], state->s_lu, sizeof(state->s_lu));
|
||||
}
|
||||
|
||||
else
|
||||
{
|
||||
memcpy(state->f_r4[2], state->audio_out_temp_bufR, sizeof(state->audio_out_temp_bufR));
|
||||
memcpy(state->s_r4[2], state->s_r, sizeof(state->s_r));
|
||||
memcpy(state->s_r4u[2], state->s_ru, sizeof(state->s_ru));
|
||||
}
|
||||
|
||||
//collect the mi fragment
|
||||
if (opts->dmr_le != 2) //if not Hytera Enhanced
|
||||
dmr_late_entry_mi_fragment (opts, state, 1, m1, m2, m3);
|
||||
dmr_late_entry_mi_fragment (opts, state, 1, m1, m2, m3);
|
||||
|
||||
cach_err = dmr_cach (opts, state, cachdata);
|
||||
if (opts->payload == 0) fprintf (stderr, "\n");
|
||||
@@ -1021,18 +730,12 @@ void dmrBSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
//update voice sync time for trunking purposes (particularly Con+)
|
||||
if (opts->p25_is_tuned == 1) state->last_vc_sync_time = time(NULL);
|
||||
|
||||
//NOTE: Only play on slot 1, if slot 0, then it'll play after the next TDMA frame in the BS loop instead
|
||||
if (internalslot == 1 && opts->floating_point == 1 && opts->pulse_digi_rate_out == 8000)
|
||||
playSynthesizedVoiceFS3 (opts, state); //Float Stereo Mix 3v2
|
||||
if (internalslot == 1 && opts->floating_point == 0 && opts->pulse_digi_rate_out == 8000)
|
||||
playSynthesizedVoiceSS3 (opts, state); //Short Stereo Mix 3v2
|
||||
|
||||
dmrBS (opts, state); //bootstrap into full TDMA frame for BS mode
|
||||
END:
|
||||
//if we have a tact err, then produce sync pattern/err message
|
||||
if (tact_okay != 1 || sync_okay != 1)
|
||||
{
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
fprintf (stderr,"%s ", getTime());
|
||||
fprintf (stderr,"Sync: DMR ");
|
||||
fprintf (stderr, "%s", KRED);
|
||||
fprintf (stderr, "| VOICE CACH/SYNC ERR");
|
||||
@@ -1044,32 +747,15 @@ void dmrBSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
state->currentslot = 0;
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
else if (state->payload_algid == 0x02)
|
||||
{
|
||||
state->currentslot = 0;
|
||||
hytera_enhanced_alg_refresh(state);
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
if (state->payload_algidR >= 0x21)
|
||||
if (state->payload_algidR >= 0x21)
|
||||
{
|
||||
state->currentslot = 1;
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
else if (state->payload_algid == 0x02)
|
||||
{
|
||||
hytera_enhanced_alg_refresh(state);
|
||||
state->currentslot = 1;
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
|
||||
|
||||
//failsafe to reset all data header and blocks when bad tact or emb
|
||||
dmr_reset_blocks (opts, state);
|
||||
dmr_reset_blocks (opts, state);
|
||||
}
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
1672
src/dmr_csbk.c
1672
src/dmr_csbk.c
File diff suppressed because it is too large
Load Diff
@@ -25,17 +25,16 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
int *dibit_p;
|
||||
char sync[25];
|
||||
char syncdata[48];
|
||||
uint8_t cachdata[25];
|
||||
UNUSED(syncdata);
|
||||
char cachdata[25];
|
||||
|
||||
char bursttype[5];
|
||||
uint8_t burst;
|
||||
char info[196];
|
||||
unsigned char SlotType[20];
|
||||
unsigned char SlotType[20];
|
||||
unsigned int SlotTypeOk;
|
||||
uint8_t cach_err = 0;
|
||||
UNUSED(cach_err);
|
||||
|
||||
int cachInterleave[24] =
|
||||
int cachInterleave[24] =
|
||||
{0, 7, 8, 9, 1, 10,
|
||||
11, 12, 2, 13, 14,
|
||||
15, 3, 16, 4, 17, 18,
|
||||
@@ -43,7 +42,7 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
};
|
||||
|
||||
dibit_p = state->dmr_payload_p - 90;
|
||||
|
||||
|
||||
//collect cach and de-interleave
|
||||
for (i = 0; i < 12; i++)
|
||||
{
|
||||
@@ -116,7 +115,7 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
if (state->dmr_stereo == 1)
|
||||
{
|
||||
dibit = (int)state->dmr_stereo_payload[61];
|
||||
dibit = (int)state->dmr_stereo_payload[61];
|
||||
}
|
||||
else state->dmr_stereo_payload[61] = dibit;
|
||||
|
||||
@@ -146,7 +145,7 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
if (state->dmr_stereo == 1) //state
|
||||
{
|
||||
dibit = (int)state->dmr_stereo_payload[63];
|
||||
dibit = (int)state->dmr_stereo_payload[63];
|
||||
}
|
||||
else state->dmr_stereo_payload[63] = dibit;
|
||||
|
||||
@@ -161,7 +160,7 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
if (state->dmr_stereo == 1) //state
|
||||
{
|
||||
dibit = (int)state->dmr_stereo_payload[64];
|
||||
dibit = (int)state->dmr_stereo_payload[64];
|
||||
}
|
||||
else state->dmr_stereo_payload[64] = dibit;
|
||||
|
||||
@@ -194,7 +193,7 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
if (state->dmr_stereo == 1)
|
||||
{
|
||||
dibit = (int)state->dmr_stereo_payload[i+66];
|
||||
dibit = (int)state->dmr_stereo_payload[i+66];
|
||||
}
|
||||
else state->dmr_stereo_payload[i+66] = dibit;
|
||||
|
||||
@@ -202,7 +201,7 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
syncdata[(2*i)+1] = (1 & dibit); // bit 0
|
||||
sync[i] = (dibit | 1) + 48;
|
||||
}
|
||||
sync[24] = 0;
|
||||
sync[24] = 0;
|
||||
|
||||
if((strcmp (sync, DMR_BS_DATA_SYNC) == 0) )
|
||||
{
|
||||
@@ -240,21 +239,21 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
// Slot type - Second part - Parity bit
|
||||
for (i = 0; i < 5; i++)
|
||||
{
|
||||
if (state->dmr_stereo == 0)
|
||||
if (state->dmr_stereo == 0)
|
||||
{
|
||||
dibit = getDibit(opts, state);
|
||||
state->dmr_stereo_payload[i+90] = dibit;
|
||||
}
|
||||
if (state->dmr_stereo == 1)
|
||||
{
|
||||
dibit = (int)state->dmr_stereo_payload[i+90];
|
||||
dibit = (int)state->dmr_stereo_payload[i+90];
|
||||
}
|
||||
SlotType[(i*2) + 10] = (1 & (dibit >> 1)); // bit 1
|
||||
SlotType[(i*2) + 11] = (1 & dibit); // bit 0
|
||||
}
|
||||
|
||||
/* Check and correct the SlotType (apply Golay(20,8) FEC check) */
|
||||
|
||||
|
||||
// golay (20,8) hamming-weight of 6 reliably corrects at most 2 bit-errors
|
||||
if( Golay_20_8_decode(SlotType) ) SlotTypeOk = 1;
|
||||
else
|
||||
@@ -278,7 +277,7 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
// Current slot - Second Half - Data Payload - 2nd part
|
||||
for (i = 0; i < 49; i++)
|
||||
{
|
||||
if (state->dmr_stereo == 0)
|
||||
if (state->dmr_stereo == 0)
|
||||
{
|
||||
dibit = getDibit(opts, state);
|
||||
state->dmr_stereo_payload[i+95] = dibit;
|
||||
@@ -286,21 +285,21 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
if (state->dmr_stereo == 1)
|
||||
{
|
||||
dibit = (int)state->dmr_stereo_payload[i+95];
|
||||
dibit = (int)state->dmr_stereo_payload[i+95];
|
||||
}
|
||||
|
||||
info[(2*i) + 98] = (1 & (dibit >> 1)); // bit 1
|
||||
info[(2*i) + 99] = (1 & dibit); // bit 0
|
||||
}
|
||||
|
||||
//
|
||||
dmr_data_burst_handler(opts, state, (uint8_t *)info, burst);
|
||||
|
||||
//don't run on MS Reverse Channel Data
|
||||
if (state->dmr_ms_rc == 0) dmr_data_burst_handler(opts, state, (uint8_t *)info, burst);
|
||||
|
||||
//don't run cach on simplex or mono
|
||||
if (state->dmr_ms_mode == 0 && opts->dmr_mono == 0)
|
||||
{
|
||||
cach_err = dmr_cach (opts, state, cachdata);
|
||||
}
|
||||
}
|
||||
|
||||
//ending line break
|
||||
fprintf(stderr, "\n");
|
||||
@@ -316,30 +315,38 @@ dmr_data_sync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
|
||||
// Skip cach (24 bit = 12 dibit) and next slot 1st half (98 + 10 bit = 49 + 5 dibit)
|
||||
if (state->dmr_stereo == 0)
|
||||
if (state->dmr_stereo == 0)
|
||||
{
|
||||
skipDibit (opts, state, 12 + 49 + 5);
|
||||
}
|
||||
|
||||
#define CON_TUNEAWAY //disable if any unlock issues noted on the logic
|
||||
|
||||
#ifdef CON_TUNEAWAY
|
||||
//simplified, if IDLE condition, drop cc and vc sync time so when RF channel tears down, we go back much quicker
|
||||
//NOTE: This was adopted, because going back to the CC early and then to be sent back to the channel grant,
|
||||
//only for it to tear down and being sent back to the CC again isn't very efficient for trunk tracking
|
||||
//NOTE: This will still leave the tuner in the 'locked' state when tuning a voice channel grant on the CC,
|
||||
//and will remain locked until a new voice channel grant is received, but its just asthetic, trying to fix it
|
||||
//is too much of a hassle and causes other issues like CC hunting, etc.
|
||||
//if using con+ trunking and last voice observed more than x seconds ago, snap back to con+ cc
|
||||
//con+ voice channels can have extremely long idle periods without properly tearing down
|
||||
if (opts->p25_trunk == 1 && opts->p25_is_tuned == 1 && state->is_con_plus == 1)
|
||||
{
|
||||
int clear = 0;
|
||||
//IF both slots currently signalling IDLE
|
||||
if (state->dmrburstL == 9 && state->dmrburstR == 9) clear = 1;
|
||||
if (clear == 1)
|
||||
//bug fixed that caused hopping from CC to VC; decreased to 2 seconds.
|
||||
if ( (time(NULL) - state->last_vc_sync_time > 2) )
|
||||
{
|
||||
state->last_cc_sync_time = 0;
|
||||
state->last_vc_sync_time = 0;
|
||||
if (opts->use_rigctl == 1) //rigctl tuning
|
||||
{
|
||||
if (opts->setmod_bw != 0) SetModulation(opts->rigctl_sockfd, opts->setmod_bw);
|
||||
SetFreq(opts->rigctl_sockfd, state->p25_cc_freq);
|
||||
}
|
||||
|
||||
else if (opts->audio_in_type == 3) //rtl_fm tuning
|
||||
{
|
||||
#ifdef USE_RTLSDR
|
||||
rtl_dev_tune(opts, state->p25_cc_freq);
|
||||
#endif
|
||||
}
|
||||
opts->p25_is_tuned = 0;
|
||||
//zero out vc frequencies
|
||||
state->p25_vc_freq[0] = 0;
|
||||
state->p25_vc_freq[1] = 0;
|
||||
memset (state->active_channel, 0, sizeof(state->active_channel));
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->is_con_plus = 0; //con+ flag off
|
||||
}
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
182
src/dmr_dburst.c
182
src/dmr_dburst.c
@@ -6,15 +6,18 @@
|
||||
* Source: https://github.com/LouisErigHerve/dsd/blob/master/src/dmr_sync.c
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2023-12 DSD-FME Florida Man Edition
|
||||
* 2022-12 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
//TODO: Test USBD LIP Decoder with Real World Samples (if/when available)
|
||||
//TODO: Test UDT NMEA and LIP Decoders with Real World Samples (if/when available)
|
||||
//WIP: Unified Single Block Data - USBD -- TODO: USBD LIP Protocol Handling
|
||||
//WIP: UDT Header and Blocks (coded - need samples)
|
||||
//WIP: CRC9/CRC32 on Rate 1 Data (need samples)
|
||||
//WIP: Reverse Channel Signalling - RC single burst BPTC/7-bit CRC (rc interleave) and when to run RC and not SB
|
||||
//WIP: Single Burst Embedded LC - Non-RC single burst LC - Look for Late Entry Alg/Key
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196], uint8_t databurst)
|
||||
void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196], uint8_t databurst)
|
||||
{
|
||||
|
||||
uint32_t i, j, k;
|
||||
@@ -23,13 +26,13 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
uint32_t CRCCorrect = 0;
|
||||
uint32_t IrrecoverableErrors = 0;
|
||||
uint8_t slot = state->currentslot;
|
||||
uint8_t block = state->data_block_counter[slot];
|
||||
|
||||
//confirmed data
|
||||
//confirmed data
|
||||
uint8_t dbsn = 0; //data block serial number for confirmed data blocks
|
||||
uint8_t blockcounter = 0; //local block count
|
||||
uint8_t confdatabits[250]; //array to reshuffle conf data block bits into sequence for crc9 check
|
||||
memset (confdatabits, 0, sizeof(confdatabits));
|
||||
UNUSED(dbsn);
|
||||
|
||||
//BPTC 196x96 Specific
|
||||
uint8_t BPTCDeInteleavedData[196];
|
||||
@@ -50,8 +53,8 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
memset (LC_DataBytes, 0, sizeof(LC_DataBytes));
|
||||
|
||||
//PDU Bytes and Bits
|
||||
uint8_t DMR_PDU[25];
|
||||
uint8_t DMR_PDU_bits[196];
|
||||
uint8_t DMR_PDU[25];
|
||||
uint8_t DMR_PDU_bits[196];
|
||||
memset (DMR_PDU, 0, sizeof (DMR_PDU));
|
||||
memset (DMR_PDU_bits, 0, sizeof (DMR_PDU_bits));
|
||||
|
||||
@@ -60,19 +63,19 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
uint8_t is_ras = 0;
|
||||
uint8_t crc_original_validity = 0;
|
||||
|
||||
uint32_t crcmask = 0;
|
||||
uint32_t crcmask = 0;
|
||||
uint8_t crclen = 0;
|
||||
|
||||
uint8_t is_bptc = 0;
|
||||
uint8_t is_trellis = 0;
|
||||
uint8_t is_trellis = 0;
|
||||
uint8_t is_emb = 0;
|
||||
uint8_t is_lc = 0;
|
||||
uint8_t is_lc = 0;
|
||||
uint8_t is_full = 0;
|
||||
uint8_t is_udt = 0;
|
||||
uint8_t is_udt = 0;
|
||||
uint8_t pdu_len = 0;
|
||||
uint8_t pdu_start = 0; //starting value of pdu (0 normal, 2 for confirmed)
|
||||
|
||||
uint8_t usbd_st = 0; //usbd service type
|
||||
uint8_t usbd_st = 0; //usbd service type
|
||||
|
||||
switch(databurst){
|
||||
case 0x00: //PI
|
||||
@@ -86,14 +89,14 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
is_bptc = 1;
|
||||
is_lc = 1;
|
||||
crclen = 24;
|
||||
crcmask = 0x969696;
|
||||
crcmask = 0x969696;
|
||||
pdu_len = 12; //12 bytes
|
||||
sprintf(state->fsubtype, " VLC ");
|
||||
break;
|
||||
case 0x02: //TLC
|
||||
is_bptc = 1;
|
||||
is_lc = 1;
|
||||
crcmask = 0x999999;
|
||||
crcmask = 0x999999;
|
||||
crclen = 24;
|
||||
pdu_len = 12; //12 bytes
|
||||
sprintf(state->fsubtype, " TLC ");
|
||||
@@ -101,7 +104,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
case 0x03: //CSBK
|
||||
is_bptc = 1;
|
||||
crclen = 16;
|
||||
crcmask = 0xA5A5;
|
||||
crcmask = 0xA5A5;
|
||||
pdu_len = 12; //12 bytes
|
||||
sprintf(state->fsubtype, " CSBK");
|
||||
break;
|
||||
@@ -128,21 +131,19 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
case 0x07: //1/2 Rate Data
|
||||
is_bptc = 1;
|
||||
crclen = 9; //confirmed data only
|
||||
crcmask = 0x0F0;
|
||||
crcmask = 0x0F0;
|
||||
pdu_len = 12; //12 bytes unconfirmed
|
||||
sprintf(state->fsubtype, " R12U ");
|
||||
if (state->data_conf_data[slot] == 1)
|
||||
{
|
||||
pdu_len = 10;
|
||||
pdu_len = 10;
|
||||
pdu_start = 2; //start at plus two when assembling
|
||||
sprintf(state->fsubtype, " R12C ");
|
||||
}
|
||||
if (state->data_header_format[slot] == 0) //UDT 1/2 Encoded Blocks
|
||||
{
|
||||
is_udt = 1;
|
||||
if (state->data_conf_data[slot] == 1)
|
||||
sprintf(state->fsubtype, " UDTC "); //confirmed data
|
||||
else sprintf(state->fsubtype, " UDTU "); //unconfirmed data
|
||||
is_udt = 1;
|
||||
sprintf(state->fsubtype, " UDTC ");
|
||||
}
|
||||
break;
|
||||
case 0x08: //3/4 Rate Data
|
||||
@@ -153,10 +154,10 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
sprintf(state->fsubtype, " R34U ");
|
||||
if (state->data_conf_data[slot] == 1)
|
||||
{
|
||||
pdu_len = 16;
|
||||
pdu_len = 16;
|
||||
pdu_start = 2; //start at plus two when assembling
|
||||
sprintf(state->fsubtype, " R34C ");
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 0x09: //Idle
|
||||
//pseudo-random data fill, no need to do anything with this
|
||||
@@ -164,16 +165,16 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
break;
|
||||
case 0x0A: //1 Rate Data
|
||||
crclen = 9; //confirmed data only
|
||||
crcmask = 0x10F;
|
||||
crcmask = 0x10F;
|
||||
is_full = 1;
|
||||
pdu_len = 24; //192 bits 24 bytes + 4 pad bits
|
||||
pdu_len = 25; //196 bits - 24.5 bytes
|
||||
sprintf(state->fsubtype, " R_1U ");
|
||||
if (state->data_conf_data[slot] == 1)
|
||||
{
|
||||
pdu_len = 22; //start at plus two when assembling
|
||||
pdu_len = 23;
|
||||
pdu_start = 2; //start at plus two when assembling
|
||||
sprintf(state->fsubtype, " R_1C ");
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 0x0B: //Unified Single Block Data USBD
|
||||
is_bptc = 1;
|
||||
@@ -182,7 +183,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
pdu_len = 12; //12 bytes
|
||||
sprintf(state->fsubtype, " USBD ");
|
||||
break;
|
||||
|
||||
|
||||
//special types (not real data 'sync' bursts)
|
||||
case 0xEB: //Embedded Signalling
|
||||
crclen = 5;
|
||||
@@ -193,12 +194,12 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
default:
|
||||
//Slot Type FEC should catch this so we never see it,
|
||||
//but if it doesn't, then we can still dump the entire 'packet'
|
||||
//treat like rate 1 unconfirmed data
|
||||
//treat like rate 1 unconfirmed data
|
||||
is_full = 1;
|
||||
pdu_len = 25; //196 bits - 24.5 bytes
|
||||
sprintf(state->fsubtype, " _UNK ");
|
||||
pdu_len = 25; //196 bits - 24.5 bytes
|
||||
sprintf(state->fsubtype, " _UNK ");
|
||||
break;
|
||||
|
||||
|
||||
}
|
||||
|
||||
//flag off prop head when not looking at data blocks
|
||||
@@ -206,12 +207,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
|
||||
if (databurst != 0xEB)
|
||||
{
|
||||
if (state->dmr_ms_mode == 0)
|
||||
{
|
||||
if (state->dmr_color_code != 16)
|
||||
fprintf(stderr, "| Color Code=%02d ", state->dmr_color_code);
|
||||
else fprintf(stderr, "| Color Code=XX ");
|
||||
}
|
||||
if (state->dmr_ms_mode == 0) fprintf(stderr, "| Color Code=%02d ", state->dmr_color_code);
|
||||
fprintf(stderr, "|%s", state->fsubtype);
|
||||
|
||||
//'DSP' output to file
|
||||
@@ -234,7 +230,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
fclose (pFile);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
//Most Data Sync Burst types will use the bptc 196x96
|
||||
if (is_bptc)
|
||||
{
|
||||
@@ -252,7 +248,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
BPTCReservedBits = (R[0] & 0x01) | ((R[1] << 1) & 0x02) | ((R[2] << 2) & 0x04);
|
||||
|
||||
//debug print
|
||||
//fprintf (stderr, " RAS? %X - %d %d %d", BPTCReservedBits, R[0], R[1], R[2]);
|
||||
//fprintf (stderr, " RAS? %X - %d %d %d", BPTCReservedBits, R[0], R[1], R[2]);
|
||||
|
||||
/* Convert the 96 bits BPTC data into 12 bytes */
|
||||
k = 0;
|
||||
@@ -269,16 +265,16 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
|
||||
/* Fill the CRC extracted (before Reed-Solomon (12,9) FEC correction) */
|
||||
CRCExtracted = 0;
|
||||
for(i = 0; i < crclen; i++)
|
||||
for(i = 0; i < crclen; i++)
|
||||
{
|
||||
CRCExtracted = CRCExtracted << 1;
|
||||
CRCExtracted = CRCExtracted | (uint32_t)(BPTCDmrDataBit[i + 96 - crclen] & 1);
|
||||
CRCExtracted = CRCExtracted | (uint32_t)(BPTCDmrDataBit[i + 96 - crclen] & 1);
|
||||
}
|
||||
|
||||
/* Apply the CRC mask (see DMR standard B.3.12 Data Type CRC Mask) */
|
||||
CRCExtracted = CRCExtracted ^ crcmask;
|
||||
|
||||
/* Check/correct the BPTC data and compute the Reed-Solomon (12,9) CRC */
|
||||
/* Check/correct the BPTC data and compute the Reed-Solomon (12,9) CRC */
|
||||
if (is_lc) CRCCorrect = ComputeAndCorrectFullLinkControlCrc(BPTCDmrDataByte, &CRCComputed, crcmask);
|
||||
|
||||
//set CRC to correct on unconfirmed 1/2 data blocks (for reporting due to no CRC available on these)
|
||||
@@ -287,7 +283,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
CRCComputed = 0;
|
||||
CRCExtracted = 0;
|
||||
CRCCorrect = 1;
|
||||
}
|
||||
}
|
||||
|
||||
//run CRC9 on intermediate and last 1/2 confirmed data blocks
|
||||
else if (state->data_conf_data[slot] == 1 && databurst == 0x7)
|
||||
@@ -307,32 +303,32 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
{
|
||||
CRCCorrect = 1;
|
||||
state->data_block_crc_valid[slot][blockcounter] = 1;
|
||||
}
|
||||
}
|
||||
else state->data_block_crc_valid[slot][blockcounter] = 0;
|
||||
|
||||
}
|
||||
|
||||
//run CCITT on other data forms
|
||||
else
|
||||
else
|
||||
{
|
||||
CRCComputed = ComputeCrcCCITT(BPTCDmrDataBit);
|
||||
CRCComputed = ComputeCrcCCITT(BPTCDmrDataBit);
|
||||
if (CRCComputed == CRCExtracted) CRCCorrect = 1;
|
||||
else CRCCorrect = 0;
|
||||
}
|
||||
|
||||
//set the 'RAS Flag', if no irrecoverable errors but bad crc, only when enabled by user (to prevent a lot of bad data CSBKs)
|
||||
if (opts->aggressive_framesync == 0 && CRCCorrect == 0 && IrrecoverableErrors == 0 && BPTCReservedBits == 4) is_ras = 1;
|
||||
if (opts->aggressive_framesync == 0 && CRCCorrect == 0 && IrrecoverableErrors == 0 && BPTCReservedBits == 4) is_ras = 1;
|
||||
|
||||
//make sure the system type isn't Hytera, but could just be bad decodes on bad sample
|
||||
if (BPTCDmrDataByte[1] == 0x68) is_ras = 0;
|
||||
|
||||
//if this is a RAS system, set the CRC to okay if irrecoverable errors are okay
|
||||
//if we don't do this, then we can't view some data (CSBKs on RAS enabled systems)
|
||||
//if we don't do this, then we can't view some data (CSBKs on RAS enabled systems)
|
||||
if (is_ras == 1)
|
||||
{
|
||||
crc_original_validity = CRCCorrect;
|
||||
CRCCorrect = 1;
|
||||
}
|
||||
}
|
||||
|
||||
if (databurst == 0x04 || databurst == 0x06) //MBC Header, Data Header
|
||||
{
|
||||
@@ -342,7 +338,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
}
|
||||
else state->data_block_crc_valid[slot][0] = 0;
|
||||
}
|
||||
|
||||
|
||||
/* Convert corrected x bytes into x*8 bits */
|
||||
for(i = 0, j = 0; i < pdu_len; i++, j+=8)
|
||||
{
|
||||
@@ -372,7 +368,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
//Embedded Signalling will use BPTC 128x77
|
||||
if (is_emb)
|
||||
{
|
||||
|
||||
|
||||
CRCExtracted = 0;
|
||||
CRCComputed = 0;
|
||||
IrrecoverableErrors = 0;
|
||||
@@ -409,7 +405,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
|
||||
if(CRCExtracted == CRCComputed) CRCCorrect = 1;
|
||||
else CRCCorrect = 0;
|
||||
|
||||
|
||||
for (i = 0; i < 72; i++)
|
||||
{
|
||||
DMR_PDU_bits[i] = LC_DataBit[i];
|
||||
@@ -427,14 +423,14 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
{
|
||||
CRCExtracted = 0;
|
||||
CRCComputed = 0;
|
||||
IrrecoverableErrors = 1;
|
||||
IrrecoverableErrors = 1;
|
||||
|
||||
uint8_t tdibits[98];
|
||||
memset (tdibits, 0, sizeof(tdibits));
|
||||
|
||||
//reconstitute info bits into dibits for the trellis decoder
|
||||
for (i = 0; i < 98; i++)
|
||||
tdibits[i] = (info[i*2] << 1) | info[i*2+1];
|
||||
tdibits[i] = (info[i*2] << 1) | info[i*2+1];
|
||||
|
||||
uint8_t TrellisReturn[18];
|
||||
memset (TrellisReturn, 0, sizeof(TrellisReturn));
|
||||
@@ -444,7 +440,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
//they may have been successfully corrected, the CRC will reveal as much
|
||||
|
||||
for (i = 0; i < pdu_len; i++)
|
||||
DMR_PDU[i] = TrellisReturn[i+pdu_start];
|
||||
DMR_PDU[i] = TrellisReturn[i+pdu_start];
|
||||
|
||||
for(i = 0, j = 0; i < 18; i++, j+=8)
|
||||
{
|
||||
@@ -460,7 +456,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
|
||||
//set CRC to correct on unconfirmed 3/4 data blocks (for reporting due to no CRC available on these)
|
||||
if (state->data_conf_data[slot] == 0) CRCCorrect = 1;
|
||||
|
||||
|
||||
//run CRC9 on intermediate and last 3/4 data blocks
|
||||
else if (state->data_conf_data[slot] == 1)
|
||||
{
|
||||
@@ -473,12 +469,12 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
for(i = 0; i < 128; i++) confdatabits[i] = DMR_PDU_bits[i + 16];
|
||||
for(i = 0; i < 7; i++) confdatabits[i + 128] = DMR_PDU_bits[i];
|
||||
|
||||
CRCComputed = ComputeCrc9Bit(confdatabits, 135);
|
||||
CRCComputed = ComputeCrc9Bit(confdatabits, 135);
|
||||
if (CRCExtracted == CRCComputed)
|
||||
{
|
||||
CRCCorrect = 1;
|
||||
state->data_block_crc_valid[slot][blockcounter] = 1;
|
||||
}
|
||||
}
|
||||
else
|
||||
state->data_block_crc_valid[slot][blockcounter] = 0;
|
||||
|
||||
@@ -501,26 +497,24 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
|
||||
}
|
||||
|
||||
if (is_full) //Rate 1 Data
|
||||
if (is_full) //Rate 1 Data -- todo: fix padding bits, the four padding bits are on bit 96,97,98,99
|
||||
{
|
||||
//assembly (w/ confirmed data) on a working Tier III Tait System
|
||||
|
||||
CRCExtracted = 0;
|
||||
CRCComputed = 0;
|
||||
IrrecoverableErrors = 0; //implicit, since there is no encoding
|
||||
|
||||
//pack rate 1 data for a total of up to 24 bytes, (22 if Confirmed Data)
|
||||
//skipping the 4 padding bits located at 96,97,98,99 using the ptr values
|
||||
//as offsets for confirmed data, len, and continue points for packing
|
||||
int bit_ptr = pdu_start * 8;
|
||||
int byte_ptr = 0;
|
||||
pack_bit_array_into_byte_array (info+bit_ptr, DMR_PDU+byte_ptr, 12-pdu_start);
|
||||
bit_ptr = 100; byte_ptr = 12-pdu_start;
|
||||
pack_bit_array_into_byte_array (info+bit_ptr, DMR_PDU+byte_ptr, 12);
|
||||
for (i = 0; i < 24; i++)
|
||||
{
|
||||
DMR_PDU[i] = (uint8_t)ConvertBitIntoBytes(&info[i*8], 8);
|
||||
}
|
||||
//leftover 4 bits, manual doesn't say which 4 so assuming last 4
|
||||
//pushing last 4 to 25 and shifting it
|
||||
DMR_PDU[25] = (uint8_t)ConvertBitIntoBytes(&info[192], 4);
|
||||
DMR_PDU[25] = DMR_PDU[25] << 4;
|
||||
|
||||
//set CRC to correct on unconfirmed 1 rate data blocks (for reporting due to no CRC available on these)
|
||||
if (state->data_conf_data[slot] == 0) CRCCorrect = 1;
|
||||
|
||||
|
||||
//run CRC9 on intermediate and last 1 rate data blocks
|
||||
else if (state->data_conf_data[slot] == 1)
|
||||
{
|
||||
@@ -530,22 +524,18 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
CRCExtracted = CRCExtracted ^ crcmask;
|
||||
|
||||
//reorganize the info bit array into confdatabits, just for CRC9 check
|
||||
int k = 0;
|
||||
for (i = 16; i < 96; i++) confdatabits[k++] = info[i]; //first half
|
||||
for (i = 100; i < 196; i++) confdatabits[k++] = info[i]; //second half
|
||||
for (i = 0; i < 7; i++) confdatabits[k++] = info[i]; //DBSN
|
||||
CRCComputed = ComputeCrc9Bit(confdatabits, k);
|
||||
//unconfirmed, haven't seen any samples with rate 1 data
|
||||
for(i = 0; i < 176; i++) confdatabits[i] = info[i + 16];
|
||||
for(i = 0; i < 7; i++) confdatabits[i + 176] = info[i];
|
||||
|
||||
CRCComputed = ComputeCrc9Bit(confdatabits, 183);
|
||||
if (CRCExtracted == CRCComputed)
|
||||
{
|
||||
CRCCorrect = 1;
|
||||
state->data_block_crc_valid[slot][blockcounter] = 1;
|
||||
}
|
||||
}
|
||||
else state->data_block_crc_valid[slot][blockcounter] = 0;
|
||||
|
||||
//debug confirmed data values (working now)
|
||||
// fprintf (stderr, " K: %d; DSBN: %d; CRC: %03X / %03X;", k, dbsn, CRCComputed, CRCExtracted);
|
||||
|
||||
}
|
||||
|
||||
//copy info to dmr_pdu_bits
|
||||
@@ -553,14 +543,14 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
//time for some pi
|
||||
if (databurst == 0x00) dmr_pi (opts, state, DMR_PDU, CRCCorrect, IrrecoverableErrors);
|
||||
|
||||
//full link control
|
||||
if (databurst == 0x01) dmr_flco (opts, state, DMR_PDU_bits, CRCCorrect, &IrrecoverableErrors, 1); //VLC
|
||||
if (databurst == 0x02) dmr_flco (opts, state, DMR_PDU_bits, CRCCorrect, &IrrecoverableErrors, 2); //TLC
|
||||
if (databurst == 0xEB) dmr_flco (opts, state, DMR_PDU_bits, CRCCorrect, &IrrecoverableErrors, 3); //EMB
|
||||
if (databurst == 0x01) dmr_flco (opts, state, DMR_PDU_bits, CRCCorrect, IrrecoverableErrors, 1); //VLC
|
||||
if (databurst == 0x02) dmr_flco (opts, state, DMR_PDU_bits, CRCCorrect, IrrecoverableErrors, 2); //TLC
|
||||
if (databurst == 0xEB) dmr_flco (opts, state, DMR_PDU_bits, CRCCorrect, IrrecoverableErrors, 3); //EMB
|
||||
|
||||
//dmr data header and multi block types (header, 1/2, 3/4, 1, UDT) - type 1
|
||||
if (databurst == 0x06) dmr_dheader (opts, state, DMR_PDU, DMR_PDU_bits, CRCCorrect, IrrecoverableErrors);
|
||||
@@ -571,14 +561,14 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
|
||||
//control signalling types (CSBK, MBC)
|
||||
if (databurst == 0x03) dmr_cspdu (opts, state, DMR_PDU_bits, DMR_PDU, CRCCorrect, IrrecoverableErrors);
|
||||
|
||||
//both MBC header and MBC continuation will go to the block_assembler - type 2, and then to dmr_cspdu
|
||||
if (databurst == 0x04)
|
||||
|
||||
//both MBC header and MBC continuation will go to the block_assembler - type 2, and then to dmr_cspdu
|
||||
if (databurst == 0x04)
|
||||
{
|
||||
state->data_block_counter[slot] = 0; //zero block counter before running header
|
||||
state->data_header_valid[slot] = 1; //set valid header since we received one
|
||||
dmr_block_assembler (opts, state, DMR_PDU, pdu_len, databurst, 2);
|
||||
}
|
||||
}
|
||||
if (databurst == 0x05) dmr_block_assembler (opts, state, DMR_PDU, pdu_len, databurst, 2);
|
||||
|
||||
//Unified Single Data Block (USBD) -- Not to be confused with Unified Data Transport (UDT)
|
||||
@@ -587,8 +577,8 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
//TODO: provide more robust handling at a later date -- ETSI TS 102 361-4 V1.11.1 (2021-01) 6.6.11.3
|
||||
usbd_st = (uint8_t)ConvertBitIntoBytes(&DMR_PDU_bits[0], 4);
|
||||
fprintf (stderr, "%s\n", KYEL);
|
||||
fprintf (stderr, " USBD - ");
|
||||
if (usbd_st == 0) lip_protocol_decoder (opts, state, DMR_PDU_bits);
|
||||
fprintf (stderr, " Unified Single Block Data - ");
|
||||
if (usbd_st == 0) fprintf (stderr, "Location Information Protocol");
|
||||
else if (usbd_st > 8) fprintf (stderr, "Manufacturer Specific Service %d ", usbd_st);
|
||||
else fprintf (stderr, "Reserved %d ", usbd_st);
|
||||
}
|
||||
@@ -597,7 +587,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
if (is_ras == 1) CRCCorrect = crc_original_validity;
|
||||
|
||||
//start printing relevant fec/crc/ras messages, don't print on idle or MBC continuation blocks (handled in dmr_block.c)
|
||||
// if (IrrecoverableErrors == 0 && CRCCorrect == 1 && databurst != 0x09 && databurst != 0x05) fprintf(stderr, "(CRC OK)");
|
||||
if (IrrecoverableErrors == 0 && CRCCorrect == 1 && databurst != 0x09 && databurst != 0x05) ; //fprintf(stderr, "(CRC OK)");
|
||||
|
||||
// if (IrrecoverableErrors == 0 && CRCCorrect == 0 && databurst != 0x09 && databurst != 0x05)
|
||||
// {
|
||||
@@ -605,14 +595,14 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
// fprintf(stderr, " (FEC OK)");
|
||||
// fprintf (stderr, "%s", KNRM);
|
||||
|
||||
// }
|
||||
// }
|
||||
|
||||
if (IrrecoverableErrors != 0 && databurst != 0x08 && databurst != 0x09) //&& databurst != 0x05
|
||||
{
|
||||
fprintf (stderr, "%s", KRED);
|
||||
fprintf(stderr, " (FEC ERR)");
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
}
|
||||
|
||||
//print whether or not the 'RAS Field' bits are set to indicate RAS enabled (to be verified)
|
||||
if (is_ras == 1)
|
||||
@@ -623,7 +613,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
if (opts->payload == 1) fprintf (stderr, "%X ", BPTCReservedBits);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
|
||||
if (IrrecoverableErrors == 0 && CRCCorrect == 0 && is_ras == 0 && databurst != 0x09 && databurst != 0x05)
|
||||
{
|
||||
fprintf (stderr, "%s", KRED);
|
||||
@@ -647,7 +637,7 @@ void dmr_data_burst_handler(dsd_opts * opts, dsd_state * state, uint8_t info[196
|
||||
// fprintf (stderr, " CRC - EXT %X CMP %X", CRCExtracted, CRCComputed);
|
||||
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
786
src/dmr_flco.c
786
src/dmr_flco.c
File diff suppressed because it is too large
Load Diff
235
src/dmr_le.c
235
src/dmr_le.c
@@ -9,9 +9,9 @@
|
||||
#include "dsd.h"
|
||||
|
||||
//gather ambe_fr mi fragments for processing
|
||||
void dmr_late_entry_mi_fragment (dsd_opts * opts, dsd_state * state, uint8_t vc, uint8_t ambe_fr[4][24], uint8_t ambe_fr2[4][24], uint8_t ambe_fr3[4][24])
|
||||
void dmr_late_entry_mi_fragment (dsd_opts * opts, dsd_state * state, uint8_t vc, char ambe_fr[4][24], char ambe_fr2[4][24], char ambe_fr3[4][24])
|
||||
{
|
||||
|
||||
|
||||
uint8_t slot = state->currentslot;
|
||||
|
||||
//enforce RC4 due to missing PI header, but with valid SVC Opts
|
||||
@@ -30,7 +30,7 @@ void dmr_late_entry_mi_fragment (dsd_opts * opts, dsd_state * state, uint8_t vc,
|
||||
state->payload_keyidR = 0xFF;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
//collect our fragments and place them into storage
|
||||
state->late_entry_mi_fragment[slot][vc][0] = (uint64_t)ConvertBitIntoBytes(&ambe_fr[3][0], 4);
|
||||
state->late_entry_mi_fragment[slot][vc][1] = (uint64_t)ConvertBitIntoBytes(&ambe_fr2[3][0], 4);
|
||||
@@ -42,12 +42,10 @@ void dmr_late_entry_mi_fragment (dsd_opts * opts, dsd_state * state, uint8_t vc,
|
||||
|
||||
void dmr_late_entry_mi (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
UNUSED(opts);
|
||||
|
||||
uint8_t slot = state->currentslot;
|
||||
int i, j;
|
||||
int g[3];
|
||||
unsigned char mi_go_bits[24];
|
||||
int g[3];
|
||||
unsigned char mi_go_bits[24];
|
||||
|
||||
uint64_t mi_test = 0;
|
||||
uint64_t go_test = 0;
|
||||
@@ -59,7 +57,7 @@ void dmr_late_entry_mi (dsd_opts * opts, dsd_state * state)
|
||||
uint8_t mi_crc_cmp = 0;
|
||||
uint8_t mi_crc_ext = 1;
|
||||
uint8_t mi_crc_ok = 0;
|
||||
|
||||
|
||||
mi_test = (state->late_entry_mi_fragment[slot][1][0] << 32L) | (state->late_entry_mi_fragment[slot][2][0] << 28) | (state->late_entry_mi_fragment[slot][3][0] << 24) |
|
||||
(state->late_entry_mi_fragment[slot][1][1] << 20) | (state->late_entry_mi_fragment[slot][2][1] << 16) | (state->late_entry_mi_fragment[slot][3][1] << 12) |
|
||||
(state->late_entry_mi_fragment[slot][1][2] << 8) | (state->late_entry_mi_fragment[slot][2][2] << 4) | (state->late_entry_mi_fragment[slot][3][2] << 0);
|
||||
@@ -72,8 +70,8 @@ void dmr_late_entry_mi (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
for (i = 0; i < 12; i++)
|
||||
{
|
||||
mi_go_bits[i] = (( mi_test << (i+j*12) ) & 0x800000000) >> 35;
|
||||
mi_go_bits[i+12] = (( go_test << (i+j*12) ) & 0x800000000) >> 35;
|
||||
mi_go_bits[i] = (( mi_test << (i+j*12) ) & 0x800000000) >> 35;
|
||||
mi_go_bits[i+12] = (( go_test << (i+j*12) ) & 0x800000000) >> 35;
|
||||
}
|
||||
//execute golay decode and assign pass or fail to g
|
||||
if ( Golay_24_12_decode(mi_go_bits) ) g[j] = 1;
|
||||
@@ -90,7 +88,7 @@ void dmr_late_entry_mi (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
}
|
||||
|
||||
unsigned long long int mi_final = 0;
|
||||
int mi_final = 0;
|
||||
mi_final = (mi_corrected >> 4) & 0xFFFFFFFF;
|
||||
|
||||
mi_crc_ext = (uint8_t)ConvertBitIntoBytes(&mi_bits[32], 4);
|
||||
@@ -105,113 +103,54 @@ void dmr_late_entry_mi (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
if (slot == 0 && state->payload_algid != 0)
|
||||
{
|
||||
if (state->payload_mi != mi_final)
|
||||
if (state->payload_mi != mi_final)
|
||||
{
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, " Slot 1 PI/LFSR and Late Entry MI Mismatch - %08llX : %08llX ", state->payload_mi, mi_final);
|
||||
if (mi_crc_ok == 1) state->payload_mi = mi_final;
|
||||
fprintf (stderr, " Slot 1 PI/LFSR and Late Entry MI Mismatch - %08X : %08X ", state->payload_mi, mi_final);
|
||||
state->payload_mi = mi_final;
|
||||
if (mi_crc_ok == 1) fprintf (stderr, "(CRC OK)");
|
||||
else fprintf (stderr, "(CRC ERR)");
|
||||
fprintf (stderr, "\n");
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
//run expansions afterwards, or le verification won't match up properly
|
||||
|
||||
//DES1
|
||||
if (state->payload_algid == 0x22)
|
||||
//run afterwards, or le verification won't match up properly
|
||||
if (state->payload_algid != 0x21)
|
||||
{
|
||||
LFSR64 (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
//AES-128 or AES-256
|
||||
if (state->payload_algid == 0x24 || state->payload_algid == 0x25)
|
||||
{
|
||||
LFSR128d (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
if (slot == 1 && state->payload_algidR != 0)
|
||||
{
|
||||
if (state->payload_miR != mi_final)
|
||||
{
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, " Slot 2 PI/LFSR and Late Entry MI Mismatch - %08llX : %08llX ", state->payload_miR, mi_final);
|
||||
if (mi_crc_ok == 1) state->payload_miR = mi_final;
|
||||
fprintf (stderr, " Slot 2 PI/LFSR and Late Entry MI Mismatch - %08X : %08X ", state->payload_miR, mi_final);
|
||||
state->payload_miR = mi_final;
|
||||
if (mi_crc_ok == 1) fprintf (stderr, "(CRC OK)");
|
||||
else fprintf (stderr, "(CRC ERR)");
|
||||
fprintf (stderr, "\n");
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
//run expansions afterwards, or le verification won't match up properly
|
||||
|
||||
//DES1
|
||||
if (state->payload_algidR == 0x22)
|
||||
//run afterwards, or le verification won't match up properly
|
||||
if (state->payload_algidR != 0x21)
|
||||
{
|
||||
LFSR64 (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
//AES-128 or AES-256
|
||||
if (state->payload_algidR == 0x24 || state->payload_algidR == 0x25)
|
||||
{
|
||||
LFSR128d (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//run LFSR even if golay fails
|
||||
else if (slot == 0 && state->payload_algid != 0)
|
||||
{
|
||||
//DES1
|
||||
if (state->payload_algid == 0x22)
|
||||
{
|
||||
LFSR64 (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
//AES-128 or AES-256
|
||||
if (state->payload_algid == 0x24 || state->payload_algid == 0x25)
|
||||
{
|
||||
LFSR128d (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
}
|
||||
else if (slot == 1 && state->payload_algidR != 0)
|
||||
{
|
||||
//DES1
|
||||
if (state->payload_algidR == 0x22)
|
||||
{
|
||||
LFSR64 (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
//AES-128 or AES-256
|
||||
if (state->payload_algidR == 0x24 || state->payload_algidR == 0x25)
|
||||
{
|
||||
LFSR128d (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
void dmr_alg_refresh (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
UNUSED(opts);
|
||||
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
state->dropL = 256;
|
||||
|
||||
if (state->K1 != 0)
|
||||
if (state->K1 != 0)
|
||||
{
|
||||
state->DMRvcL = 0;
|
||||
}
|
||||
@@ -221,27 +160,14 @@ void dmr_alg_refresh (dsd_opts * opts, dsd_state * state)
|
||||
LFSR (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
//LFSR64/128 carried out after LE verification in order to keep it from constantly resetting the MI to the previous value
|
||||
|
||||
if (state->payload_algid == 0x02)
|
||||
{
|
||||
state->DMRvcL = 0;
|
||||
//LFSR already calculated, just dump it now
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X;", state->payload_algid, state->payload_keyid);
|
||||
fprintf (stderr, " MI(40): %010llX;", state->payload_mi);
|
||||
fprintf (stderr, " Hytera Enhanced;");
|
||||
fprintf (stderr, "%s\n", KNRM);
|
||||
}
|
||||
//LFSR64 carried out after LE verification in order to keep it from constantly resetting the MI to the previous value
|
||||
|
||||
}
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
state->dropR = 256;
|
||||
|
||||
if (state->K1 != 0)
|
||||
if (state->K1 != 0)
|
||||
{
|
||||
state->DMRvcR = 0;
|
||||
}
|
||||
@@ -251,20 +177,7 @@ void dmr_alg_refresh (dsd_opts * opts, dsd_state * state)
|
||||
LFSR (state);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
//LFSR64/128 carried out after LE verification in order to keep it from constantly resetting the MI to the previous value
|
||||
|
||||
if (state->payload_algidR == 0x02)
|
||||
{
|
||||
state->DMRvcR = 0;
|
||||
//LFSR already calculated, just dump it now
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X;", state->payload_algidR, state->payload_keyidR);
|
||||
fprintf (stderr, " MI(40): %010llX;", state->payload_miR);
|
||||
fprintf (stderr, " Hytera Enhanced;");
|
||||
fprintf (stderr, "%s\n", KNRM);
|
||||
}
|
||||
//LFSR64 carried out after LE verification in order to keep it from constantly resetting the MI to the previous value
|
||||
|
||||
}
|
||||
|
||||
@@ -272,17 +185,15 @@ void dmr_alg_refresh (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
void dmr_alg_reset (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
UNUSED(opts);
|
||||
|
||||
state->dropL = 256;
|
||||
state->dropR = 256;
|
||||
state->DMRvcL = 0;
|
||||
state->DMRvcR = 0;
|
||||
// state->payload_miP = 0; //running these clears out before we can create a new keystream
|
||||
// state->payload_miN = 0; //running these clears out before we can create a new keystream
|
||||
state->DMRvcR = 0;
|
||||
state->payload_miP = 0;
|
||||
state->payload_miN = 0;
|
||||
}
|
||||
|
||||
//handle Single Burst (Voice Burst F) or Reverse Channel Signalling
|
||||
//handle Single Burst (Voice Burst F) or Reverse Channel Signalling
|
||||
void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
{
|
||||
int i;
|
||||
@@ -300,8 +211,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
uint8_t crc7_okay = 0; //RC
|
||||
uint8_t crc3_okay = 0; //TXI
|
||||
uint8_t txi = 0; //SEE: https://patents.google.com/patent/US8271009B2
|
||||
UNUSED(txi);
|
||||
|
||||
|
||||
//NOTE: Any previous mentions to Cap+ in this area may have been in error,
|
||||
//The signalling observed here was actually TXI information, not Cap+ Specifically
|
||||
|
||||
@@ -324,7 +234,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
//arrange the return for proper order for the crc3 check
|
||||
for (i = 0; i < 8; i++) sbrc_retcrc[i] = sbrc_return[i+3];
|
||||
|
||||
//RC Channel CRC 7 Mask = 0x7A; CRC bits are used as privacy indicators on
|
||||
//RC Channel CRC 7 Mask = 0x7A; CRC bits are used as privacy indicators on
|
||||
//Single Voice Burst F (see below), other moto values seem to exist there as well -- See TXI patent
|
||||
if (power == 1) //RC
|
||||
{
|
||||
@@ -335,7 +245,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
crc_extracted = crc_extracted | sbrc_return[i+4];
|
||||
}
|
||||
crc_extracted = crc_extracted ^ 0x7A;
|
||||
crc_computed = crc7((uint8_t *) sbrc_return, 4); //#187 fix
|
||||
crc_computed = crc7((uint8_t *) sbrc_return, 7);
|
||||
if (crc_extracted == crc_computed) crc7_okay = 1;
|
||||
}
|
||||
else //if (txi == 1) //if TXI -- but TXI systems also carry the non-crc protected ENC identifiers
|
||||
@@ -346,7 +256,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
crc_extracted = crc_extracted << 1;
|
||||
crc_extracted = crc_extracted | sbrc_return[i]; //first 3 most significant bits
|
||||
}
|
||||
crc_computed = crc3((uint8_t *) sbrc_retcrc, 8); //working now seems consistent as well
|
||||
crc_computed = crc3((uint8_t *) sbrc_retcrc, 8); //working now seems consistent as well
|
||||
if (crc_extracted == crc_computed) crc3_okay = 1;
|
||||
// fprintf (stderr, " CRC EXT %02X, CRC CMP %02X", crc_extracted, crc_computed);
|
||||
}
|
||||
@@ -367,7 +277,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
fprintf (stderr, "%d", sbrc_return[i]);
|
||||
fprintf (stderr, " - %03X; ", sbrc_hex);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
|
||||
// if (crc_okay == 0) //forego this since the crc can vary or not be used at all
|
||||
// {
|
||||
// fprintf (stderr, "%s", KRED);
|
||||
@@ -378,7 +288,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
|
||||
uint8_t sbrc_opcode = sbrc_hex & 0x7; //opcode and alg the same bits, but the alg is present when CRC is bad (I know they are limited on bits, but I hate that idea)
|
||||
uint8_t alg = sbrc_hex & 0x7; //SEE: https://patents.google.com/patent/EP2347540B1/en
|
||||
uint8_t key = (sbrc_hex >> 3) & 0xFF;
|
||||
@@ -390,23 +300,12 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
//NOTE: on above, I belive that we need to check by opcode as well, as a CRC3 can have multiple collisions
|
||||
//so we need to exclude op/alg 0 and 3 from the check (does algID 0x03/0x23 even exist?)
|
||||
|
||||
if (opts->dmr_le == 1)
|
||||
if (opts->dmr_le == 1) //this will now require a user to switch it on or off until more testing/figuring can be done
|
||||
{
|
||||
if (irr_err != 0)
|
||||
{
|
||||
uint32_t sbrcpl = 0;
|
||||
for(i = 0; i < 32; i++)
|
||||
{
|
||||
sbrcpl = sbrcpl << 1;
|
||||
sbrcpl |= sbrc_interleaved[i] & 1;
|
||||
}
|
||||
if (opts->payload == 0) fprintf (stderr, "\n");
|
||||
fprintf (stderr, "%s SLOT %d SB/RC (FEC ERR) E:%d; I:%08X D:%03X; %s ", KRED, slot+1, irr_err, sbrcpl, sbrc_hex, KNRM);
|
||||
if (opts->payload == 1) fprintf (stderr, "\n");
|
||||
}
|
||||
if (irr_err != 0) fprintf (stderr, "\n%s SLOT %d SB/RC (FEC ERR) %d %s \n", KRED, slot, irr_err, KNRM);
|
||||
if (irr_err == 0)
|
||||
{
|
||||
if (sbrc_hex == 0 && crc7_okay == 0) ; //NULL Single Burst, do nothing (changed to allow the 0 value of RC below to trigger)
|
||||
if (sbrc_hex == 0) ; //NULL, do nothing
|
||||
|
||||
//else if (placeholder for future conditions)
|
||||
// {
|
||||
@@ -415,20 +314,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
|
||||
else if (crc7_okay == 1)
|
||||
{
|
||||
//decode the reverse channel information ETSI TS 102 361-4 V1.12.1 (2023-07) p 103 Table 6.32: MS Reverse Channel (RC) Command Information Elements
|
||||
if (opts->payload == 0) fprintf (stderr, "\n");
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
sbrc_hex = sbrc_hex >> 7; //set value to its 4-bit form
|
||||
if (sbrc_hex == 0) fprintf (stderr, " RC: Increase Power By One Step;");
|
||||
else if (sbrc_hex == 1) fprintf (stderr, " RC: Decrease Power By One Step;");
|
||||
else if (sbrc_hex == 2) fprintf (stderr, " RC: Set Power To Highest;");
|
||||
else if (sbrc_hex == 3) fprintf (stderr, " RC: Set Power To Lowest;");
|
||||
else if (sbrc_hex == 4) fprintf (stderr, " RC: Cease Transmission Command;");
|
||||
else if (sbrc_hex == 5) fprintf (stderr, " RC: Cease Transmission Request;");
|
||||
else fprintf (stderr, " RC: Reserved %02X;", sbrc_hex);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
// if (opts->payload == 1)
|
||||
fprintf (stderr, "\n");
|
||||
//do something with the reverse channel information
|
||||
}
|
||||
|
||||
//if the call is interruptable (TXI) and the crc3 is okay and TXI Opcode
|
||||
@@ -439,7 +325,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, " TXI Op: %X -", sbrc_opcode);
|
||||
if (sbrc_opcode == 0) fprintf (stderr, " Null; ");
|
||||
else if (sbrc_opcode == 3)
|
||||
else if (sbrc_opcode == 3)
|
||||
{
|
||||
if (txi_delay != 0)
|
||||
fprintf (stderr, " BR Delay: %d - %d ms;", txi_delay, txi_delay * 30); //could also indicate number of superframes until next VC6 pre-emption
|
||||
@@ -463,7 +349,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
|
||||
if (slot == 0) //may not need the state->errs anymore //&& state->errs < 3
|
||||
{
|
||||
if (state->dmr_so & 0x40 && key != 0 && alg != 0)
|
||||
if (state->dmr_so & 0x40 && key != 0 && state->payload_keyid == 0)
|
||||
{
|
||||
//if we aren't forcing a particular alg or privacy key set
|
||||
if (state->M == 0)
|
||||
@@ -471,17 +357,11 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
fprintf (stderr, "\n");
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR LE SB ALG ID: %02X; KEY ID: %02X;", alg + 0x20, key);
|
||||
if (alg == 1) fprintf (stderr, " RC4;");
|
||||
if (alg == 2) fprintf (stderr, " DES;");
|
||||
if (alg == 4) fprintf (stderr, " AES128;");
|
||||
if (alg == 5) fprintf (stderr, " AES256;");
|
||||
fprintf (stderr, " DMR LE SB ALG ID: 0x%02X KEY ID: 0x%02X", alg + 0x20, key);
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
if (opts->payload == 1) fprintf (stderr, "\n");
|
||||
if (state->payload_keyid != key)
|
||||
state->payload_keyid = key;
|
||||
if (state->payload_algid != alg)
|
||||
state->payload_algid = alg + 0x20; //assuming DMRA approved alg values (moto patent)
|
||||
state->payload_keyid = key;
|
||||
state->payload_algid = alg + 0x20; //assuming DMRA approved alg values (moto patent)
|
||||
}
|
||||
|
||||
}
|
||||
@@ -489,7 +369,7 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
|
||||
if (slot == 1) //may not need the state->errs anymore //&& state->errsR < 3
|
||||
{
|
||||
if (state->dmr_soR & 0x40 && key != 0 && alg != 0)
|
||||
if (state->dmr_soR & 0x40 && key != 0 && state->payload_keyidR == 0)
|
||||
{
|
||||
//if we aren't forcing a particular alg or privacy key set
|
||||
if (state->M == 0)
|
||||
@@ -497,13 +377,11 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
fprintf (stderr, "\n");
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR LE SB ALG ID: %02X; KEY ID: %02X;", alg + 0x20, key);
|
||||
fprintf (stderr, " DMR LE SB ALG ID: 0x%02X KEY ID: 0x%02X", alg + 0x20, key);
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
if (opts->payload == 1) fprintf (stderr, "\n");
|
||||
if (state->payload_keyidR != key)
|
||||
state->payload_keyidR = key;
|
||||
if (state->payload_algidR != alg)
|
||||
state->payload_algidR = alg + 0x20; //assuming DMRA approved alg values (moto patent)
|
||||
state->payload_keyidR = key;
|
||||
state->payload_algidR = alg + 0x20; //assuming DMRA approved alg values (moto patent)
|
||||
}
|
||||
|
||||
}
|
||||
@@ -516,20 +394,21 @@ void dmr_sbrc (dsd_opts * opts, dsd_state * state, uint8_t power)
|
||||
|
||||
SBRC_END:
|
||||
|
||||
//'DSP' output to file -- SB and RC
|
||||
if (opts->use_dsp_output == 1)
|
||||
//'DSP' output to file -- only RC, or RC and SB?
|
||||
if (power == 1 && opts->use_dsp_output == 1 && sbrc_hex != 0) //if not NULL
|
||||
{
|
||||
FILE * pFile; //file pointer
|
||||
pFile = fopen (opts->dsp_out_file, "a");
|
||||
fprintf (pFile, "\n%d 99 ", slot+1); //'99' is SB and RC designation value
|
||||
for (i = 0; i < 12; i++) //48 bits (includes CC, PPI, LCSS, and QR)
|
||||
// for (i = 2; i < 10; i++) //32 bits (only SB/RC Data and its PC/H)
|
||||
fprintf (pFile, "\n%d 99 ", slot+1); //'99' is RC designation value
|
||||
int k = 0;
|
||||
for (i = 0; i < 24; i++) //12 bytes, SB or RC
|
||||
{
|
||||
uint8_t sbrc_nib = (state->dmr_embedded_signalling[slot][5][(i*4)+0] << 3) | (state->dmr_embedded_signalling[slot][5][(i*4)+1] << 2) | (state->dmr_embedded_signalling[slot][5][(i*4)+2] << 1) | (state->dmr_embedded_signalling[slot][5][(i*4)+3] << 0);
|
||||
//check to see if k++ starts at zero, or at 1
|
||||
int sbrc_nib = (state->dmr_embedded_signalling[slot][5][k++] << 3) | (state->dmr_embedded_signalling[slot][5][k++] << 2) | (state->dmr_embedded_signalling[slot][5][k++] << 1) | (state->dmr_embedded_signalling[slot][5][k++] << 0);
|
||||
fprintf (pFile, "%X", sbrc_nib);
|
||||
}
|
||||
fclose (pFile);
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
@@ -537,7 +416,7 @@ uint8_t crc3(uint8_t bits[], unsigned int len)
|
||||
{
|
||||
uint8_t crc=0;
|
||||
unsigned int K = 3;
|
||||
//x^3+x+1
|
||||
//x^3+x+1
|
||||
uint8_t poly[4] = {1,1,0,1};
|
||||
uint8_t buf[256];
|
||||
if (len+K > sizeof(buf)) {
|
||||
@@ -561,7 +440,7 @@ uint8_t crc4(uint8_t bits[], unsigned int len)
|
||||
{
|
||||
uint8_t crc=0;
|
||||
unsigned int K = 4;
|
||||
//x^4+x+1
|
||||
//x^4+x+1
|
||||
uint8_t poly[5] = {1,0,0,1,1};
|
||||
uint8_t buf[256];
|
||||
if (len+K > sizeof(buf)) {
|
||||
|
||||
339
src/dmr_ms.c
339
src/dmr_ms.c
@@ -9,42 +9,43 @@
|
||||
#include "dsd.h"
|
||||
#include "dmr_const.h"
|
||||
|
||||
// #define PRINT_AMBE72 //enable to view 72-bit AMBE codewords
|
||||
|
||||
//A subroutine for processing MS voice
|
||||
void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
|
||||
char * timestr = getTimeC();
|
||||
|
||||
int i, j, dibit;
|
||||
int i, j, k, l, dibit;
|
||||
int *dibit_p;
|
||||
char ambe_fr[4][24];
|
||||
char ambe_fr2[4][24];
|
||||
char ambe_fr3[4][24];
|
||||
char ambe_fr4[4][24];
|
||||
|
||||
//memcpy of ambe_fr for late entry
|
||||
uint8_t m1[4][24];
|
||||
uint8_t m2[4][24];
|
||||
uint8_t m3[4][24];
|
||||
char m1[4][24];
|
||||
char m2[4][24];
|
||||
char m3[4][24];
|
||||
|
||||
const int *w, *x, *y, *z;
|
||||
|
||||
uint8_t syncdata[48];
|
||||
memset (syncdata, 0, sizeof(syncdata));
|
||||
|
||||
uint8_t emb_pdu[16];
|
||||
memset (emb_pdu, 0, sizeof(emb_pdu));
|
||||
char sync[25];
|
||||
char syncdata[48];
|
||||
char EmbeddedSignalling[16];
|
||||
|
||||
//cach
|
||||
char cachdata[25];
|
||||
char cachdata[25];
|
||||
int cachInterleave[24] =
|
||||
{0, 7, 8, 9, 1, 10,
|
||||
11, 12, 2, 13, 14,
|
||||
15, 3, 16, 4, 17, 18,
|
||||
19, 5, 20, 21, 22, 6, 23
|
||||
};
|
||||
|
||||
//cach tact bits
|
||||
uint8_t tact_bits[7];
|
||||
|
||||
uint8_t tact_okay = 0;
|
||||
uint8_t emb_ok = 0;
|
||||
UNUSED(emb_ok);
|
||||
uint8_t tact_okay = 0;
|
||||
uint8_t cach_err = 0;
|
||||
uint8_t EmbeddedSignallingOk = 0;
|
||||
|
||||
uint8_t internalslot;
|
||||
uint8_t vc;
|
||||
@@ -53,21 +54,39 @@ void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
uint8_t cc = 25;
|
||||
uint8_t power = 9; //power and pre-emption indicator
|
||||
uint8_t lcss = 9;
|
||||
UNUSED2(cc, lcss);
|
||||
|
||||
//dummy bits to pass to dburst for link control
|
||||
uint8_t dummy_bits[196];
|
||||
memset (dummy_bits, 0, sizeof (dummy_bits));
|
||||
|
||||
//add time to mirror printFrameSync
|
||||
time_t now;
|
||||
char * getTime(void) //get pretty hh:mm:ss timestamp
|
||||
{
|
||||
time_t t = time(NULL);
|
||||
|
||||
char * curr;
|
||||
char * stamp = asctime(localtime( & t));
|
||||
|
||||
curr = strtok(stamp, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
|
||||
return curr;
|
||||
}
|
||||
|
||||
vc = 2;
|
||||
|
||||
short int skipcount = 0;
|
||||
|
||||
//Hardset variables for MS/Mono
|
||||
state->currentslot = 0; //0
|
||||
|
||||
//Note: Manual dibit inversion required here since I didn't seperate inverted return from normal return in framesync,
|
||||
//so getDibit doesn't know to invert it before it gets here
|
||||
|
||||
for (j = 0; j < 6; j++) {
|
||||
for (j = 0; j < 6; j++) {
|
||||
state->dmrburstL = 16;
|
||||
|
||||
memset (ambe_fr, 0, sizeof(ambe_fr));
|
||||
@@ -158,8 +177,10 @@ void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
syncdata[(2*i)] = (1 & (dibit >> 1)); // bit 1
|
||||
syncdata[(2*i)+1] = (1 & dibit); // bit 0
|
||||
|
||||
sync[i] = (dibit | 1) + 48;
|
||||
|
||||
// load the superframe to do embedded signal processing
|
||||
if(vc > 1) //grab on vc2 values 2-5 B C D E, and F
|
||||
if(vc > 1) //grab on vc1 values 2-5 B C D and E
|
||||
{
|
||||
state->dmr_embedded_signalling[internalslot][vc-1][i*2] = (1 & (dibit >> 1)); // bit 1
|
||||
state->dmr_embedded_signalling[internalslot][vc-1][i*2+1] = (1 & dibit); // bit 0
|
||||
@@ -167,17 +188,35 @@ void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
}
|
||||
|
||||
for(i = 0; i < 8; i++) emb_pdu[i + 0] = syncdata[i];
|
||||
for(i = 0; i < 8; i++) emb_pdu[i + 8] = syncdata[i + 40];
|
||||
sync[24] = 0;
|
||||
|
||||
emb_ok = -1;
|
||||
if(QR_16_7_6_decode(emb_pdu))
|
||||
//test for RC sync pattern in MS sourced audio
|
||||
if ( strcmp (sync, DMR_RC_DATA_SYNC) == 0)
|
||||
{
|
||||
emb_ok = 1;
|
||||
cc = ((emb_pdu[0] << 3) + (emb_pdu[1] << 2) + (emb_pdu[2] << 1) + emb_pdu[3]);
|
||||
power = emb_pdu[4];
|
||||
lcss = ((emb_pdu[5] << 1) + emb_pdu[6]);
|
||||
state->dmr_color_code = state->color_code = cc;
|
||||
state->dmr_ms_rc = 1;
|
||||
fprintf (stderr, "%s ", getTime());
|
||||
if (opts->inverted_dmr == 0)
|
||||
{
|
||||
fprintf (stderr,"Sync: +DMR MS/DM MODE/MONO ");
|
||||
}
|
||||
else fprintf (stderr,"Sync: -DMR MS/DM MODE/MONO ");
|
||||
|
||||
fprintf (stderr, "| RC ");
|
||||
fprintf (stderr, "\n");
|
||||
|
||||
}
|
||||
|
||||
for(i = 0; i < 8; i++) EmbeddedSignalling[i] = syncdata[i];
|
||||
for(i = 0; i < 8; i++) EmbeddedSignalling[i + 8] = syncdata[i + 40];
|
||||
|
||||
EmbeddedSignallingOk = -1;
|
||||
if(QR_16_7_6_decode(EmbeddedSignalling))
|
||||
{
|
||||
EmbeddedSignallingOk = 1;
|
||||
cc = ((EmbeddedSignalling[0] << 3) + (EmbeddedSignalling[1] << 2) + (EmbeddedSignalling[2] << 1) + EmbeddedSignalling[3]);
|
||||
power = EmbeddedSignalling[4];
|
||||
lcss = ((EmbeddedSignalling[5] << 1) + EmbeddedSignalling[6]);
|
||||
|
||||
}
|
||||
|
||||
//Continue Second AMBE Frame, 18 after Sync or EmbeddedSignalling
|
||||
@@ -239,71 +278,41 @@ void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
memcpy (ambe_fr4, ambe_fr2, sizeof(ambe_fr2));
|
||||
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//we go to do correction on them there too
|
||||
memcpy (m1, ambe_fr, sizeof(m1));
|
||||
memcpy (m2, ambe_fr2, sizeof(m2));
|
||||
memcpy (m3, ambe_fr3, sizeof(m3));
|
||||
|
||||
if (state->tyt_bp == 1)
|
||||
if (state->dmr_ms_rc == 0)
|
||||
{
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr, 0);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr2, 1);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr3, 0);
|
||||
}
|
||||
|
||||
#ifdef PRINT_AMBE72
|
||||
ambe2_codeword_print_i(opts, ambe_fr);
|
||||
ambe2_codeword_print_i(opts, ambe_fr2);
|
||||
ambe2_codeword_print_i(opts, ambe_fr3);
|
||||
#endif
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
||||
memcpy(state->f_l4[0], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[0], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[0], state->s_lu, sizeof(state->s_lu));
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
memcpy(state->f_l4[1], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[1], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[1], state->s_lu, sizeof(state->s_lu));
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
memcpy(state->f_l4[2], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[2], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[2], state->s_lu, sizeof(state->s_lu));
|
||||
|
||||
//TODO: Consider copying f_l to f_r for left and right channel saturation on MS mode
|
||||
if (opts->floating_point == 0)
|
||||
{
|
||||
// memcpy (state->s_r4, state->s_l4, sizeof(state->s_l4));
|
||||
if(opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceSS3(opts, state);
|
||||
}
|
||||
|
||||
if (opts->floating_point == 1)
|
||||
{
|
||||
// memcpy (state->f_r4, state->f_l4, sizeof(state->f_l4));
|
||||
if(opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceFS3(opts, state);
|
||||
if (state->directmode == 0)
|
||||
{
|
||||
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
}
|
||||
else
|
||||
{
|
||||
processMbeFrame (opts, state, NULL, ambe_fr4, NULL); //play duplicate of 2 here to smooth audio on tdma direct
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
}
|
||||
}
|
||||
|
||||
if (vc == 6)
|
||||
{
|
||||
//this needs to run prior to embedded link control
|
||||
if (state->payload_algid == 0x02)
|
||||
hytera_enhanced_alg_refresh(state);
|
||||
|
||||
dmr_data_burst_handler(opts, state, (uint8_t *)dummy_bits, 0xEB);
|
||||
//check the single burst/reverse channel opportunity
|
||||
dmr_sbrc (opts, state, power);
|
||||
|
||||
|
||||
fprintf (stderr, "\n");
|
||||
dmr_alg_refresh (opts, state);
|
||||
}
|
||||
|
||||
//collect the mi fragment
|
||||
if (opts->dmr_le != 2) //if not Hytera Enhanced
|
||||
dmr_late_entry_mi_fragment (opts, state, vc, m1, m2, m3);
|
||||
dmr_late_entry_mi_fragment (opts, state, vc, m1, m2, m3);
|
||||
|
||||
//errors in ms/mono since we skip the other slot
|
||||
// cach_err = dmr_cach (opts, state, cachdata);
|
||||
@@ -312,16 +321,17 @@ void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
state->last_vc_sync_time = time(NULL);
|
||||
|
||||
vc++;
|
||||
|
||||
|
||||
//reset emb components
|
||||
cc = 25;
|
||||
power = 9; //power and pre-emption indicator
|
||||
lcss = 9;
|
||||
|
||||
//this is necessary because we need to skip and collect dibits, not just skip them
|
||||
if (vc > 6) goto END;
|
||||
if (vc > 6) goto END;
|
||||
|
||||
skipDibit (opts, state, 144); //skip to next tdma channel
|
||||
state->dmr_ms_rc = 0;
|
||||
|
||||
//since we are in a loop, run ncursesPrinter here
|
||||
if (opts->use_ncurses_terminal == 1)
|
||||
@@ -329,10 +339,6 @@ void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
ncursesPrinter(opts, state);
|
||||
}
|
||||
|
||||
//slot 1
|
||||
watchdog_event_history(opts, state, 0);
|
||||
watchdog_event_current(opts, state, 0);
|
||||
|
||||
} // end loop
|
||||
|
||||
END:
|
||||
@@ -353,29 +359,16 @@ void dmrMS (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
state->dmr_stereo = 0;
|
||||
state->dmr_ms_mode = 0;
|
||||
state->dmr_ms_rc = 0;
|
||||
state->directmode = 0; //flag off
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
|
||||
//reset static ks counter
|
||||
state->static_ks_counter[0] = 0;
|
||||
|
||||
|
||||
}
|
||||
|
||||
//collect buffered 1st half and get 2nd half voice payload and then jump to full MS Voice decoding.
|
||||
void dmrMSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
|
||||
char * timestr = getTimeC();
|
||||
|
||||
//reset static ks counter
|
||||
state->static_ks_counter[0] = 0;
|
||||
|
||||
int i, dibit;
|
||||
int i, j, k, l, dibit;
|
||||
int *dibit_p;
|
||||
|
||||
char ambe_fr[4][24];
|
||||
@@ -388,17 +381,51 @@ void dmrMSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
memset (ambe_fr3, 0, sizeof(ambe_fr3));
|
||||
|
||||
//memcpy of ambe_fr for late entry
|
||||
uint8_t m1[4][24];
|
||||
uint8_t m2[4][24];
|
||||
uint8_t m3[4][24];
|
||||
char m1[4][24];
|
||||
char m2[4][24];
|
||||
char m3[4][24];
|
||||
|
||||
const int *w, *x, *y, *z;
|
||||
char sync[25];
|
||||
char syncdata[48];
|
||||
|
||||
//cach
|
||||
char cachdata[25];
|
||||
UNUSED(cachdata);
|
||||
char cachdata[25];
|
||||
int cachInterleave[24] =
|
||||
{0, 7, 8, 9, 1, 10,
|
||||
11, 12, 2, 13, 14,
|
||||
15, 3, 16, 4, 17, 18,
|
||||
19, 5, 20, 21, 22, 6, 23
|
||||
};
|
||||
|
||||
state->dmrburstL = 16;
|
||||
int mutecurrentslot;
|
||||
int msMode;
|
||||
char cc[4];
|
||||
char EmbeddedSignalling[16];
|
||||
|
||||
uint8_t emb_ok = 0;
|
||||
uint8_t tact_okay = 0;
|
||||
uint8_t cach_err = 0;
|
||||
uint8_t EmbeddedSignallingOk = 0;
|
||||
|
||||
//add time to mirror sync
|
||||
time_t now;
|
||||
char * getTime(void) //get pretty hh:mm:ss timestamp
|
||||
{
|
||||
time_t t = time(NULL);
|
||||
|
||||
char * curr;
|
||||
char * stamp = asctime(localtime( & t));
|
||||
|
||||
curr = strtok(stamp, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
|
||||
return curr;
|
||||
}
|
||||
|
||||
state->dmrburstL = 16;
|
||||
state->currentslot = 0; //force to slot 0
|
||||
|
||||
dibit_p = state->dmr_payload_p - 90;
|
||||
@@ -533,15 +560,13 @@ void dmrMSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", timestr);
|
||||
fprintf (stderr, "%s ", getTime());
|
||||
if (opts->inverted_dmr == 0)
|
||||
{
|
||||
fprintf (stderr,"Sync: +DMR MS/DM MODE/MONO ");
|
||||
}
|
||||
else fprintf (stderr,"Sync: -DMR MS/DM MODE/MONO ");
|
||||
if (state->dmr_color_code != 16)
|
||||
fprintf (stderr, "| Color Code=%02d ", state->dmr_color_code);
|
||||
else fprintf (stderr, "| Color Code=XX ");
|
||||
|
||||
fprintf (stderr, "| VC* ");
|
||||
fprintf (stderr, "\n");
|
||||
|
||||
@@ -550,65 +575,31 @@ void dmrMSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
memcpy (ambe_fr4, ambe_fr2, sizeof(ambe_fr2));
|
||||
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//copy ambe_fr frames first, running process mbe will correct them,
|
||||
//but this also leads to issues extracting good le mi values when
|
||||
//we go to do correction on them there too
|
||||
memcpy (m1, ambe_fr, sizeof(m1));
|
||||
memcpy (m2, ambe_fr2, sizeof(m2));
|
||||
memcpy (m3, ambe_fr3, sizeof(m3));
|
||||
|
||||
if (state->tyt_bp == 1)
|
||||
if (state->directmode == 0)
|
||||
{
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr, 0);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr2, 1);
|
||||
tyt16_ambe2_codeword_keystream(state, ambe_fr3, 0);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
}
|
||||
|
||||
#ifdef PRINT_AMBE72
|
||||
ambe2_codeword_print_i(opts, ambe_fr);
|
||||
ambe2_codeword_print_i(opts, ambe_fr2);
|
||||
ambe2_codeword_print_i(opts, ambe_fr3);
|
||||
#endif
|
||||
|
||||
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
||||
memcpy(state->f_l4[0], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[0], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[0], state->s_lu, sizeof(state->s_lu));
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
memcpy(state->f_l4[1], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[1], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[1], state->s_lu, sizeof(state->s_lu));
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
memcpy(state->f_l4[2], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
||||
memcpy(state->s_l4[2], state->s_l, sizeof(state->s_l));
|
||||
memcpy(state->s_l4u[2], state->s_lu, sizeof(state->s_lu));
|
||||
|
||||
//TODO: Consider copying f_l to f_r for left and right channel saturation on MS mode
|
||||
if (opts->floating_point == 0)
|
||||
else
|
||||
{
|
||||
// memcpy (state->s_r4, state->s_l4, sizeof(state->s_l4));
|
||||
if(opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceSS3(opts, state);
|
||||
}
|
||||
|
||||
if (opts->floating_point == 1)
|
||||
{
|
||||
// memcpy (state->f_r4, state->f_l4, sizeof(state->f_l4));
|
||||
if(opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceFS3(opts, state);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr4, NULL); //play duplicate of 2 here to smooth audio
|
||||
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
||||
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
||||
}
|
||||
|
||||
//collect the mi fragment
|
||||
if (opts->dmr_le != 2) //if not Hytera Enhanced
|
||||
dmr_late_entry_mi_fragment (opts, state, 1, m1, m2, m3);
|
||||
dmr_late_entry_mi_fragment (opts, state, 1, m1, m2, m3);
|
||||
|
||||
//errors due to skipping other slot
|
||||
// cach_err = dmr_cach (opts, state, cachdata);
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
|
||||
skipDibit (opts, state, 144); //skip to next TDMA slot
|
||||
dmrMS (opts, state); //bootstrap into full TDMA frame
|
||||
@@ -618,13 +609,28 @@ void dmrMSBootstrap (dsd_opts * opts, dsd_state * state)
|
||||
//simplied to a simple data collector, and then passed on to dmr_data_sync for the usual processing
|
||||
void dmrMSData (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
|
||||
char * timestr = getTimeC();
|
||||
|
||||
int i;
|
||||
int i, b, c;
|
||||
int dibit;
|
||||
int *dibit_p;
|
||||
|
||||
//add time to mirror sync
|
||||
time_t now;
|
||||
char * getTime(void) //get pretty hh:mm:ss timestamp
|
||||
{
|
||||
time_t t = time(NULL);
|
||||
|
||||
char * curr;
|
||||
char * stamp = asctime(localtime( & t));
|
||||
|
||||
curr = strtok(stamp, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
|
||||
return curr;
|
||||
}
|
||||
|
||||
|
||||
//CACH + First Half Payload + Sync = 12 + 54 + 24
|
||||
dibit_p = state->dmr_payload_p - 90;
|
||||
for (i = 0; i < 90; i++) //90
|
||||
@@ -633,6 +639,7 @@ void dmrMSData (dsd_opts * opts, dsd_state * state)
|
||||
dibit_p++;
|
||||
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
||||
state->dmr_stereo_payload[i] = dibit;
|
||||
|
||||
}
|
||||
|
||||
for (i = 0; i < 54; i++)
|
||||
@@ -640,17 +647,16 @@ void dmrMSData (dsd_opts * opts, dsd_state * state)
|
||||
dibit = getDibit(opts, state);
|
||||
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
||||
state->dmr_stereo_payload[i+90] = dibit;
|
||||
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", timestr);
|
||||
fprintf (stderr, "%s ", getTime());
|
||||
if (opts->inverted_dmr == 0)
|
||||
{
|
||||
fprintf (stderr,"Sync: +DMR MS/DM MODE/MONO ");
|
||||
}
|
||||
else fprintf (stderr,"Sync: -DMR MS/DM MODE/MONO ");
|
||||
if (state->dmr_color_code != 16)
|
||||
fprintf (stderr, "| Color Code=%02d ", state->dmr_color_code);
|
||||
else fprintf (stderr, "| Color Code=XX ");
|
||||
|
||||
|
||||
sprintf(state->slot1light, "%s", "");
|
||||
sprintf(state->slot2light, "%s", "");
|
||||
@@ -666,23 +672,16 @@ void dmrMSData (dsd_opts * opts, dsd_state * state)
|
||||
state->directmode = 0; //flag off
|
||||
|
||||
//should just be loaded in the dmr_payload_buffer instead now
|
||||
//but we want to run getDibit so the buffer has actual good values in it
|
||||
for (i = 0; i < 144; i++) //66
|
||||
{
|
||||
dibit = getDibit(opts, state);
|
||||
state->dmr_stereo_payload[i] = 1; //set to one so first frame will fail intentionally instead of zero fill
|
||||
state->dmr_stereo_payload[i] = dibit;
|
||||
}
|
||||
//CACH + First Half Payload = 12 + 54
|
||||
for (i = 0; i < 66; i++) //66
|
||||
{
|
||||
dibit = getDibit(opts, state);
|
||||
state->dmr_stereo_payload[i+66] = 1; ////set to one so first frame will fail intentionally instead of zero fill
|
||||
}
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
state->dmr_stereo_payload[i] = dibit;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
992
src/dmr_pdu.c
992
src/dmr_pdu.c
File diff suppressed because it is too large
Load Diff
479
src/dmr_pi.c
479
src/dmr_pi.c
@@ -7,233 +7,91 @@
|
||||
* LWVMOBILE
|
||||
* 2022-12 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
void dmr_pi (dsd_opts * opts, dsd_state * state, uint8_t PI_BYTE[], uint32_t CRCCorrect, uint32_t IrrecoverableErrors)
|
||||
{
|
||||
UNUSED2(opts, CRCCorrect);
|
||||
|
||||
uint8_t MFID = PI_BYTE[1];
|
||||
|
||||
if(IrrecoverableErrors == 0)
|
||||
if((IrrecoverableErrors == 0))
|
||||
{
|
||||
|
||||
//update cc amd vc sync time for trunking purposes (particularly Con+)
|
||||
if (opts->p25_is_tuned == 1)
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
state->last_vc_sync_time = time(NULL);
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->payload_algid = PI_BYTE[0];
|
||||
state->payload_keyid = PI_BYTE[2];
|
||||
state->payload_mi = ( ((PI_BYTE[3]) << 24) + ((PI_BYTE[4]) << 16) + ((PI_BYTE[5]) << 8) + (PI_BYTE[6]) );
|
||||
if (state->payload_algid < 0x26)
|
||||
{
|
||||
fprintf (stderr, "%s ", KYEL);
|
||||
fprintf (stderr, "\n Slot 1");
|
||||
fprintf (stderr, " DMR PI H- ALG ID: 0x%02X KEY ID: 0x%02X MI: 0x%08X", state->payload_algid, state->payload_keyid, state->payload_mi);
|
||||
|
||||
//Anytone RC4 Shim
|
||||
if (state->payload_algid == 0x01)
|
||||
{
|
||||
fprintf (stderr, " Anytone (0x01)");
|
||||
state->payload_algid = 0x21;
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
if (state->payload_algid != 0x21)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR64 (state);
|
||||
}
|
||||
}
|
||||
|
||||
if (state->payload_algid >= 0x26)
|
||||
{
|
||||
state->payload_algid = 0;
|
||||
state->payload_keyid = 0;
|
||||
state->payload_mi = 0;
|
||||
}
|
||||
}
|
||||
|
||||
if (MFID == 0x68) //Hytera Enhanced
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
if (state->currentslot == 0)
|
||||
|
||||
state->payload_algidR = PI_BYTE[0];
|
||||
state->payload_keyidR = PI_BYTE[2];
|
||||
state->payload_miR = ( ((PI_BYTE[3]) << 24) + ((PI_BYTE[4]) << 16) + ((PI_BYTE[5]) << 8) + (PI_BYTE[6]) );
|
||||
if (state->payload_algidR < 0x26)
|
||||
{
|
||||
state->dmr_so |= 0x40; //OR the enc bit onto the SO
|
||||
state->payload_algid = PI_BYTE[0];
|
||||
state->payload_keyid = PI_BYTE[2];
|
||||
state->payload_mi = ((unsigned long long int)PI_BYTE[3] << 32ULL) | ((unsigned long long int)PI_BYTE[4] << 24) |
|
||||
((unsigned long long int)PI_BYTE[5] << 16) | ((unsigned long long int)PI_BYTE[6] << 8) | ((unsigned long long int)PI_BYTE[7] << 0);
|
||||
}
|
||||
else
|
||||
{
|
||||
state->dmr_soR |= 0x40; //OR the enc bit onto the SO
|
||||
state->payload_algidR = PI_BYTE[0];
|
||||
state->payload_keyidR = PI_BYTE[2];
|
||||
state->payload_miR = ((unsigned long long int)PI_BYTE[3] << 32ULL) | ((unsigned long long int)PI_BYTE[4] << 24) |
|
||||
((unsigned long long int)PI_BYTE[5] << 16) | ((unsigned long long int)PI_BYTE[6] << 8) | ((unsigned long long int)PI_BYTE[7] << 0);
|
||||
fprintf (stderr, "%s ", KYEL);
|
||||
fprintf (stderr, "\n Slot 2");
|
||||
fprintf (stderr, " DMR PI H- ALG ID: 0x%02X KEY ID: 0x%02X MI: 0x%08X", state->payload_algidR, state->payload_keyidR, state->payload_miR);
|
||||
|
||||
//Anytone RC4 Shim
|
||||
if (state->payload_algidR == 0x01)
|
||||
{
|
||||
fprintf (stderr, " Anytone (0x01)");
|
||||
state->payload_algidR = 0x21;
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
if (state->payload_algidR != 0x21)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR64 (state);
|
||||
}
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", KYEL);
|
||||
fprintf (stderr, "\n Slot %d", state->currentslot+1);
|
||||
fprintf (stderr, " DMR PI H- ALG ID: %02X; KEY ID: %02X; MI(40): %02X%02X%02X%02X%02X;",
|
||||
PI_BYTE[0], PI_BYTE[2], PI_BYTE[3], PI_BYTE[4], PI_BYTE[5], PI_BYTE[6], PI_BYTE[7]);
|
||||
|
||||
//PI_BYTE[9] is a checksum of the other bytes combined
|
||||
uint8_t checksum = 0;
|
||||
for (int i = 0; i < 9; i++)
|
||||
if (state->payload_algidR >= 0x26)
|
||||
{
|
||||
checksum += PI_BYTE[i];
|
||||
checksum &= 0xFF;
|
||||
state->payload_algidR = 0;
|
||||
state->payload_keyidR = 0;
|
||||
state->payload_miR = 0;
|
||||
}
|
||||
checksum = ~checksum & 0xFF;
|
||||
checksum++;
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, " CHK: %02X / %02X;", checksum, PI_BYTE[9]);
|
||||
|
||||
if (checksum == PI_BYTE[9])
|
||||
{
|
||||
fprintf (stderr, " Hytera Enhanced; ");
|
||||
|
||||
if (state->currentslot == 0 && state->R != 0)
|
||||
fprintf (stderr, "Key: %010llX; ", state->R);
|
||||
|
||||
if (state->currentslot == 1 && state->RR != 0)
|
||||
fprintf (stderr, "Key: %010llX; ", state->RR);
|
||||
|
||||
//disable late entry for DMRA (hopefully, there aren't any systems running both DMRA and Hytera Enhanced mixed together)
|
||||
opts->dmr_le = 2;
|
||||
|
||||
// fprintf (stderr, " (Checksum Okay);");
|
||||
}
|
||||
else
|
||||
{
|
||||
fprintf (stderr, "%s", KRED);
|
||||
fprintf (stderr, " (Checksum Err);");
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
}
|
||||
|
||||
else if (MFID == 0x10) //DMRA
|
||||
{
|
||||
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
state->payload_algid = PI_BYTE[0];
|
||||
state->payload_keyid = PI_BYTE[2];
|
||||
state->payload_mi = ((unsigned long long int)PI_BYTE[3] << 24ULL) | ((unsigned long long int)PI_BYTE[4] << 16ULL) | ((unsigned long long int)PI_BYTE[5] << 8ULL) | ((unsigned long long int)PI_BYTE[6] << 0ULL);
|
||||
if (state->payload_algid < 0x26)
|
||||
{
|
||||
fprintf (stderr, "%s ", KYEL);
|
||||
fprintf (stderr, "\n Slot 1");
|
||||
fprintf (stderr, " DMR PI H- ALG ID: %02X; KEY ID: %02X; MI(32): %08llX;", state->payload_algid, state->payload_keyid, state->payload_mi);
|
||||
|
||||
//check for any values that aren't 0x2X but just 0x0X
|
||||
//going to be very generic here to avoid any particular vendors using 0x2X and not 0x0X
|
||||
if (state->payload_algid & 0x20)
|
||||
fprintf (stderr, " DMRA");
|
||||
else fprintf (stderr, " DMRA Compatible");
|
||||
|
||||
if ((state->payload_algid & 0x07) == 0x01)
|
||||
{
|
||||
fprintf (stderr, " RC4;");
|
||||
state->payload_algid = 0x21;
|
||||
}
|
||||
|
||||
else if ((state->payload_algid & 0x07) == 0x02)
|
||||
{
|
||||
fprintf (stderr, " DES;");
|
||||
state->payload_algid = 0x22;
|
||||
}
|
||||
|
||||
else if ((state->payload_algid & 0x07) == 0x04)
|
||||
{
|
||||
fprintf (stderr, " AES-128;");
|
||||
state->payload_algid = 0x24;
|
||||
}
|
||||
|
||||
else if ((state->payload_algid & 0x07) == 0x05)
|
||||
{
|
||||
fprintf (stderr, " AES-256;");
|
||||
state->payload_algid = 0x25;
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
|
||||
//expand the 32-bit MI to a 64-bit DES IV
|
||||
if (state->payload_algid == 0x22)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR64 (state);
|
||||
}
|
||||
|
||||
//expand the 32-bit MI to a 128-bit AES IV
|
||||
if (state->payload_algid == 0x24 || state->payload_algid == 0x25)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR128d (state);
|
||||
}
|
||||
}
|
||||
|
||||
if (state->payload_algid >= 0x26)
|
||||
{
|
||||
state->payload_algid = 0;
|
||||
state->payload_keyid = 0;
|
||||
state->payload_mi = 0;
|
||||
}
|
||||
}
|
||||
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
|
||||
state->payload_algidR = PI_BYTE[0];
|
||||
state->payload_keyidR = PI_BYTE[2];
|
||||
state->payload_miR = ((unsigned long long int)PI_BYTE[3] << 24ULL) | ((unsigned long long int)PI_BYTE[4] << 16ULL) | ((unsigned long long int)PI_BYTE[5] << 8ULL) | ((unsigned long long int)PI_BYTE[6] << 0ULL);
|
||||
if (state->payload_algidR < 0x26)
|
||||
{
|
||||
fprintf (stderr, "%s ", KYEL);
|
||||
fprintf (stderr, "\n Slot 2");
|
||||
fprintf (stderr, " DMR PI H- ALG ID: %02X; KEY ID: %02X; MI(32): %08llX;", state->payload_algidR, state->payload_keyidR, state->payload_miR);
|
||||
|
||||
//check for any values that aren't 0x2X but just 0x0X
|
||||
//going to be very generic here to avoid any particular vendors using 0x2X and not 0x0X
|
||||
if (state->payload_algidR & 0x20)
|
||||
fprintf (stderr, " DMRA");
|
||||
else fprintf (stderr, " DMRA Compatible");
|
||||
|
||||
if ((state->payload_algidR & 0x07) == 0x01)
|
||||
{
|
||||
fprintf (stderr, " RC4;");
|
||||
state->payload_algidR = 0x21;
|
||||
}
|
||||
|
||||
else if ((state->payload_algidR & 0x07) == 0x02)
|
||||
{
|
||||
fprintf (stderr, " DES;");
|
||||
state->payload_algidR = 0x22;
|
||||
}
|
||||
|
||||
else if ((state->payload_algidR & 0x07) == 0x04)
|
||||
{
|
||||
fprintf (stderr, " AES-128;");
|
||||
state->payload_algidR = 0x24;
|
||||
}
|
||||
|
||||
else if ((state->payload_algidR & 0x07) == 0x05)
|
||||
{
|
||||
fprintf (stderr, " AES-256;");
|
||||
state->payload_algidR = 0x25;
|
||||
}
|
||||
|
||||
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
|
||||
//expand the 32-bit MI to a 64-bit DES IV
|
||||
if (state->payload_algidR == 0x22)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR64 (state);
|
||||
}
|
||||
|
||||
//expand the 32-bit MI to a 128-bit AES IV
|
||||
if (state->payload_algidR == 0x24 || state->payload_algidR == 0x25)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR128d (state);
|
||||
}
|
||||
}
|
||||
|
||||
if (state->payload_algidR >= 0x26)
|
||||
{
|
||||
state->payload_algidR = 0;
|
||||
state->payload_keyidR = 0;
|
||||
state->payload_miR = 0;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
} //end DMRA
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
void LFSR(dsd_state * state)
|
||||
{
|
||||
unsigned long long int lfsr = 0;
|
||||
int lfsr = 0;
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
lfsr = state->payload_mi;
|
||||
@@ -245,229 +103,70 @@ void LFSR(dsd_state * state)
|
||||
for(cnt=0;cnt<32;cnt++)
|
||||
{
|
||||
// Polynomial is C(x) = x^32 + x^4 + x^2 + 1
|
||||
unsigned long long int bit = ((lfsr >> 31) ^ (lfsr >> 3) ^ (lfsr >> 1)) & 0x1;
|
||||
lfsr = (lfsr << 1) | bit;
|
||||
int bit = ((lfsr >> 31) ^ (lfsr >> 3) ^ (lfsr >> 1)) & 0x1;
|
||||
lfsr = (lfsr << 1) | (bit);
|
||||
}
|
||||
|
||||
lfsr &= 0xFFFFFFFF;
|
||||
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X;", state->payload_algid, state->payload_keyid);
|
||||
fprintf (stderr, " MI(32): %08llX;", lfsr);
|
||||
fprintf (stderr, " RC4;");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algid, state->payload_keyid);
|
||||
fprintf(stderr, " MI: 0x%08X", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_mi = lfsr;
|
||||
}
|
||||
|
||||
if (state->currentslot == 1)
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X;", state->payload_algidR, state->payload_keyidR);
|
||||
fprintf(stderr, " MI(32): %08llX;", lfsr);
|
||||
fprintf (stderr, " RC4;");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algidR, state->payload_keyidR);
|
||||
fprintf(stderr, " MI: 0x%08X", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_miR = lfsr;
|
||||
}
|
||||
}
|
||||
|
||||
//Expand a 32-bit MI into a 64-bit IV for DES
|
||||
void LFSR64(dsd_state * state)
|
||||
{
|
||||
{
|
||||
{
|
||||
unsigned long long int lfsr = 0;
|
||||
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
lfsr = (uint64_t) state->payload_mi;
|
||||
}
|
||||
else lfsr = (uint64_t) state->payload_miR;
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
lfsr = (uint64_t) state->payload_mi;
|
||||
}
|
||||
else lfsr = (uint64_t) state->payload_miR;
|
||||
|
||||
uint8_t cnt = 0;
|
||||
|
||||
for(cnt=0;cnt<32;cnt++)
|
||||
for(cnt=0;cnt<32;cnt++)
|
||||
{
|
||||
unsigned long long int bit = ( (lfsr >> 31) ^ (lfsr >> 21) ^ (lfsr >> 1) ^ (lfsr >> 0) ) & 0x1;
|
||||
unsigned long long int bit = ( (lfsr >> 31) ^ (lfsr >> 21) ^ (lfsr >> 1) ^ (lfsr >> 0) ) & 0x1;
|
||||
lfsr = (lfsr << 1) | bit;
|
||||
}
|
||||
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X;", state->payload_algid, state->payload_keyid);
|
||||
fprintf (stderr, " MI(64): %016llX;", lfsr);
|
||||
fprintf (stderr, " DES;");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algid, state->payload_keyid);
|
||||
fprintf (stderr, " MI: 0x%016llX", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_mi = lfsr & 0xFFFFFFFF; //truncate for next repitition and le verification
|
||||
state->payload_miP = lfsr;
|
||||
state->DMRvcL = 0;
|
||||
}
|
||||
state->payload_mi = lfsr & 0xFFFFFFFF; //truncate for next repitition and le verification
|
||||
}
|
||||
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X;", state->payload_algidR, state->payload_keyidR);
|
||||
fprintf (stderr, " MI(64): %016llX;", lfsr);
|
||||
fprintf (stderr, " DES;");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algidR, state->payload_keyidR);
|
||||
fprintf (stderr, " MI: 0x%016llX", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_miR = lfsr & 0xFFFFFFFF; //truncate for next repitition and le verification
|
||||
state->payload_miN = lfsr;
|
||||
state->DMRvcR = 0;
|
||||
}
|
||||
state->payload_miR = lfsr & 0xFFFFFFFF; //truncate for next repitition and le verification
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
//Expand a 32-bit MI into a 128-bit IV for AES
|
||||
void LFSR128d(dsd_state * state)
|
||||
{
|
||||
unsigned long long int lfsr = 0;
|
||||
|
||||
if (state->currentslot == 0)
|
||||
lfsr = state->payload_mi;
|
||||
else lfsr = state->payload_miR;
|
||||
|
||||
unsigned long long int next_mi;
|
||||
|
||||
//start packing aes_iv
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
state->aes_iv[0] = (lfsr >> 24) & 0xFF;
|
||||
state->aes_iv[1] = (lfsr >> 16) & 0xFF;
|
||||
state->aes_iv[2] = (lfsr >> 8 ) & 0xFF;
|
||||
state->aes_iv[3] = (lfsr >> 0 ) & 0xFF;
|
||||
}
|
||||
else if (state->currentslot == 1)
|
||||
{
|
||||
state->aes_ivR[0] = (lfsr >> 24) & 0xFF;
|
||||
state->aes_ivR[1] = (lfsr >> 16) & 0xFF;
|
||||
state->aes_ivR[2] = (lfsr >> 8 ) & 0xFF;
|
||||
state->aes_ivR[3] = (lfsr >> 0 ) & 0xFF;
|
||||
}
|
||||
|
||||
int cnt = 0; int x = 32;
|
||||
unsigned long long int bit;
|
||||
for(cnt=0;cnt<96;cnt++)
|
||||
{
|
||||
//32,22,2,1
|
||||
bit = ( (lfsr >> 31) ^ (lfsr >> 21) ^ (lfsr >> 1) ^ (lfsr >> 0) ) & 0x1;
|
||||
lfsr = (lfsr << 1) | bit;
|
||||
|
||||
//continue packing aes_iv
|
||||
if (state->currentslot == 0)
|
||||
state->aes_iv[x/8] = (state->aes_iv[x/8] << 1) + bit;
|
||||
else if (state->currentslot == 1)
|
||||
state->aes_ivR[x/8] = (state->aes_ivR[x/8] << 1) + bit;
|
||||
x++;
|
||||
}
|
||||
|
||||
//assign the next 32-bit short MI from 4,5,6,7 so it'll match up with OTA late entry
|
||||
if (state->currentslot == 0)
|
||||
next_mi = ((unsigned long long int)state->aes_iv[4] << 24) | ((unsigned long long int)state->aes_iv[5] << 16) |
|
||||
((unsigned long long int)state->aes_iv[6] << 8) | ((unsigned long long int)state->aes_iv[7] << 0);
|
||||
if (state->currentslot == 1)
|
||||
next_mi = ((unsigned long long int)state->aes_ivR[4] << 24) | ((unsigned long long int)state->aes_ivR[5] << 16) |
|
||||
((unsigned long long int)state->aes_ivR[6] << 8) | ((unsigned long long int)state->aes_ivR[7] << 0);
|
||||
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X; MI(128): ", state->payload_algid, state->payload_keyid);
|
||||
for (x = 0; x < 16; x++)
|
||||
fprintf (stderr, "%02X", state->aes_iv[x]);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
fprintf (stderr, ";");
|
||||
|
||||
if (state->payload_algid == 0x24)
|
||||
fprintf (stderr, " AES-128;");
|
||||
else fprintf (stderr, " AES-256;");
|
||||
|
||||
state->payload_mi = next_mi;
|
||||
state->DMRvcL = 0;
|
||||
|
||||
}
|
||||
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: %02X; KEY ID: %02X; MI(128): ", state->payload_algidR, state->payload_keyidR);
|
||||
for (x = 0; x < 16; x++)
|
||||
fprintf (stderr, "%02X", state->aes_ivR[x]);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
fprintf (stderr, ";");
|
||||
|
||||
if (state->payload_algidR == 0x24)
|
||||
fprintf (stderr, " AES-128;");
|
||||
else fprintf (stderr, " AES-256;");
|
||||
|
||||
state->payload_miR = next_mi;
|
||||
state->DMRvcR = 0;
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
unsigned long long int hytera_lfsr(uint8_t * mi, uint8_t * taps, uint8_t len)
|
||||
{
|
||||
|
||||
for (uint8_t i = 0; i < len; i++)
|
||||
{
|
||||
uint8_t bit = (mi[i] >> 7) & 1;
|
||||
mi[i] <<= 1;
|
||||
if (bit) mi[i] ^= taps[i%5];
|
||||
mi[i] |= bit;
|
||||
|
||||
}
|
||||
|
||||
unsigned long long int mi_value = 0;
|
||||
for (uint8_t i = 0; i < 5; i++)
|
||||
{
|
||||
mi_value <<= 8;
|
||||
mi_value |= mi[i];
|
||||
}
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, " Next MI: %010llX \n", mi_value);
|
||||
|
||||
return mi_value;
|
||||
}
|
||||
|
||||
void hytera_enhanced_alg_refresh(dsd_state * state)
|
||||
{
|
||||
uint8_t mi[5]; memset (mi, 0, sizeof(mi));
|
||||
unsigned long long int mi_value = 0;
|
||||
if (state->currentslot == 0)
|
||||
mi_value = state->payload_mi;
|
||||
else mi_value = state->payload_miR;
|
||||
|
||||
//load mi_value into mi array
|
||||
mi[0] = ((mi_value & 0xFF00000000) >> 32UL);
|
||||
mi[1] = ((mi_value & 0xFF000000) >> 24);
|
||||
mi[2] = ((mi_value & 0xFF0000) >> 16);
|
||||
mi[3] = ((mi_value & 0xFF00) >> 8);
|
||||
mi[4] = ((mi_value & 0xFF) >> 0);
|
||||
|
||||
//calculate the next MI value
|
||||
uint8_t taps[5]; memset(taps, 0, sizeof(taps));
|
||||
|
||||
//the tap values
|
||||
taps[0] = 0x12;
|
||||
taps[1] = 0x24;
|
||||
taps[2] = 0x48;
|
||||
taps[3] = 0x22;
|
||||
taps[4] = 0x14;
|
||||
mi_value = hytera_lfsr(mi, taps, 5);
|
||||
|
||||
if (state->currentslot == 0)
|
||||
state->payload_mi = mi_value;
|
||||
else state->payload_miR = mi_value;
|
||||
}
|
||||
}
|
||||
@@ -10,7 +10,7 @@
|
||||
#include "dsd.h"
|
||||
|
||||
//modified to accept variable payload size and len
|
||||
uint16_t ComputeCrcCCITT16d(const uint8_t * buf, uint32_t len)
|
||||
uint16_t ComputeCrcCCITT16d(const uint8_t buf[], uint8_t len)
|
||||
{
|
||||
uint32_t i;
|
||||
uint16_t CRC = 0x0000; /* Initialization value = 0x0000 */
|
||||
|
||||
@@ -53,10 +53,15 @@ void processdPMRvoice (dsd_opts * opts, dsd_state * state)
|
||||
uint32_t CCH_EmergencyPriority[NB_OF_DPMR_VOICE_FRAME_TO_DECODE];
|
||||
uint32_t CCH_Reserved[NB_OF_DPMR_VOICE_FRAME_TO_DECODE];
|
||||
uint32_t CCH_SlowData[NB_OF_DPMR_VOICE_FRAME_TO_DECODE];
|
||||
uint32_t *errs;
|
||||
uint32_t *errs2;
|
||||
uint8_t AmbeBitDescrambled[49] = {0};
|
||||
uint32_t ScramblerKey = 0;
|
||||
uint32_t PartOfSuperFrame = 0;
|
||||
uint32_t VoiceFrameFlag = 1; /* We consider the current frame as a voice frame */
|
||||
uint32_t AttachedDataFlag = 0;
|
||||
uint8_t CalledID[8] = {0};
|
||||
uint8_t CallingID[8] = {0};
|
||||
UNUSED(PartOfSuperFrame);
|
||||
|
||||
/* First CCH (Control CHannel) - 72 bit */
|
||||
k = 0;
|
||||
@@ -376,7 +381,7 @@ void processdPMRvoice (dsd_opts * opts, dsd_state * state)
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
//check other as well before assigning
|
||||
if(state->dPMRVoiceFS2Frame.CalledIDOk) sprintf (state->dpmr_target_id, "%s", CalledID);
|
||||
if(state->dPMRVoiceFS2Frame.CallingIDOk) sprintf (state->dpmr_target_id, "%s", CalledID);
|
||||
|
||||
}
|
||||
else
|
||||
@@ -412,7 +417,7 @@ void processdPMRvoice (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
fprintf (stderr, "%s", KRED);
|
||||
fprintf(stderr, " Src=(CRC ERR) Channel Code =(CRC ERR)");
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
if (state->dPMRVoiceFS2Frame.Version[0] == 3)
|
||||
@@ -439,7 +444,7 @@ void processdPMRvoice (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
//reset scrambler key seed on frame 0
|
||||
if (state->dPMRVoiceFS2Frame.FrameNumbering[o] == 0) state->payload_miN = 0;
|
||||
|
||||
|
||||
//depending on first or second TCH, set start and end variables appropriately
|
||||
if (o == 1)
|
||||
{
|
||||
@@ -448,14 +453,14 @@ void processdPMRvoice (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
}
|
||||
|
||||
//this is used so we can simply pass the voice here to the
|
||||
//this is used so we can simply pass the voice here to the
|
||||
//nxdn scrambler by telling mbe these are nxdn frames and to
|
||||
//apply the same descramble method to them if necessary
|
||||
int realsynctype = state->synctype;
|
||||
int realsynctype = state->synctype;
|
||||
|
||||
// fprintf (stderr, "\nCommunication Mode: %d\n", state->dPMRVoiceFS2Frame.CommunicationMode[o]);
|
||||
// fprintf (stderr, "Encryption Mode: %d\n", state->dPMRVoiceFS2Frame.Version[o]); //shows as 3 (manufacturer specific, 5.16) on the dPMR scrambler values received
|
||||
// fprintf (stderr, "Superframe Number: %d", state->dPMRVoiceFS2Frame.FrameNumbering[o]);
|
||||
// fprintf (stderr, "Superframe Number: %d", state->dPMRVoiceFS2Frame.FrameNumbering[o]);
|
||||
|
||||
if((state->dPMRVoiceFS2Frame.CommunicationMode[o] == 0) ||
|
||||
(state->dPMRVoiceFS2Frame.CommunicationMode[o] == 1) ||
|
||||
@@ -469,30 +474,22 @@ void processdPMRvoice (dsd_opts * opts, dsd_state * state)
|
||||
state->nxdn_cipher_type = 0x01; //turn on nxdn scrambler cipher
|
||||
state->dmr_encL = 1; //flag on enc bit here so we can mute if no key provided
|
||||
}
|
||||
|
||||
|
||||
//flag back off if key is provided
|
||||
if (state->R != 0) state->dmr_encL = 0;
|
||||
|
||||
//print Current Frame Number if payload verbosity enabled
|
||||
if (opts->payload == 1)
|
||||
fprintf (stderr, "\n FN %d/4", state->dPMRVoiceFS2Frame.FrameNumbering[o]+1);
|
||||
|
||||
|
||||
//There are 4 AMBE voice frames per TCH
|
||||
for(i = start; i < end; i++)
|
||||
{
|
||||
processMbeFrame (opts, state, NULL, ambe_fr[i], NULL);
|
||||
if (opts->floating_point == 0)
|
||||
playSynthesizedVoiceMS(opts, state);
|
||||
if (opts->floating_point == 1)
|
||||
playSynthesizedVoiceFM(opts, state);
|
||||
}
|
||||
}
|
||||
|
||||
//set the correct sync type again and flag off the cipher
|
||||
state->synctype = realsynctype;
|
||||
state->nxdn_cipher_type = 0;
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
fprintf(stderr, "\n");
|
||||
|
||||
|
||||
829
src/dsd_alias.c
829
src/dsd_alias.c
@@ -1,829 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_alias.c
|
||||
* Talker Alias Handling for Various Protocols and Vendors
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2025-02 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
//Motorola P25 OTA Alias Decoding ripped/demystified from Ilya Smirnov's SDRTrunk Voodoo Code
|
||||
uint8_t moto_alias_lut[256] = {
|
||||
0xD2, 0xF6, 0xD4, 0x2B, 0x63, 0x49, 0x94, 0x5E, 0xA7, 0x5C, 0x70, 0x69, 0xF7, 0x08, 0xB1, 0x7D,
|
||||
0x38, 0xCF, 0xCC, 0xD8, 0x51, 0x8F, 0xD5, 0x93, 0x6A, 0xF3, 0xEF, 0x7E, 0xFB, 0x64, 0xF4, 0x35,
|
||||
0x27, 0x07, 0x31, 0x14, 0x87, 0x98, 0x76, 0x34, 0xCA, 0x92, 0x33, 0x1B, 0x4F, 0x8C, 0x09, 0x40,
|
||||
0x32, 0x36, 0x77, 0x12, 0xD3, 0xC3, 0x01, 0xAB, 0x72, 0x81, 0x95, 0xC9, 0xC0, 0xE9, 0x65, 0x52,
|
||||
0x24, 0x30, 0x1C, 0xDB, 0x88, 0xE8, 0x97, 0x9D, 0x58, 0x26, 0x04, 0x39, 0xAC, 0x2A, 0x9E, 0xAA,
|
||||
0x25, 0xD7, 0xCE, 0xEB, 0x96, 0xF5, 0x0E, 0x8D, 0xDC, 0xA9, 0x2F, 0xDD, 0x1F, 0xEA, 0x91, 0xB7,
|
||||
0xD6, 0x89, 0x8B, 0xD1, 0xB0, 0x99, 0x13, 0x7A, 0xE7, 0x9A, 0xB5, 0x86, 0xFF, 0x46, 0x85, 0xB2,
|
||||
0x73, 0xDA, 0xBF, 0xD0, 0x71, 0xCB, 0x4D, 0x80, 0x15, 0x67, 0x16, 0x1A, 0x20, 0x8E, 0x45, 0x3E,
|
||||
0xF2, 0x2E, 0x66, 0x90, 0x74, 0x8A, 0x6F, 0x78, 0xBB, 0x53, 0x03, 0x11, 0x68, 0xCD, 0x44, 0x17,
|
||||
0x28, 0x5F, 0x1E, 0x84, 0x75, 0x79, 0x6E, 0x9B, 0x2C, 0xBE, 0x62, 0x2D, 0xF1, 0x7C, 0xB8, 0x83,
|
||||
0xD9, 0x4E, 0x6D, 0x02, 0x61, 0x3D, 0xA8, 0x06, 0xB9, 0xF8, 0x9C, 0x37, 0x3A, 0x23, 0xC1, 0x50,
|
||||
0xED, 0x9F, 0xAF, 0x3B, 0xBD, 0x82, 0xBA, 0xA0, 0xDF, 0xC2, 0x47, 0x22, 0xF0, 0xEE, 0xA1, 0xFE,
|
||||
0xA2, 0x10, 0x5B, 0x48, 0x57, 0xA3, 0x05, 0x60, 0x7B, 0x0D, 0xF9, 0x6C, 0xB3, 0x56, 0x4C, 0xBC,
|
||||
0x29, 0xA4, 0x0F, 0xEC, 0xB6, 0xA5, 0xA6, 0x3C, 0x7F, 0x6B, 0xB4, 0x21, 0xAD, 0xAE, 0xC4, 0xC8,
|
||||
0xC5, 0x5D, 0xDE, 0xE0, 0x1D, 0x19, 0x4B, 0xC6, 0x0C, 0x3F, 0x5A, 0xC7, 0xE1, 0x59, 0x55, 0x54,
|
||||
0x4A, 0x43, 0x42, 0xE2, 0xE3, 0xFA, 0x00, 0xE4, 0xE5, 0x18, 0x41, 0x0B, 0x0A, 0xE6, 0xFC, 0xFD
|
||||
};
|
||||
|
||||
void apx_embedded_alias_test_phase1 (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
|
||||
uint64_t temp_a = 0x15902D2806010005; uint64_t temp_b = 0xDE; //72 bits, so break into segments
|
||||
uint8_t lcw[72]; memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
temp_a = 0x1790010BEE0740F0; temp_b = 0x4E;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
temp_a = 0x17900200DD2D2168; temp_b = 0x1A;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
temp_a = 0x17900301B52FFBFB; temp_b = 0xFE;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
temp_a = 0x1790040E53FE86BE; temp_b = 0xF7;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
temp_a = 0x17900508FD5AB910; temp_b = 0xB2;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
temp_a = 0x1790060376F9D800; temp_b = 0x00;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
//Harris Phase 1 GPS
|
||||
state->lastsrc = 1000;
|
||||
temp_a = 0x2AA41D4C24262328; temp_b = 0xAF;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
|
||||
temp_a = 0x2BA44E0DB2660108; temp_b = 0x14;
|
||||
memset (lcw, 0, sizeof(lcw));
|
||||
for (uint64_t i = 0; i < 64; i++)
|
||||
lcw[i] = (temp_a >> (63-i)) & 1;
|
||||
for (uint64_t i = 0; i < 8; i++)
|
||||
lcw[i+64] = (temp_b >> (7-i)) & 1;
|
||||
p25_lcw(opts, state, lcw, 0);
|
||||
state->lastsrc = 0;
|
||||
|
||||
}
|
||||
|
||||
void apx_embedded_alias_header_phase1 (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t * lc_bits)
|
||||
{
|
||||
|
||||
UNUSED(opts);
|
||||
uint8_t ta_len = (uint8_t)ConvertBitIntoBytes(&lc_bits[32], 8); //len in blocks of associated talker alias
|
||||
uint8_t sn = (uint8_t)ConvertBitIntoBytes(&lc_bits[56], 4);
|
||||
fprintf (stderr, " SN: %X;", sn);
|
||||
fprintf (stderr, " BN: 0/%d;", ta_len);
|
||||
|
||||
//use dmr_pdu_sf for storage, store entire header (will be used to verify complete reception of full alias)
|
||||
memset (state->dmr_pdu_sf[slot], 0, sizeof (state->dmr_pdu_sf[slot])); //reset storage for header and blocks
|
||||
memcpy (state->dmr_pdu_sf[slot], lc_bits, 72*sizeof(uint8_t));
|
||||
|
||||
}
|
||||
|
||||
void apx_embedded_alias_blocks_phase1 (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t * lc_bits)
|
||||
{
|
||||
|
||||
UNUSED(opts);
|
||||
uint8_t bn = (uint8_t)ConvertBitIntoBytes(&lc_bits[16], 8); //current block number
|
||||
uint8_t sn = (uint8_t)ConvertBitIntoBytes(&lc_bits[24], 4); //is a static value on all block sequences
|
||||
uint8_t ta_len = (uint8_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][32], 8); //len in blocks pulled from stored header
|
||||
uint16_t header = (uint16_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][0], 16); //header check, should be 0x1590
|
||||
|
||||
if (ta_len == 0 || header != 0x1590) //checkdown, make sure we have an up to date header for this with a good len value
|
||||
{
|
||||
fprintf (stderr, " Missing Header");
|
||||
fprintf (stderr, " BN: %d/??;", bn);
|
||||
fprintf (stderr, " SN: %X;", sn);
|
||||
fprintf (stderr, " Partial: ");
|
||||
for (uint8_t i = 7; i < 18; i++)
|
||||
fprintf (stderr, "%0X", (uint8_t)ConvertBitIntoBytes(&lc_bits[0+(i*4)], 4));
|
||||
|
||||
//clear out now stale storage
|
||||
memset (state->dmr_pdu_sf[slot], 0, sizeof (state->dmr_pdu_sf[slot]));
|
||||
}
|
||||
|
||||
else //good len and header stored
|
||||
{
|
||||
|
||||
//sanity check, bn cannot equal zero (this shouldn't happen, but bad decode could occur)
|
||||
if (bn == 0) bn = 1;
|
||||
|
||||
fprintf (stderr, " SN: %X;", sn);
|
||||
fprintf (stderr, " BN: %d/%d;", bn, ta_len);
|
||||
|
||||
//use dmr_pdu_sf for storage, store data relevant portion at ptr of (bn-1) * 44 + 72 offset for header
|
||||
memcpy(state->dmr_pdu_sf[slot]+(((bn-1)*44)+72), lc_bits+28, 44*sizeof(uint8_t));
|
||||
|
||||
if (ta_len == bn) //this is the last block, proceed to decoding
|
||||
{
|
||||
|
||||
//Calculate variable len bits determined by non-zero octets
|
||||
int16_t num_bits = 56; //starting value is the static bit count on the fqsuid
|
||||
|
||||
// //evaluate the storage and determine how many octets/bits are present at this point (fall back to this if needed)
|
||||
// for (int16_t i = 0; i < 368; i++) //(3072-128)/8
|
||||
// {
|
||||
// uint8_t byte = (uint8_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][72+56+(i*8)], 8);
|
||||
// if (byte == 0)
|
||||
// break;
|
||||
// else
|
||||
// num_bits += 8;
|
||||
// }
|
||||
|
||||
//evaluate the storage and determine how many octets/bits are present at this point (expanded to two octets each, CRC with a 00xx pattern failed this)
|
||||
for (int16_t i = 0; i < 184; i++) //(3072-128)/16
|
||||
{
|
||||
uint16_t bytes = (uint16_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][72+56+(i*16)], 16);
|
||||
if (bytes == 0)
|
||||
break;
|
||||
else
|
||||
num_bits += 16;
|
||||
}
|
||||
|
||||
//pass to alias decoder
|
||||
apx_embedded_alias_decode (opts, state, slot, num_bits, state->dmr_pdu_sf[slot]);
|
||||
|
||||
//clear out now stale storage
|
||||
memset (state->dmr_pdu_sf[slot], 0, sizeof(state->dmr_pdu_sf[slot]));
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void apx_embedded_alias_header_phase2 (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t * lc_bits)
|
||||
{
|
||||
|
||||
UNUSED(opts);
|
||||
uint8_t ta_len = (uint8_t)ConvertBitIntoBytes(&lc_bits[40], 8);
|
||||
uint8_t sn = (uint8_t)ConvertBitIntoBytes(&lc_bits[64], 4);
|
||||
uint8_t bn = (uint8_t)ConvertBitIntoBytes(&lc_bits[56], 8);
|
||||
fprintf (stderr, " SN: %X;", sn); //NOTE: vPDU header is also a partial block, and has a block num and SN value in it
|
||||
fprintf (stderr, " BN: %d/%d;", bn, ta_len);
|
||||
|
||||
//bit array to rearrange input lc_bits from phase 2 input to match the phase 1 header and block handling
|
||||
uint8_t bits[136]; memset(bits, 0, sizeof(bits));
|
||||
memcpy (bits, lc_bits, 2*8*sizeof(uint8_t)); //header 0x9190
|
||||
memcpy (bits+16, lc_bits+24, 4*8*sizeof(uint8_t)); //BN, SN, etc
|
||||
memcpy (bits+56, lc_bits+56, 10*8*sizeof(uint8_t)); //adding 8 bits of extra padding here
|
||||
|
||||
int16_t alias_st = 136; //start of the encoded alias (the copied size of this header, basically)
|
||||
|
||||
//debug, dump header arranged at this end
|
||||
// fprintf (stderr, " Header: ");
|
||||
// for (int16_t i = 0; i < alias_st/8; i++) //double check and adjust
|
||||
// fprintf (stderr, "%02X", (uint8_t)ConvertBitIntoBytes(&bits[0+(i*8)], 8));
|
||||
|
||||
//use dmr_pdu_sf for storage, store entire header (will be used to verify complete reception of full alias)
|
||||
memset (state->dmr_pdu_sf[slot], 0, sizeof (state->dmr_pdu_sf[slot])); //reset storage for header and blocks
|
||||
memcpy (state->dmr_pdu_sf[slot], bits, alias_st*sizeof(uint8_t)); //this header block has 128 bits of relevant data (through the fqsuid)
|
||||
|
||||
}
|
||||
|
||||
void apx_embedded_alias_blocks_phase2 (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t * lc_bits)
|
||||
{
|
||||
|
||||
UNUSED(opts);
|
||||
int16_t rel_bits = 100; //number of relevant bits in each block
|
||||
int16_t rel_st = 36; //start of relevant bits in this block
|
||||
int16_t alias_st = 136; //start of the encoded alias
|
||||
uint8_t bn = (uint8_t)ConvertBitIntoBytes(&lc_bits[24], 8); //current block number
|
||||
uint8_t sn = (uint8_t)ConvertBitIntoBytes(&lc_bits[32], 4); //is a static value on all block sequences
|
||||
uint8_t ta_len = (uint8_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][32], 8); //len in blocks pulled from stored header
|
||||
uint16_t header = (uint16_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][0], 16); //header check, should be 0x9190
|
||||
|
||||
if (ta_len == 0 || header != 0x9190)
|
||||
{
|
||||
fprintf (stderr, " Missing Header");
|
||||
fprintf (stderr, " BN: %d/??;", bn);
|
||||
fprintf (stderr, " SN: %X;", sn);
|
||||
fprintf (stderr, " Partial: ");
|
||||
for (uint8_t i = 9; i < 32; i++) //double check and adjust
|
||||
fprintf (stderr, "%0X", (uint8_t)ConvertBitIntoBytes(&lc_bits[0+(i*4)], 4));
|
||||
|
||||
//clear out now stale storage
|
||||
memset (state->dmr_pdu_sf[slot], 0, sizeof(state->dmr_pdu_sf[slot]));
|
||||
}
|
||||
|
||||
else //good len and header stored
|
||||
{
|
||||
|
||||
//sanity check, bn cannot equal zero (this shouldn't happen, but bad decode could occur)
|
||||
if (bn == 0) bn = 1;
|
||||
|
||||
fprintf (stderr, " SN: %X;", sn);
|
||||
fprintf (stderr, " BN: %d/%d;", bn, ta_len);
|
||||
|
||||
//use dmr_pdu_sf for storage, store data relevant portion at ptr calculated below
|
||||
memcpy(state->dmr_pdu_sf[slot]+(alias_st+((bn-1)*rel_bits)), lc_bits+rel_st, rel_bits*sizeof(uint8_t)); //Fix this value when samples arrive
|
||||
|
||||
//debug, dump accumulated data at this end
|
||||
// fprintf (stderr, " Accumulated: ");
|
||||
// for (int16_t i = 0; i < (alias_st+(rel_bits*bn))/8; i++) //double check and adjust
|
||||
// fprintf (stderr, "%02X", (uint8_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][0+(i*8)], 8));
|
||||
|
||||
if (ta_len == bn) //this is the last block, proceed to decoding
|
||||
{
|
||||
|
||||
//Calculate variable len bits determined by non-zero octets
|
||||
int16_t num_bits = 56; //starting value is the static bit count on the fqsuid
|
||||
|
||||
// //evaluate the storage and determine how many octets/bits are present at this point (fall back to this if needed)
|
||||
// for (int16_t i = 0; i < 368; i++) //(3072-128)/8
|
||||
// {
|
||||
// uint8_t byte = (uint8_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][72+56+(i*8)], 8);
|
||||
// if (byte == 0)
|
||||
// break;
|
||||
// else
|
||||
// num_bits += 8;
|
||||
// }
|
||||
|
||||
//evaluate the storage and determine how many octets/bits are present at this point (expanded to two octets each, CRC with a 00xx pattern failed this)
|
||||
for (int16_t i = 0; i < 184; i++) //(3072-128)/16
|
||||
{
|
||||
uint16_t bytes = (uint16_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][72+56+(i*16)], 16);
|
||||
if (bytes == 0)
|
||||
break;
|
||||
else
|
||||
num_bits += 16;
|
||||
}
|
||||
|
||||
//pass to alias decoder
|
||||
apx_embedded_alias_decode (opts, state, slot, num_bits, state->dmr_pdu_sf[slot]);
|
||||
|
||||
//clear out now stale storage
|
||||
memset (state->dmr_pdu_sf[slot], 0, sizeof (state->dmr_pdu_sf[slot]));
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void apx_embedded_alias_decode (dsd_opts * opts, dsd_state * state, uint8_t slot, int16_t num_bits, uint8_t * input)
|
||||
{
|
||||
|
||||
UNUSED(opts);
|
||||
UNUSED(state);
|
||||
UNUSED(slot);
|
||||
|
||||
//debug, dump completed data set
|
||||
// fprintf (stderr, "\n Full: ");
|
||||
// for (int16_t i = 0; i < (72+num_bits)/4; i++)
|
||||
// fprintf (stderr, "%X", (uint8_t)ConvertBitIntoBytes(&input[0+(i*4)], 4));
|
||||
|
||||
//extract CRC
|
||||
uint16_t crc_ext = (uint16_t)ConvertBitIntoBytes(&input[(72+num_bits-16)], 16);
|
||||
|
||||
//compute CRC
|
||||
uint16_t crc_cmp = ComputeCrcCCITT16d(&input[72], num_bits-16);
|
||||
|
||||
//print comparison
|
||||
// fprintf (stderr, " CRC EXT: %04X CMP: %04X;", crc_ext, crc_cmp);
|
||||
if (crc_ext != crc_cmp)
|
||||
fprintf (stderr, " Alias CRC Error;");
|
||||
// else fprintf (stderr, " Alias Okay;");
|
||||
|
||||
//start decoding the alias
|
||||
if (crc_ext == crc_cmp)
|
||||
{
|
||||
|
||||
//extract fully qualified SUID
|
||||
uint32_t wacn = (uint32_t)ConvertBitIntoBytes(&input[72], 20);
|
||||
uint32_t sys = (uint32_t)ConvertBitIntoBytes(&input[92], 12);
|
||||
uint32_t rid = (uint32_t)ConvertBitIntoBytes(&input[104], 24);
|
||||
|
||||
//print fully qualified SUID
|
||||
fprintf (stderr, "\n FQ-SUID: %05X.%03X.%06X (%d);", wacn, sys, rid, rid);
|
||||
|
||||
//WIP: Working, needs more samples to verify various num_bits values
|
||||
uint16_t ptr = 128; //starting point of encoded alias
|
||||
uint8_t encoded[200]; memset(encoded, 0, sizeof(encoded));
|
||||
uint8_t decoded[200]; memset(decoded, 0, sizeof(decoded));
|
||||
uint16_t num_bytes = (num_bits / 8) - 9; //subtract 2 CRC and 7 FQSUID
|
||||
|
||||
//sanity check
|
||||
if (num_bytes <= 0) num_bytes = 1;
|
||||
|
||||
for (int16_t i = 0; i < num_bytes; i++)
|
||||
{
|
||||
encoded[i] = (uint8_t)ConvertBitIntoBytes(&input[ptr], 8);
|
||||
ptr += 8;
|
||||
}
|
||||
|
||||
uint16_t accumulator = num_bytes;
|
||||
|
||||
//Ilya's Voodoo Code
|
||||
for (uint16_t i = 0; i < num_bytes; i++)
|
||||
{
|
||||
// Multiplication step 1
|
||||
uint16_t accum_mult = accumulator * 293 + 0x72E9;
|
||||
|
||||
// Lookup table step
|
||||
uint8_t lut = moto_alias_lut[encoded[i]];
|
||||
uint8_t mult1 = lut - (accum_mult >> 8);
|
||||
|
||||
// Incrementing step
|
||||
uint8_t mult2 = 1;
|
||||
uint8_t shortstop = accum_mult | 0x1;
|
||||
uint8_t increment = shortstop << 1;
|
||||
|
||||
//clang warning -- warning: result of comparison of constant -1 with expression of type 'uint8_t' (aka 'unsigned char') is always true [-Wtautological-constant-out-of-range-compare]
|
||||
// while(mult2 != -1 && shortstop != 1) //clang warning can't be -1 if uint8_t (set to 255 instead?)
|
||||
while(shortstop != 1) //this one tests out okay, so may use it instead
|
||||
{
|
||||
shortstop += increment;
|
||||
mult2 += 2;
|
||||
}
|
||||
|
||||
// Multiplication step 2
|
||||
decoded[i] = mult1 * mult2;
|
||||
|
||||
// Update the accumulator
|
||||
accumulator += encoded[i] + 1;
|
||||
|
||||
}
|
||||
|
||||
// //debug, dump just the encoded alias portion
|
||||
// fprintf (stderr, "\n Encoded: ");
|
||||
// for (int16_t i = 0; i < num_bytes; i++)
|
||||
// fprintf (stderr, "%02X", encoded[i]);
|
||||
|
||||
// //debug, dump the decoded payload as hex octets
|
||||
// fprintf (stderr, "\n Decoded: ");
|
||||
// for (int16_t i = 0; i < num_bytes; i++)
|
||||
// fprintf (stderr, "%02X", decoded[i]);
|
||||
|
||||
//dump the decoded payload as long chars
|
||||
// fprintf (stderr, "\n");
|
||||
fprintf (stderr, " Alias: ");
|
||||
for (int16_t i = 0; i < num_bytes/2; i++)
|
||||
fprintf (stderr, "%lc", ((decoded[(i*2)+0])<<8) | ((decoded[(i*2)+1])<<0) );
|
||||
|
||||
apx_embedded_alias_dump (opts, state, slot, num_bytes, input, decoded);
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void apx_embedded_alias_dump (dsd_opts * opts, dsd_state * state, uint8_t slot, uint16_t num_bytes, uint8_t * input, uint8_t * decoded)
|
||||
{
|
||||
|
||||
char str[50]; memset(str, 0, sizeof(str));
|
||||
char fqs[50]; memset(fqs, 0, sizeof(fqs));
|
||||
|
||||
//check num_bytes, if greter than 100, then set to 100
|
||||
if (num_bytes >= 98) num_bytes = 98;
|
||||
|
||||
for (int16_t i = 0; i < num_bytes/2; i++)
|
||||
{
|
||||
if (decoded[(i*2)+1] == 0x2C) //remove a comma if it exists, change it to a 0x2E dot
|
||||
str[i] = 0x2E;
|
||||
else if (decoded[(i*2)+1] > 0x1F && decoded[(i*2)+1] < 0x7F) //may not need or use this restriction
|
||||
str[i] = decoded[(i*2)+1];
|
||||
else str[i] = 0x20; //space
|
||||
}
|
||||
|
||||
//flag to indicate this already exists in import or group struct
|
||||
uint8_t wr = 0;
|
||||
|
||||
//fully qualified SUID
|
||||
uint32_t wacn = (uint32_t)ConvertBitIntoBytes(&input[72], 20);
|
||||
uint32_t sys = (uint32_t)ConvertBitIntoBytes(&input[92], 12);
|
||||
uint32_t rid = (uint32_t)ConvertBitIntoBytes(&input[104], 24);
|
||||
|
||||
sprintf (fqs, " FQ-SUID: %05X:%03X.%06X (%d);", wacn, sys, rid, rid);
|
||||
if (rid != 0 && state->event_history_s[slot].Event_History_Items[0].source_id == rid)
|
||||
{
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].alias, "%s; ", str);
|
||||
strcat (state->event_history_s[slot].Event_History_Items[0].alias, fqs);
|
||||
}
|
||||
|
||||
for (int16_t i = 0; i < state->group_tally; i++)
|
||||
{
|
||||
if (state->group_array[i].groupNumber == rid)
|
||||
{
|
||||
wr = 1; //already in there, so no need to assign it
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (wr == 0) //not already in there, so save it there now
|
||||
{
|
||||
state->group_array[state->group_tally].groupNumber = rid;
|
||||
sprintf (state->group_array[state->group_tally].groupMode, "%s", "D");
|
||||
sprintf (state->group_array[state->group_tally].groupName, "%s", str);
|
||||
state->group_tally++;
|
||||
|
||||
//if we have an opened group file, let's write what info we found into it
|
||||
if (opts->group_in_file[0] != 0) //file is available
|
||||
{
|
||||
FILE * pFile; //file pointer
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->group_in_file, "a");
|
||||
fprintf (pFile, "%d,D,", rid); //may want to not use this one
|
||||
fprintf (pFile, "%s", str);
|
||||
fprintf (pFile, ",FQS:%05X.%03X.%06X(%d),Moto\n", wacn, sys, rid, rid);
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//end Motorola P25 OTA Alias Decoding
|
||||
|
||||
//TODO: Migrate Other OTA Alias functions here
|
||||
|
||||
void l3h_embedded_alias_blocks_phase1 (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t * lc_bits)
|
||||
{
|
||||
|
||||
uint8_t op = (uint8_t)ConvertBitIntoBytes(&lc_bits[0], 8);
|
||||
uint8_t ptr = op-0x32;
|
||||
uint8_t bytes[7]; memset(bytes, 0, sizeof(bytes));
|
||||
for (uint8_t i = 0; i < 7; i++)
|
||||
bytes[i] = (uint8_t)ConvertBitIntoBytes(&lc_bits[16+(i*8)], 8);
|
||||
|
||||
//use +4 offset to match the MAC vPDU since that was already worked out long ago
|
||||
memcpy(state->dmr_pdu_sf[slot]+4+(ptr*7), bytes, sizeof(bytes));
|
||||
|
||||
//to be tested
|
||||
if (ptr == 4) //is there always 4 blocks, or is it a variable amount?
|
||||
l3h_embedded_alias_decode(opts, state, slot, 4+28, state->dmr_pdu_sf[slot]);
|
||||
}
|
||||
|
||||
void l3h_embedded_alias_decode (dsd_opts * opts, dsd_state * state, uint8_t slot, int16_t len, uint8_t * input)
|
||||
{
|
||||
|
||||
//storage info for storing to groupName, if not available
|
||||
char str[40]; memset (str, 0, sizeof(str));
|
||||
char ttemp[40]; memset (ttemp, 0, sizeof(ttemp));
|
||||
uint8_t wr = 0;
|
||||
uint32_t tsrc = 0, ttg = 0;
|
||||
if (slot == 0 && state->lastsrc != 0) tsrc = state->lastsrc;
|
||||
if (slot == 1 && state->lastsrcR != 0) tsrc = state->lastsrcR;
|
||||
if (slot == 0 && state->lasttg != 0) ttg = state->lasttg;
|
||||
if (slot == 1 && state->lasttgR != 0) ttg = state->lasttgR;
|
||||
|
||||
int8_t ptr = 0;
|
||||
if (tsrc != 0)
|
||||
fprintf (stderr, " TG: %d; SRC: %d; Talker Alias: ", ttg, tsrc);
|
||||
else fprintf (stderr, " TG: UNK; SRC: UNK; Talker Alias: ");
|
||||
for (int8_t i = 4; i <= len; i++)
|
||||
{
|
||||
if ( (input[i] > 0x19) && (input[i] < 0x7F) )
|
||||
fprintf (stderr, "%c", (char)input[i]);
|
||||
else fprintf (stderr, " ");
|
||||
|
||||
if (input[i] == 0x2C) //remove a comma if it exists, change it to a 0x2E dot
|
||||
ttemp[ptr] = 0x2E;
|
||||
else if ( (input[i] > 0x19) && (input[i] < 0x7F) )
|
||||
ttemp[ptr] = input[i];
|
||||
else if (input[i] != 0)
|
||||
ttemp[ptr] = 0x20; //space
|
||||
|
||||
ptr++;
|
||||
}
|
||||
|
||||
//assign completed talker to a more useful string instead
|
||||
snprintf (str, ptr+1, "%s", ttemp);
|
||||
|
||||
if (state->event_history_s[slot].Event_History_Items[0].source_id == tsrc && tsrc != 0)
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].alias, "%s", str);
|
||||
|
||||
//The Duke Energy system may relay two src values, may be a good idea to pick one and stick with it
|
||||
if (tsrc != 0)
|
||||
{
|
||||
for (int16_t i = 0; i < state->group_tally; i++)
|
||||
{
|
||||
if (state->group_array[i].groupNumber == tsrc)
|
||||
{
|
||||
wr = 1; //already in there, so no need to assign it
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (wr == 0) //not already in there, so save it there now
|
||||
{
|
||||
state->group_array[state->group_tally].groupNumber = tsrc;
|
||||
sprintf (state->group_array[state->group_tally].groupMode, "%s", "D");
|
||||
sprintf (state->group_array[state->group_tally].groupName, "%s", str);
|
||||
state->group_tally++;
|
||||
|
||||
//if we have an opened group file, let's write what info we found into it
|
||||
if (opts->group_in_file[0] != 0) //file is available
|
||||
{
|
||||
FILE * pFile; //file pointer
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->group_in_file, "a");
|
||||
fprintf (pFile, "%d,D,", tsrc);
|
||||
fprintf (pFile, "%s", str);
|
||||
fprintf (pFile, ",TG:%d,SYS:%03llX,RFSS:%lld,SITE:%lld,Harris\n", ttg, state->p2_sysid, state->p2_rfssid, state->p2_siteid);
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "\n WR: %d TG: %d SRC: %d Res: %d Len: %d STR: %s", wr, ttg, tsrc, res, len, str);
|
||||
|
||||
//reset storage
|
||||
memset (state->dmr_pdu_sf[slot], 0, sizeof (state->dmr_pdu_sf[slot]));
|
||||
|
||||
}
|
||||
|
||||
void tait_iso7_embedded_alias_decode (dsd_opts * opts, dsd_state * state, uint8_t slot, int16_t len, uint8_t * input)
|
||||
{
|
||||
|
||||
UNUSED(slot);
|
||||
uint8_t alias[24]; memset(alias, 0, sizeof(alias));
|
||||
for (uint8_t i = 0; i < len; i++)
|
||||
{
|
||||
alias[i] = (uint8_t)ConvertBitIntoBytes(&input[16+(i*7)], 7);
|
||||
fprintf (stderr, "%c", alias[i]);
|
||||
if (alias[i] == 0x2C) //change a comma to a dot
|
||||
alias[i] = 0x2E;
|
||||
else if (alias[i] < 0x20) //change any garble / control chars to a space
|
||||
alias[i] = 0x20;
|
||||
}
|
||||
|
||||
//flag to indicate this already exists in import or group struct
|
||||
uint8_t wr = 0;
|
||||
uint32_t rid = state->lastsrc;
|
||||
uint16_t nac = state->nac;
|
||||
|
||||
if (state->event_history_s[slot].Event_History_Items[0].source_id == rid)
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].alias, "%s", alias);
|
||||
|
||||
if (rid != 0)
|
||||
{
|
||||
for (int16_t i = 0; i < state->group_tally; i++)
|
||||
{
|
||||
if (state->group_array[i].groupNumber == rid)
|
||||
{
|
||||
wr = 1; //already in there, so no need to assign it
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (wr == 0) //not already in there, so save it there now
|
||||
{
|
||||
state->group_array[state->group_tally].groupNumber = rid;
|
||||
sprintf (state->group_array[state->group_tally].groupMode, "%s", "D");
|
||||
sprintf (state->group_array[state->group_tally].groupName, "%s", alias);
|
||||
state->group_tally++;
|
||||
|
||||
//if we have an opened group file, let's write what info we found into it
|
||||
if (opts->group_in_file[0] != 0) //file is available
|
||||
{
|
||||
FILE * pFile; //file pointer
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->group_in_file, "a");
|
||||
fprintf (pFile, "%d,D,", rid); //may want to not use this one
|
||||
fprintf (pFile, "%s,", alias);
|
||||
fprintf (pFile, "%03X,", nac); //if we find this on a trunking system, may want to add the site and rfss id
|
||||
fprintf (pFile, "%s", ",Tait\n");
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
void dmr_talker_alias_lc_header (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t * lc_bits)
|
||||
{
|
||||
uint8_t format = (uint8_t)ConvertBitIntoBytes(&lc_bits[16], 2);
|
||||
uint8_t block_len = (uint8_t)ConvertBitIntoBytes(&lc_bits[18], 5);
|
||||
uint8_t char_size = 0;
|
||||
|
||||
if (format == 0) char_size = 7;
|
||||
else if (format == 1 || format == 2) char_size = 8;
|
||||
else char_size = 16;
|
||||
|
||||
state->dmr_alias_format[slot] = format;
|
||||
state->dmr_alias_block_len[slot] = block_len; //data len, see below
|
||||
state->dmr_alias_char_size[slot] = char_size;
|
||||
|
||||
//load into dmr_pdu_sf as bit wise values for this since iso7 has 49 bits in this header, otherwise, load with 48?
|
||||
if (char_size == 7)
|
||||
memcpy(state->dmr_pdu_sf[slot], lc_bits+23, 49*sizeof(uint8_t));
|
||||
else if (char_size == 8)
|
||||
memcpy(state->dmr_pdu_sf[slot], lc_bits+24, 48*sizeof(uint8_t));
|
||||
else if (char_size == 16)
|
||||
memcpy(state->dmr_pdu_sf[slot], lc_bits+24, 48*sizeof(uint8_t));
|
||||
|
||||
//TEST: The Block Len (Data Lan) value is, according to my interpretation, the number of encoded
|
||||
//character units in the alias, test to verify, but fall back to the ptr index if necessary
|
||||
//this is referenced in 5.4.3 ETSI TS 102 361-2 V2.5.1 (2023-05) 7.2.19 Talker Alias Data Length
|
||||
|
||||
fprintf (stderr, " Slot %d - Talker Alias LC Header; Format %d; Char Len: %d; Char Size: %d;", slot, format, block_len, char_size);
|
||||
|
||||
//Decode the header's alias portion
|
||||
fprintf (stderr, "\n");
|
||||
dmr_talker_alias_lc_decode(opts, state, slot, 0, char_size, block_len);
|
||||
}
|
||||
|
||||
void dmr_talker_alias_lc_blocks (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t block_num, uint8_t * lc_bits)
|
||||
{
|
||||
UNUSED(opts); //delete if we don't use this, but may want it if we dump alias to a file later on
|
||||
uint8_t block_len = state->dmr_alias_block_len[slot];
|
||||
uint8_t char_size = state->dmr_alias_char_size[slot];
|
||||
uint16_t ptr = 0;
|
||||
uint16_t end = block_len;
|
||||
|
||||
//Note: The Joann sample only carries block 5, and no header on block 4
|
||||
//another radio on that ham setup also has a broken alias similar, but
|
||||
//the other talkers have the 04 and the sample has a good decode otherwise
|
||||
//debug broken aliasing on ham radio
|
||||
|
||||
// if (char_size == 0) //Enable this is you need to check alias even with missing header (set 7, 8, or 16)
|
||||
// char_size = 8;
|
||||
|
||||
/*
|
||||
22:54:51 Sync: +DMR slot1 [SLOT2] | Color Code=01 | VC6
|
||||
Slot 1 - Talker Alias Block Num: 1; Valid Block; Talker Alias: Joann
|
||||
DMR PDU Payload [05][00][4A][6F][61][6E][6E][00][FF]
|
||||
*/
|
||||
|
||||
//set the pointer to the current index of the dmr_pdu_sf
|
||||
if (char_size == 16)
|
||||
ptr = 48 + (block_num * 56);
|
||||
else if (char_size == 8)
|
||||
ptr = 48 + (block_num * 56);
|
||||
else if (char_size == 7)
|
||||
ptr = 49 + (block_num * 56);
|
||||
|
||||
if (char_size == 0) //unset, no header received
|
||||
fprintf (stderr, " Slot %d - Talker Alias Block Num: %d; Invalid Header;", slot, block_num+1);
|
||||
|
||||
else if (block_num > 3) //invalid block (data error)
|
||||
fprintf (stderr, " Slot %d - Talker Alias Block Num: %d; Invalid Block;", slot, block_num+1);
|
||||
|
||||
else //valid header present, continue
|
||||
{
|
||||
if (char_size == 7)
|
||||
{
|
||||
memcpy(state->dmr_pdu_sf[slot]+ptr, lc_bits+16, 56*sizeof(uint8_t));
|
||||
ptr += 56;
|
||||
if (block_len == 0)
|
||||
end = ptr / 7;
|
||||
else end = block_len;
|
||||
}
|
||||
else if (char_size == 8)
|
||||
{
|
||||
memcpy(state->dmr_pdu_sf[slot]+ptr, lc_bits+16, 56*sizeof(uint8_t));
|
||||
ptr += 56;
|
||||
if (block_len == 0)
|
||||
end = ptr / 8;
|
||||
else end = block_len;
|
||||
}
|
||||
else if (char_size == 16)
|
||||
{
|
||||
memcpy(state->dmr_pdu_sf[slot]+ptr, lc_bits+16, 56*sizeof(uint8_t));
|
||||
ptr += 56;
|
||||
if (block_len == 0)
|
||||
end = ptr / 16;
|
||||
else end = block_len;
|
||||
}
|
||||
|
||||
dmr_talker_alias_lc_decode (opts, state, slot, block_num+1, char_size, end);
|
||||
}
|
||||
}
|
||||
|
||||
//Decode partial or completed alias
|
||||
void dmr_talker_alias_lc_decode (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t block_num, uint8_t char_size, uint16_t end)
|
||||
{
|
||||
UNUSED(opts);
|
||||
uint16_t i = 0;
|
||||
fprintf (stderr, " Slot %d - Talker Alias Block Num: %d; Valid Block;", slot, block_num+1);
|
||||
fprintf (stderr, " Talker Alias: ");
|
||||
|
||||
char alias_string[500]; memset (alias_string, 0, sizeof(alias_string));
|
||||
sprintf (alias_string, "%s", "");
|
||||
|
||||
if (char_size == 7)
|
||||
{
|
||||
for (i = 0; i < end; i++)
|
||||
{
|
||||
uint8_t character = (uint8_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][(i*7)], 7);
|
||||
char ch[2]; ch[0] = character; ch[1] = 0;
|
||||
if (character >= 0x20 && character <= 0x7E) //Standard ASCII Set
|
||||
{
|
||||
fprintf (stderr, "%c", character);
|
||||
strcat (alias_string, ch);
|
||||
}
|
||||
// else if (character == 0)
|
||||
// {
|
||||
// strcat (alias_string, " ");
|
||||
// fprintf (stderr, " ");
|
||||
// break;
|
||||
// }
|
||||
else
|
||||
{
|
||||
strcat (alias_string, " ");
|
||||
fprintf (stderr, " ");
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (char_size == 8)
|
||||
{
|
||||
for (i = 0; i < end; i++)
|
||||
{
|
||||
uint8_t character = (uint8_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][(i*8)], 8);
|
||||
char ch[2]; ch[0] = character; ch[1] = 0;
|
||||
// if (character >= 0x20 && character <= 0x7E) //Standard ASCII Set
|
||||
if (character >= 0x20 && character != 0x7F) //allow some extended UTF diacritical characters as well
|
||||
{
|
||||
fprintf (stderr, "%c", character);
|
||||
strcat (alias_string, ch);
|
||||
}
|
||||
// else if (character == 0)
|
||||
// {
|
||||
// strcat (alias_string, " ");
|
||||
// fprintf (stderr, " ");
|
||||
// break;
|
||||
// }
|
||||
else
|
||||
{
|
||||
strcat (alias_string, " ");
|
||||
fprintf (stderr, " ");
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (char_size == 16)
|
||||
{
|
||||
setlocale(LC_ALL, ""); //needed when encoded alias contains Chinese (or probably any non-roman charset that isn't default on users terminal)
|
||||
for (i = 0; i < end; i++)
|
||||
{
|
||||
uint16_t character = (uint16_t)ConvertBitIntoBytes(&state->dmr_pdu_sf[slot][(i*16)], 16);
|
||||
char ch[2]; ch[0] = character & 0xFF; ch[1] = 0;
|
||||
|
||||
if (character >= 0x20 && character != 0x7F)
|
||||
fprintf (stderr, "%lc", character);
|
||||
else fprintf (stderr, " ");
|
||||
|
||||
if (character == 0)
|
||||
strcat (alias_string, " ");
|
||||
else if (character >= 0x20 && character <= 0xFE)
|
||||
strcat (alias_string, ch);
|
||||
else
|
||||
strcat (alias_string, "*");
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, " [%04X], ", character);
|
||||
}
|
||||
}
|
||||
|
||||
//assign to string for event history and ncurses display
|
||||
uint32_t source = 0;
|
||||
if (slot == 0)
|
||||
source = state->lastsrc;
|
||||
else source = state->lastsrcR;
|
||||
|
||||
if (state->event_history_s[slot].Event_History_Items[0].source_id == source)
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].alias, "%s; ", alias_string);
|
||||
sprintf (state->generic_talker_alias[slot], "Talker Alias: %s; ", alias_string);
|
||||
|
||||
}
|
||||
428
src/dsd_audio.c
428
src/dsd_audio.c
@@ -21,16 +21,16 @@ pa_sample_spec ss;
|
||||
pa_sample_spec tt;
|
||||
pa_sample_spec zz;
|
||||
pa_sample_spec cc;
|
||||
pa_sample_spec ff; //float
|
||||
|
||||
//pulse audio buffer attributes (input latency)
|
||||
pa_buffer_attr lt;
|
||||
|
||||
void closePulseOutput (dsd_opts * opts)
|
||||
{
|
||||
pa_simple_free (opts->pulse_digi_dev_out);
|
||||
if (opts->dmr_stereo == 1)
|
||||
pa_simple_free (opts->pulse_digi_dev_outR);
|
||||
|
||||
if (opts->frame_provoice == 1 || opts->monitor_input_audio == 1) //EDACS analog calls and/or monitoring source analog audio
|
||||
pa_simple_free (opts->pulse_raw_dev_out);
|
||||
|
||||
}
|
||||
|
||||
void closePulseInput (dsd_opts * opts)
|
||||
@@ -41,66 +41,32 @@ void closePulseInput (dsd_opts * opts)
|
||||
void openPulseOutput(dsd_opts * opts)
|
||||
{
|
||||
|
||||
char * dev = NULL;
|
||||
if (opts->pa_output_idx[0] != 0)
|
||||
dev = opts->pa_output_idx;
|
||||
|
||||
int err = 0;
|
||||
|
||||
ss.format = PA_SAMPLE_S16NE;
|
||||
ss.channels = opts->pulse_raw_out_channels;
|
||||
ss.rate = opts->pulse_raw_rate_out;
|
||||
ss.channels = opts->pulse_raw_out_channels; //doing tests with 2 channels at 22050 for 44100 audio default in pulse
|
||||
ss.rate = opts->pulse_raw_rate_out; //48000
|
||||
|
||||
tt.format = PA_SAMPLE_S16NE;
|
||||
tt.channels = opts->pulse_digi_out_channels;
|
||||
tt.rate = opts->pulse_digi_rate_out;
|
||||
|
||||
ff.format = PA_SAMPLE_FLOAT32NE;
|
||||
ff.channels = opts->pulse_digi_out_channels;
|
||||
ff.rate = opts->pulse_digi_rate_out;
|
||||
tt.channels = opts->pulse_digi_out_channels; //doing tests with 2 channels at 22050 for 44100 audio default in pulse
|
||||
tt.rate = opts->pulse_digi_rate_out; //48000, switches to 8000 when using RTL dongle
|
||||
|
||||
//reconfigured to open when using edacs or raw analog monitor so we can have a analog audio out that runs at 48k1 and not 8k1 float/short
|
||||
if (opts->frame_provoice == 1 || opts->monitor_input_audio == 1)
|
||||
opts->pulse_raw_dev_out = pa_simple_new(NULL, "DSD-FME3", PA_STREAM_PLAYBACK, dev, "Analog", &ss, 0, NULL, &err);
|
||||
opts->pulse_raw_dev_out = pa_simple_new(NULL, "DSD-FME3", PA_STREAM_PLAYBACK, NULL, "Analog", &ss, 0, NULL, NULL);
|
||||
|
||||
if (err != 0)
|
||||
//tt
|
||||
pa_channel_map* left = 0; //NULL and 0 are same in this context
|
||||
pa_channel_map* right = 0; //NULL and 0 are same in this context
|
||||
|
||||
if (opts->dmr_stereo == 0)
|
||||
{
|
||||
fprintf (stderr, "Err: %d; %s; ", err, pa_strerror(err));
|
||||
#ifdef __CYGWIN__
|
||||
fprintf (stderr, "Please make sure the Pulse Audio Server Backend is running first.");
|
||||
#endif
|
||||
exit(0);
|
||||
opts->pulse_digi_dev_out = pa_simple_new(NULL, "DSD-FME", PA_STREAM_PLAYBACK, NULL, opts->output_name, &tt, left, NULL, NULL);
|
||||
|
||||
}
|
||||
|
||||
pa_channel_map* fl = 0; //NULL and 0 are same in this context
|
||||
pa_channel_map* ss = 0; //NULL and 0 are same in this context
|
||||
|
||||
if (opts->floating_point == 0 && opts->analog_only == 0)
|
||||
if (opts->dmr_stereo == 1)
|
||||
{
|
||||
opts->pulse_digi_dev_out = pa_simple_new(NULL, "DSD-FME", PA_STREAM_PLAYBACK, dev, opts->output_name, &tt, ss, NULL, &err);
|
||||
|
||||
if (err != 0)
|
||||
{
|
||||
fprintf (stderr, "Err: %d; %s; ", err, pa_strerror(err));
|
||||
#ifdef __CYGWIN__
|
||||
fprintf (stderr, "Please make sure the Pulse Audio Server Backend is running first.");
|
||||
#endif
|
||||
exit(0);
|
||||
}
|
||||
}
|
||||
|
||||
if (opts->floating_point == 1 && opts->analog_only == 0)
|
||||
{
|
||||
opts->pulse_digi_dev_out = pa_simple_new(NULL, "DSD-FME", PA_STREAM_PLAYBACK, dev, opts->output_name, &ff, fl, NULL, &err);
|
||||
|
||||
if (err != 0)
|
||||
{
|
||||
fprintf (stderr, "Err: %d; %s; ", err, pa_strerror(err));
|
||||
#ifdef __CYGWIN__
|
||||
fprintf (stderr, "Please make sure the Pulse Audio Server Backend is running first.");
|
||||
#endif
|
||||
exit(0);
|
||||
}
|
||||
opts->pulse_digi_dev_out = pa_simple_new(NULL, "DSD-FME1", PA_STREAM_PLAYBACK, NULL, "XDMA SLOT 1", &tt, left, NULL, NULL);
|
||||
opts->pulse_digi_dev_outR = pa_simple_new(NULL, "DSD-FME2", PA_STREAM_PLAYBACK, NULL, "XDMA SLOT 2", &tt, right, NULL, NULL);
|
||||
}
|
||||
|
||||
}
|
||||
@@ -108,198 +74,12 @@ void openPulseOutput(dsd_opts * opts)
|
||||
void openPulseInput(dsd_opts * opts)
|
||||
{
|
||||
|
||||
char * dev = NULL;
|
||||
if (opts->pa_input_idx[0] != 0)
|
||||
dev = opts->pa_input_idx;
|
||||
|
||||
int err = 0;
|
||||
|
||||
cc.format = PA_SAMPLE_S16NE;
|
||||
cc.channels = opts->pulse_digi_in_channels;
|
||||
cc.rate = opts->pulse_digi_rate_in; //48000
|
||||
|
||||
//adjust input latency settings (defaults are all -1 to let server set these automatically, but without pavucontrol open, this is approx 2s)
|
||||
//setting fragsize to 960 for 48000 input seems to do the trick to allow a much faster latency without underrun, may need adjusting if
|
||||
//modifying the input rate (will only apply IF using pulse audio input, and not any other input method)
|
||||
opts->pulse_digi_dev_in = pa_simple_new(NULL, "DSD-FME", PA_STREAM_RECORD, NULL, opts->output_name, &cc, NULL, NULL, NULL);
|
||||
|
||||
//TODO: set fragsize vs expected input rate if required in the future
|
||||
//NOTE: If users report any underrun conditions, then either change 960 back to -1, or pass NULL instead of <
|
||||
|
||||
//https://freedesktop.org/software/pulseaudio/doxygen/structpa__buffer__attr.html
|
||||
|
||||
//for now, only going to modify the fragsize if using the encoder, else, let the pa server set it automatically
|
||||
// if (opts->m17encoder == 1)
|
||||
// lt.fragsize = 960*5;
|
||||
// else lt.fragsize = -1;
|
||||
|
||||
//test doing it universally, fall back to above if needed
|
||||
lt.fragsize = 960*5;
|
||||
lt.maxlength = -1;
|
||||
lt.prebuf = -1;
|
||||
lt.tlength = -1;
|
||||
if (opts->m17encoder == 1)
|
||||
opts->pulse_digi_dev_in = pa_simple_new(NULL, "DSD-FME4", PA_STREAM_RECORD, dev, "M17 Voice Input", &cc, NULL, <, &err);
|
||||
else opts->pulse_digi_dev_in = pa_simple_new(NULL, "DSD-FME", PA_STREAM_RECORD, dev, opts->output_name, &cc, NULL, <, &err);
|
||||
|
||||
if (err != 0)
|
||||
{
|
||||
fprintf (stderr, "Err: %d; %s; ", err, pa_strerror(err));
|
||||
#ifdef __CYGWIN__
|
||||
fprintf (stderr, "Please make sure the Pulse Audio Server Backend is running first.");
|
||||
#endif
|
||||
exit(0);
|
||||
}
|
||||
|
||||
//debug
|
||||
// if (opts->m17encoder == 1)
|
||||
// {
|
||||
// unsigned long long int latency = pa_simple_get_latency (opts->pulse_digi_dev_in, NULL);
|
||||
// fprintf (stderr, "Pulse Audio Input Latency: %05lld;", latency);
|
||||
// }
|
||||
|
||||
}
|
||||
|
||||
void parse_pulse_input_string (dsd_opts * opts, char * input)
|
||||
{
|
||||
char * curr;
|
||||
curr = strtok(input, ":");
|
||||
if (curr != NULL)
|
||||
{
|
||||
strncpy (opts->pa_input_idx, curr, 99);
|
||||
opts->pa_input_idx[99] = 0;
|
||||
fprintf (stderr, "\n");
|
||||
fprintf (stderr, "Pulse Input Device: %s; ", opts->pa_input_idx);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
}
|
||||
|
||||
void parse_pulse_output_string (dsd_opts * opts, char * input)
|
||||
{
|
||||
char * curr;
|
||||
curr = strtok(input, ":");
|
||||
if (curr != NULL)
|
||||
{
|
||||
strncpy (opts->pa_output_idx, curr, 99);
|
||||
opts->pa_output_idx[99] = 0;
|
||||
fprintf (stderr, "\n");
|
||||
fprintf (stderr, "Pulse Output Device: %s; ", opts->pa_output_idx);
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
}
|
||||
|
||||
void openOSSOutput (dsd_opts * opts)
|
||||
{
|
||||
int fmt;
|
||||
int speed = 48000;
|
||||
if (opts->audio_in_type == 5) //if((strncmp(opts->audio_in_dev, "/dev/dsp", 8) == 0)) or 'split' == 0
|
||||
{
|
||||
|
||||
if((strncmp(opts->audio_out_dev, "/dev/dsp", 8) == 0))
|
||||
{
|
||||
fprintf (stderr, "OSS Output %s.\n", opts->audio_out_dev);
|
||||
opts->audio_out_fd = open (opts->audio_out_dev, O_RDWR);
|
||||
if (opts->audio_out_fd == -1)
|
||||
{
|
||||
fprintf (stderr, "Error, couldn't open #1 %s\n", opts->audio_out_dev);
|
||||
opts->audio_out = 0;
|
||||
exit(1);
|
||||
}
|
||||
|
||||
fmt = 0;
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_RESET) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl reset error \n");
|
||||
}
|
||||
|
||||
fmt = speed;
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_SPEED, &fmt) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl speed error \n");
|
||||
}
|
||||
|
||||
fmt = 0; //this seems okay to be 1 or 0, not sure what the difference really is (works in stereo on 0)
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_STEREO, &fmt) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl stereo error \n");
|
||||
}
|
||||
|
||||
fmt = AFMT_S16_LE;
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_SETFMT, &fmt) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl setfmt error \n");
|
||||
}
|
||||
|
||||
opts->audio_out_type = 5; //5 for 1 channel - 48k OSS 16-bit short output (matching with input)
|
||||
opts->pulse_digi_rate_out = 48000; //this is used to force to upsample and also allow source audio monitor conditional check
|
||||
opts->pulse_digi_out_channels = 1; //this is used to allow source audio monitor conditional check
|
||||
opts->audio_gain = 0;
|
||||
}
|
||||
}
|
||||
|
||||
if (opts->audio_in_type != 5 || opts->split == 1) //split == 1
|
||||
{
|
||||
|
||||
if((strncmp(opts->audio_out_dev, "/dev/dsp", 8) == 0))
|
||||
{
|
||||
fprintf (stderr, "OSS Output %s.\n", opts->audio_out_dev);
|
||||
opts->audio_out_fd = open (opts->audio_out_dev, O_WRONLY);
|
||||
if (opts->audio_out_fd == -1)
|
||||
{
|
||||
fprintf (stderr, "Error, couldn't open %s\n", opts->audio_out_dev);
|
||||
opts->audio_out = 0;
|
||||
exit(1);
|
||||
}
|
||||
|
||||
//Setup the device. Note that it's important to set the sample format, number of channels and sample rate exactly in this order. Some devices depend on the order.
|
||||
|
||||
fmt = 0;
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_RESET) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl reset error \n");
|
||||
}
|
||||
|
||||
fmt = AFMT_S16_LE; //Sample Format
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_SETFMT, &fmt) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl setfmt error \n");
|
||||
}
|
||||
|
||||
fmt = opts->pulse_digi_out_channels; //number of channels //was 2
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_CHANNELS, &fmt) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl channel error \n");
|
||||
}
|
||||
|
||||
//if using split with OSS output, and using EDACS w/ Analog, we have to use 48k
|
||||
if (opts->frame_provoice == 1)
|
||||
opts->pulse_digi_rate_out = 48000;
|
||||
|
||||
speed = opts->pulse_digi_rate_out; //since we have split input/output, we want to mirror pulse rate out
|
||||
fmt = speed; //output rate
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_SPEED, &fmt) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl speed error \n");
|
||||
}
|
||||
if (opts->pulse_digi_out_channels == 2)
|
||||
fmt = 1;
|
||||
else fmt = 0;
|
||||
|
||||
if (ioctl (opts->audio_out_fd, SNDCTL_DSP_STEREO, &fmt) < 0)
|
||||
{
|
||||
fprintf (stderr, "ioctl stereo error \n");
|
||||
}
|
||||
|
||||
//TODO: Multiple output returns based on 8k/1, 8k/2, or maybe 48k/1? (2,3,5)??
|
||||
if (opts->pulse_digi_out_channels == 2)
|
||||
opts->audio_out_type = 2; //2 for 2 channel 8k OSS 16-bit short output
|
||||
else if (opts->frame_m17 == 1)
|
||||
opts->audio_out_type = 2;
|
||||
else opts->audio_out_type = 5;
|
||||
|
||||
//debug
|
||||
fprintf (stderr, "Using OSS Output with %dk/%d channel configuration.\n", opts->pulse_digi_rate_out, opts->pulse_digi_out_channels);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void
|
||||
@@ -393,7 +173,8 @@ processAudio (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
// copy audio data to output buffer and upsample if necessary
|
||||
state->audio_out_temp_buf_p = state->audio_out_temp_buf;
|
||||
//we only want to upsample when using sample rates greater than 8k for output
|
||||
//we only want to upsample when using sample rates greater than 8k for output,
|
||||
//hard set to 8k for RTL mono and MBE playback, otherwise crackling may occur.
|
||||
if (opts->pulse_digi_rate_out > 8000)
|
||||
{
|
||||
for (n = 0; n < 160; n++)
|
||||
@@ -417,8 +198,6 @@ processAudio (dsd_opts * opts, dsd_state * state)
|
||||
*state->audio_out_float_buf_p = -32768.0F;
|
||||
}
|
||||
*state->audio_out_buf_p = (short) *state->audio_out_float_buf_p;
|
||||
//tap the pointer here and store the short upsample buffer samples
|
||||
state->s_lu[n] = (short) *state->audio_out_float_buf_p;
|
||||
state->audio_out_buf_p++;
|
||||
state->audio_out_float_buf_p++;
|
||||
}
|
||||
@@ -437,10 +216,6 @@ processAudio (dsd_opts * opts, dsd_state * state)
|
||||
*state->audio_out_temp_buf_p = -32768.0F;
|
||||
}
|
||||
*state->audio_out_buf_p = (short) *state->audio_out_temp_buf_p;
|
||||
//tap the pointer here and store the short buffer samples
|
||||
state->s_l[n] = (short) *state->audio_out_temp_buf_p;
|
||||
//debug
|
||||
// fprintf (stderr, " %d", state->s_l[n]);
|
||||
state->audio_out_buf_p++;
|
||||
state->audio_out_temp_buf_p++;
|
||||
state->audio_out_idx++;
|
||||
@@ -541,6 +316,7 @@ processAudioR (dsd_opts * opts, dsd_state * state)
|
||||
// copy audio data to output buffer and upsample if necessary
|
||||
state->audio_out_temp_buf_pR = state->audio_out_temp_bufR;
|
||||
//we only want to upsample when using sample rates greater than 8k for output,
|
||||
//hard set to 8k for RTL mono and MBE playback, otherwise crackling may occur.
|
||||
if (opts->pulse_digi_rate_out > 8000)
|
||||
{
|
||||
for (n = 0; n < 160; n++)
|
||||
@@ -564,8 +340,6 @@ processAudioR (dsd_opts * opts, dsd_state * state)
|
||||
*state->audio_out_float_buf_pR = -32768.0F;
|
||||
}
|
||||
*state->audio_out_buf_pR = (short) *state->audio_out_float_buf_pR;
|
||||
//tap the pointer here and store the short upsample buffer samples
|
||||
state->s_ru[n] = (short) *state->audio_out_float_buf_pR;
|
||||
state->audio_out_buf_pR++;
|
||||
state->audio_out_float_buf_pR++;
|
||||
}
|
||||
@@ -584,8 +358,6 @@ processAudioR (dsd_opts * opts, dsd_state * state)
|
||||
*state->audio_out_temp_buf_pR = -32768.0F;
|
||||
}
|
||||
*state->audio_out_buf_pR = (short) *state->audio_out_temp_buf_pR;
|
||||
//tap the pointer here and store the short buffer samples
|
||||
state->s_r[n] = (short) *state->audio_out_temp_buf_pR;
|
||||
state->audio_out_buf_pR++;
|
||||
state->audio_out_temp_buf_pR++;
|
||||
state->audio_out_idxR++;
|
||||
@@ -650,47 +422,12 @@ void writeSynthesizedVoiceR (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
}
|
||||
|
||||
//short Mono to Stereo version for new static .wav files in stereo format for TDMA
|
||||
void writeSynthesizedVoiceMS (dsd_opts * opts, dsd_state * state)
|
||||
void writeRawSample (dsd_opts * opts, dsd_state * state, short sample)
|
||||
{
|
||||
int n;
|
||||
short aout_buf[160];
|
||||
short *aout_buf_p;
|
||||
|
||||
aout_buf_p = aout_buf;
|
||||
state->audio_out_temp_buf_p = state->audio_out_temp_buf;
|
||||
|
||||
for (n = 0; n < 160; n++)
|
||||
{
|
||||
if (*state->audio_out_temp_buf_p > (float) 32767)
|
||||
{
|
||||
*state->audio_out_temp_buf_p = (float) 32767;
|
||||
}
|
||||
else if (*state->audio_out_temp_buf_p < (float) -32768)
|
||||
{
|
||||
*state->audio_out_temp_buf_p = (float) -32768;
|
||||
}
|
||||
*aout_buf_p = (short) *state->audio_out_temp_buf_p;
|
||||
aout_buf_p++;
|
||||
state->audio_out_temp_buf_p++;
|
||||
}
|
||||
|
||||
short ss[320];
|
||||
for (n = 0; n < 160; n++)
|
||||
{
|
||||
ss[(n*2)+0] = aout_buf[n];
|
||||
ss[(n*2)+1] = aout_buf[n];
|
||||
}
|
||||
|
||||
sf_write_short(opts->wav_out_f, ss, 320);
|
||||
|
||||
}
|
||||
|
||||
void writeRawSample (dsd_opts * opts, dsd_state * state, short sample)
|
||||
{
|
||||
UNUSED(state);
|
||||
|
||||
//short aout_buf[160];
|
||||
//sf_write_short(opts->wav_out_raw, aout_buf, 160);
|
||||
|
||||
//only write if actual audio, truncate silence
|
||||
@@ -705,37 +442,18 @@ void
|
||||
playSynthesizedVoice (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
ssize_t result;
|
||||
UNUSED(result);
|
||||
|
||||
//don't synthesize voice if slot is turned off
|
||||
if (opts->slot1_on == 0)
|
||||
{
|
||||
//clear any previously buffered audio
|
||||
state->audio_out_float_buf_p = state->audio_out_float_buf + 100;
|
||||
state->audio_out_buf_p = state->audio_out_buf + 100;
|
||||
memset (state->audio_out_float_buf, 0, 100 * sizeof (float));
|
||||
memset (state->audio_out_buf, 0, 100 * sizeof (short));
|
||||
state->audio_out_idx2 = 0;
|
||||
state->audio_out_idx = 0;
|
||||
goto end_psv;
|
||||
}
|
||||
|
||||
if (state->audio_out_idx > opts->delay)
|
||||
{
|
||||
if (opts->audio_out_type == 5 || opts->audio_out_type == 1) //OSS
|
||||
if (opts->audio_out_type == 5) //OSS
|
||||
{
|
||||
//OSS 48k/1
|
||||
//OSS
|
||||
result = write (opts->audio_out_fd, (state->audio_out_buf_p - state->audio_out_idx), (state->audio_out_idx * 2));
|
||||
state->audio_out_idx = 0;
|
||||
}
|
||||
else if (opts->audio_out_type == 0)
|
||||
{
|
||||
pa_simple_write(opts->pulse_digi_dev_out, (state->audio_out_buf_p - state->audio_out_idx), (state->audio_out_idx * 2), NULL);
|
||||
state->audio_out_idx = 0;
|
||||
}
|
||||
else if (opts->audio_out_type == 8) //UDP Audio Out -- Forgot some things still use this for now
|
||||
{
|
||||
udp_socket_blaster (opts, state, (state->audio_out_idx * 2), (state->audio_out_buf_p - state->audio_out_idx));
|
||||
pa_simple_write(opts->pulse_digi_dev_out, (state->audio_out_buf_p - state->audio_out_idx), (state->audio_out_idx * 2), NULL);
|
||||
state->audio_out_idx = 0;
|
||||
}
|
||||
else state->audio_out_idx = 0; //failsafe for audio_out == 0
|
||||
@@ -743,8 +461,6 @@ playSynthesizedVoice (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
}
|
||||
|
||||
end_psv:
|
||||
|
||||
if (state->audio_out_idx2 >= 800000)
|
||||
{
|
||||
state->audio_out_float_buf_p = state->audio_out_float_buf + 100;
|
||||
@@ -760,25 +476,19 @@ void
|
||||
playSynthesizedVoiceR (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
ssize_t result;
|
||||
UNUSED(result);
|
||||
|
||||
if (state->audio_out_idxR > opts->delay)
|
||||
{
|
||||
// output synthesized speech to sound card
|
||||
if (opts->audio_out_type == 5) //OSS
|
||||
{
|
||||
//OSS 48k/1
|
||||
result = write (opts->audio_out_fd, (state->audio_out_buf_pR - state->audio_out_idxR), (state->audio_out_idxR * 2));
|
||||
//OSS
|
||||
result = write (opts->audio_out_fdR, (state->audio_out_buf_pR - state->audio_out_idxR), (state->audio_out_idxR * 2));
|
||||
state->audio_out_idxR = 0;
|
||||
}
|
||||
else if (opts->audio_out_type == 0)
|
||||
{
|
||||
pa_simple_write(opts->pulse_digi_dev_outR, (state->audio_out_buf_pR - state->audio_out_idxR), (state->audio_out_idxR * 2), NULL);
|
||||
state->audio_out_idxR = 0;
|
||||
}
|
||||
else if (opts->audio_out_type == 8) //UDP Audio Out -- Not sure how this would handle, but R never gets called anymore, so just here for symmetry
|
||||
{
|
||||
udp_socket_blaster (opts, state, (state->audio_out_idxR * 2), (state->audio_out_buf_pR - state->audio_out_idxR));
|
||||
pa_simple_write(opts->pulse_digi_dev_outR, (state->audio_out_buf_pR - state->audio_out_idxR), (state->audio_out_idxR * 2), NULL);
|
||||
state->audio_out_idxR = 0;
|
||||
}
|
||||
else state->audio_out_idxR = 0; //failsafe for audio_out == 0
|
||||
@@ -798,8 +508,6 @@ playSynthesizedVoiceR (dsd_opts * opts, dsd_state * state)
|
||||
void
|
||||
openAudioOutDevice (dsd_opts * opts, int speed)
|
||||
{
|
||||
UNUSED(speed);
|
||||
|
||||
//converted to handle any calls to use portaudio
|
||||
if(strncmp(opts->audio_out_dev, "pa:", 3) == 0)
|
||||
{
|
||||
@@ -814,7 +522,7 @@ openAudioOutDevice (dsd_opts * opts, int speed)
|
||||
}
|
||||
else
|
||||
{
|
||||
// struct stat stat_buf;
|
||||
struct stat stat_buf;
|
||||
// if(stat(opts->audio_out_dev, &stat_buf) != 0 && strncmp(opts->audio_out_dev, "pulse", 5 != 0)) //HERE
|
||||
// {
|
||||
// fprintf (stderr,"Error, couldn't open %s\n", opts->audio_out_dev);
|
||||
@@ -859,11 +567,6 @@ openAudioInDevice (dsd_opts * opts)
|
||||
}
|
||||
}
|
||||
|
||||
else if (strncmp(opts->audio_in_dev, "m17udp", 6) == 0)
|
||||
{
|
||||
opts->audio_in_type = 9; //NULL audio device
|
||||
}
|
||||
|
||||
else if (strncmp(opts->audio_in_dev, "tcp", 3) == 0)
|
||||
{
|
||||
opts->audio_in_type = 8;
|
||||
@@ -880,23 +583,22 @@ openAudioInDevice (dsd_opts * opts)
|
||||
}
|
||||
}
|
||||
|
||||
// else if (strncmp(opts->audio_in_dev, "udp", 3) == 0)
|
||||
// {
|
||||
// opts->audio_in_type = 6;
|
||||
// opts->audio_in_file_info = calloc(1, sizeof(SF_INFO));
|
||||
// opts->audio_in_file_info->samplerate=opts->wav_sample_rate;
|
||||
// opts->audio_in_file_info->channels=1;
|
||||
// opts->audio_in_file_info->seekable=0;
|
||||
// opts->audio_in_file_info->format=SF_FORMAT_RAW|SF_FORMAT_PCM_16|SF_ENDIAN_LITTLE;
|
||||
// opts->udp_file_in = sf_open_fd(opts->udp_sockfd, SFM_READ, opts->audio_in_file_info, 0);
|
||||
|
||||
// if(opts->udp_file_in == NULL)
|
||||
// {
|
||||
// fprintf(stderr, "Error, couldn't open UDP with libsndfile: %s\n", sf_strerror(NULL));
|
||||
// exit(1);
|
||||
// }
|
||||
// }
|
||||
else if (strncmp(opts->audio_in_dev, "udp", 3) == 0)
|
||||
{
|
||||
opts->audio_in_type = 6;
|
||||
opts->audio_in_file_info = calloc(1, sizeof(SF_INFO));
|
||||
opts->audio_in_file_info->samplerate=opts->wav_sample_rate;
|
||||
opts->audio_in_file_info->channels=1;
|
||||
opts->audio_in_file_info->seekable=0;
|
||||
opts->audio_in_file_info->format=SF_FORMAT_RAW|SF_FORMAT_PCM_16|SF_ENDIAN_LITTLE;
|
||||
opts->udp_file_in = sf_open_fd(opts->udp_sockfd, SFM_READ, opts->audio_in_file_info, 0);
|
||||
|
||||
if(opts->udp_file_in == NULL)
|
||||
{
|
||||
fprintf(stderr, "Error, couldn't open UDP with libsndfile: %s\n", sf_strerror(NULL));
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
else if(strncmp(opts->audio_in_dev, "rtl", 3) == 0)
|
||||
{
|
||||
#ifdef USE_RTLSDR
|
||||
@@ -937,11 +639,11 @@ openAudioInDevice (dsd_opts * opts)
|
||||
}
|
||||
|
||||
//test .rrc files with hardset wav file settings
|
||||
else if (strncmp(extension, ".rrc", 4) == 0)
|
||||
else if (strncmp(extension, ".rrc", 3) == 0)
|
||||
{
|
||||
//debug
|
||||
fprintf (stderr, "Opening M17 .rrc headless wav file\n");
|
||||
|
||||
|
||||
opts->audio_in_type = 2;
|
||||
opts->audio_in_file_info = calloc(1, sizeof(SF_INFO));
|
||||
opts->audio_in_file_info->samplerate = 48000;
|
||||
@@ -957,19 +659,19 @@ openAudioInDevice (dsd_opts * opts)
|
||||
}
|
||||
}
|
||||
|
||||
//Open .raw files as a float input type
|
||||
else if (strncmp(extension, ".raw", 4) == 0)
|
||||
//TODO: test .sym files as symbol capture .bin files
|
||||
else if (strncmp(extension, ".sym", 3) == 0)
|
||||
{
|
||||
struct stat stat_buf;
|
||||
if (stat(opts->audio_in_dev, &stat_buf) != 0)
|
||||
{
|
||||
fprintf (stderr,"Error, couldn't open raw (float) file %s\n", opts->audio_in_dev);
|
||||
fprintf (stderr,"Error, couldn't open bin file %s\n", opts->audio_in_dev);
|
||||
exit(1);
|
||||
}
|
||||
if (S_ISREG(stat_buf.st_mode))
|
||||
{
|
||||
opts->symbolfile = fopen(opts->audio_in_dev, "r");
|
||||
opts->audio_in_type = 44; //float symbol input
|
||||
opts->audio_in_type = 4; //symbol capture bin files
|
||||
}
|
||||
else
|
||||
{
|
||||
@@ -977,27 +679,7 @@ openAudioInDevice (dsd_opts * opts)
|
||||
}
|
||||
}
|
||||
|
||||
//Open .raw files as a float input type
|
||||
else if (strncmp(extension, ".sym", 4) == 0)
|
||||
{
|
||||
struct stat stat_buf;
|
||||
if (stat(opts->audio_in_dev, &stat_buf) != 0)
|
||||
{
|
||||
fprintf (stderr,"Error, couldn't open sym (float) file %s\n", opts->audio_in_dev);
|
||||
exit(1);
|
||||
}
|
||||
if (S_ISREG(stat_buf.st_mode))
|
||||
{
|
||||
opts->symbolfile = fopen(opts->audio_in_dev, "r");
|
||||
opts->audio_in_type = 44; //float symbol input
|
||||
}
|
||||
else
|
||||
{
|
||||
opts->audio_in_type = 0;
|
||||
}
|
||||
}
|
||||
|
||||
else if (strncmp(extension, ".bin", 4) == 0)
|
||||
else if (strncmp(extension, ".bin", 3) == 0)
|
||||
{
|
||||
struct stat stat_buf;
|
||||
if (stat(opts->audio_in_dev, &stat_buf) != 0)
|
||||
@@ -1028,8 +710,8 @@ openAudioInDevice (dsd_opts * opts)
|
||||
{
|
||||
opts->audio_in_type = 2; //two now, seperating STDIN and wav files
|
||||
opts->audio_in_file_info = calloc(1, sizeof(SF_INFO));
|
||||
opts->audio_in_file_info->samplerate=opts->wav_sample_rate;
|
||||
opts->audio_in_file_info->channels=1;
|
||||
opts->audio_in_file_info->samplerate=opts->wav_sample_rate;
|
||||
opts->audio_in_file_info->channels=1;
|
||||
opts->audio_in_file_info->channels = 1;
|
||||
opts->audio_in_file_info->seekable=0;
|
||||
opts->audio_in_file_info->format=SF_FORMAT_RAW|SF_FORMAT_PCM_16|SF_ENDIAN_LITTLE;
|
||||
|
||||
2334
src/dsd_audio2.c
2334
src/dsd_audio2.c
File diff suppressed because it is too large
Load Diff
@@ -118,8 +118,6 @@ print_datascope(dsd_opts* opts, dsd_state* state, int* sbuf2)
|
||||
static void
|
||||
use_symbol (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
{
|
||||
UNUSED(symbol);
|
||||
|
||||
int i;
|
||||
int sbuf2[128];
|
||||
int lmin, lmax, lsum;
|
||||
@@ -267,8 +265,7 @@ int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
else if ((state->synctype == 1) || (state->synctype == 3) || (state->synctype == 5) ||
|
||||
(state->synctype == 9) || (state->synctype == 11) || (state->synctype == 13) ||
|
||||
(state->synctype == 17) || (state->synctype == 29) || (state->synctype == 31) ||
|
||||
(state->synctype == 77) || (state->synctype == 87) ||(state->synctype == 36) ||
|
||||
(state->synctype == 99) )
|
||||
(state->synctype == 36) || (state->synctype == 99) )
|
||||
|
||||
{
|
||||
// 1 -P25p1
|
||||
@@ -279,10 +276,8 @@ int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
// 13 -DMR (inverted signal data frame)
|
||||
// 17 -M17 STR
|
||||
// 29 -NXDN (inverted FSW)
|
||||
// 31 -YSF
|
||||
// 36 -P25p2
|
||||
// 77 -M17 BRT
|
||||
// 87 -M17 PKT
|
||||
// 31 -YSF
|
||||
// 36 -P25p2
|
||||
// 99 -M17 Preamble
|
||||
|
||||
int valid;
|
||||
@@ -290,11 +285,8 @@ int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
|
||||
valid = 0;
|
||||
|
||||
UNUSED(opts);
|
||||
|
||||
//testing again, either on Voice channels only (when tuned) or with trunk disabled
|
||||
// if (state->synctype == 1 && (opts->p25_is_tuned == 1 || opts->p25_trunk == 0) && opts->use_heuristics == 1)
|
||||
if (state->synctype == 1 && opts->use_heuristics == 1)
|
||||
if (state->synctype == 1 && (opts->p25_is_tuned == 1 || opts->p25_trunk == 0) && opts->use_heuristics == 1)
|
||||
{
|
||||
// Use the P25p1 heuristics if available
|
||||
valid = estimate_symbol(state->rf_mod, &(state->inv_p25_heuristics), state->last_dibit, symbol, &dibit);
|
||||
@@ -334,7 +326,7 @@ int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
state->dibit_buf_p++;
|
||||
|
||||
//dmr buffer
|
||||
*state->dmr_payload_p = invert_dibit(dibit);
|
||||
*state->dmr_payload_p = invert_dibit(dibit);
|
||||
state->dmr_payload_p++;
|
||||
//dmr buffer end
|
||||
|
||||
@@ -352,8 +344,6 @@ int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
// 28 +NXND (FSW)
|
||||
// 30 +YSF
|
||||
// 35 +p25p2
|
||||
// 76 +M17 BRT
|
||||
// 86 +M17 PKT
|
||||
// 98 +M17 Preamble
|
||||
|
||||
int valid;
|
||||
@@ -362,8 +352,7 @@ int digitize (dsd_opts* opts, dsd_state* state, int symbol)
|
||||
valid = 0;
|
||||
|
||||
//testing again, either on Voice channels only (when tuned) or with trunk disabled
|
||||
// if (state->synctype == 0 && (opts->p25_is_tuned == 1 || opts->p25_trunk == 0) && opts->use_heuristics == 1)
|
||||
if (state->synctype == 0 && opts->use_heuristics == 1)
|
||||
if (state->synctype == 0 && (opts->p25_is_tuned == 1 || opts->p25_trunk == 0) && opts->use_heuristics == 1)
|
||||
{
|
||||
// Use the P25p1 heuristics if available
|
||||
valid = estimate_symbol(state->rf_mod, &(state->p25_heuristics), state->last_dibit, symbol, &dibit);
|
||||
@@ -449,18 +438,18 @@ get_dibit_and_analog_signal (dsd_opts* opts, dsd_state* state, int* out_analog_s
|
||||
|
||||
dibit = digitize (opts, state, symbol);
|
||||
|
||||
if (opts->audio_in_type == 4)
|
||||
if (opts->audio_in_type == 4)
|
||||
{
|
||||
//assign dibit from last symbol/dibit read from capture bin
|
||||
dibit = state->symbolc;
|
||||
if (state->use_throttle == 1)
|
||||
{
|
||||
usleep(0);
|
||||
usleep(0);
|
||||
}
|
||||
}
|
||||
|
||||
//symbol/dibit file capture/writing
|
||||
if (opts->symbol_out_f)
|
||||
if (opts->symbol_out == 1)
|
||||
{
|
||||
//fprintf (stderr, "%d", dibit);
|
||||
fputc (dibit, opts->symbol_out_f);
|
||||
@@ -497,7 +486,6 @@ skipDibit (dsd_opts * opts, dsd_state * state, int count)
|
||||
|
||||
short sample;
|
||||
int i;
|
||||
UNUSED(sample);
|
||||
|
||||
for (i = 0; i < (count); i++)
|
||||
{
|
||||
|
||||
870
src/dsd_events.c
870
src/dsd_events.c
@@ -1,870 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_events.c
|
||||
* DSD-FME event history init, watchdog, push, and related functions
|
||||
*
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2025-05 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
#include "git_ver.h"
|
||||
#include "synctype.h"
|
||||
|
||||
//init each event history struct passed into here
|
||||
void init_event_history (Event_History_I * event_struct, uint8_t start, uint8_t stop)
|
||||
{
|
||||
for (uint8_t i = start; i < stop; i++)
|
||||
{
|
||||
event_struct->Event_History_Items[i].write = 0;
|
||||
event_struct->Event_History_Items[i].color_pair = 4;
|
||||
event_struct->Event_History_Items[i].systype = -1;
|
||||
event_struct->Event_History_Items[i].subtype = -1;
|
||||
event_struct->Event_History_Items[i].sys_id1 = 0;
|
||||
event_struct->Event_History_Items[i].sys_id2 = 0;
|
||||
event_struct->Event_History_Items[i].sys_id3 = 0;
|
||||
event_struct->Event_History_Items[i].sys_id4 = 0;
|
||||
event_struct->Event_History_Items[i].sys_id5 = 0;
|
||||
event_struct->Event_History_Items[i].gi = 0;
|
||||
event_struct->Event_History_Items[i].enc = 0;
|
||||
event_struct->Event_History_Items[i].enc_alg = 0;
|
||||
event_struct->Event_History_Items[i].enc_key = 0;
|
||||
event_struct->Event_History_Items[i].mi = 0;
|
||||
event_struct->Event_History_Items[i].svc = 0;
|
||||
event_struct->Event_History_Items[i].source_id = 0;
|
||||
event_struct->Event_History_Items[i].target_id = 0;
|
||||
sprintf (event_struct->Event_History_Items[i].src_str, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].tgt_str, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].t_name, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].s_name, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].t_mode, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].s_mode, "%s", "BUMBLEBEETUNA");
|
||||
event_struct->Event_History_Items[i].channel = 0;
|
||||
event_struct->Event_History_Items[i].event_time = 0;
|
||||
|
||||
memset (event_struct->Event_History_Items[i].pdu, 0, sizeof(event_struct->Event_History_Items[0].pdu));
|
||||
sprintf (event_struct->Event_History_Items[i].sysid_string, "%s", "");
|
||||
sprintf (event_struct->Event_History_Items[i].alias, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].gps_s, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].text_message, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].event_string, "%s", "BUMBLEBEETUNA");
|
||||
sprintf (event_struct->Event_History_Items[i].internal_str, "%s", "BUMBLEBEETUNA");
|
||||
}
|
||||
}
|
||||
|
||||
void push_event_history (Event_History_I * event_struct)
|
||||
{
|
||||
|
||||
//Fixed, had it going in the wrong direction first time
|
||||
for (uint8_t i = 254; i >= 1; i--)
|
||||
{
|
||||
event_struct->Event_History_Items[i].write = event_struct->Event_History_Items[i-1].write;
|
||||
event_struct->Event_History_Items[i].color_pair = event_struct->Event_History_Items[i-1].color_pair;
|
||||
event_struct->Event_History_Items[i].systype = event_struct->Event_History_Items[i-1].systype;
|
||||
event_struct->Event_History_Items[i].subtype = event_struct->Event_History_Items[i-1].subtype;
|
||||
event_struct->Event_History_Items[i].sys_id1 = event_struct->Event_History_Items[i-1].sys_id1;
|
||||
event_struct->Event_History_Items[i].sys_id2 = event_struct->Event_History_Items[i-1].sys_id2;
|
||||
event_struct->Event_History_Items[i].sys_id3 = event_struct->Event_History_Items[i-1].sys_id3;
|
||||
event_struct->Event_History_Items[i].sys_id4 = event_struct->Event_History_Items[i-1].sys_id4;
|
||||
event_struct->Event_History_Items[i].sys_id5 = event_struct->Event_History_Items[i-1].sys_id5;
|
||||
event_struct->Event_History_Items[i].gi = event_struct->Event_History_Items[i-1].gi;
|
||||
event_struct->Event_History_Items[i].enc = event_struct->Event_History_Items[i-1].enc;
|
||||
event_struct->Event_History_Items[i].enc_alg = event_struct->Event_History_Items[i-1].enc_alg;
|
||||
event_struct->Event_History_Items[i].enc_key = event_struct->Event_History_Items[i-1].enc_key;
|
||||
event_struct->Event_History_Items[i].mi = event_struct->Event_History_Items[i-1].mi;
|
||||
event_struct->Event_History_Items[i].svc = event_struct->Event_History_Items[i-1].svc;
|
||||
event_struct->Event_History_Items[i].source_id = event_struct->Event_History_Items[i-1].source_id;
|
||||
event_struct->Event_History_Items[i].target_id = event_struct->Event_History_Items[i-1].target_id;
|
||||
sprintf (event_struct->Event_History_Items[i].src_str, "%s", event_struct->Event_History_Items[i-1].src_str);
|
||||
sprintf (event_struct->Event_History_Items[i].tgt_str, "%s", event_struct->Event_History_Items[i-1].tgt_str);
|
||||
sprintf (event_struct->Event_History_Items[i].t_name, "%s", event_struct->Event_History_Items[i-1].t_name);
|
||||
sprintf (event_struct->Event_History_Items[i].s_name, "%s", event_struct->Event_History_Items[i-1].s_name);
|
||||
sprintf (event_struct->Event_History_Items[i].t_mode, "%s", event_struct->Event_History_Items[i-1].t_mode);
|
||||
sprintf (event_struct->Event_History_Items[i].s_mode, "%s", event_struct->Event_History_Items[i-1].s_mode);
|
||||
event_struct->Event_History_Items[i].channel = event_struct->Event_History_Items[i-1].channel;
|
||||
event_struct->Event_History_Items[i].event_time = event_struct->Event_History_Items[i+1].event_time;
|
||||
|
||||
memcpy (event_struct->Event_History_Items[i].pdu, event_struct->Event_History_Items[i-1].pdu, sizeof(event_struct->Event_History_Items[0].pdu));
|
||||
sprintf (event_struct->Event_History_Items[i].sysid_string, "%s", event_struct->Event_History_Items[i-1].sysid_string);
|
||||
sprintf (event_struct->Event_History_Items[i].alias, "%s", event_struct->Event_History_Items[i-1].alias);
|
||||
sprintf (event_struct->Event_History_Items[i].gps_s, "%s", event_struct->Event_History_Items[i-1].gps_s);
|
||||
sprintf (event_struct->Event_History_Items[i].text_message, "%s", event_struct->Event_History_Items[i-1].text_message);
|
||||
sprintf (event_struct->Event_History_Items[i].event_string, "%s", event_struct->Event_History_Items[i-1].event_string);
|
||||
sprintf (event_struct->Event_History_Items[i].internal_str, "%s", event_struct->Event_History_Items[i-1].internal_str);
|
||||
}
|
||||
}
|
||||
|
||||
void write_event_to_log_file (dsd_opts * opts, dsd_state * state, uint8_t slot, uint8_t swrite, char * event_string) //pass completed event string here that is in the struct
|
||||
{
|
||||
|
||||
//open log file
|
||||
FILE * event_log_file;
|
||||
event_log_file = fopen(opts->event_out_file, "a");
|
||||
|
||||
fprintf (event_log_file, "%s ", event_string);
|
||||
if (swrite == 1)
|
||||
fprintf (event_log_file, "Slot %d; ", slot+1);
|
||||
fprintf (event_log_file,"\n");
|
||||
|
||||
char text_string[2000]; sprintf (text_string, "%s", "BUMBLEBEETUNA");
|
||||
if (strncmp(text_string, state->event_history_s[slot].Event_History_Items[0].text_message, 13) != 0)
|
||||
fprintf (event_log_file, "%s \n", state->event_history_s[slot].Event_History_Items[0].text_message);
|
||||
if (strncmp(text_string, state->event_history_s[slot].Event_History_Items[0].alias, 13) != 0)
|
||||
fprintf (event_log_file, " Talker Alias: %s \n", state->event_history_s[slot].Event_History_Items[0].alias);
|
||||
if (strncmp(text_string, state->event_history_s[slot].Event_History_Items[0].gps_s, 13) != 0)
|
||||
fprintf (event_log_file, " GPS: %s \n", state->event_history_s[slot].Event_History_Items[0].gps_s);
|
||||
if (strncmp(text_string, state->event_history_s[slot].Event_History_Items[0].internal_str, 13) != 0)
|
||||
fprintf (event_log_file, " DSD-FME: %s \n", state->event_history_s[slot].Event_History_Items[0].internal_str);
|
||||
|
||||
//flush and close log file
|
||||
fflush (event_log_file);
|
||||
fclose (event_log_file);
|
||||
}
|
||||
|
||||
// run once per loop to check for and push and update event history
|
||||
void watchdog_event_history (dsd_opts * opts, dsd_state * state, uint8_t slot)
|
||||
{
|
||||
|
||||
//create a pointer to the current slot event history
|
||||
Event_History_I * event_struct = &state->event_history_s[slot];
|
||||
|
||||
//is this a TDMA slot (append Slot value to end of written event history)
|
||||
uint8_t swrite = 0;
|
||||
|
||||
//who is currently talking
|
||||
uint32_t source_id = 0;
|
||||
|
||||
//last values pulled from the event history
|
||||
uint32_t last_source_id = event_struct->Event_History_Items[0].source_id;
|
||||
|
||||
if (slot == 0)
|
||||
source_id = state->lastsrc;
|
||||
else
|
||||
source_id = state->lastsrcR;
|
||||
|
||||
//if DMR BS or P25P2, then flag the swrite, so write can append slot value to event history log //|| state->lastsynctype == 32 || state->lastsynctype == 33 || state->lastsynctype == 34 MS
|
||||
if (state->lastsynctype == 10 || state->lastsynctype == 11 || state->lastsynctype == 12 || state->lastsynctype == 13)
|
||||
swrite = 1;
|
||||
|
||||
else if (state->lastsynctype == 35 || state->lastsynctype == 36)
|
||||
swrite = 1;
|
||||
|
||||
if (slot == 0) //BUGFIX: generic catch on FDMA systems so that we don't write duplicate data to slot 2 event history
|
||||
{
|
||||
//NXDN RID (TODO: Changeover to lastsrc later on)
|
||||
if (state->lastsynctype == 28 || state->lastsynctype == 29)
|
||||
source_id = state->nxdn_last_rid;
|
||||
|
||||
if (state->lastsynctype == 30 || state->lastsynctype == 31) //YSF Fusion
|
||||
{
|
||||
source_id = 0;
|
||||
if (strncmp(state->ysf_src, " ", 10) != 0) //if this field does not have ten spaces in it
|
||||
{
|
||||
for (uint8_t i = 0; i < 11; i++)
|
||||
source_id += state->ysf_src[i]; //convert to sum value to make a distinct enough src value
|
||||
}
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 8 || state->lastsynctype == 9 || state->lastsynctype == 16 || state->lastsynctype == 17) //M17 STR
|
||||
{
|
||||
source_id = (uint32_t)state->m17_src;
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 6 || state->lastsynctype == 7 || state->lastsynctype == 18 || state->lastsynctype == 19) //DSTAR
|
||||
{
|
||||
source_id = 0;
|
||||
for (uint8_t i = 0; i < 12; i++)
|
||||
source_id += state->dstar_src[i]; //convert to sum value to make a distinct enough src value
|
||||
|
||||
//need a strncmp here for 8 spaces in this field first so we don't blip a blank into the event history
|
||||
if (strncmp(state->dstar_src, " ", 8) == 0)
|
||||
source_id = 0;
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 20 || state->lastsynctype == 24 || state->lastsynctype == 21 || state->lastsynctype == 25 || state->lastsynctype == 22 || state->lastsynctype == 26 || state->lastsynctype == 23 || state->lastsynctype == 27) //dPMR
|
||||
{
|
||||
source_id = 0;
|
||||
for (uint8_t i = 0; i < 20; i++)
|
||||
source_id += state->dpmr_caller_id[i]; //convert to sum value to make a distinct enough src value
|
||||
|
||||
//need a strncmp here for 8 spaces in this field first so we don't blip a blank into the event history
|
||||
if (strncmp(state->dpmr_caller_id, " ", 6) == 0)
|
||||
source_id = 0;
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 14 || state->lastsynctype == 15 || state->lastsynctype == 37 || state->lastsynctype == 38) //EDACS Calls
|
||||
{
|
||||
source_id = 0;
|
||||
if (opts->p25_is_tuned == 1)
|
||||
source_id = state->lastsrc;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//call alert beep when new call detected
|
||||
if (last_source_id == 0 && source_id != 0 && opts->call_alert == 1)
|
||||
beeper (opts, state, slot, 40, 86, 3);
|
||||
|
||||
if (source_id != last_source_id && last_source_id != 0)
|
||||
{
|
||||
|
||||
if (opts->event_out_file[0] != 0)
|
||||
write_event_to_log_file(opts, state, slot, swrite, event_struct->Event_History_Items[0].event_string);
|
||||
|
||||
event_struct->Event_History_Items[0].write = 1; //written, or pushed at this point
|
||||
|
||||
if (opts->static_wav_file == 0)
|
||||
{
|
||||
|
||||
if (slot == 0 && opts->wav_out_f != NULL)
|
||||
{
|
||||
opts->wav_out_f = close_and_rename_wav_file(opts->wav_out_f, opts->wav_out_file, opts->wav_out_dir, event_struct);
|
||||
opts->wav_out_f = open_wav_file(opts->wav_out_dir, opts->wav_out_file, 8000, 0);
|
||||
}
|
||||
|
||||
else if (slot == 1 && opts->wav_out_fR != NULL)
|
||||
{
|
||||
opts->wav_out_fR = close_and_rename_wav_file(opts->wav_out_fR, opts->wav_out_fileR, opts->wav_out_dir, event_struct);
|
||||
opts->wav_out_fR = open_wav_file(opts->wav_out_dir, opts->wav_out_fileR, 8000, 0);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
push_event_history (event_struct);
|
||||
init_event_history (event_struct, 0, 1);
|
||||
|
||||
//clear out some strings and things
|
||||
memset(state->ysf_txt, 0, sizeof(state->ysf_txt));
|
||||
memset(state->dstar_gps, 0, sizeof(state->dstar_gps));
|
||||
memset(state->dstar_txt, 0, sizeof(state->dstar_txt));
|
||||
state->gi[slot] = -1; //return to an unset value
|
||||
|
||||
//end of voice call alert
|
||||
if (opts->call_alert == 1)
|
||||
beeper (opts, state, slot, 40, 86, 3);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//similar to above, but constantly testing and checking the most recent event only
|
||||
//this will hopefully be more useful when dealing with an ongoing event with
|
||||
//features that update over time with embedded signalling, etc
|
||||
void watchdog_event_current (dsd_opts * opts, dsd_state * state, uint8_t slot)
|
||||
{
|
||||
|
||||
//create a pointer to the current slot event history
|
||||
Event_History_I * event_struct = &state->event_history_s[slot];
|
||||
|
||||
//ncurses color pairs
|
||||
uint8_t color_pair = 4; //default voice color (unknown gi)
|
||||
if (state->gi[slot] == 1)
|
||||
color_pair = 4; //default private voice color
|
||||
else if (state->gi[slot] == 0)
|
||||
color_pair = 4; //default group voice color
|
||||
|
||||
//TODO: Flesh out more later on.
|
||||
uint32_t source_id = 0;
|
||||
uint32_t target_id = 0;
|
||||
char src_str[200]; memset (src_str, 0, sizeof(src_str));
|
||||
sprintf (src_str, "%s", "BUMBLEBEETUNA");
|
||||
char tgt_str[200]; memset (tgt_str, 0, sizeof(tgt_str));
|
||||
sprintf (tgt_str, "%s", "BUMBLEBEETUNA");
|
||||
|
||||
//group import items
|
||||
char t_name[200]; memset (t_name, 0, sizeof(t_name));
|
||||
sprintf (t_name, "%s", "BUMBLEBEETUNA");
|
||||
char s_name[200]; memset (s_name, 0, sizeof(s_name));
|
||||
sprintf (s_name, "%s", "BUMBLEBEETUNA");
|
||||
char t_mode[200]; memset (t_mode, 0, sizeof(t_mode));
|
||||
sprintf (t_mode, "%s", "BUMBLEBEETUNA");
|
||||
char s_mode[200]; memset (s_mode, 0, sizeof(s_mode));
|
||||
sprintf (s_mode, "%s", "BUMBLEBEETUNA");
|
||||
|
||||
uint16_t svc_opts = 0;
|
||||
uint8_t subtype = 0;
|
||||
uint8_t mfid = 0;
|
||||
uint32_t sys_id1 = 0;
|
||||
uint32_t sys_id2 = 0;
|
||||
uint32_t sys_id3 = 0;
|
||||
uint32_t sys_id4 = 0;
|
||||
uint32_t sys_id5 = 0;
|
||||
|
||||
uint32_t channel = 0;
|
||||
|
||||
uint8_t enc = 0;
|
||||
uint8_t alg_id = 0;
|
||||
uint16_t key_id = 0;
|
||||
unsigned long long int mi;
|
||||
|
||||
char sysid_string[200]; memset(sysid_string, 0, sizeof(sysid_string));
|
||||
sprintf (sysid_string, "%s", "");
|
||||
|
||||
if (slot == 0)
|
||||
{
|
||||
source_id = state->lastsrc;
|
||||
target_id = state->lasttg;
|
||||
|
||||
subtype = state->dmrburstL;
|
||||
mfid = state->dmr_fid;
|
||||
|
||||
svc_opts = state->dmr_so;
|
||||
enc = (svc_opts >> 6) & 1;
|
||||
alg_id = state->payload_algid;
|
||||
key_id = (uint16_t)state->payload_keyid;
|
||||
|
||||
mi = state->payload_mi;
|
||||
}
|
||||
else
|
||||
{
|
||||
source_id = state->lastsrcR;
|
||||
target_id = state->lasttgR;
|
||||
|
||||
subtype = state->dmrburstR;
|
||||
mfid = state->dmr_fidR;
|
||||
|
||||
svc_opts = state->dmr_soR;
|
||||
enc = (svc_opts >> 6) & 1;
|
||||
|
||||
alg_id = state->payload_algidR;
|
||||
key_id = (uint16_t)state->payload_keyidR;
|
||||
mi = state->payload_miR;
|
||||
}
|
||||
|
||||
//if P25 (if not P25, then these will all be zero anyways)
|
||||
sys_id1 = state->p2_wacn;
|
||||
sys_id2 = state->p2_sysid;
|
||||
if (state->nac != 0)
|
||||
sys_id3 = state->nac; //same as state->p2_cc, but zeroes out when no signal or error
|
||||
else sys_id3 = state->p2_cc;
|
||||
sys_id4 = state->p2_rfssid;
|
||||
sys_id5 = state->p2_siteid;
|
||||
|
||||
if (sys_id1)
|
||||
sprintf (sysid_string, "P25_%05X%03X%03X_%d_%d", sys_id1, sys_id2, sys_id3, sys_id4, sys_id5);
|
||||
else sprintf (sysid_string, "P25_%03X", sys_id3);
|
||||
|
||||
if (state->lastsynctype == 10 || state->lastsynctype == 11 || state->lastsynctype == 12 || state->lastsynctype == 13 ||
|
||||
state->lastsynctype == 32 || state->lastsynctype == 33 || state->lastsynctype == 34 )
|
||||
{
|
||||
sys_id1 = state->dmr_t3_syscode;
|
||||
sys_id2 = state->dmr_color_code;
|
||||
|
||||
if (sys_id1)
|
||||
sprintf (sysid_string, "DMR_%X_CC_%d", sys_id1, sys_id2);
|
||||
else sprintf (sysid_string, "DMR_CC_%d", sys_id2);
|
||||
}
|
||||
|
||||
if (slot == 0) //BUGFIX: generic catch on FDMA systems so that we don't write duplicate data to slot 2 event history
|
||||
{
|
||||
//NXDN RID (TODO: Changeover to lastsrc and lasttg later on)
|
||||
if (state->lastsynctype == 28 || state->lastsynctype == 29)
|
||||
{
|
||||
source_id = state->nxdn_last_rid;
|
||||
target_id = state->nxdn_last_tg;
|
||||
if (state->nxdn_cipher_type != 0)
|
||||
enc = 1;
|
||||
alg_id = state->nxdn_cipher_type;
|
||||
key_id = state->nxdn_key;
|
||||
|
||||
sys_id1 = state->nxdn_location_site_code;
|
||||
sys_id2 = state->nxdn_location_sys_code;
|
||||
sys_id3 = state->nxdn_last_ran; //might be an issue on conventional systems that have a different RAN on the tx_rel or idle data bursts
|
||||
|
||||
if (sys_id1)
|
||||
sprintf (sysid_string, "NXDN_%d_%d_RAN_%d", sys_id2, sys_id1, sys_id3);
|
||||
else sprintf (sysid_string, "NXDN_RAN_%d", sys_id3);
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 30 || state->lastsynctype == 31) //YSF Fusion
|
||||
{
|
||||
source_id = 0;
|
||||
if (strncmp(state->ysf_src, " ", 10) != 0) //if this field does not have ten spaces in it
|
||||
{
|
||||
for (uint8_t i = 0; i < 11; i++)
|
||||
source_id += state->ysf_src[i]; //convert to sum value to make a distinct enough src value
|
||||
}
|
||||
|
||||
//WIP: If Text, compile it here (still having issues with an empty txt string making a line break)
|
||||
uint8_t k = 0; char ysf_emp[21][21]; memset(ysf_emp, 0, sizeof(ysf_emp));
|
||||
if (memcmp(ysf_emp, state->ysf_txt, sizeof(state->ysf_txt)) != 0)
|
||||
{
|
||||
for (uint8_t i = 4; i < 8; i++)
|
||||
{
|
||||
for (uint8_t j = 0; j < 20; j++)
|
||||
{
|
||||
if (state->ysf_txt[i][j] != 0x2A)
|
||||
event_struct->Event_History_Items[0].text_message[k++] = state->ysf_txt[i][j];
|
||||
else event_struct->Event_History_Items[0].text_message[k++] = 0x20; //space
|
||||
|
||||
}
|
||||
event_struct->Event_History_Items[0].text_message[k] = 0; //terminate
|
||||
}
|
||||
}
|
||||
else sprintf (event_struct->Event_History_Items[0].text_message, "%s", "BUMBLEBEETUNA");
|
||||
|
||||
sprintf (sysid_string, "%s", "YSF");
|
||||
|
||||
char temp_str[20];
|
||||
memset(temp_str, 0, sizeof(temp_str));
|
||||
|
||||
//set src string as a non-spaced non-garbo char string
|
||||
for (uint8_t i = 0; i < 10; i++)
|
||||
{
|
||||
if (state->ysf_src[i] == 0x20) //spaces to underscore
|
||||
temp_str[i] = 0x5F;
|
||||
else if (state->ysf_src[i] > 0x20 && state->ysf_src[i] < 0x7F) //copy normal ascii range characters
|
||||
temp_str[i] = state->ysf_src[i];
|
||||
else if (state->ysf_src[i] == 0) break; //hit the terminator, so stop
|
||||
else temp_str[i] = 0x5F; //unknown to underscore
|
||||
}
|
||||
sprintf (src_str, "%s", temp_str);
|
||||
|
||||
//same for tgt str
|
||||
memset(temp_str, 0, sizeof(temp_str));
|
||||
for (uint8_t i = 0; i < 10; i++)
|
||||
{
|
||||
if (state->ysf_tgt[i] == 0x20) //spaces to underscore
|
||||
temp_str[i] = 0x5F;
|
||||
else if (state->ysf_tgt[i] > 0x20 && state->ysf_tgt[i] < 0x7F) //copy normal ascii range characters
|
||||
temp_str[i] = state->ysf_tgt[i];
|
||||
else if (state->ysf_tgt[i] == 0) break; //hit the terminator, so stop
|
||||
else temp_str[i] = 0x5F; //unknown to underscore
|
||||
}
|
||||
sprintf (tgt_str, "%s", temp_str);
|
||||
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 8 || state->lastsynctype == 9 || state->lastsynctype == 16 || state->lastsynctype == 17) //M17 STR
|
||||
{
|
||||
target_id = (uint32_t)state->m17_dst;
|
||||
source_id = (uint32_t)state->m17_src;
|
||||
sys_id1 = state->m17_can;
|
||||
sprintf (sysid_string, "M17_CAN_%d", sys_id1);
|
||||
sprintf (src_str, "%s", state->m17_src_csd);
|
||||
sprintf (tgt_str, "%s", state->m17_dst_csd);
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 6 || state->lastsynctype == 7 || state->lastsynctype == 18 || state->lastsynctype == 19) //DSTAR
|
||||
{
|
||||
source_id = 0;
|
||||
for (uint8_t i = 0; i < 12; i++)
|
||||
source_id += state->dstar_src[i]; //convert to sum value to make a distinct enough src value
|
||||
|
||||
//need a strncmp here for 8 spaces in this field first so we don't blip a blank into the event history
|
||||
if (strncmp(state->dstar_src, " ", 8) == 0)
|
||||
source_id = 0;
|
||||
|
||||
sprintf (sysid_string, "%s", "DSTAR");
|
||||
|
||||
char temp_str[20];
|
||||
memset(temp_str, 0, sizeof(temp_str));
|
||||
|
||||
//set src string as a non-spaced non-garbo char string
|
||||
for (uint8_t i = 0; i < 12; i++)
|
||||
{
|
||||
if (state->dstar_src[i] == 0x20) //spaces to underscore
|
||||
temp_str[i] = 0x5F;
|
||||
else if (state->dstar_src[i] > 0x20 && state->dstar_src[i] < 0x7F) //copy normal ascii range characters
|
||||
temp_str[i] = state->dstar_src[i];
|
||||
else if (state->dstar_src[i] == 0) break; //hit the terminator, so stop
|
||||
else temp_str[i] = 0x5F; //unknown to underscore
|
||||
}
|
||||
sprintf (src_str, "%s", temp_str);
|
||||
|
||||
//same for tgt str
|
||||
memset(temp_str, 0, sizeof(temp_str));
|
||||
for (uint8_t i = 0; i < 8; i++)
|
||||
{
|
||||
if (state->dstar_dst[i] == 0x20) //spaces to underscore
|
||||
temp_str[i] = 0x5F;
|
||||
else if (state->dstar_dst[i] > 0x20 && state->dstar_dst[i] < 0x7F) //copy normal ascii range characters
|
||||
temp_str[i] = state->dstar_dst[i];
|
||||
else if (state->dstar_dst[i] == 0) break; //hit the terminator, so stop
|
||||
else temp_str[i] = 0x5F; //unknown to underscore
|
||||
}
|
||||
sprintf (tgt_str, "%s", temp_str);
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 20 || state->lastsynctype == 24 || state->lastsynctype == 21 || state->lastsynctype == 25 || state->lastsynctype == 22 || state->lastsynctype == 26 || state->lastsynctype == 23 || state->lastsynctype == 27) //dPMR
|
||||
{
|
||||
source_id = 0;
|
||||
for (uint8_t i = 0; i < 20; i++)
|
||||
source_id += state->dpmr_caller_id[i]; //convert to sum value to make a distinct enough src value
|
||||
|
||||
//need a strncmp here for 8 spaces in this field first so we don't blip a blank into the event history
|
||||
if (strncmp(state->dpmr_caller_id, " ", 6) == 0)
|
||||
source_id = 0;
|
||||
|
||||
sprintf (sysid_string, "DPMR_CC_%d", state->dpmr_color_code);
|
||||
|
||||
sprintf (src_str, "%s", state->dpmr_caller_id);
|
||||
sprintf (tgt_str, "%s", state->dpmr_target_id);
|
||||
}
|
||||
|
||||
if (state->lastsynctype == 14 || state->lastsynctype == 15 || state->lastsynctype == 37 || state->lastsynctype == 38) //EDACS Calls
|
||||
{
|
||||
source_id = 0;
|
||||
if (opts->p25_is_tuned == 1)
|
||||
{
|
||||
source_id = state->lastsrc;
|
||||
channel = state->edacs_tuned_lcn;
|
||||
}
|
||||
|
||||
sys_id1 = state->edacs_site_id;
|
||||
sys_id2 = state->edacs_area_code;
|
||||
sys_id3 = state->edacs_sys_id;
|
||||
svc_opts = state->edacs_vc_call_type;
|
||||
char sup_str[200]; memset (sup_str, 0, sizeof(sup_str));
|
||||
sprintf (sup_str, "%s", "_");
|
||||
if (svc_opts & 0x02)
|
||||
strcat (sup_str, "Digital_");
|
||||
else strcat (sup_str, "Analog_");
|
||||
if (svc_opts & 0x04)
|
||||
strcat (sup_str, "Emergency_");
|
||||
if (svc_opts & 0x08)
|
||||
strcat (sup_str, "Group_");
|
||||
if (svc_opts & 0x10)
|
||||
strcat (sup_str, "I_");
|
||||
if (svc_opts & 0x20)
|
||||
strcat (sup_str, "ALL_");
|
||||
if (svc_opts & 0x40)
|
||||
strcat (sup_str, "INTER_");
|
||||
if (svc_opts & 0x80)
|
||||
strcat (sup_str, "TEST_");
|
||||
if (svc_opts & 0x100)
|
||||
strcat (sup_str, "AGENCY_");
|
||||
if (svc_opts & 0x200)
|
||||
strcat (sup_str, "FLEET_");
|
||||
if (svc_opts & 0x01)
|
||||
strcat (sup_str, "Voice_");
|
||||
strcat (sup_str, "Call");
|
||||
|
||||
sprintf (sysid_string, "EDACS_SITE_%03d", sys_id1);
|
||||
strcat (sysid_string, sup_str);
|
||||
|
||||
if (state->ea_mode == 0)
|
||||
{
|
||||
int afs = state->lasttg;
|
||||
sprintf(src_str, "%s", ""); sprintf(tgt_str, "%s", "");
|
||||
int a = (afs >> state->edacs_a_shift) & state->edacs_a_mask;
|
||||
int f = (afs >> state->edacs_f_shift) & state->edacs_f_mask;
|
||||
int s = afs & state->edacs_s_mask;
|
||||
sprintf (tgt_str, "%03d_AFS_%02d_%02d%01d", afs, a, f, s);
|
||||
if (state->lastsrc != 0x800 && state->lastsrc != 0)
|
||||
sprintf (src_str, "LID_%d", state->lastsrc);
|
||||
else sprintf (src_str, "LID_UNK");
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//if we have a group_array import, search and load it here
|
||||
//will search and load both target values, and src values if available
|
||||
uint8_t t_name_loaded = 0;
|
||||
uint8_t s_name_loaded = 0;
|
||||
if (target_id != 0)
|
||||
{
|
||||
for (int i = 0; i < state->group_tally; i++)
|
||||
{
|
||||
if (state->group_array[i].groupNumber == target_id)
|
||||
{
|
||||
sprintf (t_name, "%s", state->group_array[i].groupName);
|
||||
sprintf (t_mode, "%s", state->group_array[i].groupMode);
|
||||
t_name_loaded = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (source_id != 0) //&& state->gi[slot] == 1
|
||||
{
|
||||
for (int i = 0; i < state->group_tally; i++)
|
||||
{
|
||||
if (state->group_array[i].groupNumber == source_id)
|
||||
{
|
||||
sprintf (s_name, "%s", state->group_array[i].groupName);
|
||||
sprintf (s_mode, "%s", state->group_array[i].groupMode);
|
||||
s_name_loaded = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
//system type string (P25, DMR, etc)
|
||||
const char * sys_string = "Digital";
|
||||
if (state->lastsynctype != -1)
|
||||
sys_string = SyncTypes[state->lastsynctype];
|
||||
|
||||
//date and time strings
|
||||
char * timestr = getTimeN(time(NULL));
|
||||
char * datestr = getDateN(time(NULL));
|
||||
|
||||
if (source_id != 0)
|
||||
{
|
||||
event_struct->Event_History_Items[0].write = 0;
|
||||
state->event_history_s[slot].Event_History_Items[0].color_pair = color_pair;
|
||||
if (state->lastsynctype != -1)
|
||||
event_struct->Event_History_Items[0].systype = state->lastsynctype;
|
||||
else event_struct->Event_History_Items[0].systype = 39; //generic digital call
|
||||
event_struct->Event_History_Items[0].subtype = subtype; //voice
|
||||
event_struct->Event_History_Items[0].gi = state->gi[slot]; //need this add this to link control messages
|
||||
event_struct->Event_History_Items[0].sys_id1 = sys_id1;
|
||||
event_struct->Event_History_Items[0].sys_id2 = sys_id2;
|
||||
event_struct->Event_History_Items[0].sys_id3 = sys_id3;
|
||||
event_struct->Event_History_Items[0].sys_id4 = sys_id4;
|
||||
event_struct->Event_History_Items[0].sys_id5 = sys_id5;
|
||||
event_struct->Event_History_Items[0].enc = enc;
|
||||
event_struct->Event_History_Items[0].enc_alg = alg_id;
|
||||
event_struct->Event_History_Items[0].enc_key = key_id;
|
||||
event_struct->Event_History_Items[0].mi = mi;
|
||||
event_struct->Event_History_Items[0].svc = svc_opts;
|
||||
event_struct->Event_History_Items[0].source_id = source_id;
|
||||
event_struct->Event_History_Items[0].target_id = target_id;
|
||||
event_struct->Event_History_Items[0].channel = channel; //need to add this to trunking messages, if tuned from call grant
|
||||
if (opts->playfiles == 0) //if playing back .mbe files with a time in it, don't set this
|
||||
event_struct->Event_History_Items[0].event_time = time(NULL);
|
||||
sprintf (event_struct->Event_History_Items[0].sysid_string, "%s", sysid_string);
|
||||
sprintf (event_struct->Event_History_Items[0].src_str, "%s", src_str);
|
||||
sprintf (event_struct->Event_History_Items[0].tgt_str, "%s", tgt_str);
|
||||
|
||||
sprintf (event_struct->Event_History_Items[0].t_name, "%s", t_name);
|
||||
sprintf (event_struct->Event_History_Items[0].s_name, "%s", s_name);
|
||||
sprintf (event_struct->Event_History_Items[0].t_mode, "%s", t_mode);
|
||||
sprintf (event_struct->Event_History_Items[0].s_mode, "%s", s_mode);
|
||||
|
||||
}
|
||||
|
||||
//Craft an event string for ncurses event history, and a more complex string for logging
|
||||
char event_string[2000]; memset(event_string, 0, sizeof(event_string));
|
||||
|
||||
//WIP: Seperate Voice Call Event Strings when SRC/TGT values are numerical,
|
||||
//and a seperate one for when they are string values (M17, YSF, DSTAR, and dPMR, or use special formatting)
|
||||
if (state->lastsynctype == 30 || state->lastsynctype == 31) //YSF Fusion //TODO: Data calls dumping a lot of events as VOICE
|
||||
{
|
||||
//TODO: See if we can add some decoded data as well in the future to an event string
|
||||
sprintf (event_string, "%s %s %s TGT: %s SRC: %s ", datestr, timestr, sys_string, state->ysf_tgt, state->ysf_src);
|
||||
}
|
||||
else if (state->lastsynctype == 16 || state->lastsynctype == 17) //M17
|
||||
{
|
||||
//TODO: See if we can add some decoded data as well in the future to an event string
|
||||
if (state->m17_dst == 0xFFFFFFFFFFFF)
|
||||
sprintf (event_string, "%s %s %s TGT: %s SRC: %s CAN: %02d;", datestr, timestr, sys_string, "BROADCAST", state->m17_src_str, state->m17_can);
|
||||
else
|
||||
sprintf (event_string, "%s %s %s TGT: %s SRC: %s CAN: %02d;", datestr, timestr, sys_string, state->m17_dst_str, state->m17_src_str, state->m17_can);
|
||||
}
|
||||
else if (state->lastsynctype == 6 || state->lastsynctype == 7 || state->lastsynctype == 18 || state->lastsynctype == 19) //DSTAR
|
||||
{
|
||||
//TODO: See if we can add some decoded data as well in the future to an event string
|
||||
sprintf (event_string, "%s %s %s TGT: %s SRC: %s ", datestr, timestr, sys_string, state->dstar_dst, state->dstar_src);
|
||||
}
|
||||
else if (state->lastsynctype == 20 || state->lastsynctype == 24 || state->lastsynctype == 21 || state->lastsynctype == 25 || state->lastsynctype == 22 || state->lastsynctype == 26 || state->lastsynctype == 23 || state->lastsynctype == 27) //dPMR
|
||||
{
|
||||
//TODO: See if we can add some decoded data as well in the future to an event string
|
||||
sprintf (event_string, "%s %s %s CC: %02d; TGT: %s; SRC: %s; ", datestr, timestr, sys_string, state->dpmr_color_code, state->dpmr_target_id, state->dpmr_caller_id);
|
||||
if (state->dPMRVoiceFS2Frame.Version[0] == 3)
|
||||
strcat (event_string, "Scrambler Enc; ");
|
||||
}
|
||||
else if (state->lastsynctype == 14 || state->lastsynctype == 15 || state->lastsynctype == 37 || state->lastsynctype == 38) //EDACS Calls
|
||||
{
|
||||
svc_opts = state->edacs_vc_call_type;
|
||||
char sup_str[200]; memset (sup_str, 0, sizeof(sup_str));
|
||||
sprintf (sup_str, "%s", "");
|
||||
if (svc_opts & 0x02)
|
||||
strcat (sup_str, "Digital ");
|
||||
else strcat (sup_str, "Analog ");
|
||||
if (svc_opts & 0x04)
|
||||
strcat (sup_str, "Emergency ");
|
||||
if (svc_opts & 0x08)
|
||||
strcat (sup_str, "Group ");
|
||||
if (svc_opts & 0x10)
|
||||
strcat (sup_str, "I ");
|
||||
if (svc_opts & 0x20)
|
||||
strcat (sup_str, "ALL ");
|
||||
if (svc_opts & 0x40)
|
||||
strcat (sup_str, "INTER ");
|
||||
if (svc_opts & 0x80)
|
||||
strcat (sup_str, "TEST ");
|
||||
if (svc_opts & 0x100)
|
||||
strcat (sup_str, "AGENCY ");
|
||||
if (svc_opts & 0x200)
|
||||
strcat (sup_str, "FLEET ");
|
||||
if (svc_opts & 0x01)
|
||||
strcat (sup_str, "Voice ");
|
||||
strcat (sup_str, "Call");
|
||||
|
||||
if (state->ea_mode == 1)
|
||||
{
|
||||
sprintf (event_string, "%s %s %s TGT: %07d; SRC: %07d; LCN: %02d; SITE: %d:%d.%04X; %s;", datestr, timestr, sys_string, target_id, source_id, channel, sys_id1, sys_id2, sys_id3, sup_str);
|
||||
}
|
||||
else
|
||||
{
|
||||
int afs = state->lasttg;
|
||||
int a = (afs >> state->edacs_a_shift) & state->edacs_a_mask;
|
||||
int f = (afs >> state->edacs_f_shift) & state->edacs_f_mask;
|
||||
int s = afs & state->edacs_s_mask;
|
||||
char afs_str[8];
|
||||
getAfsString(state, afs_str, a, f, s);
|
||||
char lid_str[20]; memset(lid_str, 0, sizeof(lid_str));
|
||||
sprintf(lid_str, "%s", "");
|
||||
if (state->lastsrc != 0 && state->lastsrc != 0x800)
|
||||
sprintf (lid_str, "LID: %05d;", state->lastsrc);
|
||||
else sprintf (lid_str, "LID: __UNK;");
|
||||
|
||||
sprintf (event_string, "%s %s %s AFS: %s (%04d); %s LCN: %02d; Site: %d; %s; ", datestr, timestr, sys_string, afs_str, afs, lid_str, channel, sys_id1, sup_str);
|
||||
}
|
||||
}
|
||||
else if (state->lastsynctype == 10 || state->lastsynctype == 11 || state->lastsynctype == 12 || state->lastsynctype == 13 ||
|
||||
state->lastsynctype == 32 || state->lastsynctype == 33 || state->lastsynctype == 34 ) //DMR
|
||||
{
|
||||
if (sys_id1)
|
||||
sprintf (event_string, "%s %s %s TGT: %08d; SRC: %08d; CC: %02d; SYS: %X; ", datestr, timestr, sys_string, target_id, source_id, sys_id2, sys_id1);
|
||||
else
|
||||
sprintf (event_string, "%s %s %s TGT: %08d; SRC: %08d; CC: %02d; ", datestr, timestr, sys_string, target_id, source_id, sys_id2);
|
||||
if (enc)
|
||||
strcat(event_string, "ENC; ");
|
||||
if (alg_id != 0)
|
||||
{
|
||||
char ess_str[30];
|
||||
sprintf (ess_str, "ALG: %02X; KID: %02X; ", alg_id, key_id);
|
||||
strcat(event_string, ess_str);
|
||||
}
|
||||
|
||||
//monitor for misc link control that may set a SO without having SO inside of it,
|
||||
//those could cause misc issues here, will need to observe and make adjustments
|
||||
if (svc_opts & 0x80)
|
||||
strcat (event_string, "Emergency; ");
|
||||
|
||||
if (svc_opts & 0x08)
|
||||
strcat (event_string, "Broadcast; ");
|
||||
|
||||
if (svc_opts & 0x04)
|
||||
strcat (event_string, "OVCM; ");
|
||||
|
||||
if (state->gi[slot] == 0)
|
||||
strcat (event_string, "Group; ");
|
||||
else if (state->gi[slot] == 1)
|
||||
strcat (event_string, "Private; ");
|
||||
|
||||
if (mfid == 0x10)
|
||||
{
|
||||
if (svc_opts & 0x20)
|
||||
strcat (event_string, "TXI; ");
|
||||
else if (svc_opts & 0x10)
|
||||
strcat (event_string, "TXI; "); //this is the svc opt bit that tells you when the next VC6 will be pre-empted, but not helpful here
|
||||
|
||||
if (svc_opts & 0x03)
|
||||
strcat (event_string, "PRIORITY; "); //need to break this apart into each one, but need to double check the decoded value is accurate
|
||||
}
|
||||
|
||||
}
|
||||
else if (state->lastsynctype == 0 || state->lastsynctype == 1 || state->lastsynctype == 35 || state->lastsynctype == 36)
|
||||
{
|
||||
if (sys_id1)
|
||||
sprintf (event_string, "%s %s %s TGT: %08d; SRC: %08d; NAC: %03X; NET_STS: %05X:%03X:%d.%d; ", datestr, timestr, sys_string, target_id, source_id, sys_id3, sys_id1, sys_id2, sys_id4, sys_id5);
|
||||
else
|
||||
sprintf (event_string, "%s %s %s TGT: %08d; SRC: %08d; NAC: %03X; ", datestr, timestr, sys_string, target_id, source_id, sys_id3);
|
||||
if (alg_id != 0 && alg_id != 0x80)
|
||||
{
|
||||
char ess_str[30];
|
||||
sprintf (ess_str, "ENC; ALG: %02X; KID: %04X; ", alg_id, key_id);
|
||||
strcat(event_string, ess_str);
|
||||
}
|
||||
if (svc_opts & 0x80)
|
||||
strcat (event_string, "Emergency; ");
|
||||
if (state->gi[slot] == 0)
|
||||
strcat (event_string, "Group; ");
|
||||
else if (state->gi[slot] == 1)
|
||||
strcat (event_string, "Private; ");
|
||||
}
|
||||
|
||||
else if (state->lastsynctype == 28 || state->lastsynctype == 29)
|
||||
{
|
||||
if (sys_id1)
|
||||
sprintf (event_string, "%s %s %s TGT: %08d; SRC: %08d; RAN: %02d; SYS: %d.%d; ", datestr, timestr, sys_string, target_id, source_id, sys_id3, sys_id2, sys_id1);
|
||||
else
|
||||
sprintf (event_string, "%s %s %s TGT: %08d; SRC: %08d; RAN: %02d; ", datestr, timestr, sys_string, target_id, source_id, sys_id3);
|
||||
if (enc)
|
||||
strcat(event_string, "ENC; ");
|
||||
if (alg_id != 0)
|
||||
{
|
||||
char ess_str[30];
|
||||
sprintf (ess_str, "ALG: %d; KID: %02X; ", alg_id, key_id);
|
||||
strcat(event_string, ess_str);
|
||||
}
|
||||
if (state->gi[slot] == 0)
|
||||
strcat (event_string, "Group; ");
|
||||
else if (state->gi[slot] == 1)
|
||||
strcat (event_string, "Private; ");
|
||||
}
|
||||
|
||||
if (t_name_loaded)
|
||||
{
|
||||
char group[420];
|
||||
sprintf (group, "TName: %s; Mode: %s; ", t_name, t_mode);
|
||||
strcat (event_string, group);
|
||||
}
|
||||
if (s_name_loaded)
|
||||
{
|
||||
char private[420];
|
||||
sprintf (private, "SName: %s; Mode: %s; ", s_name, s_mode);
|
||||
strcat (event_string, private);
|
||||
}
|
||||
|
||||
sprintf (event_struct->Event_History_Items[0].event_string, "%s", event_string);
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
void watchdog_event_datacall (dsd_opts * opts, dsd_state * state, uint32_t src, uint32_t dst, char * data_string, uint8_t slot)
|
||||
{
|
||||
UNUSED(opts);
|
||||
state->event_history_s[slot].Event_History_Items[0].write = 0;
|
||||
if (state->event_history_s[slot].Event_History_Items[0].color_pair == 4) //if not set previously by specific decoder //don't touch this one
|
||||
state->event_history_s[slot].Event_History_Items[0].color_pair = 4; //default data color //you can change this one
|
||||
state->event_history_s[slot].Event_History_Items[0].systype = state->lastsynctype;
|
||||
state->event_history_s[slot].Event_History_Items[0].subtype = 6; //data
|
||||
state->event_history_s[slot].Event_History_Items[0].gi = state->gi[slot];
|
||||
state->event_history_s[slot].Event_History_Items[0].enc = 0;
|
||||
state->event_history_s[slot].Event_History_Items[0].enc_alg = 0;
|
||||
state->event_history_s[slot].Event_History_Items[0].enc_key = 0;
|
||||
state->event_history_s[slot].Event_History_Items[0].mi = 0;
|
||||
state->event_history_s[slot].Event_History_Items[0].svc = 0;
|
||||
state->event_history_s[slot].Event_History_Items[0].source_id = src;
|
||||
state->event_history_s[slot].Event_History_Items[0].target_id = dst;
|
||||
state->event_history_s[slot].Event_History_Items[0].channel = 0;
|
||||
state->event_history_s[slot].Event_History_Items[0].event_time = time(NULL);
|
||||
|
||||
//date and time strings //getTimeN(time(NULL)); //getDateN(time(NULL));
|
||||
char * timestr = getTimeN(time(NULL));
|
||||
char * datestr = getDateN(time(NULL));
|
||||
|
||||
char event_string[2000]; memset (event_string, 0, sizeof(event_string));
|
||||
sprintf (event_string, "%s %s ", datestr, timestr);
|
||||
strcat (event_string, data_string); //may need to check for potential overflow of this
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].event_string, "%s", event_string); //could change this to a strncpy to prevent potential overflow
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
|
||||
//call alert on data calls
|
||||
if (opts->call_alert)
|
||||
beeper (opts, state, slot, 80, 20, 3);
|
||||
}
|
||||
1342
src/dsd_file.c
1342
src/dsd_file.c
File diff suppressed because it is too large
Load Diff
@@ -1,41 +1,29 @@
|
||||
#include "dsd.h"
|
||||
|
||||
//M17 Filter -- RRC Alpha = 0.5 S/s 48000 with 81 taps
|
||||
#define M17ZEROS 80
|
||||
float m17gain = 3.16227766f; //sqrt of 10.0f
|
||||
static float m17xv[81];
|
||||
|
||||
//sample RRC filter for 48kHz sample rate
|
||||
//alpha=0.5, span=8, sps=10, gain=sqrt(sps)
|
||||
float m17coeffs[81] = //replaced old ones with ones from libm17
|
||||
#define M17ZEROS 80 //ONLY SEE 79 THOUGH
|
||||
float m17gain = 10.0f;
|
||||
static float m17xv[M17ZEROS+1];
|
||||
float m17coeffs[81] =
|
||||
{
|
||||
-0.003195702904062073f, -0.002930279157647190f, -0.001940667871554463f,
|
||||
-0.000356087678023658f, 0.001547011339077758f, 0.003389554791179751f,
|
||||
0.004761898604225673f, 0.005310860846138910f, 0.004824746306020221f,
|
||||
0.003297923526848786f, 0.000958710871218619f, -0.001749908029791816f,
|
||||
-0.004238694106631223f, -0.005881783042101693f, -0.006150256456781309f,
|
||||
-0.004745376707651645f, -0.001704189656473565f, 0.002547854551539951f,
|
||||
0.007215575568844704f, 0.011231038205363532f, 0.013421952197060707f,
|
||||
0.012730475385624438f, 0.008449554307303753f, 0.000436744366018287f,
|
||||
-0.010735380379191660f, -0.023726883538258272f, -0.036498030780605324f,
|
||||
-0.046500883189991064f, -0.050979050575999614f, -0.047340680079891187f,
|
||||
-0.033554880492651755f, -0.008513823955725943f, 0.027696543159614194f,
|
||||
0.073664520037517042f, 0.126689053778116234f, 0.182990955139333916f,
|
||||
0.238080025892859704f, 0.287235637987091563f, 0.326040247765297220f,
|
||||
0.350895727088112619f, 0.359452932027607974f, 0.350895727088112619f,
|
||||
0.326040247765297220f, 0.287235637987091563f, 0.238080025892859704f,
|
||||
0.182990955139333916f, 0.126689053778116234f, 0.073664520037517042f,
|
||||
0.027696543159614194f, -0.008513823955725943f, -0.033554880492651755f,
|
||||
-0.047340680079891187f, -0.050979050575999614f, -0.046500883189991064f,
|
||||
-0.036498030780605324f, -0.023726883538258272f, -0.010735380379191660f,
|
||||
0.000436744366018287f, 0.008449554307303753f, 0.012730475385624438f,
|
||||
0.013421952197060707f, 0.011231038205363532f, 0.007215575568844704f,
|
||||
0.002547854551539951f, -0.001704189656473565f, -0.004745376707651645f,
|
||||
-0.006150256456781309f, -0.005881783042101693f, -0.004238694106631223f,
|
||||
-0.001749908029791816f, 0.000958710871218619f, 0.003297923526848786f,
|
||||
0.004824746306020221f, 0.005310860846138910f, 0.004761898604225673f,
|
||||
0.003389554791179751f, 0.001547011339077758f, -0.000356087678023658f,
|
||||
-0.001940667871554463f, -0.002930279157647190f, -0.003195702904062073f
|
||||
-0.009265784007800534, -0.006136551625729697, -0.001125978562075172, 0.004891777252042491,
|
||||
0.01071805138282269, 0.01505751553351295, 0.01679337935001369, 0.015256245142156299,
|
||||
0.01042830577908502, 0.003031522725559901, -0.0055333532968188165, -0.013403099825723372,
|
||||
-0.018598682349642525, -0.01944761739590459, -0.015005271935951746, -0.0053887880354343935,
|
||||
0.008056525910253532, 0.022816244158307273, 0.035513467692208076, 0.04244131815783876,
|
||||
0.04025481153629372, 0.02671818654865632, 0.0013810216516704976, -0.03394615682795165,
|
||||
-0.07502635967975885, -0.11540977897637611, -0.14703962203941534, -0.16119995609538576,
|
||||
-0.14969512896336504, -0.10610329539459686, -0.026921412469634916, 0.08757875030779196,
|
||||
0.23293327870303457, 0.4006012210123992, 0.5786324696325503, 0.7528286479934068,
|
||||
0.908262741447522, 1.0309661131633199, 1.1095611856548013, 1.1366197723675815,
|
||||
1.1095611856548013, 1.0309661131633199, 0.908262741447522, 0.7528286479934068,
|
||||
0.5786324696325503, 0.4006012210123992, 0.23293327870303457, 0.08757875030779196,
|
||||
-0.026921412469634916, -0.10610329539459686, -0.14969512896336504, -0.16119995609538576,
|
||||
-0.14703962203941534, -0.11540977897637611, -0.07502635967975885, -0.03394615682795165,
|
||||
0.0013810216516704976, 0.02671818654865632, 0.04025481153629372, 0.04244131815783876,
|
||||
0.035513467692208076, 0.022816244158307273, 0.008056525910253532, -0.0053887880354343935,
|
||||
-0.015005271935951746, -0.01944761739590459, -0.018598682349642525, -0.013403099825723372,
|
||||
-0.0055333532968188165, 0.003031522725559901, 0.01042830577908502, 0.015256245142156299,
|
||||
0.01679337935001369, 0.01505751553351295, 0.01071805138282269, 0.004891777252042491,
|
||||
-0.001125978562075172, -0.006136551625729697, -0.009265784007800534
|
||||
};
|
||||
|
||||
// Original DMR filter
|
||||
@@ -64,7 +52,7 @@ float xcoeffs[61] =
|
||||
//reverted to original NXDN filters, do better with LICH/Data handling
|
||||
// NXDN48 filter - Original Version
|
||||
#define NXZEROS 134
|
||||
float nxgain = 15.95930463f;
|
||||
float nxgain = 15.95930463f;
|
||||
static float nxv[NXZEROS+1];
|
||||
|
||||
float nxcoeffs[135] =
|
||||
@@ -115,17 +103,17 @@ static float dxv[DMRNZEROS+1];
|
||||
|
||||
// DMR filter F4EXB - root raised cosine alpha=0.7 Ts = 6650 S/s Fc = 48kHz
|
||||
const float dmrcoeffs[61] =
|
||||
{0.0301506278, 0.0269200615, 0.0159662432, -0.0013114705, -0.0216605133,
|
||||
-0.0404938748, -0.0528141756, -0.0543747957, -0.0428325003, -0.0186176083,
|
||||
0.0147202645, 0.0508418571, 0.0816392577, 0.0988113688, 0.0957187780,
|
||||
0.0691512084, 0.0206194642, -0.0431564563, -0.1107569268, -0.1675773224,
|
||||
-0.1981519842, -0.1889130786, -0.1308939560, -0.0218608492, 0.1325685970,
|
||||
0.3190962499, 0.5182530574, 0.7070497652, 0.8623526878, 0.9644213921,
|
||||
1.0000000000, 0.9644213921, 0.8623526878, 0.7070497652, 0.5182530574,
|
||||
0.3190962499, 0.1325685970, -0.0218608492, -0.1308939560, -0.1889130786,
|
||||
-0.1981519842, -0.1675773224, -0.1107569268, -0.0431564563, 0.0206194642,
|
||||
0.0691512084, 0.0957187780, 0.0988113688, 0.0816392577, 0.0508418571,
|
||||
0.0147202645, -0.0186176083, -0.0428325003, -0.0543747957, -0.0528141756,
|
||||
{0.0301506278, 0.0269200615, 0.0159662432, -0.0013114705, -0.0216605133,
|
||||
-0.0404938748, -0.0528141756, -0.0543747957, -0.0428325003, -0.0186176083,
|
||||
0.0147202645, 0.0508418571, 0.0816392577, 0.0988113688, 0.0957187780,
|
||||
0.0691512084, 0.0206194642, -0.0431564563, -0.1107569268, -0.1675773224,
|
||||
-0.1981519842, -0.1889130786, -0.1308939560, -0.0218608492, 0.1325685970,
|
||||
0.3190962499, 0.5182530574, 0.7070497652, 0.8623526878, 0.9644213921,
|
||||
1.0000000000, 0.9644213921, 0.8623526878, 0.7070497652, 0.5182530574,
|
||||
0.3190962499, 0.1325685970, -0.0218608492, -0.1308939560, -0.1889130786,
|
||||
-0.1981519842, -0.1675773224, -0.1107569268, -0.0431564563, 0.0206194642,
|
||||
0.0691512084, 0.0957187780, 0.0988113688, 0.0816392577, 0.0508418571,
|
||||
0.0147202645, -0.0186176083, -0.0428325003, -0.0543747957, -0.0528141756,
|
||||
-0.0404938748, -0.0216605133, -0.0013114705, 0.0159662432, 0.0269200615, 0.0301506278};
|
||||
|
||||
// dPMR filter, version of F4EXB
|
||||
@@ -187,13 +175,13 @@ dmr_filter(short sample)
|
||||
short
|
||||
nxdn_filter(short sample)
|
||||
{
|
||||
return dsd_input_filter(sample, 4);
|
||||
return dsd_input_filter(sample, 2);
|
||||
}
|
||||
|
||||
short
|
||||
dpmr_filter(short sample)
|
||||
{
|
||||
return dsd_input_filter(sample, 4);
|
||||
return dsd_input_filter(sample, 4);
|
||||
}
|
||||
|
||||
short m17_filter (short sample)
|
||||
@@ -245,7 +233,7 @@ dsd_input_filter(short sample, int mode)
|
||||
default:
|
||||
return sample;
|
||||
}
|
||||
|
||||
|
||||
for (i = 0; i < zeros; i++)
|
||||
v[i] = v[i+1];
|
||||
|
||||
@@ -256,13 +244,4 @@ dsd_input_filter(short sample, int mode)
|
||||
sum += (coeffs[i] * v[i]);
|
||||
|
||||
return (short)(sum / gain); // filtered sample out
|
||||
}
|
||||
|
||||
void init_rrc_filter_memory()
|
||||
{
|
||||
memset (m17xv, 0, 81*sizeof(float));
|
||||
memset (xv, 0, 61*sizeof(float));
|
||||
memset (dxv, 0, 61*sizeof(float));
|
||||
memset (nxv, 0, 135*sizeof(float));
|
||||
memset (dpmrxv, 0, 135*sizeof(float));
|
||||
}
|
||||
127
src/dsd_frame.c
127
src/dsd_frame.c
@@ -26,23 +26,29 @@ void
|
||||
printFrameInfo (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
|
||||
UNUSED(opts);
|
||||
int level;
|
||||
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
if (state->p2_wacn != 0)
|
||||
fprintf (stderr, "WACN: %05llX; ", state->p2_wacn);
|
||||
if (state->p2_sysid != 0)
|
||||
fprintf (stderr, "SYS: %03llX; ", state->p2_sysid);
|
||||
if (state->p2_cc != 0)
|
||||
fprintf (stderr, "NAC/CC: %03llX; ", state->p2_cc);
|
||||
else fprintf (stderr, "NAC: %03X; ", state->nac);
|
||||
level = (int) state->max / 164;
|
||||
if (opts->verbose > 0)
|
||||
{
|
||||
//fprintf (stderr,"inlvl: %2i%% ", level);
|
||||
}
|
||||
if (state->nac != 0)
|
||||
{
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr,"nac: [%4X] ", state->nac);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
if (state->p2_rfssid != 0)
|
||||
fprintf (stderr, "RFSS: %03lld; ", state->p2_rfssid);
|
||||
if (state->p2_siteid != 0)
|
||||
fprintf (stderr, "Site: %03lld; ", state->p2_siteid);
|
||||
if (opts->verbose > 1)
|
||||
{
|
||||
fprintf (stderr, "%s", KGRN);
|
||||
fprintf (stderr,"src: [%8i] ", state->lastsrc);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
fprintf (stderr, "%s", KGRN);
|
||||
fprintf (stderr,"tg: [%5i] ", state->lasttg);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
}
|
||||
|
||||
void
|
||||
@@ -53,10 +59,8 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
char duid[3];
|
||||
char nac[13];
|
||||
int level;
|
||||
UNUSED2(nac, level);
|
||||
|
||||
char status_0;
|
||||
UNUSED(status_0);
|
||||
char bch_code[63];
|
||||
int index_bch_code;
|
||||
unsigned char parity;
|
||||
@@ -84,29 +88,55 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
if ((state->synctype == 28) || (state->synctype == 29))
|
||||
{
|
||||
//MBEout restored, is not handled internally by nxdn_frame.c
|
||||
nxdn_frame (opts, state);
|
||||
nxdn_frame (opts, state);
|
||||
return;
|
||||
}
|
||||
|
||||
//DSTAR
|
||||
else if ((state->synctype == 6) || (state->synctype == 7))
|
||||
{
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL))
|
||||
openMbeOutFile (opts, state);
|
||||
sprintf (state->fsubtype, " VOICE ");
|
||||
processDSTAR (opts, state);
|
||||
return;
|
||||
}
|
||||
{
|
||||
state->nac = 0;
|
||||
state->lastsrc = 0;
|
||||
state->lasttg = 0;
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
if (opts->verbose > 0)
|
||||
{
|
||||
level = (int) state->max / 164;
|
||||
//fprintf (stderr,"inlvl: %2i%% ", level);
|
||||
}
|
||||
}
|
||||
state->nac = 0;
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL))
|
||||
{
|
||||
openMbeOutFile (opts, state); //dstar ambe files are read back incorrectly, need to change file extension to differentiate when doing a playback
|
||||
}
|
||||
sprintf (state->fsubtype, " VOICE ");
|
||||
processDSTAR (opts, state);
|
||||
return;
|
||||
}
|
||||
else if ((state->synctype == 18) || (state->synctype == 19))
|
||||
{
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL))
|
||||
openMbeOutFile (opts, state);
|
||||
sprintf (state->fsubtype, " DATA ");
|
||||
processDSTAR_HD (opts, state);
|
||||
return;
|
||||
}
|
||||
{
|
||||
state->nac = 0;
|
||||
state->lastsrc = 0;
|
||||
state->lasttg = 0;
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
if (opts->verbose > 0)
|
||||
{
|
||||
level = (int) state->max / 164;
|
||||
//fprintf (stderr,"inlvl: %2i%% ", level);
|
||||
}
|
||||
}
|
||||
state->nac = 0;
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL))
|
||||
{
|
||||
openMbeOutFile (opts, state); //dstar ambe files are read back incorrectly, need to change file extension to differentiate when doing a playback
|
||||
}
|
||||
sprintf (state->fsubtype, " DATA ");
|
||||
processDSTAR_HD (opts, state);
|
||||
return;
|
||||
}
|
||||
//Start DMR Types
|
||||
else if ((state->synctype >= 10 && state->synctype <= 13) || (state->synctype == 32) || (state->synctype == 33) || (state->synctype == 34) ) //32-34 DMR MS and RC
|
||||
else if ((state->synctype >= 10) && (state->synctype <= 13) || (state->synctype == 32) || (state->synctype == 33) || (state->synctype == 34) ) //32-34 DMR MS and RC
|
||||
{
|
||||
|
||||
//print manufacturer strings to branding, disabled 0x10 moto other systems can use that fid set
|
||||
@@ -114,7 +144,7 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
if (state->dmr_mfid == 0x10) ; //sprintf (state->dmr_branding, "%s", "Motorola");
|
||||
else if (state->dmr_mfid == 0x68) sprintf (state->dmr_branding, "%s", " Hytera");
|
||||
else if (state->dmr_mfid == 0x58) sprintf (state->dmr_branding, "%s", " Tait");
|
||||
|
||||
|
||||
//disabling these due to random data decodes setting an odd mfid, could be legit, but only for that one packet?
|
||||
//or, its just a decode error somewhere
|
||||
// else if (state->dmr_mfid == 0x20) sprintf (state->dmr_branding, "%s", "JVC Kenwood");
|
||||
@@ -152,14 +182,14 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
sprintf (state->slot1light, " slot1 ");
|
||||
sprintf (state->slot2light, " slot2 ");
|
||||
//we can safely open MBE on any MS or mono handling
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL)) openMbeOutFile (opts, state);
|
||||
if (opts->p25_trunk == 0) dmrMSBootstrap (opts, state);
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL)) openMbeOutFile (opts, state);
|
||||
if (opts->p25_trunk == 0) dmrMSBootstrap (opts, state);
|
||||
}
|
||||
if (opts->dmr_mono == 1 && state->synctype == 32)
|
||||
{
|
||||
//we can safely open MBE on any MS or mono handling
|
||||
if ((opts->mbe_out_dir[0] != 0) && (opts->mbe_out_f == NULL)) openMbeOutFile (opts, state);
|
||||
if (opts->p25_trunk == 0) dmrMSBootstrap (opts, state);
|
||||
if (opts->p25_trunk == 0) dmrMSBootstrap (opts, state);
|
||||
}
|
||||
if (opts->dmr_stereo == 1) //opts->dmr_stereo == 1
|
||||
{
|
||||
@@ -251,7 +281,7 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
//edacs
|
||||
else if ((state->synctype == 37) || (state->synctype == 38))
|
||||
{
|
||||
if (opts->mbe_out_f != NULL) closeMbeOutFile (opts, state);
|
||||
if (opts->mbe_out_f != NULL) closeMbeOutFile (opts, state);
|
||||
edacs (opts, state);
|
||||
return;
|
||||
}
|
||||
@@ -263,19 +293,13 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
return;
|
||||
}
|
||||
//M17
|
||||
else if ((state->synctype == 16) || (state->synctype == 9) || (state->synctype == 17) || (state->synctype == 8) ||
|
||||
(state->synctype == 76) || (state->synctype == 77) || (state->synctype == 86) || (state->synctype == 87) ||
|
||||
(state->synctype == 99) || (state->synctype == 98) )
|
||||
else if ((state->synctype == 16) || (state->synctype == 9) || (state->synctype == 17) || (state->synctype == 8) || (state->synctype == 99) || (state->synctype == 98))
|
||||
{
|
||||
if (state->synctype == 98 || state->synctype == 99) //preamble only
|
||||
skipDibit(opts, state, 8); //skip dibits to prime the demodulator
|
||||
else if (state->synctype == 16 || state->synctype == 17)
|
||||
processM17STR(opts, state);
|
||||
else if (state->synctype == 76 || state->synctype == 77) {} //Not available yet
|
||||
// processM17BRT(opts, state); //Not available yet
|
||||
else if (state->synctype == 86 || state->synctype == 87)
|
||||
processM17PKT(opts, state);
|
||||
else
|
||||
else
|
||||
processM17LSF(opts, state);
|
||||
return;
|
||||
}
|
||||
@@ -403,8 +427,7 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
if (new_nac != state->nac) {
|
||||
// NAC fixed by error correction
|
||||
state->nac = new_nac;
|
||||
//apparently, both 0 and 0xFFF can the BCH code on signal drop
|
||||
if (state->p2_hardset == 0 && new_nac != 0 && new_nac != 0xFFF)
|
||||
if (state->p2_hardset == 0 && new_nac != 0)
|
||||
{
|
||||
state->p2_cc = new_nac;
|
||||
}
|
||||
@@ -436,7 +459,7 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
if (opts->mbe_out_dir[0] != 0)
|
||||
{
|
||||
if (opts->mbe_out_f != NULL) closeMbeOutFile (opts, state);
|
||||
if (opts->mbe_out_f != NULL) closeMbeOutFile (opts, state);
|
||||
if (opts->mbe_out_f == NULL) openMbeOutFile (opts, state);
|
||||
}
|
||||
mbe_initMbeParms (state->cur_mp, state->prev_mp, state->prev_mp_enhanced);
|
||||
@@ -584,7 +607,7 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameInfo (opts, state);
|
||||
fprintf (stderr," MPDU\n"); //multi block format PDU
|
||||
fprintf (stderr," MBF\n"); //multi block format PDU
|
||||
}
|
||||
if (opts->mbe_out_dir[0] != 0)
|
||||
{
|
||||
@@ -596,7 +619,7 @@ processFrame (dsd_opts * opts, dsd_state * state)
|
||||
resumeScan (opts, state);
|
||||
}
|
||||
state->lastp25type = 4;
|
||||
sprintf (state->fsubtype, " MPDU ");
|
||||
sprintf (state->fsubtype, " MBF ");
|
||||
|
||||
processMPDU(opts, state);
|
||||
}
|
||||
|
||||
@@ -18,33 +18,58 @@
|
||||
#include "dsd.h"
|
||||
#include <locale.h>
|
||||
|
||||
char * getTime(void) //get pretty hh:mm:ss timestamp
|
||||
{
|
||||
time_t t = time(NULL);
|
||||
|
||||
char * curr;
|
||||
char * stamp = asctime(localtime( & t));
|
||||
|
||||
curr = strtok(stamp, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
curr = strtok(NULL, " ");
|
||||
|
||||
return curr;
|
||||
}
|
||||
|
||||
char * getDate(void) {
|
||||
#ifdef AERO_BUILD
|
||||
char datename[80];
|
||||
#else
|
||||
char datename[99];
|
||||
#endif
|
||||
char * curr2;
|
||||
struct tm * to;
|
||||
time_t t;
|
||||
t = time(NULL);
|
||||
to = localtime( & t);
|
||||
strftime(datename, sizeof(datename), "%Y-%m-%d", to);
|
||||
curr2 = strtok(datename, " ");
|
||||
return curr2;
|
||||
}
|
||||
|
||||
void
|
||||
printFrameSync (dsd_opts * opts, dsd_state * state, char *frametype, int offset, char *modulation)
|
||||
{
|
||||
UNUSED3(state, offset, modulation);
|
||||
|
||||
char * timestr = getTimeC();
|
||||
if (opts->verbose > 0)
|
||||
{
|
||||
fprintf (stderr,"%s ", timestr);
|
||||
fprintf (stderr,"Sync: %s ", frametype);
|
||||
}
|
||||
|
||||
//oops, that made a nested if-if-if-if statement,
|
||||
//causing a memory leak
|
||||
|
||||
// if (opts->verbose > 2)
|
||||
//fprintf (stderr,"o: %4i ", offset);
|
||||
// if (opts->verbose > 1)
|
||||
//fprintf (stderr,"mod: %s ", modulation);
|
||||
// if (opts->verbose > 2)
|
||||
//fprintf (stderr,"g: %f ", state->aout_gain);
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
{
|
||||
fprintf (stderr,"%s ", getTime());
|
||||
fprintf (stderr,"Sync: %s ", frametype);
|
||||
}
|
||||
if (opts->verbose > 2)
|
||||
{
|
||||
//fprintf (stderr,"o: %4i ", offset);
|
||||
}
|
||||
if (opts->verbose > 1)
|
||||
{
|
||||
//fprintf (stderr,"mod: %s ", modulation);
|
||||
}
|
||||
if (opts->verbose > 2)
|
||||
{
|
||||
//fprintf (stderr,"g: %f ", state->aout_gain);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
@@ -99,14 +124,11 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
if (state->dmr_rest_channel == -1 && opts->p25_is_tuned == 0 && opts->p25_trunk == 1 && ( (time(NULL) - state->last_cc_sync_time) > (opts->trunk_hangtime + 0) ) ) //was 3, go to hangtime value
|
||||
{
|
||||
|
||||
//if P25p2 VCH and going back to P25p1 CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 0)
|
||||
//test to switch back to 10/4 P1 QPSK for P25 FDMA CC
|
||||
if (opts->mod_qpsk == 1 && state->p25_cc_is_tdma == 0)
|
||||
{
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
//re-enable both slots
|
||||
opts->slot1_on = 1;
|
||||
opts->slot2_on = 1;
|
||||
}
|
||||
|
||||
//start going through the lcn/frequencies CC/signal hunting
|
||||
@@ -123,14 +145,14 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
state->lcn_freq_roll++;
|
||||
//check roll again if greater than expected, then go back to zero
|
||||
if (state->lcn_freq_roll >= state->lcn_freq_count)
|
||||
if (state->lcn_freq_roll >= state->lcn_freq_count)
|
||||
{
|
||||
state->lcn_freq_roll = 0; //reset to zero
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
//check that we have a non zero value first, then tune next frequency
|
||||
if (state->trunk_lcn_freq[state->lcn_freq_roll] != 0)
|
||||
if (state->trunk_lcn_freq[state->lcn_freq_roll] != 0)
|
||||
{
|
||||
//rigctl
|
||||
if (opts->use_rigctl == 1)
|
||||
@@ -145,8 +167,8 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
rtl_dev_tune (opts, state->trunk_lcn_freq[state->lcn_freq_roll]);
|
||||
#endif
|
||||
}
|
||||
|
||||
fprintf (stderr, "Tuning to Frequency: %.06lf MHz\n",
|
||||
|
||||
fprintf (stderr, "Tuning to Frequency: %.06lf MHz\n",
|
||||
(double)state->trunk_lcn_freq[state->lcn_freq_roll]/1000000);
|
||||
|
||||
}
|
||||
@@ -154,22 +176,26 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->last_cc_sync_time = time(NULL); //set again to give another x seconds
|
||||
}
|
||||
|
||||
int i, t, dibit, sync, symbol, synctest_pos, lastt;
|
||||
int i, j, t, o, dibit, sync, symbol, synctest_pos, lastt;
|
||||
char synctest[25];
|
||||
char synctest12[13]; //dPMR
|
||||
char synctest10[11]; //NXDN FSW only
|
||||
char synctest18[19];
|
||||
char synctest32[33];
|
||||
char synctest20[21]; //YSF
|
||||
char synctest21[22]; //P25 S-OEMI (SACCH)
|
||||
char synctest48[49]; //EDACS
|
||||
char synctest8[9]; //M17
|
||||
char synctest16[17]; //M17 Preamble
|
||||
char modulation[8];
|
||||
char *synctest_p;
|
||||
int symboltest_pos; //symbol test position, match to synctest_pos
|
||||
int symboltest_p[10240]; //make this an array instead
|
||||
char synctest_buf[10240]; //what actually is assigned to this, can't find its use anywhere?
|
||||
int lmin, lmax, lidx;
|
||||
|
||||
|
||||
//assign t_max value based on decoding type expected (all non-auto decodes first)
|
||||
int t_max = 24; //initialize as an actual value to prevent any overflow related issues
|
||||
int t_max; //maximum values allowed for t will depend on decoding type - NXDN will be 10, others will be more
|
||||
if (opts->frame_nxdn48 == 1 || opts->frame_nxdn96 == 1)
|
||||
{
|
||||
t_max = 10;
|
||||
@@ -192,29 +218,24 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
t_max = 19; //Phase 2 S-ISCH is only 19
|
||||
}
|
||||
else if (opts->analog_only == 1) //shim to make sure this is set to a reasonable value
|
||||
{
|
||||
t_max = 24;
|
||||
}
|
||||
else t_max = 24; //24 for everything else
|
||||
|
||||
int lbuf[48], lbuf2[48]; //if we use t_max in these arrays, and t >= t_max in condition below, then it can overflow those checks in there if t exceeds t_max
|
||||
int lsum;
|
||||
char spectrum[64];
|
||||
//init the lbuf
|
||||
memset (lbuf, 0, sizeof(lbuf));
|
||||
memset (lbuf2, 0, sizeof(lbuf2));
|
||||
|
||||
// detect frame sync
|
||||
t = 0;
|
||||
synctest10[10] = 0;
|
||||
synctest10[10] = 0;
|
||||
synctest[24] = 0;
|
||||
synctest8[8] = 0; //M17, wasn't initialized or terminated (source of much pain and frustration in Cygwin)
|
||||
synctest12[12] = 0;
|
||||
synctest16[16] = 0; //M17, wasn't initialized or terminated (source of much pain and frustration in Cygwin)
|
||||
synctest18[18] = 0;
|
||||
synctest48[48] = 0;
|
||||
synctest32[32] = 0;
|
||||
synctest20[20] = 0;
|
||||
modulation[7] = 0; //not initialized or terminated (unsure if this would be an issue or not)
|
||||
synctest_pos = 0;
|
||||
synctest_p = synctest_buf + 10;
|
||||
sync = 0;
|
||||
@@ -224,17 +245,11 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
lastt = 0;
|
||||
state->numflips = 0;
|
||||
|
||||
//run here as well
|
||||
//move ncursesPrinter outside of the sync loop, causes weird lag inside the loop
|
||||
if (opts->use_ncurses_terminal == 1)
|
||||
{
|
||||
ncursesPrinter(opts, state);
|
||||
|
||||
//slot 1
|
||||
watchdog_event_history(opts, state, 0);
|
||||
watchdog_event_current(opts, state, 0);
|
||||
|
||||
//slot 2 for TDMA systems
|
||||
watchdog_event_history(opts, state, 1);
|
||||
watchdog_event_current(opts, state, 1);
|
||||
}
|
||||
|
||||
if ((opts->symboltiming == 1) && (state->carrier == 1))
|
||||
{
|
||||
@@ -246,11 +261,6 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
t++;
|
||||
|
||||
//run ncurses printer more frequently when no sync to speed up responsiveness of it during no sync period
|
||||
//NOTE: Need to monitor and test this, if responsiveness issues arise, then disable this
|
||||
if ( opts->use_ncurses_terminal == 1 && ((t % 300) == 0)) //t maxes out at 1800 (6 times each getFrameSync)
|
||||
ncursesPrinter(opts, state);
|
||||
|
||||
symbol = getSymbol (opts, state, 0);
|
||||
|
||||
lbuf[lidx] = symbol;
|
||||
@@ -322,7 +332,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
dibit = 51; // '3'
|
||||
}
|
||||
|
||||
if (opts->symbol_out_f && dibit != 0)
|
||||
if (opts->symbol_out == 1 && dibit != 0)
|
||||
{
|
||||
int csymbol = 0;
|
||||
if (dibit == 49)
|
||||
@@ -369,20 +379,20 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
state->dmr_payload_p++;
|
||||
// end digitize and dmr buffer testing
|
||||
|
||||
*synctest_p = dibit;
|
||||
*synctest_p = dibit;
|
||||
if (t >= t_max) //works excelent now with short sync patterns, and no issues with large ones!
|
||||
{
|
||||
for (i = 0; i < t_max; i++) //24
|
||||
{
|
||||
lbuf2[i] = lbuf[i];
|
||||
}
|
||||
qsort (lbuf2, t_max, sizeof (int), comp);
|
||||
qsort (lbuf2, t_max, sizeof (int), comp);
|
||||
lmin = (lbuf2[1] + lbuf2[2] + lbuf2[3]) / 3;
|
||||
lmax = (lbuf2[t_max - 3] + lbuf2[t_max - 2] + lbuf2[t_max - 1]) / 3;
|
||||
lmax = (lbuf2[t_max - 3] + lbuf2[t_max - 2] + lbuf2[t_max - 1]) / 3;
|
||||
|
||||
if (state->rf_mod == 1)
|
||||
{
|
||||
@@ -419,8 +429,8 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
|
||||
|
||||
//if using an rtl input method, do not look for sync patterns if the pwr value is lower than our 'soft squelch' level
|
||||
if (opts->audio_in_type == 3 && opts->rtl_pwr < opts->rtl_squelch_level)
|
||||
//if using an rtl input method, do not look for sync patterns if the rms value is lower than our 'soft squelch' level
|
||||
if (opts->audio_in_type == 3 && opts->rtl_rms < opts->rtl_squelch_level)
|
||||
{
|
||||
if (opts->frame_nxdn48 == 1 || opts->frame_nxdn96 == 1 || opts->frame_dpmr == 1 || opts->frame_m17 == 1)
|
||||
{
|
||||
@@ -443,7 +453,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
sprintf (state->ftype, "P25 Phase 1");
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameSync (opts, state, "+P25p1", synctest_pos + 1, modulation);
|
||||
printFrameSync (opts, state, "+P25p1 ", synctest_pos + 1, modulation);
|
||||
}
|
||||
state->lastsynctype = 0;
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
@@ -539,7 +549,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
//YSF sync
|
||||
strncpy(synctest20, (synctest_p - 19), 20);
|
||||
if(opts->frame_ysf == 1)
|
||||
if(opts->frame_ysf == 1)
|
||||
{
|
||||
if (strcmp(synctest20, FUSION_SYNC) == 0)
|
||||
{
|
||||
@@ -569,9 +579,9 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
//M17 Sync -- Just STR and LSF for now
|
||||
strncpy(synctest16, (synctest_p - 15), 16);
|
||||
strncpy(synctest8, (synctest_p - 7), 8);
|
||||
if(opts->frame_m17 == 1)
|
||||
if(opts->frame_m17 == 1)
|
||||
{
|
||||
//preambles will skip dibits in an attempt to prime the
|
||||
//preambles will skip dibits in an attempt to prime the
|
||||
//demodulator but not attempt any decoding
|
||||
if (strcmp(synctest8, M17_PRE) == 0)
|
||||
{
|
||||
@@ -601,39 +611,6 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
return (99);
|
||||
}
|
||||
}
|
||||
else if (strcmp(synctest8, M17_PKT) == 0)
|
||||
{
|
||||
if (opts->inverted_m17 == 0)
|
||||
{
|
||||
printFrameSync (opts, state, "+M17 PKT", synctest_pos + 1, modulation);
|
||||
state->carrier = 1;
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
if (state->lastsynctype == 86 || state->lastsynctype == 8)
|
||||
{
|
||||
state->lastsynctype = 86;
|
||||
return (86);
|
||||
}
|
||||
state->lastsynctype = 86;
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
// else //unknown, -BRT?
|
||||
// {
|
||||
// printFrameSync (opts, state, "-M17 BRT", synctest_pos + 1, modulation);
|
||||
// state->carrier = 1;
|
||||
// state->offset = synctest_pos;
|
||||
// state->max = ((state->max) + lmax) / 2;
|
||||
// state->min = ((state->min) + lmin) / 2;
|
||||
// if (state->lastsynctype == 77)
|
||||
// {
|
||||
// state->lastsynctype = 77;
|
||||
// return (77);
|
||||
// }
|
||||
// state->lastsynctype = 77;
|
||||
// fprintf (stderr, "\n");
|
||||
// }
|
||||
}
|
||||
else if (strcmp(synctest8, M17_STR) == 0)
|
||||
{
|
||||
if (opts->inverted_m17 == 0)
|
||||
@@ -701,7 +678,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
}
|
||||
}
|
||||
//end M17
|
||||
//end M17
|
||||
|
||||
//P25 P2 sync S-ISCH VCH
|
||||
strncpy(synctest20, (synctest_p - 19), 20);
|
||||
@@ -719,11 +696,13 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->lastsynctype = 35; //35
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameSync (opts, state, "+P25p2", synctest_pos + 1, modulation);
|
||||
printFrameSync (opts, state, "+P25p2 SISCH", synctest_pos + 1, modulation);
|
||||
}
|
||||
if (state->p2_wacn != 0 && state->p2_cc != 0 && state->p2_sysid != 0)
|
||||
{
|
||||
printFrameInfo(opts, state);
|
||||
//fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, " WACN [%05llX] SYS [%03llX] NAC [%03llX] ", state->p2_wacn, state->p2_sysid, state->p2_cc);
|
||||
//fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
else
|
||||
{
|
||||
@@ -750,11 +729,13 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
opts->inverted_p2 = 1;
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameSync (opts, state, "-P25p2", synctest_pos + 1, modulation);
|
||||
printFrameSync (opts, state, "-P25p2 SISCH", synctest_pos + 1, modulation);
|
||||
}
|
||||
if (state->p2_wacn != 0 && state->p2_cc != 0 && state->p2_sysid != 0)
|
||||
{
|
||||
printFrameInfo(opts, state);
|
||||
//fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, " WACN [%05llX] SYS [%03llX] NAC [%03llX] ", state->p2_wacn, state->p2_sysid, state->p2_cc);
|
||||
//fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
else
|
||||
{
|
||||
@@ -874,6 +855,32 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
return (32);
|
||||
}
|
||||
}
|
||||
//not sure if this should be here, RC data should only be present in vc6?
|
||||
if(strcmp (synctest, DMR_RC_DATA_SYNC) == 0)
|
||||
{
|
||||
state->carrier = 1;
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
//state->directmode = 0;
|
||||
//fprintf (stderr, "DMR RC DATA\n");
|
||||
state->dmr_ms_rc == 1; //set flag for RC data, then process accordingly and reset back to 0 afterwards
|
||||
if (0 == 0) //opts->inverted_dmr
|
||||
{
|
||||
// voice frame
|
||||
sprintf(state->ftype, "DMR RC");
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
//printFrameSync (opts, state, "+DMR RC Data", synctest_pos + 1, modulation);
|
||||
}
|
||||
if (state->lastsynctype != 34)
|
||||
{
|
||||
//state->firstframe = 1;
|
||||
}
|
||||
state->lastsynctype = 34;
|
||||
return (34);
|
||||
}
|
||||
}
|
||||
|
||||
if(strcmp (synctest, DMR_MS_VOICE_SYNC) == 0)
|
||||
{
|
||||
@@ -924,7 +931,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
printFrameSync (opts, state, "+DMR ", synctest_pos + 1, modulation);
|
||||
}
|
||||
state->lastsynctype = 10;
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
return (10);
|
||||
}
|
||||
else
|
||||
@@ -940,7 +947,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->firstframe = 1;
|
||||
}
|
||||
state->lastsynctype = 11;
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
return (11); //11
|
||||
}
|
||||
}
|
||||
@@ -1039,7 +1046,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->firstframe = 1;
|
||||
}
|
||||
state->lastsynctype = 12;
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
return (12);
|
||||
}
|
||||
|
||||
@@ -1052,7 +1059,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
printFrameSync (opts, state, "-DMR ", synctest_pos + 1, modulation);
|
||||
}
|
||||
state->lastsynctype = 13;
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
return (13);
|
||||
}
|
||||
}
|
||||
@@ -1171,7 +1178,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
printFrameSync (opts, state, "-EDACS", synctest_pos + 1, modulation);
|
||||
state->lastsynctype = 38;
|
||||
state->lastsynctype = 38;
|
||||
return (38);
|
||||
}
|
||||
else if ( strcmp (synctest48, INV_EDACS_SYNC) == 0)
|
||||
@@ -1182,21 +1189,17 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
printFrameSync (opts, state, "+EDACS", synctest_pos + 1, modulation);
|
||||
state->lastsynctype = 37;
|
||||
state->lastsynctype = 37;
|
||||
return (37);
|
||||
}
|
||||
else if ((strcmp (synctest48, DOTTING_SEQUENCE_A) == 0) || (strcmp (synctest48, DOTTING_SEQUENCE_B) == 0))
|
||||
{
|
||||
//only print and execute Dotting Sequence if Trunking and Tuned so we don't get multiple prints on this
|
||||
if (opts->p25_trunk == 1 && opts->p25_is_tuned == 1)
|
||||
{
|
||||
printFrameSync (opts, state, " EDACS DOTTING SEQUENCE: ", synctest_pos + 1, modulation);
|
||||
eot_cc (opts, state);
|
||||
}
|
||||
printFrameSync (opts, state, " EDACS DOTTING SEQUENCE: ", synctest_pos + 1, modulation);
|
||||
eot_cc (opts, state);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
|
||||
else if (opts->frame_dstar == 1)
|
||||
{
|
||||
if (strcmp (synctest, DSTAR_SYNC) == 0)
|
||||
@@ -1205,10 +1208,10 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
sprintf (state->ftype, "DSTAR ");
|
||||
sprintf (state->ftype, "D-STAR ");
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameSync (opts, state, "+DSTAR VOICE ", synctest_pos + 1, modulation);
|
||||
printFrameSync (opts, state, "+D-STAR ", synctest_pos + 1, modulation);
|
||||
}
|
||||
state->lastsynctype = 6;
|
||||
return (6);
|
||||
@@ -1219,10 +1222,10 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
sprintf (state->ftype, "DSTAR ");
|
||||
sprintf (state->ftype, "D-STAR ");
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameSync (opts, state, "-DSTAR VOICE ", synctest_pos + 1, modulation);
|
||||
printFrameSync (opts, state, "-D-STAR ", synctest_pos + 1, modulation);
|
||||
}
|
||||
state->lastsynctype = 7;
|
||||
return (7);
|
||||
@@ -1233,10 +1236,10 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
sprintf (state->ftype, "DSTAR_HD ");
|
||||
sprintf (state->ftype, "D-STAR_HD ");
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameSync (opts, state, "+DSTAR HEADER", synctest_pos + 1, modulation);
|
||||
printFrameSync (opts, state, "+D-STAR_HD ", synctest_pos + 1, modulation);
|
||||
}
|
||||
state->lastsynctype = 18;
|
||||
return (18);
|
||||
@@ -1247,10 +1250,10 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
sprintf (state->ftype, " DSTAR_HD");
|
||||
sprintf (state->ftype, " D-STAR_HD");
|
||||
if (opts->errorbars == 1)
|
||||
{
|
||||
printFrameSync (opts, state, "-DSTAR HEADER", synctest_pos + 1, modulation);
|
||||
printFrameSync (opts, state, "-D-STAR_HD ", synctest_pos + 1, modulation);
|
||||
}
|
||||
state->lastsynctype = 19;
|
||||
return (19);
|
||||
@@ -1268,14 +1271,14 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
|| (strcmp (synctest10, "3131331111") == 0 )
|
||||
|| (strcmp (synctest10, "3331331111") == 0 )
|
||||
|| (strcmp (synctest10, "3131311131") == 0 ) //First few FSW on NXDN48 Type-C seems to hit this for some reason
|
||||
|
||||
|
||||
)
|
||||
{
|
||||
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
if (state->lastsynctype == 28)
|
||||
if (state->lastsynctype == 28)
|
||||
{
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
return (28);
|
||||
@@ -1283,21 +1286,21 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
state->lastsynctype = 28;
|
||||
}
|
||||
|
||||
else if (
|
||||
|
||||
else if (
|
||||
|
||||
(strcmp (synctest10, "1313113313") == 0 )
|
||||
|| (strcmp (synctest10, "1113113313") == 0 )
|
||||
|| (strcmp (synctest10, "1313113333") == 0 )
|
||||
|| (strcmp (synctest10, "1113113333") == 0 )
|
||||
|| (strcmp (synctest10, "1313133313") == 0 )
|
||||
|
||||
|
||||
)
|
||||
{
|
||||
|
||||
state->offset = synctest_pos;
|
||||
state->max = ((state->max) + lmax) / 2;
|
||||
state->min = ((state->min) + lmin) / 2;
|
||||
if (state->lastsynctype == 29)
|
||||
if (state->lastsynctype == 29)
|
||||
{
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
return (29);
|
||||
@@ -1310,7 +1313,7 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
#ifdef PVCONVENTIONAL
|
||||
if (opts->frame_provoice == 1)
|
||||
{
|
||||
memset (synctest32, 0, sizeof(synctest32));
|
||||
memset (synctest32, 0, sizeof(synctest32));
|
||||
strncpy (synctest32, (synctest_p - 31), 16); //short sync grab here on 32
|
||||
char pvc_txs[9]; //string (symbol) value of TX Address
|
||||
char pvc_rxs[9]; //string (symbol) value of RX Address
|
||||
@@ -1425,18 +1428,18 @@ getFrameSync (dsd_opts * opts, dsd_state * state)
|
||||
if ((opts->errorbars == 1) && (opts->verbose > 1) && (state->carrier == 1))
|
||||
{
|
||||
fprintf (stderr,"Sync: no sync\n");
|
||||
// fprintf (stderr,"Press CTRL + C to close.\n");
|
||||
// fprintf (stderr,"Press CTRL + C to close.\n");
|
||||
|
||||
}
|
||||
noCarrier (opts, state);
|
||||
|
||||
return (-1);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
return (-1);
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
837
src/dsd_gps.c
837
src/dsd_gps.c
@@ -1,837 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_gps.c
|
||||
* GPS Handling Functions for Various Protocols
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2023-12 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
void lip_protocol_decoder (dsd_opts * opts, dsd_state * state, uint8_t * input)
|
||||
{
|
||||
//NOTE: This is defined in ETSI TS 102 361-4 V1.12.1 (2023-07) p208
|
||||
//6.6.11.3.2 USBD Polling Service Poll Response PDU for LIP (That's a mouthful)
|
||||
|
||||
int slot = state->currentslot;
|
||||
|
||||
//May need to set this in the UDT header, or pass it into this function to be sure
|
||||
// uint32_t src = 0;
|
||||
// if (slot == 0)
|
||||
// src = state->lastsrc;
|
||||
// else src = state->lastsrcR;
|
||||
|
||||
//NOTE: This format is pretty much the same as DMR EMB GPS, but has a few extra elements,
|
||||
//so I got lazy and just lifted most of the code from there, also assuming same lat/lon calcs
|
||||
//since those have been tested to work in DMR EMB GPS and units are same in LIP
|
||||
|
||||
fprintf (stderr, "Location Information Protocol; ");
|
||||
|
||||
// uint8_t service_type = (uint8_t)ConvertBitIntoBytes(&input[0], 4); //checked before arrival here
|
||||
uint8_t time_elapsed = (uint8_t)ConvertBitIntoBytes(&input[6], 2);
|
||||
uint8_t lon_sign = input[8];
|
||||
uint32_t lon = (uint32_t)ConvertBitIntoBytes(&input[9], 24); //8, 25
|
||||
uint8_t lat_sign = input[33];
|
||||
uint32_t lat = (uint32_t)ConvertBitIntoBytes(&input[34], 23); //33, 24
|
||||
uint8_t pos_err = (uint8_t)ConvertBitIntoBytes(&input[57], 2);
|
||||
uint8_t hor_vel = (uint8_t)ConvertBitIntoBytes(&input[59], 7);
|
||||
uint8_t dir_tra = (uint8_t)ConvertBitIntoBytes(&input[66], 4);
|
||||
uint8_t reason = (uint8_t)ConvertBitIntoBytes(&input[70], 3);
|
||||
uint8_t add_hash = (uint8_t)ConvertBitIntoBytes(&input[73], 8); //MS Source Address Hash
|
||||
|
||||
//NOTE: May need to use double instead of float to avoid rounding errors
|
||||
double latitude, longitude = 0.0f;
|
||||
double lat_unit = (double)180/ pow (2.0, 24); //180 divided by 2^24 -- 6.3.30
|
||||
double lon_unit = (double)360/ pow (2.0, 25); //360 divided by 2^25 -- 6.3.50
|
||||
double lon_sf = 1.0f; //float value we can multiple longitude with
|
||||
double lat_sf = 1.0f; //float value we can multiple latitude with
|
||||
|
||||
char latstr[3];
|
||||
char lonstr[3];
|
||||
sprintf (latstr, "%s", "N");
|
||||
sprintf (lonstr, "%s", "E");
|
||||
|
||||
char deg_glyph[4];
|
||||
sprintf (deg_glyph, "%s", "°");
|
||||
|
||||
//lat and lon calculations
|
||||
if (lat_sign)
|
||||
{
|
||||
lat = 0x800001 - lat;
|
||||
sprintf (latstr, "%s", "S");
|
||||
lat_sf = -1.0f;
|
||||
}
|
||||
latitude = ((double)lat * lat_unit);
|
||||
|
||||
if (lon_sign)
|
||||
{
|
||||
lon = 0x1000001 - lon;
|
||||
sprintf (lonstr, "%s", "W");
|
||||
lon_sf = -1.0f;
|
||||
}
|
||||
longitude = ((double)lon * lon_unit);
|
||||
|
||||
//6.3.63 Position Error
|
||||
//6.3.17 Horizontal velocity
|
||||
/*
|
||||
Horizontal velocity shall be encoded for speeds 0 km/h to 28 km/h in 1 km/h steps and
|
||||
from 28 km/h onwards using equation: v = C × (1 + x)^(K-A) + B where:
|
||||
*/
|
||||
float v = 0.0f;
|
||||
float C = 16.0f;
|
||||
float x = 0.038f;
|
||||
float A = 13.0f;
|
||||
float K = (float)hor_vel;
|
||||
float B = 0.0f;
|
||||
|
||||
if (hor_vel > 28)
|
||||
v = C * (pow(1+x, K-A)) + B; //I think this pow function is set up correctly
|
||||
else v = (float)hor_vel;
|
||||
|
||||
float dir = (((float)dir_tra + 11.25f)/22.5f); //page 68, Table 6.45
|
||||
|
||||
//truncated and rounded forms
|
||||
int vt = (int)v;
|
||||
int dt = (int)dir;
|
||||
|
||||
//sanity check
|
||||
if (fabs (latitude) < 90 && fabs(longitude) < 180)
|
||||
{
|
||||
fprintf (stderr, "Src(Hash); %03d; Lat: %.5lf%s%s Lon: %.5lf%s%s (%.5lf, %.5lf); Spd: %d km/h; Dir: %d%s",add_hash, latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr, lat_sf * latitude, lon_sf * longitude, vt, dt, deg_glyph);
|
||||
|
||||
//6.3.63 Position Error
|
||||
uint16_t position_error = 2 * pow(10, pos_err); //2 * 10^pos_err
|
||||
if (pos_err == 0x7 ) fprintf (stderr, "\n Position Error: Unknown or Invalid;");
|
||||
else fprintf (stderr, "\n Position Error: Less than %dm;", position_error);
|
||||
|
||||
//Reason For Sending 6.6.11.3.3 Table 6.80
|
||||
if (reason) fprintf (stderr, " Reserved: %d;", reason);
|
||||
else fprintf (stderr, " Request Response; ");
|
||||
|
||||
//6.3.78 Time elapsed
|
||||
if (time_elapsed == 0) fprintf (stderr, " TE: < 5s;");
|
||||
if (time_elapsed == 1) fprintf (stderr, " TE: < 5m;");
|
||||
if (time_elapsed == 2) fprintf (stderr, " TE: < 30m;");
|
||||
if (time_elapsed == 3) fprintf (stderr, " TE: NA or UNK;"); //not applicable or unknown
|
||||
|
||||
//save to array for ncurses
|
||||
if (pos_err != 0x7)
|
||||
{
|
||||
sprintf (state->dmr_embedded_gps[slot], "%03d; LIP: %.5lf%s%s %.5lf%s%s; Err: %dm; Spd: %d km/h; Dir: %d%s", add_hash, latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr, position_error, vt, dt, deg_glyph);
|
||||
}
|
||||
else sprintf (state->dmr_embedded_gps[slot], "%03d; LIP: %.5lf%s%s %.5lf%s%s Unknown Pos Err; Spd: %d km/h; Dir %d%s", add_hash, latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr, vt, dt, deg_glyph);
|
||||
|
||||
//save to event history string
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].gps_s, "%s", state->dmr_embedded_gps[slot]);
|
||||
|
||||
//save to LRRP report for mapping/logging
|
||||
FILE * pFile; //file pointer
|
||||
if (opts->lrrp_file_output == 1)
|
||||
{
|
||||
|
||||
char * datestr = getDate();
|
||||
char * timestr = getTime();
|
||||
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->lrrp_out_file, "a");
|
||||
fprintf (pFile, "%s\t", datestr );
|
||||
fprintf (pFile, "%s\t", timestr );
|
||||
fprintf (pFile, "%08d\t", add_hash);
|
||||
fprintf (pFile, "%.5lf\t", latitude);
|
||||
fprintf (pFile, "%.5lf\t", longitude);
|
||||
fprintf (pFile, "%d\t", vt); //speed in km/h
|
||||
fprintf (pFile, "%d\t", dt); //direction of travel
|
||||
fprintf (pFile, "\n");
|
||||
fclose (pFile);
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
else fprintf (stderr, " Position Calculation Error;");
|
||||
|
||||
}
|
||||
|
||||
void nmea_iec_61162_1 (dsd_opts * opts, dsd_state * state, uint8_t * input, uint32_t src, int type)
|
||||
{
|
||||
int slot = state->currentslot;
|
||||
|
||||
//NOTE: The Only difference between Short (type == 1) and Long Format (type == 2)
|
||||
//is the utc_ss3 on short vs utc_ss6 and inclusion of COG value on long
|
||||
|
||||
//NOTE: MFID Specific Formats are not handled here, unknown, could be added if worked out
|
||||
//they could share most of the same elements and use the large spare bits in block 2 for extra
|
||||
// uint8_t mfid = (uint8_t)ConvertBitIntoBytes(&input[88], 8); //on type 3, last octet of first block carries MFID
|
||||
|
||||
// uint8_t nmea_c = input[0]; //encrypted -- checked before we get here
|
||||
uint8_t nmea_ns = input[1]; //north/south (lat sign)
|
||||
uint8_t nmea_ew = input[2]; //east/west (lon sign)
|
||||
uint8_t nmea_q = input[3]; //Quality Indicator (no fix or fix valid)
|
||||
uint8_t nmea_speed = (uint8_t)ConvertBitIntoBytes(&input[4], 7); //speed in knots (127 = greater than 126 knots)
|
||||
|
||||
//Latitude Bits
|
||||
uint8_t nmea_ndeg = (uint8_t)ConvertBitIntoBytes(&input[11], 7); //Latitude Degrees
|
||||
uint8_t nmea_nmin = (uint8_t)ConvertBitIntoBytes(&input[18], 6); //Latitude Minutes
|
||||
uint16_t nmea_nminf = (uint16_t)ConvertBitIntoBytes(&input[24], 14); //Latitude Fractions of Minutes
|
||||
|
||||
//Longitude Bits
|
||||
uint8_t nmea_edeg = (uint8_t)ConvertBitIntoBytes(&input[38], 8); //Longitude Degrees
|
||||
uint8_t nmea_emin = (uint8_t)ConvertBitIntoBytes(&input[46], 6); //Longitude Minutes
|
||||
uint16_t nmea_eminf = (uint16_t)ConvertBitIntoBytes(&input[52], 14); //Longitude Fractions of Minutes
|
||||
|
||||
//UTC Time and COG
|
||||
uint8_t nmea_utc_hh = (uint8_t)ConvertBitIntoBytes(&input[66], 5);
|
||||
uint8_t nmea_utc_mm = (uint8_t)ConvertBitIntoBytes(&input[71], 6);
|
||||
//seconds and the addition of COG is the difference between short and long formats
|
||||
uint8_t nmea_utc_ss3 = (uint8_t)ConvertBitIntoBytes(&input[77], 3) * 10; //seconds in 10s
|
||||
uint8_t nmea_utc_ss6 = (uint8_t)ConvertBitIntoBytes(&input[77], 6); //seconds in 1s
|
||||
uint16_t nmea_cog = (uint16_t)ConvertBitIntoBytes(&input[103], 9); //course over ground in degrees
|
||||
|
||||
//lat and lon conversion
|
||||
char deg_glyph[4];
|
||||
sprintf (deg_glyph, "%s", "°");
|
||||
float latitude = 0.0f;
|
||||
float longitude = 0.0f;
|
||||
// float m_unit = 1.0f / 60.0f; //unit to convert min into decimal value - (1/60)*60 minutes = 1 degree
|
||||
// float mm_unit = 1.0f / 10000.0f; //unit to convert minf into decimal value - (0000 - 9999) 0.0001×9999 = .9999 minutes, so its sub 1 minute decimal
|
||||
|
||||
//testing w/ Harris NMEA like values (ran tests over there with this code, this seems to work on those values)
|
||||
float m_unit = 1.0f / 60.0f; //unit to convert min into decimal value - (1/60)*60 minutes = 1 degree
|
||||
float mm_unit = 1.0f / 600000.0f; //unit to convert minf into decimal value - (0000 - 9999) 0.0001×9999 = .9999 minutes, so its sub 1 minute decimal
|
||||
|
||||
//speed conversion
|
||||
float fmps, fmph, fkph = 0.0f; //conversion of knots to mps, kph, and mph values
|
||||
fmps = (float)nmea_speed * 0.514444; UNUSED(fmps);
|
||||
fmph = (float)nmea_speed * 1.15078f; UNUSED(fmph);
|
||||
fkph = (float)nmea_speed * 1.852f;
|
||||
|
||||
//calculate decimal representation of latidude and longitude (need some samples to test)
|
||||
latitude = ( (float)nmea_ndeg + ((float)nmea_nmin*m_unit) + ((float)nmea_nminf*mm_unit) );
|
||||
longitude = ( (float)nmea_edeg + ((float)nmea_emin*m_unit) + ((float)nmea_eminf*mm_unit) );
|
||||
|
||||
if (!nmea_ns) latitude *= -1.0f; //0 is South, 1 is North
|
||||
if (!nmea_ew) longitude *= -1.0f; //0 is West, 1 is East
|
||||
|
||||
fprintf (stderr, " GPS: %f%s, %f%s;", latitude, deg_glyph, longitude, deg_glyph);
|
||||
|
||||
//Speed in Knots
|
||||
if (nmea_speed > 126)
|
||||
fprintf (stderr, " SPD > 126 knots or %f kph;", fkph);
|
||||
else
|
||||
fprintf (stderr, " SPD: %d knots; %f kph;", nmea_speed, fkph);
|
||||
|
||||
//Print UTC Time and COG according to Format Type
|
||||
if (type == 1)
|
||||
fprintf (stderr, " FIX: %d; %02d:%02d:%02d UTC; Short Format;", nmea_q, nmea_utc_hh, nmea_utc_mm, nmea_utc_ss3);
|
||||
if (type == 2)
|
||||
fprintf (stderr, " FIX: %d; %02d:%02d:%02d UTC; COG: %d%s; Long Format;", nmea_q, nmea_utc_hh, nmea_utc_mm, nmea_utc_ss6, nmea_cog, deg_glyph);
|
||||
|
||||
//save to ncurses string
|
||||
sprintf (state->dmr_embedded_gps[slot], "GPS: (%f%s, %f%s)", latitude, deg_glyph, longitude, deg_glyph);
|
||||
|
||||
//save to event history string
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].gps_s, "(%f%s, %f%s)", latitude, deg_glyph, longitude, deg_glyph);
|
||||
|
||||
//save to LRRP report for mapping/logging
|
||||
FILE * pFile; //file pointer
|
||||
if (opts->lrrp_file_output == 1)
|
||||
{
|
||||
|
||||
char * datestr = getDate();
|
||||
char * timestr = getTime();
|
||||
|
||||
int s = (int)fkph; //rounded interger format for the log report
|
||||
int a = 0;
|
||||
if (type == 2)
|
||||
a = nmea_cog; //long format only
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->lrrp_out_file, "a");
|
||||
fprintf (pFile, "%s\t", datestr );
|
||||
fprintf (pFile, "%s\t", timestr ); //could switch to UTC time if desired, but would require local user offset
|
||||
fprintf (pFile, "%08d\t", src);
|
||||
fprintf (pFile, "%.6lf\t", latitude);
|
||||
fprintf (pFile, "%.6lf\t", longitude);
|
||||
fprintf (pFile, "%d\t ", s);
|
||||
fprintf (pFile, "%d\t ", a);
|
||||
fprintf (pFile, "\n");
|
||||
fclose (pFile);
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//restructured the Harris GPS to flow more like the DMR UDT NMEA Format when possible
|
||||
void nmea_harris (dsd_opts * opts, dsd_state * state, uint8_t * input, uint32_t src, int slot)
|
||||
{
|
||||
|
||||
//GPS working, Time Working (old method), COG and Speed are logical on due west sample
|
||||
//TODO: Fiddle/Test various ns and ew bits for proper signs in case its located elsewhere
|
||||
//UPDATE: Found two contiguous bits that always work on all my accumulated samples
|
||||
//the bits also place it with the 'lone' flagged bit observed prior
|
||||
|
||||
uint8_t nmea_ns = input[88]; //north/south (lat sign) //72 previously used bit
|
||||
uint8_t nmea_ew = input[89]; //east/west (lon sign) //88 previously used bit
|
||||
uint8_t nmea_q = input[147]; //Quality Indicator (last fix or current fix)
|
||||
// uint8_t nmea_speed = (uint8_t)ConvertBitIntoBytes(&input[129], 7); //129,7
|
||||
uint8_t nmea_speed = (uint8_t)ConvertBitIntoBytes(&input[129], 6); //this is one bit shorter than called for, but I believe it works
|
||||
|
||||
//Latitude Bits
|
||||
uint8_t nmea_ndeg = (uint8_t)ConvertBitIntoBytes(&input[65], 7); //Latitude Degrees
|
||||
uint8_t nmea_nmin = (uint8_t)ConvertBitIntoBytes(&input[58], 6); //Latitude Minutes
|
||||
uint16_t nmea_nminf = (uint16_t)ConvertBitIntoBytes(&input[42], 14); //Latitude Fractions of Minutes
|
||||
|
||||
//Longitude Bits
|
||||
uint8_t nmea_edeg = (uint8_t)ConvertBitIntoBytes(&input[96], 8); //Longitude Degrees
|
||||
uint8_t nmea_emin = (uint8_t)ConvertBitIntoBytes(&input[90], 6); //Longitude Minutes
|
||||
uint16_t nmea_eminf = (uint16_t)ConvertBitIntoBytes(&input[74], 14); //Longitude Fractions of Minutes
|
||||
|
||||
//NOTE: Removed UTC hh.mm.ss6 format found in DMR UDT, could not make it work
|
||||
//with bits already established for time and it works extremely well as is
|
||||
|
||||
//Course Over Ground in Degrees (0-360)
|
||||
uint16_t nmea_cog = (uint16_t)ConvertBitIntoBytes(&input[135], 9) % 360; //course over ground in degrees //working on due west sample without %360
|
||||
|
||||
//timestamp (16-bit value w/ appended 17th bit to MSB)
|
||||
uint32_t rtime = (uint32_t)ConvertBitIntoBytes(&input[104], 16);
|
||||
rtime |= input[144] << 16; //this bit is flagged on after 0xFFFF rollover in the late afternoon
|
||||
uint32_t thour = rtime / 3600;
|
||||
uint32_t tmin = (rtime % 3600) / 60;
|
||||
uint32_t tsec = (rtime % 3600) % 60;
|
||||
|
||||
//lat and lon conversion
|
||||
char deg_glyph[4];
|
||||
sprintf (deg_glyph, "%s", "°");
|
||||
float latitude = 0.0f;
|
||||
float longitude = 0.0f;
|
||||
float m_unit = 1.0f / 60.0f;
|
||||
float mm_unit = 1.0f / 600000.0f;
|
||||
|
||||
//speed conversion
|
||||
float fmps, fmph, fkph = 0.0f; //conversion of knots to mps, kph, and mph values
|
||||
fmps = (float)nmea_speed * 0.514444; UNUSED(fmps);
|
||||
fmph = (float)nmea_speed * 1.15078f; UNUSED(fmph);
|
||||
fkph = (float)nmea_speed * 1.852f; UNUSED(fkph);
|
||||
|
||||
//calculate decimal representation of latidude and longitude (need some samples to test)
|
||||
latitude = ( (float)nmea_ndeg + ((float)nmea_nmin*m_unit) + ((float)nmea_nminf*mm_unit) );
|
||||
longitude = ( (float)nmea_edeg + ((float)nmea_emin*m_unit) + ((float)nmea_eminf*mm_unit) );
|
||||
|
||||
//This is opposite (seemingly) compared to the version specified by DMR UDT NMEA, could still be different bits involved (to be tested)
|
||||
// if (nmea_ns) latitude *= -1.0f; //1 is South, 0 is North
|
||||
// if (nmea_ew) longitude *= -1.0f; //1 is West, 0 is East
|
||||
|
||||
//DMR UDT NMEA original version (working now with new bit selection 88 and 89 like how DMR UDT NMEA format specifies)
|
||||
if (!nmea_ns) latitude *= -1.0f; //0 is South, 1 is North
|
||||
if (!nmea_ew) longitude *= -1.0f; //0 is West, 1 is East
|
||||
|
||||
//is this from LCW, or MAC?
|
||||
uint16_t header = (uint16_t)ConvertBitIntoBytes(&input[0], 16);
|
||||
|
||||
fprintf (stderr, "\n");
|
||||
if (header == 0x2AA4)
|
||||
fprintf (stderr, " SRC: %08d;", src);
|
||||
else
|
||||
fprintf (stderr, " VCH: %d - SRC: %08d;", slot, src);
|
||||
fprintf (stderr, " GPS: %f%s, %f%s;", latitude, deg_glyph, longitude, deg_glyph);
|
||||
|
||||
//Speed in Knots (assuming in knots, and not in mps, or kph)
|
||||
if (header != 0x2AA4) //can't yet verify this is present or accurate on LCW
|
||||
{
|
||||
if (nmea_speed > 126)
|
||||
fprintf (stderr, " SPD > 126 knots or %f MPH;", fmph); //using MPH here, its Harris, they're in the U.S.
|
||||
else
|
||||
fprintf (stderr, " SPD: %d knots; %f MPH;", nmea_speed, fmph);
|
||||
}
|
||||
|
||||
//Course Over Ground (COG)
|
||||
fprintf (stderr, " COG: %03d%s;", nmea_cog, deg_glyph); //%360
|
||||
|
||||
//debug speed
|
||||
// fprintf (stderr, " RSPD: %02X;", nmea_speed);
|
||||
|
||||
//debug cog
|
||||
// fprintf (stderr, " RCOG: %03X;", nmea_cog >> 0);
|
||||
|
||||
//UTC Time
|
||||
fprintf (stderr, " T: %02d:%02d:%02d UTC;", thour, tmin, tsec);
|
||||
|
||||
//Fix Indicator
|
||||
if (nmea_q) fprintf (stderr, " Current Fix;");
|
||||
else fprintf (stderr, " Last Fix;");
|
||||
|
||||
//save to ncurses string
|
||||
sprintf (state->dmr_embedded_gps[slot], "(%f%s, %f%s)", latitude, deg_glyph, longitude, deg_glyph);
|
||||
|
||||
//save to event history string
|
||||
if (state->event_history_s[slot].Event_History_Items[0].source_id == src && src != 0)
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].gps_s, "%s", state->dmr_embedded_gps[slot]);
|
||||
|
||||
//save to LRRP report for mapping/logging
|
||||
FILE * pFile; //file pointer
|
||||
if (opts->lrrp_file_output == 1)
|
||||
{
|
||||
|
||||
char * datestr = getDate();
|
||||
char * timestr = getTime();
|
||||
|
||||
//rounded interger formats for the log report
|
||||
int s = (int)fkph;
|
||||
int a = nmea_cog;
|
||||
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->lrrp_out_file, "a");
|
||||
fprintf (pFile, "%s\t", datestr );
|
||||
fprintf (pFile, "%s\t", timestr ); //could switch to UTC time on PDU if desired
|
||||
fprintf (pFile, "%08d\t", src);
|
||||
fprintf (pFile, "%.6lf\t", latitude);
|
||||
fprintf (pFile, "%.6lf\t", longitude);
|
||||
fprintf (pFile, "%d\t ", s);
|
||||
fprintf (pFile, "%d\t ", a);
|
||||
fprintf (pFile, "\n");
|
||||
fclose (pFile);
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//NOTE: There seems to be a few more octets left undecoded in this PDU
|
||||
//not including the CRC obviously, unsure of their meaning, could relate
|
||||
//to other GPS functions like precision, etc, unknown.
|
||||
|
||||
//NOTE2: All these values are just best effort based on observation and
|
||||
//making map points match using logic and distance over time for speed and course
|
||||
//without any documentation, any of these values may still be wrong
|
||||
|
||||
}
|
||||
|
||||
//fallback version (if desired/required)
|
||||
void harris_gps(dsd_opts * opts, dsd_state * state, int slot, uint8_t * input)
|
||||
{
|
||||
|
||||
uint8_t lat_sign, lat_deg, lat_min = 0;
|
||||
uint8_t lon_sign, lon_deg, lon_min = 0;
|
||||
uint16_t lat_mmin = 0;
|
||||
uint16_t lon_mmin = 0;
|
||||
|
||||
//potentially in this PDU, but unverifiable without documentation or reasonable
|
||||
//mathematical proof vs map points and direction of travel / distance over time (assuming the radio is facing that direction)
|
||||
uint16_t rspeed = (uint16_t)ConvertBitIntoBytes(&input[136], 8); //MSB //136
|
||||
rspeed = (rspeed << 8) + (uint16_t)ConvertBitIntoBytes(&input[128], 8); //LSB //128
|
||||
|
||||
//this works okay for example of driver driving due west at the speed limit of the road (fluke?)
|
||||
uint16_t rangle = (uint16_t)ConvertBitIntoBytes(&input[120], 8); //120,8
|
||||
float fspeed = (float)rspeed;
|
||||
float fangle = (float)rangle;
|
||||
|
||||
fspeed /= 255.0f; //unit value of 1 bit
|
||||
fspeed *= 1.56f; //this is based on an observation of a driver moving approx 210 meters in about 8 seconds and this makes it just under the speed limit on the road there
|
||||
// fangle *= 360.0f/255.0f; //unit value of 1 bit
|
||||
fangle *= 2.0f; //may exceed 360 degrees as is (use %)
|
||||
|
||||
int s, a = 0;
|
||||
s = (int)fspeed * 3.6;
|
||||
a = (int)fangle % 360;
|
||||
|
||||
//fix and quality indicators?
|
||||
uint8_t fix = input[147]; UNUSED(fix);
|
||||
uint8_t quality = (uint16_t)ConvertBitIntoBytes(&input[148], 3); UNUSED(quality);
|
||||
|
||||
//timestamp (16-bit value w/ appended 17th bit to MSB)
|
||||
uint32_t rtime = (uint32_t)ConvertBitIntoBytes(&input[104], 16); //seconds since midnight since last GPS fix (whatever the radio has as internal time)
|
||||
rtime |= input[144] << 16; //test appending this as bit 17 (observed this bit set after the afternoon 0xFFFF rollover)
|
||||
uint32_t thour = rtime / 3600;
|
||||
uint32_t tmin = (rtime % 3600) / 60;
|
||||
uint32_t tsec = (rtime % 3600) % 60;
|
||||
|
||||
float lat_dec = 0.0f;
|
||||
float lon_dec = 0.0f;
|
||||
|
||||
char deg_glyph[4];
|
||||
sprintf (deg_glyph, "%s", "°");
|
||||
|
||||
//This appears to be similar to the NMEA GPGGA format (DDmm.mm) but
|
||||
//octets are ordered in least significant to most significant value
|
||||
lat_mmin = (uint16_t)ConvertBitIntoBytes(&input[40], 16); //? bits required, but grabbing two octets
|
||||
lat_min = (uint8_t)ConvertBitIntoBytes(&input[58], 6); //6 bits required to get 60
|
||||
lat_deg = (uint8_t)ConvertBitIntoBytes(&input[65], 7); //7 bits required to get 90
|
||||
lat_sign = input[72]; //64
|
||||
|
||||
lon_mmin = (uint16_t)ConvertBitIntoBytes(&input[72], 16); //? bits required, but grabbing two octets
|
||||
lon_min = (uint8_t)ConvertBitIntoBytes(&input[90], 6); //6 bits required to get 60
|
||||
lon_deg = (uint8_t)ConvertBitIntoBytes(&input[96], 8); //8 bits required to get 180
|
||||
lon_sign = input[88]; //88, unsure of a correct location, but on the sample with 0 minutes, this lonely bit was flagged on
|
||||
|
||||
int src = 0;
|
||||
if (slot == 0) src = state->lastsrc;
|
||||
if (slot == 1) src = state->lastsrcR;
|
||||
|
||||
//calculate decimal representation (was a pain to figure out the sub minute values)
|
||||
lat_dec = ( (float)lat_deg + ((float)lat_min/60.0f) + ((float)lat_mmin/600000.0f) );
|
||||
lon_dec = ( (float)lon_deg + ((float)lon_min/60.0f) + ((float)lon_mmin/600000.0f) );
|
||||
|
||||
if (lat_sign)
|
||||
lat_dec *= -1.0f;
|
||||
|
||||
if (lon_sign)
|
||||
lon_dec *= -1.0f;
|
||||
|
||||
//line break
|
||||
fprintf (stderr, "\n");
|
||||
fprintf (stderr, " GPS: %f%s, %f%s;", lat_dec, deg_glyph, lon_dec, deg_glyph);
|
||||
|
||||
//gps fix time
|
||||
// fprintf (stderr, " RT: %05X;", rtime); //debug
|
||||
fprintf (stderr, " LTS: %02d:%02d:%02d UTC;", thour, tmin, tsec); //last time synced to GPS
|
||||
|
||||
//speed and direction
|
||||
// fprintf (stderr, " RSPD: %04X;", rspeed); //debug
|
||||
// fprintf (stderr, " RANG: %02X;", rangle); //debug
|
||||
// fprintf (stderr, " MPS: %06.02f;", fspeed);
|
||||
// fprintf (stderr, " KPH: %06.02f;", fspeed * 3.6f);
|
||||
// fprintf (stderr, " MPH: %06.02f;", fspeed * 2.2369f);
|
||||
fprintf (stderr, " DIR: %03d%s;", a, deg_glyph);
|
||||
|
||||
// fprintf (stderr, " FIX: %d", fix);
|
||||
// fprintf (stderr, " QLT: %02d", quality);
|
||||
|
||||
// fprintf (stderr, " SRC: %08d;", src);
|
||||
|
||||
//save to array for ncurses
|
||||
sprintf (state->dmr_embedded_gps[slot], "GPS: (%f%s, %f%s)", lat_dec, deg_glyph, lon_dec, deg_glyph);
|
||||
|
||||
//save to LRRP report for mapping/logging
|
||||
FILE * pFile; //file pointer
|
||||
if (opts->lrrp_file_output == 1)
|
||||
{
|
||||
|
||||
char * datestr = getDate();
|
||||
char * timestr = getTime();
|
||||
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->lrrp_out_file, "a");
|
||||
fprintf (pFile, "%s\t", datestr );
|
||||
fprintf (pFile, "%s\t", timestr );
|
||||
fprintf (pFile, "%08d\t", src);
|
||||
fprintf (pFile, "%.6lf\t", lat_dec);
|
||||
fprintf (pFile, "%.6lf\t", lon_dec);
|
||||
fprintf (pFile, "%d\t ", s);
|
||||
fprintf (pFile, "%d\t ", a);
|
||||
fprintf (pFile, "\n");
|
||||
fclose (pFile);
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//NOTE: Thanks to DSheirer (SDRTrunk) for helping me work out a few of the things in here
|
||||
//not entirely convinced on some of these calcs (speed, angle, and TS) but sure these bits
|
||||
//are actual speed/direction/timestamps judging from what the coordinates show on a map
|
||||
}
|
||||
|
||||
//externalize embedded GPS - Confirmed working now on NE, NW, SE, and SW coordinates
|
||||
void dmr_embedded_gps (dsd_opts * opts, dsd_state * state, uint8_t lc_bits[])
|
||||
{
|
||||
UNUSED(opts);
|
||||
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Embedded GPS:");
|
||||
uint8_t slot = state->currentslot;
|
||||
uint8_t pf = lc_bits[0];
|
||||
uint8_t res_a = lc_bits[1];
|
||||
uint8_t res_b = (uint8_t)ConvertBitIntoBytes(&lc_bits[16], 4);
|
||||
uint8_t pos_err = (uint8_t)ConvertBitIntoBytes(&lc_bits[20], 3);
|
||||
UNUSED2(res_a, res_b);
|
||||
|
||||
char deg_glyph[4];
|
||||
sprintf (deg_glyph, "%s", "°");
|
||||
|
||||
uint32_t lon_sign = lc_bits[23];
|
||||
uint32_t lon = (uint32_t)ConvertBitIntoBytes(&lc_bits[24], 24);
|
||||
uint32_t lat_sign = lc_bits[48];
|
||||
uint32_t lat = (uint32_t)ConvertBitIntoBytes(&lc_bits[49], 23);
|
||||
double lon_sf = 1.0f; //float value we can multiple longitude with
|
||||
double lat_sf = 1.0f; //float value we can multiple latitude with
|
||||
|
||||
double lat_unit = (double)180/ pow (2.0, 24); //180 divided by 2^24
|
||||
double lon_unit = (double)360/ pow (2.0, 25); //360 divided by 2^25
|
||||
|
||||
char latstr[3];
|
||||
char lonstr[3];
|
||||
sprintf (latstr, "%s", "N");
|
||||
sprintf (lonstr, "%s", "E");
|
||||
|
||||
//run calculations and print
|
||||
//7.2.16 and 7.2.17 (two's compliment)
|
||||
|
||||
double latitude = 0;
|
||||
double longitude = 0;
|
||||
|
||||
if (pf) fprintf (stderr, " Protected");
|
||||
else
|
||||
{
|
||||
if (lat_sign)
|
||||
{
|
||||
lat = 0x800001 - lat;
|
||||
sprintf (latstr, "%s", "S");
|
||||
lat_sf = -1.0f;
|
||||
}
|
||||
latitude = ((double)lat * lat_unit);
|
||||
|
||||
if (lon_sign)
|
||||
{
|
||||
lon = 0x1000001 - lon;
|
||||
sprintf (lonstr, "%s", "W");
|
||||
lon_sf = -1.0f;
|
||||
}
|
||||
longitude = ((double)lon * lon_unit);
|
||||
|
||||
//sanity check
|
||||
if (fabs(latitude) < 90 && fabs(longitude) < 180)
|
||||
{
|
||||
fprintf (stderr, " Lat: %.5lf%s%s Lon: %.5lf%s%s (%.5lf, %.5lf)", latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr, lat_sf * latitude, lon_sf * longitude);
|
||||
|
||||
//7.2.15 Position Error
|
||||
uint16_t position_error = 2 * pow(10, pos_err); //2 * 10^pos_err
|
||||
if (pos_err == 0x7 ) fprintf (stderr, "\n Position Error: Unknown or Invalid");
|
||||
else fprintf (stderr, "\n Position Error: Less than %dm", position_error);
|
||||
|
||||
//save to array for ncurses
|
||||
if (pos_err != 0x7)
|
||||
{
|
||||
sprintf (state->dmr_embedded_gps[slot], "GPS: %.5lf%s%s %.5lf%s%s Err: %dm", latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr, position_error);
|
||||
}
|
||||
else sprintf (state->dmr_embedded_gps[slot], "GPS: %.5lf%s%s %.5lf%s%s Unknown Pos Err", latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr);
|
||||
|
||||
uint32_t src = 0;
|
||||
if (slot == 0) src = state->lasttg;
|
||||
if (slot == 1) src = state->lasttgR;
|
||||
|
||||
//save to event history string
|
||||
if (state->event_history_s[slot].Event_History_Items[0].source_id == src)
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].gps_s, "%s", state->dmr_embedded_gps[slot]);
|
||||
|
||||
//save to LRRP report for mapping/logging
|
||||
FILE * pFile; //file pointer
|
||||
if (opts->lrrp_file_output == 1)
|
||||
{
|
||||
|
||||
char * datestr = getDate();
|
||||
char * timestr = getTime();
|
||||
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->lrrp_out_file, "a");
|
||||
fprintf (pFile, "%s\t", datestr );
|
||||
fprintf (pFile, "%s\t", timestr );
|
||||
fprintf (pFile, "%08d\t", src);
|
||||
fprintf (pFile, "%.5lf\t", latitude);
|
||||
fprintf (pFile, "%.5lf\t", longitude);
|
||||
fprintf (pFile, "0\t " ); //zero for velocity
|
||||
fprintf (pFile, "0\t " ); //zero for azimuth
|
||||
fprintf (pFile, "\n");
|
||||
fclose (pFile);
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
//This Function needs testing, is tested working for NW and NE lat and
|
||||
//long coordinates, but not for SE and SW coordinates
|
||||
void apx_embedded_gps (dsd_opts * opts, dsd_state * state, uint8_t lc_bits[])
|
||||
{
|
||||
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " GPS:");
|
||||
uint8_t slot = state->currentslot;
|
||||
uint8_t pf = lc_bits[0];
|
||||
uint8_t res_a = lc_bits[1];
|
||||
uint8_t res_b = (uint8_t)ConvertBitIntoBytes(&lc_bits[16], 7);
|
||||
uint8_t expired = lc_bits[23]; //this bit seems to indicate that the GPS coordinates are out of date or fresh
|
||||
|
||||
char deg_glyph[4];
|
||||
sprintf (deg_glyph, "%s", "°");
|
||||
|
||||
uint32_t lon_sign = lc_bits[48];
|
||||
uint32_t lon = (uint32_t)ConvertBitIntoBytes(&lc_bits[49], 23);
|
||||
uint32_t lat_sign = lc_bits[24];
|
||||
uint32_t lat = (uint32_t)ConvertBitIntoBytes(&lc_bits[25], 23);
|
||||
|
||||
double lat_unit = 90.0f / 0x7FFFFF;
|
||||
double lon_unit = 180.0f / 0x7FFFFF;
|
||||
|
||||
char latstr[3];
|
||||
char lonstr[3];
|
||||
char valid[12];
|
||||
sprintf (latstr, "%s", "N");
|
||||
sprintf (lonstr, "%s", "E");
|
||||
sprintf (valid, "%s", "Current Fix");
|
||||
|
||||
double latitude = 0;
|
||||
double longitude = 0;
|
||||
|
||||
if (pf) fprintf (stderr, " Protected");
|
||||
else
|
||||
{
|
||||
|
||||
latitude = ((double)lat * lat_unit);
|
||||
if (lat_sign)
|
||||
{
|
||||
latitude -= 90.0f;
|
||||
sprintf (latstr, "%s", "S");
|
||||
}
|
||||
|
||||
longitude = ((double)lon * lon_unit);
|
||||
if (lon_sign)
|
||||
{
|
||||
longitude -= 180.0f;
|
||||
sprintf (lonstr, "%s", "W");
|
||||
}
|
||||
|
||||
//sanity check
|
||||
if (fabs ((float)latitude) < 90 && fabs((float)longitude) < 180)
|
||||
{
|
||||
fprintf (stderr, " Lat: %.5lf%s%s Lon: %.5lf%s%s (%.5lf, %.5lf) ", latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr, latitude, longitude);
|
||||
|
||||
if (expired)
|
||||
{
|
||||
fprintf (stderr, "Last Fix; ");
|
||||
sprintf (valid, "%s", "Last Fix");
|
||||
}
|
||||
else if (!expired)
|
||||
fprintf (stderr, "Current Fix; ");
|
||||
|
||||
if (res_a)
|
||||
fprintf (stderr, "RES_A: %d; ", res_a);
|
||||
|
||||
if (res_b)
|
||||
fprintf (stderr, "RES_B: %02X; ", res_b);
|
||||
|
||||
uint32_t src = 0;
|
||||
if (slot == 0) src = state->lastsrc;
|
||||
if (slot == 1) src = state->lastsrcR;
|
||||
|
||||
//save to array for ncurses
|
||||
sprintf (state->dmr_embedded_gps[slot], "GPS: %lf%s%s %lf%s%s (%lf, %lf) %s", latitude, deg_glyph, latstr, longitude, deg_glyph, lonstr, latitude, longitude, valid);
|
||||
|
||||
//save to event history string
|
||||
if (state->event_history_s[slot].Event_History_Items[0].source_id == src)
|
||||
sprintf (state->event_history_s[slot].Event_History_Items[0].gps_s, "%s", state->dmr_embedded_gps[slot]);
|
||||
|
||||
//save to LRRP report for mapping/logging
|
||||
FILE * pFile; //file pointer
|
||||
if (opts->lrrp_file_output == 1)
|
||||
{
|
||||
char * datestr = getDate();
|
||||
char * timestr = getTime();
|
||||
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->lrrp_out_file, "a");
|
||||
fprintf (pFile, "%s\t", datestr );
|
||||
fprintf (pFile, "%s\t", timestr );
|
||||
fprintf (pFile, "%08d\t", src);
|
||||
fprintf (pFile, "%.5lf\t", latitude);
|
||||
fprintf (pFile, "%.5lf\t", longitude);
|
||||
fprintf (pFile, "0\t " ); //zero for velocity
|
||||
fprintf (pFile, "0\t " ); //zero for azimuth
|
||||
fprintf (pFile, "\n");
|
||||
fclose (pFile);
|
||||
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
void decode_cellocator(dsd_opts * opts, dsd_state * state, uint8_t * input, int len)
|
||||
{
|
||||
//TODO: This
|
||||
UNUSED(opts);
|
||||
UNUSED(state);
|
||||
UNUSED(input);
|
||||
UNUSED(len);
|
||||
|
||||
//UTF8 Text: MCGP (0x4D434750) followed by data values
|
||||
//(0417D1050000F45FD1DD00010000000097BDD56C81000009AAAABF12864C)
|
||||
utf8_to_text(state, 0, 4, input);
|
||||
|
||||
fprintf (stderr, " Cellocator:");
|
||||
|
||||
uint8_t type = input[4];
|
||||
if (type == 1) fprintf (stderr, " Platform Manifest Data;");
|
||||
else if (type == 2) fprintf (stderr, " CAN Data;");
|
||||
else if (type == 3) fprintf (stderr, " CAN Trigger Data;");
|
||||
else if (type == 4) fprintf (stderr, " Time and Location Data;");
|
||||
else if (type == 5) fprintf (stderr, " Accelerometer Data;");
|
||||
else if (type == 6) fprintf (stderr, " PSP Alarm System Data;");
|
||||
else if (type == 7) fprintf (stderr, " Usage Counter Data;");
|
||||
else if (type == 8) fprintf (stderr, " Command Authentication Table Data;");
|
||||
else if (type == 9) fprintf (stderr, " GSM Neighbor List Data;");
|
||||
else if (type == 10) fprintf (stderr, " Maintenance Server Platform Manifest Data;");
|
||||
else fprintf (stderr, " Unknown Data;");
|
||||
|
||||
//Data afterwards appears to be an arbitrary len so has variable reporting data
|
||||
//will need to establish a len value for data and contents
|
||||
|
||||
}
|
||||
void decode_ars(dsd_opts * opts, dsd_state * state, uint8_t * input, int len)
|
||||
{
|
||||
//TODO: This
|
||||
UNUSED(opts);
|
||||
UNUSED(state);
|
||||
UNUSED(input);
|
||||
UNUSED(len);
|
||||
}
|
||||
@@ -5,8 +5,8 @@
|
||||
|
||||
int csvGroupImport(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
char filename[1024] = "filename.csv";
|
||||
sprintf (filename, "%s", opts->group_in_file);
|
||||
char filename[1024] = "filename.csv";
|
||||
sprintf (filename, "%s", opts->group_in_file);
|
||||
//filename[1023] = '\0'; //necessary?
|
||||
char buffer[BSIZE];
|
||||
FILE * fp;
|
||||
@@ -18,7 +18,6 @@ int csvGroupImport(dsd_opts * opts, dsd_state * state)
|
||||
int row_count = 0;
|
||||
int field_count = 0;
|
||||
long int group_number = 0; //local group number for array index value
|
||||
UNUSED(group_number);
|
||||
int i = 0;
|
||||
while (fgets(buffer, BSIZE, fp)) {
|
||||
field_count = 0;
|
||||
@@ -27,7 +26,7 @@ int csvGroupImport(dsd_opts * opts, dsd_state * state)
|
||||
continue; //don't want labels
|
||||
char * field = strtok(buffer, ","); //seperate by comma
|
||||
while (field) {
|
||||
|
||||
|
||||
if (field_count == 0)
|
||||
{
|
||||
//group_number = atol(field);
|
||||
@@ -44,23 +43,23 @@ int csvGroupImport(dsd_opts * opts, dsd_state * state)
|
||||
strcpy(state->group_array[i].groupName, field);
|
||||
fprintf (stderr, "%s ", state->group_array[i].groupName);
|
||||
}
|
||||
|
||||
|
||||
field = strtok(NULL, ",");
|
||||
field_count++;
|
||||
}
|
||||
fprintf (stderr, "\n");
|
||||
i++;
|
||||
state->group_tally++;
|
||||
state->group_tally++;
|
||||
}
|
||||
fclose(fp);
|
||||
return 0;
|
||||
}
|
||||
|
||||
//LCN import for EDACS, migrated to channel map (channel map does both)
|
||||
int csvLCNImport(dsd_opts * opts, dsd_state * state)
|
||||
int csvLCNImport(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
char filename[1024] = "filename.csv";
|
||||
sprintf (filename, "%s", opts->lcn_in_file);
|
||||
char filename[1024] = "filename.csv";
|
||||
sprintf (filename, "%s", opts->lcn_in_file);
|
||||
//filename[1023] = '\0'; //necessary?
|
||||
char buffer[BSIZE];
|
||||
FILE * fp;
|
||||
@@ -86,12 +85,12 @@ int csvLCNImport(dsd_opts * opts, dsd_state * state)
|
||||
fprintf (stderr, "LCN [%d] [%ld]", field_count+1, state->trunk_lcn_freq[field_count]);
|
||||
fprintf (stderr, "\n");
|
||||
|
||||
|
||||
|
||||
field = strtok(NULL, ",");
|
||||
field_count++;
|
||||
}
|
||||
fprintf (stderr, "LCN Count %d\n", state->lcn_freq_count);
|
||||
|
||||
|
||||
}
|
||||
fclose(fp);
|
||||
return 0;
|
||||
@@ -99,7 +98,7 @@ int csvLCNImport(dsd_opts * opts, dsd_state * state)
|
||||
|
||||
int csvChanImport(dsd_opts * opts, dsd_state * state) //channel map import
|
||||
{
|
||||
char filename[1024] = "filename.csv";
|
||||
char filename[1024] = "filename.csv";
|
||||
sprintf (filename, "%s", opts->chan_in_file);
|
||||
|
||||
char buffer[BSIZE];
|
||||
@@ -135,13 +134,13 @@ int csvChanImport(dsd_opts * opts, dsd_state * state) //channel map import
|
||||
sscanf (field, "%ld", &state->trunk_lcn_freq[state->lcn_freq_count]);
|
||||
state->lcn_freq_count++; //keep tally of number of Frequencies imported
|
||||
}
|
||||
|
||||
|
||||
field = strtok(NULL, ",");
|
||||
field_count++;
|
||||
}
|
||||
fprintf (stderr, "Channel [%05ld] [%09ld]", chan_number, state->trunk_chan_map[chan_number]);
|
||||
fprintf (stderr, "\n");
|
||||
|
||||
|
||||
}
|
||||
fclose(fp);
|
||||
return 0;
|
||||
@@ -150,7 +149,7 @@ int csvChanImport(dsd_opts * opts, dsd_state * state) //channel map import
|
||||
//Decimal Variant of Key Import
|
||||
int csvKeyImportDec(dsd_opts * opts, dsd_state * state) //multi-key support
|
||||
{
|
||||
char filename[1024] = "filename.csv";
|
||||
char filename[1024] = "filename.csv";
|
||||
sprintf (filename, "%s", opts->key_in_file);
|
||||
|
||||
char buffer[BSIZE];
|
||||
@@ -162,7 +161,7 @@ int csvKeyImportDec(dsd_opts * opts, dsd_state * state) //multi-key support
|
||||
}
|
||||
int row_count = 0;
|
||||
int field_count = 0;
|
||||
|
||||
|
||||
unsigned long long int keynumber = 0;
|
||||
unsigned long long int keyvalue = 0;
|
||||
|
||||
@@ -186,13 +185,13 @@ int csvKeyImportDec(dsd_opts * opts, dsd_state * state) //multi-key support
|
||||
keynumber = keynumber & 0xFFFFFF; //truncate to 24-bits (max allowed)
|
||||
for (int i = 0; i < 24; i++)
|
||||
{
|
||||
hash_bits[i] = ((keynumber << i) & 0x800000) >> 23; //load into array for CRC16
|
||||
hash_bits[i] = ((keynumber << i) & 0x800000) >> 23; //load into array for CRC16
|
||||
}
|
||||
hash = ComputeCrcCCITT16d (hash_bits, 24);
|
||||
keynumber = hash & 0xFFFF; //make sure its no larger than 16-bits
|
||||
fprintf (stderr, "Hashed ");
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
if (field_count == 1)
|
||||
@@ -200,21 +199,21 @@ int csvKeyImportDec(dsd_opts * opts, dsd_state * state) //multi-key support
|
||||
sscanf (field, "%lld", &keyvalue);
|
||||
state->rkey_array[keynumber] = keyvalue & 0xFFFFFFFFFF; //doesn't exceed 40-bit value
|
||||
}
|
||||
|
||||
|
||||
field = strtok(NULL, ",");
|
||||
field_count++;
|
||||
}
|
||||
fprintf (stderr, "Key [%03lld] [%05lld]", keynumber, state->rkey_array[keynumber]);
|
||||
fprintf (stderr, "\n");
|
||||
hash = 0;
|
||||
|
||||
|
||||
}
|
||||
fclose(fp);
|
||||
return 0;
|
||||
}
|
||||
|
||||
//Hex Variant of Key Import
|
||||
int csvKeyImportHex(dsd_opts * opts, dsd_state * state) //key import for hex keys
|
||||
int csvKeyImportHex(dsd_opts * opts, dsd_state * state) //key import for rc4 keys
|
||||
{
|
||||
char filename[1024] = "filename.csv";
|
||||
sprintf (filename, "%s", opts->key_in_file);
|
||||
@@ -246,34 +245,13 @@ int csvKeyImportHex(dsd_opts * opts, dsd_state * state) //key import for hex key
|
||||
{
|
||||
sscanf (field, "%llX", &state->rkey_array[keynumber]);
|
||||
}
|
||||
|
||||
//this could also theoretically nuke other keys that are at the same offset
|
||||
if (field_count == 2)
|
||||
{
|
||||
sscanf (field, "%llX", &state->rkey_array[keynumber+0x101]);
|
||||
}
|
||||
|
||||
if (field_count == 3)
|
||||
{
|
||||
sscanf (field, "%llX", &state->rkey_array[keynumber+0x201]);
|
||||
}
|
||||
|
||||
if (field_count == 4)
|
||||
{
|
||||
sscanf (field, "%llX", &state->rkey_array[keynumber+0x301]);
|
||||
}
|
||||
|
||||
|
||||
field = strtok(NULL, ",");
|
||||
field_count++;
|
||||
}
|
||||
|
||||
fprintf (stderr, "Key [%04llX] [%016llX]", keynumber, state->rkey_array[keynumber]);
|
||||
|
||||
//if longer key is loaded (or clash with the 0x101, 0x201, 0x301 offset, then print the full key listing)
|
||||
if ( (state->rkey_array[keynumber+0x101] != 0) || (state->rkey_array[keynumber+0x201] != 0) || (state->rkey_array[keynumber+0x301] != 0) )
|
||||
fprintf (stderr, " [%016llX] [%016llX] [%016llX]", state->rkey_array[keynumber+0x101], state->rkey_array[keynumber+0x201], state->rkey_array[keynumber+0x301]);
|
||||
fprintf (stderr, "\n");
|
||||
|
||||
|
||||
}
|
||||
fclose(fp);
|
||||
return 0;
|
||||
|
||||
@@ -1,7 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_ks.c
|
||||
* Placeholder File 6 -- This file is for temporary code storage
|
||||
*
|
||||
*
|
||||
*
|
||||
*-----------------------------------------------------------------------------*/
|
||||
6403
src/dsd_main.c
6403
src/dsd_main.c
File diff suppressed because it is too large
Load Diff
1065
src/dsd_mbe.c
1065
src/dsd_mbe.c
File diff suppressed because it is too large
Load Diff
179
src/dsd_mbe2.c
179
src/dsd_mbe2.c
@@ -1,179 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
*
|
||||
*
|
||||
*
|
||||
* TODO: Fill me in'
|
||||
*
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2023-07 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
//new and simplified/organized ambe and imbe handling
|
||||
//moving all audio handling and decryption to seperate files for simplicity (eventually)
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
//the initial functions will ONLY return demodulated ambe or imbe frames, THAT'S IT!
|
||||
//decryption and audio handling etc will be handled at a different area
|
||||
|
||||
//using soft_demod will also allow for not compiling mbelib and also using a DVstick in the future
|
||||
|
||||
//P25p1 IMBE 7200 or AMBE+2 EFR
|
||||
void soft_demod_imbe7200 (dsd_state * state, char imbe_fr7200[8][23], char imbe_d[88])
|
||||
{
|
||||
state->errs = mbe_eccImbe7200x4400C0 (imbe_fr7200);
|
||||
state->errs2 = state->errs;
|
||||
mbe_demodulateImbe7200x4400Data (imbe_fr7200);
|
||||
state->errs2 += mbe_eccImbe7200x4400Data (imbe_fr7200, imbe_d);
|
||||
state->debug_audio_errors += state->errs2;
|
||||
|
||||
}
|
||||
|
||||
//ProVoice IMBE 7100
|
||||
void soft_demod_imbe7100 (dsd_state * state, char imbe_fr7100[7][24], char imbe_d[88])
|
||||
{
|
||||
state->errs = mbe_eccImbe7100x4400C0 (imbe_fr7100);
|
||||
state->errs2 = state->errs;
|
||||
mbe_demodulateImbe7100x4400Data (imbe_fr7100);
|
||||
state->errs2 += mbe_eccImbe7100x4400Data (imbe_fr7100, imbe_d);
|
||||
state->debug_audio_errors += state->errs2;
|
||||
|
||||
}
|
||||
|
||||
//AMBE+2 EHR
|
||||
void soft_demod_ambe2_ehr(dsd_state * state, char ambe2_ehr[4][24], char ambe_d[49])
|
||||
{
|
||||
state->errs = mbe_eccAmbe3600x2450C0 (ambe2_ehr);
|
||||
state->errs2 = state->errs;
|
||||
mbe_demodulateAmbe3600x2450Data (ambe2_ehr);
|
||||
state->errs2 += mbe_eccAmbe3600x2450Data (ambe2_ehr, ambe_d);
|
||||
|
||||
}
|
||||
|
||||
//AMBE One Shot (DSTAR)
|
||||
void soft_demod_ambe_dstar(dsd_opts * opts, dsd_state * state, char ambe_fr[4][24], char ambe_d[49])
|
||||
{
|
||||
mbe_processAmbe3600x2400Framef (state->audio_out_temp_buf, &state->errs, &state->errs2,
|
||||
state->err_str, ambe_fr, ambe_d, state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);
|
||||
if (opts->floating_point == 1)
|
||||
memcpy (state->f_l, state->audio_out_temp_buf, sizeof(state->f_l));
|
||||
else processAudio(opts, state);
|
||||
}
|
||||
|
||||
//AMBE+2 One Shot (X2-TDMA)
|
||||
void soft_demod_ambe_x2(dsd_opts * opts, dsd_state * state, char ambe_fr[4][24], char ambe_d[49])
|
||||
{
|
||||
mbe_processAmbe3600x2450Framef (state->audio_out_temp_buf, &state->errs, &state->errs2,
|
||||
state->err_str, ambe_fr, ambe_d, state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);
|
||||
if (opts->floating_point == 1)
|
||||
memcpy (state->f_l, state->audio_out_temp_buf, sizeof(state->f_l));
|
||||
else processAudio(opts, state);
|
||||
}
|
||||
|
||||
void soft_mbe (dsd_opts * opts, dsd_state * state, char imbe_fr[8][23], char ambe_fr[4][24], char imbe7100_fr[7][24])
|
||||
{
|
||||
int i;
|
||||
char ambe_d[49];
|
||||
char imbe_d[88];
|
||||
int slot = state->currentslot;
|
||||
memset (ambe_d, 0, sizeof(ambe_d));
|
||||
memset (imbe_d, 0, sizeof(imbe_d));
|
||||
|
||||
UNUSED(i);
|
||||
|
||||
//P25p1, YSF FR, NXDN EFR
|
||||
if (state->synctype == 0 || state->synctype == 1)
|
||||
{
|
||||
soft_demod_imbe7200(state, imbe_fr, imbe_d);
|
||||
//handle decryption here
|
||||
//print IMBE frame
|
||||
mbe_processImbe4400Dataf (state->audio_out_temp_buf, &state->errs, &state->errs2, state->err_str,
|
||||
imbe_d, state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);
|
||||
//send to playback here
|
||||
}
|
||||
|
||||
//ProVoice
|
||||
else if (state->synctype == 14 || state->synctype == 15)
|
||||
{
|
||||
soft_demod_imbe7100(state, imbe7100_fr, imbe_d);
|
||||
//nothing to do
|
||||
|
||||
//convert to 7200
|
||||
mbe_convertImbe7100to7200(imbe_d);
|
||||
mbe_processImbe4400Dataf (state->audio_out_temp_buf, &state->errs, &state->errs2, state->err_str,
|
||||
imbe_d, state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);
|
||||
//send to playback here
|
||||
|
||||
}
|
||||
|
||||
//D-STAR AMBE
|
||||
else if (state->synctype == 6 || state->synctype == 7)
|
||||
{
|
||||
soft_demod_ambe_dstar(opts, state, ambe_fr, ambe_d);
|
||||
if(opts->payload == 1)
|
||||
PrintAMBEData (opts, state, ambe_d);
|
||||
|
||||
if (opts->floating_point == 0 && opts->pulse_digi_out_channels == 1)
|
||||
playSynthesizedVoiceMS(opts, state);
|
||||
if (opts->floating_point == 1 && opts->pulse_digi_out_channels == 1)
|
||||
playSynthesizedVoiceFM(opts, state);
|
||||
if (opts->floating_point == 0 && opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceSS(opts, state);
|
||||
if (opts->floating_point == 1 && opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceFS(opts, state);
|
||||
|
||||
if (opts->wav_out_f != NULL && opts->dmr_stereo_wav == 1)
|
||||
writeSynthesizedVoice (opts, state);
|
||||
|
||||
//single wav file handled by playSynthesizedVoiceMS
|
||||
|
||||
if (opts->mbe_out_f != NULL)
|
||||
saveAmbe2450Data (opts, state, ambe_d);
|
||||
}
|
||||
|
||||
//X2-TDMA AMBE
|
||||
else if (state->synctype >= 2 && state->synctype <= 5)
|
||||
{
|
||||
soft_demod_ambe_x2(opts, state, ambe_fr, ambe_d);
|
||||
if(opts->payload == 1)
|
||||
PrintAMBEData (opts, state, ambe_d);
|
||||
|
||||
if (opts->floating_point == 0 && opts->pulse_digi_out_channels == 1)
|
||||
playSynthesizedVoiceMS(opts, state);
|
||||
if (opts->floating_point == 1 && opts->pulse_digi_out_channels == 1)
|
||||
playSynthesizedVoiceFM(opts, state);
|
||||
if (opts->floating_point == 0 && opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceSS(opts, state);
|
||||
if (opts->floating_point == 1 && opts->pulse_digi_out_channels == 2)
|
||||
playSynthesizedVoiceFS(opts, state);
|
||||
|
||||
if (opts->wav_out_f != NULL)
|
||||
writeSynthesizedVoice (opts, state);
|
||||
|
||||
if (opts->mbe_out_f != NULL)
|
||||
saveAmbe2450Data (opts, state, ambe_d);
|
||||
}
|
||||
|
||||
//AMBE+2 EHR (NXDN, DMR, P25p2, YSF VD/1)
|
||||
else
|
||||
{
|
||||
soft_demod_ambe2_ehr (state, ambe_fr, ambe_d);
|
||||
//decrypt here
|
||||
if(opts->payload == 1)
|
||||
PrintAMBEData (opts, state, ambe_d);
|
||||
//make left or right channel decision
|
||||
if (slot == 0)
|
||||
{
|
||||
mbe_processAmbe2450Dataf (state->audio_out_temp_buf, &state->errs, &state->errs2, state->err_str,
|
||||
ambe_d, state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);
|
||||
}
|
||||
if (slot == 1)
|
||||
{
|
||||
mbe_processAmbe2450Dataf (state->audio_out_temp_bufR, &state->errsR, &state->errs2R, state->err_strR,
|
||||
ambe_d, state->cur_mp2, state->prev_mp2, state->prev_mp_enhanced2, opts->uvquality);
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
618
src/dsd_misc.c
618
src/dsd_misc.c
@@ -1,618 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_misc.c
|
||||
* Misc Code that needs to be reorganized and sorted out
|
||||
*
|
||||
*
|
||||
*
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
static const int PARITY[] = {0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1};
|
||||
|
||||
// trellis_1_2 encode: source is in bits, result in bits
|
||||
void trellis_encode(uint8_t result[], const uint8_t source[], int result_len, int reg)
|
||||
{
|
||||
for (int i=0; i<result_len; i+=2) {
|
||||
reg = (reg << 1) | source[i>>1];
|
||||
result[i] = PARITY[reg & 0x19];
|
||||
result[i+1] = PARITY[reg & 0x17];
|
||||
}
|
||||
}
|
||||
|
||||
// simplified trellis 2:1 decode; source and result in bits
|
||||
// assumes that encoding was done with NTEST trailing zero bits
|
||||
// result_len should be set to the actual number of data bits
|
||||
// in the original unencoded message (excl. these trailing bits)
|
||||
void trellis_decode(uint8_t result[], const uint8_t source[], int result_len)
|
||||
{
|
||||
int reg = 0;
|
||||
int min_d;
|
||||
int min_bt;
|
||||
static const int NTEST = 4;
|
||||
static const int NTESTC = 1 << NTEST;
|
||||
uint8_t bt[NTEST];
|
||||
uint8_t tt[NTEST*2];
|
||||
int dstats[4];
|
||||
int sum;
|
||||
for (int p=0; p < 4; p++)
|
||||
dstats[p] = 0;
|
||||
for (int p=0; p < result_len; p++) {
|
||||
for (int i=0; i<NTESTC; i++) {
|
||||
bt[0] = (i&8)>>3;
|
||||
bt[1] = (i&4)>>2;
|
||||
bt[2] = (i&2)>>1;
|
||||
bt[3] = (i&1);
|
||||
trellis_encode(tt, bt, NTEST*2, reg);
|
||||
sum=0;
|
||||
for (int j=0; j<NTEST*2; j++) {
|
||||
sum += tt[j] ^ source[p*2+j];
|
||||
}
|
||||
if (i == 0 || sum < min_d) {
|
||||
min_d = sum;
|
||||
min_bt = bt[0];
|
||||
}
|
||||
}
|
||||
result[p] = min_bt;
|
||||
reg = (reg << 1) | min_bt;
|
||||
dstats[(min_d > 3) ? 3 : min_d] += 1;
|
||||
}
|
||||
|
||||
//debug output
|
||||
// fprintf (stderr, "\n stats\t%d %d %d %d\n", dstats[0], dstats[1], dstats[2], dstats[3]);
|
||||
}
|
||||
|
||||
//Original Copyright/License
|
||||
|
||||
/* -*- c++ -*- */
|
||||
/*
|
||||
* NXDN Encoder/Decoder (C) Copyright 2019 Max H. Parke KA1RBI
|
||||
*
|
||||
* This file is part of OP25
|
||||
*
|
||||
* This 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.
|
||||
*
|
||||
* This software 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 software; see the file COPYING. If not, write to
|
||||
* the Free Software Foundation, Inc., 51 Franklin Street,
|
||||
* Boston, MA 02110-1301, USA.
|
||||
*/
|
||||
|
||||
//Ripped from libM17
|
||||
#define K 5 //constraint length
|
||||
#define NUM_STATES (1 << (K - 1)) //number of states
|
||||
|
||||
static uint32_t prevMetrics[NUM_STATES];
|
||||
static uint32_t currMetrics[NUM_STATES];
|
||||
static uint32_t prevMetricsData[NUM_STATES];
|
||||
static uint32_t currMetricsData[NUM_STATES];
|
||||
static uint16_t viterbi_history[244];
|
||||
|
||||
/**
|
||||
* @brief Decode unpunctured convolutionally encoded data.
|
||||
*
|
||||
* @param out Destination array where decoded data is written.
|
||||
* @param in Input data.
|
||||
* @param len Input length in bits.
|
||||
* @return Number of bit errors corrected.
|
||||
*/
|
||||
uint32_t viterbi_decode(uint8_t* out, const uint16_t* in, const uint16_t len)
|
||||
{
|
||||
if(len > 244*2)
|
||||
fprintf(stderr, "Input size exceeds max history\n");
|
||||
|
||||
viterbi_reset();
|
||||
|
||||
size_t pos = 0;
|
||||
for(size_t i = 0; i < len; i += 2)
|
||||
{
|
||||
uint16_t s0 = in[i];
|
||||
uint16_t s1 = in[i + 1];
|
||||
|
||||
viterbi_decode_bit(s0, s1, pos);
|
||||
pos++;
|
||||
}
|
||||
uint32_t err = viterbi_chainback(out, pos, len/2);
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "\n vcb: \n");
|
||||
// for (size_t i = 0; i < len; i++)
|
||||
// fprintf (stderr, "%02X", out[i]);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Decode punctured convolutionally encoded data.
|
||||
*
|
||||
* @param out Destination array where decoded data is written.
|
||||
* @param in Input data.
|
||||
* @param punct Puncturing matrix.
|
||||
* @param in_len Input data length.
|
||||
* @param p_len Puncturing matrix length (entries).
|
||||
* @return Number of bit errors corrected.
|
||||
*/
|
||||
uint32_t viterbi_decode_punctured(uint8_t* out, const uint16_t* in, const uint8_t* punct, const uint16_t in_len, const uint16_t p_len)
|
||||
{
|
||||
if(in_len > 244*2)
|
||||
fprintf(stderr, "Input size exceeds max history\n");
|
||||
|
||||
uint16_t umsg[244*2]; //unpunctured message
|
||||
uint8_t p=0; //puncturer matrix entry
|
||||
uint16_t u=0; //bits count - unpunctured message
|
||||
uint16_t i=0; //bits read from the input message
|
||||
|
||||
while(i<in_len)
|
||||
{
|
||||
if(punct[p])
|
||||
{
|
||||
umsg[u]=in[i];
|
||||
i++;
|
||||
}
|
||||
else
|
||||
{
|
||||
umsg[u]=0x7FFF;
|
||||
}
|
||||
|
||||
u++;
|
||||
p++;
|
||||
p%=p_len;
|
||||
}
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, " p: %d, u: %d; p_len: %d; len: %d;", p, u, p_len, (u-in_len)*0x7FFF);
|
||||
|
||||
return viterbi_decode(out, umsg, u) - (u-in_len)*0x7FFF;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Decode one bit and update trellis.
|
||||
*
|
||||
* @param s0 Cost of the first symbol.
|
||||
* @param s1 Cost of the second symbol.
|
||||
* @param pos Bit position in history.
|
||||
*/
|
||||
void viterbi_decode_bit(uint16_t s0, uint16_t s1, const size_t pos)
|
||||
{
|
||||
static const uint16_t COST_TABLE_0[] = {0, 0, 0, 0, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF};
|
||||
static const uint16_t COST_TABLE_1[] = {0, 0xFFFF, 0xFFFF, 0, 0, 0xFFFF, 0xFFFF, 0};
|
||||
|
||||
for(uint8_t i = 0; i < NUM_STATES/2; i++)
|
||||
{
|
||||
uint32_t metric = q_abs_diff(COST_TABLE_0[i], s0)
|
||||
+ q_abs_diff(COST_TABLE_1[i], s1);
|
||||
|
||||
|
||||
uint32_t m0 = prevMetrics[i] + metric;
|
||||
uint32_t m1 = prevMetrics[i + NUM_STATES/2] + (0x1FFFE - metric);
|
||||
|
||||
uint32_t m2 = prevMetrics[i] + (0x1FFFE - metric);
|
||||
uint32_t m3 = prevMetrics[i + NUM_STATES/2] + metric;
|
||||
|
||||
uint8_t i0 = 2 * i;
|
||||
uint8_t i1 = i0 + 1;
|
||||
|
||||
if(m0 >= m1)
|
||||
{
|
||||
viterbi_history[pos]|=(1<<i0);
|
||||
currMetrics[i0] = m1;
|
||||
}
|
||||
else
|
||||
{
|
||||
viterbi_history[pos]&=~(1<<i0);
|
||||
currMetrics[i0] = m0;
|
||||
}
|
||||
|
||||
if(m2 >= m3)
|
||||
{
|
||||
viterbi_history[pos]|=(1<<i1);
|
||||
currMetrics[i1] = m3;
|
||||
}
|
||||
else
|
||||
{
|
||||
viterbi_history[pos]&=~(1<<i1);
|
||||
currMetrics[i1] = m2;
|
||||
}
|
||||
}
|
||||
|
||||
//swap
|
||||
uint32_t tmp[NUM_STATES];
|
||||
for(uint8_t i=0; i<NUM_STATES; i++)
|
||||
{
|
||||
tmp[i]=currMetrics[i];
|
||||
}
|
||||
for(uint8_t i=0; i<NUM_STATES; i++)
|
||||
{
|
||||
currMetrics[i]=prevMetrics[i];
|
||||
prevMetrics[i]=tmp[i];
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief History chainback to obtain final byte array.
|
||||
*
|
||||
* @param out Destination byte array for decoded data.
|
||||
* @param pos Starting position for the chainback.
|
||||
* @param len Length of the output in bits.
|
||||
* @return Minimum Viterbi cost at the end of the decode sequence.
|
||||
*/
|
||||
uint32_t viterbi_chainback(uint8_t* out, size_t pos, uint16_t len)
|
||||
{
|
||||
uint8_t state = 0;
|
||||
size_t bitPos = len+4;
|
||||
|
||||
memset(out, 0, (len-1)/8+1);
|
||||
|
||||
while(pos > 0)
|
||||
{
|
||||
bitPos--;
|
||||
pos--;
|
||||
uint16_t bit = viterbi_history[pos]&((1<<(state>>4)));
|
||||
state >>= 1;
|
||||
if(bit)
|
||||
{
|
||||
state |= 0x80;
|
||||
out[bitPos/8]|=1<<(7-(bitPos%8));
|
||||
}
|
||||
}
|
||||
|
||||
uint32_t cost = prevMetrics[0];
|
||||
|
||||
for(size_t i = 0; i < NUM_STATES; i++)
|
||||
{
|
||||
uint32_t m = prevMetrics[i];
|
||||
if(m < cost) cost = m;
|
||||
}
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "\n cb: \n");
|
||||
// for (size_t i = 0; i < len; i++)
|
||||
// fprintf (stderr, "%02X", out[i]);
|
||||
|
||||
return cost;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Reset the decoder state. No args.
|
||||
*
|
||||
*/
|
||||
void viterbi_reset(void)
|
||||
{
|
||||
memset((uint8_t*)viterbi_history, 0, 2*244);
|
||||
memset((uint8_t*)currMetrics, 0, 4*NUM_STATES);
|
||||
memset((uint8_t*)prevMetrics, 0, 4*NUM_STATES);
|
||||
memset((uint8_t*)currMetricsData, 0, 4*NUM_STATES);
|
||||
memset((uint8_t*)prevMetricsData, 0, 4*NUM_STATES);
|
||||
}
|
||||
|
||||
uint16_t q_abs_diff(const uint16_t v1, const uint16_t v2)
|
||||
{
|
||||
if(v2 > v1) return v2 - v1;
|
||||
return v1 - v2;
|
||||
}
|
||||
|
||||
//original sources
|
||||
//--------------------------------------------------------------------
|
||||
// M17 C library - decode/viterbi.c
|
||||
//
|
||||
// This file contains:
|
||||
// - the Viterbi decoder
|
||||
//
|
||||
// Wojciech Kaczmarski, SP5WWP
|
||||
// M17 Project, 29 December 2023
|
||||
//--------------------------------------------------------------------
|
||||
|
||||
//--------------------------------------------------------------------
|
||||
// M17 C library - math/math.c
|
||||
//
|
||||
// This file contains:
|
||||
// - absolute difference value
|
||||
// - Euclidean norm (L2) calculation for n-dimensional vectors (float)
|
||||
// - soft-valued arrays to integer conversion (and vice-versa)
|
||||
// - fixed-valued multiplication and division
|
||||
//
|
||||
// Wojciech Kaczmarski, SP5WWP
|
||||
// M17 Project, 29 December 2023
|
||||
//--------------------------------------------------------------------
|
||||
|
||||
|
||||
//audio filter stuff sourced from: https://github.com/NedSimao/FilteringLibrary
|
||||
//no license / information provided in source code
|
||||
#define PI 3.141592653
|
||||
|
||||
//do we need this for test input sthit?
|
||||
// #define PLOT_POINTS 100
|
||||
// #define SAMPLE_TIME_S 0.001
|
||||
// #define CUTOFFFREQ_HZ 50
|
||||
// #define sine_freq 40
|
||||
// #define sine_freq_1 500
|
||||
// #define HFC 50
|
||||
// #define LFC 100
|
||||
|
||||
|
||||
void LPFilter_Init(LPFilter *filter, float cutoffFreqHz, float sampleTimeS)
|
||||
{
|
||||
|
||||
float RC=0.0;
|
||||
RC=1.0/(2*PI*cutoffFreqHz);
|
||||
filter->coef[0]=sampleTimeS/(sampleTimeS+RC);
|
||||
filter->coef[1]=RC/(sampleTimeS+RC);
|
||||
|
||||
filter->v_out[0]=0.0;
|
||||
filter->v_out[1]=0.0;
|
||||
|
||||
}
|
||||
|
||||
|
||||
float LPFilter_Update(LPFilter *filter, float v_in)
|
||||
{
|
||||
|
||||
filter->v_out[1]=filter->v_out[0];
|
||||
filter->v_out[0]=(filter->coef[0]*v_in) + (filter->coef[1]*filter->v_out[1]);
|
||||
|
||||
return (filter->v_out[0]);
|
||||
|
||||
}
|
||||
|
||||
|
||||
/********************************************************************************************************
|
||||
* HIGH PASS FILTER
|
||||
********************************************************************************************************/
|
||||
void HPFilter_Init(HPFilter *filter, float cutoffFreqHz, float sampleTimeS)
|
||||
{
|
||||
|
||||
float RC=0.0;
|
||||
RC=1.0/(2*PI*cutoffFreqHz);
|
||||
|
||||
filter->coef=RC/(sampleTimeS+RC);
|
||||
|
||||
filter->v_in[0]=0.0;
|
||||
filter->v_in[1]=0.0;
|
||||
|
||||
filter->v_out[0]=0.0;
|
||||
filter->v_out[1]=0.0;
|
||||
|
||||
}
|
||||
|
||||
|
||||
float HPFilter_Update(HPFilter *filter, float v_in)
|
||||
{
|
||||
|
||||
filter->v_in[1]=filter->v_in[0];
|
||||
filter->v_in[0]=v_in;
|
||||
|
||||
filter->v_out[1]=filter->v_out[0];
|
||||
filter->v_out[0]=filter->coef * (filter->v_in[0] - filter->v_in[1]+filter->v_out[1]);
|
||||
|
||||
return (filter->v_out[0]);
|
||||
|
||||
}
|
||||
|
||||
/********************************************************************************************************
|
||||
* BAND PASS FILTER
|
||||
********************************************************************************************************/
|
||||
|
||||
|
||||
void PBFilter_Init(PBFilter *filter, float HPF_cutoffFreqHz, float LPF_cutoffFreqHz, float sampleTimeS)
|
||||
{
|
||||
|
||||
LPFilter_Init(&filter->lpf, LPF_cutoffFreqHz, sampleTimeS);
|
||||
HPFilter_Init(&filter->hpf, HPF_cutoffFreqHz, sampleTimeS);
|
||||
|
||||
filter->out_in=0.0;
|
||||
|
||||
}
|
||||
|
||||
float PBFilter_Update(PBFilter *filter, float v_in)
|
||||
{
|
||||
|
||||
filter->out_in=HPFilter_Update(&filter->hpf, v_in);
|
||||
|
||||
filter->out_in=LPFilter_Update(&filter->lpf, filter->out_in);
|
||||
|
||||
return (filter->out_in);
|
||||
|
||||
}
|
||||
|
||||
/********************************************************************************************************
|
||||
* NOTCH FILTER
|
||||
********************************************************************************************************/
|
||||
|
||||
|
||||
void NOTCHFilter_Init(NOTCHFilter *filter, float centerFreqHz, float notchWidthHz, float sampleTimeS)
|
||||
{
|
||||
|
||||
//filter frequency to angular (rad/s)
|
||||
float w0_rps=2.0 * PI *centerFreqHz;
|
||||
float ww_rps=2.0 * PI *notchWidthHz;
|
||||
|
||||
//pre warp center frequency
|
||||
float w0_pw_rps=(2.0/sampleTimeS) * tanf(0.5 * w0_rps * sampleTimeS);
|
||||
|
||||
//computing filter coefficients
|
||||
|
||||
filter->alpha=4.0 + w0_rps*w0_pw_rps*sampleTimeS*sampleTimeS;
|
||||
filter->beta=2.0*ww_rps*sampleTimeS;
|
||||
|
||||
//clearing input and output buffers
|
||||
|
||||
for (uint8_t n=0; n<3; n++)
|
||||
{
|
||||
filter->vin[n]=0;
|
||||
filter->vout[n]=0;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
float NOTCHFilter_Update(NOTCHFilter *filter, float vin)
|
||||
{
|
||||
|
||||
//shifting samples
|
||||
filter->vin[2]=filter->vin[1];
|
||||
filter->vin[1]=filter->vin[0];
|
||||
|
||||
filter->vout[2]=filter->vout[1];
|
||||
filter->vout[1]=filter->vout[0];
|
||||
|
||||
filter->vin[0]=vin;
|
||||
|
||||
//compute new output
|
||||
filter->vout[0]=(filter->alpha*filter->vin[0] + 2.0 *(filter->alpha -8.0)*filter->vin[1] + filter->alpha*filter->vin[2]
|
||||
-(2.0f*(filter->alpha-8.0)*filter->vout[1]+(filter->alpha-filter->beta)*filter->vout[2]))/(filter->alpha+filter->beta);
|
||||
|
||||
|
||||
return (filter->vout[0]);
|
||||
}
|
||||
|
||||
void init_audio_filters (dsd_state * state)
|
||||
{
|
||||
//still not sure if this is even correct or not, but 48k sounds good now
|
||||
LPFilter_Init(&state->RCFilter, 960, (float)1/(float)48000);
|
||||
HPFilter_Init(&state->HRCFilter, 960, (float)1/(float)48000);
|
||||
|
||||
//left and right variants for stereo output testing on digital voice samples
|
||||
LPFilter_Init(&state->RCFilterL, 960, (float)1/(float)16000);
|
||||
HPFilter_Init(&state->HRCFilterL, 960, (float)1/(float)16000);
|
||||
LPFilter_Init(&state->RCFilterR, 960, (float)1/(float)16000);
|
||||
HPFilter_Init(&state->HRCFilterR, 960, (float)1/(float)16000);
|
||||
|
||||
//PBFilter_Init(PBFilter *filter, float HPF_cutoffFreqHz, float LPF_cutoffFreqHz, float sampleTimeS);
|
||||
//NOTCHFilter_Init(NOTCHFilter *filter, float centerFreqHz, float notchWidthHz, float sampleTimeS);
|
||||
|
||||
//NOTE: PBFilter_init also inits a LPF and HPF, but on another set of filters, might be worth
|
||||
//testing just using the PBFilter by itself and see how it does without the hpf used
|
||||
|
||||
//passband filter working (seems to be), notch filter unsure which values to use, doesn't have any appreciable affect when used as is
|
||||
PBFilter_Init(&state->PBF, 8000, 12000, (float)1/(float)1536000); //RTL Sampling at 1536000 S/s.
|
||||
NOTCHFilter_Init(&state->NF, 1000, 4000, (float)1/(float)1536000);
|
||||
|
||||
}
|
||||
|
||||
//FUNCTIONS for handing use of above filters
|
||||
|
||||
//lpf
|
||||
void lpf(dsd_state * state, short * input, int len)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
// fprintf (stderr, "\n in: %05d", input[i]);
|
||||
input[i] = LPFilter_Update(&state->RCFilter, input[i]);
|
||||
// fprintf (stderr, "\n out: %05d", input[i]);
|
||||
}
|
||||
}
|
||||
|
||||
//hpf
|
||||
void hpf(dsd_state * state, short * input, int len)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
// fprintf (stderr, "\n in: %05d", input[i]);
|
||||
input[i] = HPFilter_Update(&state->HRCFilter, input[i]);
|
||||
// fprintf (stderr, "\n out: %05d", input[i]);
|
||||
}
|
||||
}
|
||||
|
||||
//hpf digital left
|
||||
void hpf_dL(dsd_state * state, short * input, int len)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
// fprintf (stderr, "\n in: %05d", input[i]);
|
||||
input[i] = HPFilter_Update(&state->HRCFilterL, input[i]);
|
||||
// fprintf (stderr, "\n out: %05d", input[i]);
|
||||
}
|
||||
}
|
||||
|
||||
//hpf digital right
|
||||
void hpf_dR(dsd_state * state, short * input, int len)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
// fprintf (stderr, "\n in: %05d", input[i]);
|
||||
input[i] = HPFilter_Update(&state->HRCFilterR, input[i]);
|
||||
// fprintf (stderr, "\n out: %05d", input[i]);
|
||||
}
|
||||
}
|
||||
|
||||
//nf
|
||||
void nf(dsd_state * state, short * input, int len)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
// fprintf (stderr, "\n in: %05d", input[i]);
|
||||
input[i] = NOTCHFilter_Update(&state->NF, input[i]);
|
||||
// fprintf (stderr, "\n out: %05d", input[i]);
|
||||
}
|
||||
}
|
||||
|
||||
//pbf
|
||||
void pbf(dsd_state * state, short * input, int len)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
// fprintf (stderr, "\n in: %05d", input[i]);
|
||||
input[i] = PBFilter_Update(&state->PBF, input[i]);
|
||||
}
|
||||
}
|
||||
|
||||
//Generic RMS function derived from RTL_FM (RTL_SDR) RMS code (doesnt' really work correctly outside of RTL)
|
||||
long int raw_rms(int16_t *samples, int len, int step) //use samplespersymbol as len
|
||||
{
|
||||
|
||||
int i;
|
||||
long int rms;
|
||||
long p, t, s;
|
||||
double dc, err;
|
||||
|
||||
p = t = 0L;
|
||||
for (i=0; i<len; i+=step) {
|
||||
s = (long)samples[i];
|
||||
t += s;
|
||||
p += s * s;
|
||||
}
|
||||
/* correct for dc offset in squares */
|
||||
dc = (double)(t*step) / (double)len;
|
||||
err = t * 2 * dc - dc * dc * len;
|
||||
|
||||
rms = (long int)sqrt((p-err) / len);
|
||||
if (rms < 0) rms = 150;
|
||||
return rms;
|
||||
}
|
||||
|
||||
/*
|
||||
* Mean power (RMS^2 proxy) without sqrt, modeled after mean_power() in rtl_sdr_fm.cpp.
|
||||
* Computes a DC-corrected average of squares to avoid costly sqrt operations.
|
||||
*/
|
||||
long int raw_pwr(int16_t *samples, int len, int step)
|
||||
{
|
||||
int64_t p = 0;
|
||||
int64_t t = 0;
|
||||
for (int i = 0; i < len; i += step) {
|
||||
int64_t s = (int64_t)samples[i];
|
||||
t += s;
|
||||
p += s * s;
|
||||
}
|
||||
/* DC-corrected energy ≈ p - (t^2)/len with rounded division */
|
||||
int64_t dc_corr = 0;
|
||||
if (len > 0) {
|
||||
int64_t tt = t * t;
|
||||
dc_corr = (tt + (len / 2)) / len;
|
||||
}
|
||||
int64_t energy = p - dc_corr;
|
||||
if (energy < 0) energy = 0;
|
||||
return (long int)(energy / (len > 0 ? len : 1));
|
||||
}
|
||||
4002
src/dsd_ncurses.c
Normal file
4002
src/dsd_ncurses.c
Normal file
File diff suppressed because it is too large
Load Diff
@@ -1,940 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_ncurses_handler.c
|
||||
* DSD-FME ncurses terminal user input handler
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2025-05 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
uint8_t ncurses_input_handler(dsd_opts * opts, dsd_state * state, int c)
|
||||
{
|
||||
|
||||
struct stat st_wav = {0};
|
||||
|
||||
// //debug char value
|
||||
// if (c != -1)
|
||||
// fprintf (stderr, "\n User Input: %i / %c ;;", c, c);
|
||||
|
||||
//TEST: Handle Escape Characters
|
||||
//if issues arise, just go back to the way it was before
|
||||
//this is primarly a fix for scroll wheel activatign the menu
|
||||
//and Windows Powershell right-click doing a copy and paste
|
||||
//and sendign tons of garbage getch chars here and changing things
|
||||
if (c == '\033')
|
||||
{
|
||||
//TODO: Find way to getch all the chars immediately after, or just
|
||||
//run getch in a loop in case of somebody copying and pasting a ton of things accidentally
|
||||
for (int i = 0; i < 100000; i++) //wonder how slow this will be
|
||||
getch();
|
||||
c = -1;
|
||||
return 1;
|
||||
}
|
||||
|
||||
//keyboard shortcuts - codes same as ascii codes
|
||||
if (c == 10) //Return / Enter key, open menu
|
||||
{
|
||||
if (opts->m17encoder == 0) //don't allow menu if using M17 encoder
|
||||
ncursesMenu (opts, state);
|
||||
}
|
||||
|
||||
//use k and l keys to test tg hold toggles on slots 1 and slots 2
|
||||
if (c == 107) //'k' key, hold tg on slot 1 for trunking purposes, or toggle clear
|
||||
{
|
||||
if (state->tg_hold == 0)
|
||||
state->tg_hold = state->lasttg;
|
||||
else state->tg_hold = 0;
|
||||
|
||||
if ( (opts->frame_nxdn48 == 1 || opts->frame_nxdn96 == 1) && (state->tg_hold == 0) )
|
||||
state->tg_hold = state->nxdn_last_tg;
|
||||
|
||||
else if (opts->frame_provoice == 1 && state->ea_mode == 0)
|
||||
state->tg_hold = state->lastsrc;
|
||||
}
|
||||
|
||||
if (c == 108) //'l' key, hold tg on slot 2 for trunking purposes, or toggle clear
|
||||
{
|
||||
if (state->tg_hold == 0)
|
||||
state->tg_hold = state->lasttgR;
|
||||
else state->tg_hold = 0;
|
||||
}
|
||||
|
||||
//toggling when 48k/1 OSS still has some lag -- needed to clear out the buffer when switching
|
||||
if (c == 49) // '1' key, toggle slot1 on
|
||||
{
|
||||
//switching, but want to control each seperately plz
|
||||
if (opts->slot1_on == 1)
|
||||
{
|
||||
opts->slot1_on = 0; if (opts->slot_preference == 0) opts->slot_preference = 2;
|
||||
// opts->slot_preference = 1; //slot 2
|
||||
//clear any previously buffered audio
|
||||
state->audio_out_float_buf_p = state->audio_out_float_buf + 100;
|
||||
state->audio_out_buf_p = state->audio_out_buf + 100;
|
||||
memset (state->audio_out_float_buf, 0, 100 * sizeof (float));
|
||||
memset (state->audio_out_buf, 0, 100 * sizeof (short));
|
||||
state->audio_out_idx2 = 0;
|
||||
state->audio_out_idx = 0;
|
||||
}
|
||||
else if (opts->slot1_on == 0)
|
||||
{
|
||||
opts->slot1_on = 1;
|
||||
if (opts->audio_out_type == 5) //OSS 48k/1
|
||||
{
|
||||
opts->slot_preference = 0; //slot 1
|
||||
// opts->slot2_on = 0; //turn off slot 2
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (c == 50) // '2' key, toggle slot2 on
|
||||
{
|
||||
//switching, but want to control each seperately plz
|
||||
if (opts->slot2_on == 1)
|
||||
{
|
||||
opts->slot2_on = 0;
|
||||
opts->slot_preference = 0; //slot 1
|
||||
//clear any previously buffered audio
|
||||
state->audio_out_float_buf_pR = state->audio_out_float_bufR + 100;
|
||||
state->audio_out_buf_pR = state->audio_out_bufR + 100;
|
||||
memset (state->audio_out_float_bufR, 0, 100 * sizeof (float));
|
||||
memset (state->audio_out_bufR, 0, 100 * sizeof (short));
|
||||
state->audio_out_idx2R = 0;
|
||||
state->audio_out_idxR = 0;
|
||||
}
|
||||
else if (opts->slot2_on == 0)
|
||||
{
|
||||
opts->slot2_on = 1;
|
||||
if (opts->audio_out_type == 5) //OSS 48k/1
|
||||
{
|
||||
opts->slot_preference = 1; //slot 2
|
||||
// opts->slot1_on = 0; //turn off slot 1
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// if (c == 51) //'3' key, toggle slot preference on 48k/1
|
||||
// {
|
||||
// if (opts->slot_preference == 1) opts->slot_preference = 0;
|
||||
// else opts->slot_preference = 1;
|
||||
// }
|
||||
|
||||
if (c == 51) //'3' key, cycle slot preference
|
||||
{
|
||||
if (opts->slot_preference == 0 || opts->slot_preference == 1) opts->slot_preference++;
|
||||
else opts->slot_preference = 0;
|
||||
}
|
||||
|
||||
if (c == 43) //+ key, increment audio_gain
|
||||
{
|
||||
|
||||
if (opts->audio_gain < 50)
|
||||
opts->audio_gain++;
|
||||
|
||||
state->aout_gain = opts->audio_gain;
|
||||
state->aout_gainR = opts->audio_gain;
|
||||
|
||||
opts->audio_gainR = opts->audio_gain;
|
||||
|
||||
}
|
||||
|
||||
if (c == 45) //- key, decrement audio_gain
|
||||
{
|
||||
|
||||
if (opts->audio_gain > 0)
|
||||
opts->audio_gain--;
|
||||
|
||||
state->aout_gain = opts->audio_gain;
|
||||
state->aout_gainR = opts->audio_gain;
|
||||
|
||||
//reset to default on 0 for auto
|
||||
if (opts->audio_gain == 0)
|
||||
{
|
||||
state->aout_gain = 25;
|
||||
state->aout_gainR = 25;
|
||||
}
|
||||
|
||||
opts->audio_gainR = opts->audio_gain;
|
||||
|
||||
}
|
||||
|
||||
if (c == 42) // * key, increment audio_gainA
|
||||
{
|
||||
if (opts->audio_gainA < 100)
|
||||
opts->audio_gainA++;
|
||||
}
|
||||
|
||||
if (c == 47) // / key, decrement audio_gainA
|
||||
{
|
||||
if (opts->audio_gainA > 0)
|
||||
opts->audio_gainA--;
|
||||
}
|
||||
|
||||
if (c == 122) //'z' key, toggle payload to console
|
||||
{
|
||||
if (opts->payload == 1) opts->payload = 0;
|
||||
else opts->payload = 1;
|
||||
}
|
||||
|
||||
if (c == 99) //'c' key, toggle compact mode
|
||||
{
|
||||
if (opts->ncurses_compact == 1) opts->ncurses_compact = 0;
|
||||
else opts->ncurses_compact = 1;
|
||||
}
|
||||
|
||||
if (c == 116) //'t' key, toggle trunking
|
||||
{
|
||||
if (opts->p25_trunk == 1) opts->p25_trunk = 0;
|
||||
else opts->p25_trunk = 1;
|
||||
}
|
||||
|
||||
if (c == 121) //'y' key, toggle scanner mode
|
||||
{
|
||||
if (opts->scanner_mode == 1) opts->scanner_mode = 0;
|
||||
else opts->scanner_mode = 1;
|
||||
opts->p25_trunk = 0; //turn off trunking mode
|
||||
}
|
||||
|
||||
if (c == 97) //'a' key, toggle call alert beep
|
||||
{
|
||||
if (opts->call_alert == 1) opts->call_alert = 0;
|
||||
else opts->call_alert = 1;
|
||||
}
|
||||
|
||||
if (c == 104) //'h' key, cycle history off, short, long
|
||||
{
|
||||
opts->ncurses_history++;
|
||||
opts->ncurses_history %= 3;
|
||||
}
|
||||
|
||||
if (c == 113) //'q' key, quit
|
||||
{
|
||||
exitflag = 1;
|
||||
}
|
||||
|
||||
if (c == 52) // '4' key, toggle force privacy key over fid and svc (dmr)
|
||||
{
|
||||
if (state->M == 1 || state->M == 0x21) state->M = 0;
|
||||
else state->M = 1;
|
||||
}
|
||||
|
||||
if (c == 54) // '6' key, toggle force rc4 key over missing pi header/late entry
|
||||
{
|
||||
if (state->M == 1 || state->M == 0x21) state->M = 0;
|
||||
else state->M = 0x21;
|
||||
}
|
||||
|
||||
if (c == 105) //'i' key, toggle signal inversion on inverted types
|
||||
{
|
||||
//Set all signal for inversion or uninversion
|
||||
if (opts->inverted_dmr == 0)
|
||||
{
|
||||
opts->inverted_dmr = 1;
|
||||
opts->inverted_dpmr = 1;
|
||||
opts->inverted_x2tdma = 1;
|
||||
opts->inverted_ysf = 1;
|
||||
opts->inverted_m17 = 1;
|
||||
}
|
||||
else
|
||||
{
|
||||
opts->inverted_dmr = 0;
|
||||
opts->inverted_dpmr = 0;
|
||||
opts->inverted_x2tdma = 0;
|
||||
opts->inverted_ysf = 0;
|
||||
opts->inverted_m17 = 0;
|
||||
}
|
||||
}
|
||||
|
||||
if (c == 109) //'m' key, toggle qpsk/c4fm - everything but phase 2
|
||||
{
|
||||
if (state->rf_mod == 0)
|
||||
{
|
||||
opts->mod_c4fm = 0;
|
||||
opts->mod_qpsk = 1;
|
||||
opts->mod_gfsk = 0;
|
||||
state->rf_mod = 1;
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
}
|
||||
else
|
||||
{
|
||||
opts->mod_c4fm = 1;
|
||||
opts->mod_qpsk = 0;
|
||||
opts->mod_gfsk = 0;
|
||||
state->rf_mod = 0;
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
}
|
||||
}
|
||||
|
||||
if (c == 77) //'M' key, toggle qpsk - phase 2 6000 sps
|
||||
{
|
||||
if (state->rf_mod == 0)
|
||||
{
|
||||
opts->mod_c4fm = 0;
|
||||
opts->mod_qpsk = 1;
|
||||
opts->mod_gfsk = 0;
|
||||
state->rf_mod = 1;
|
||||
state->samplesPerSymbol = 8;
|
||||
state->symbolCenter = 3;
|
||||
}
|
||||
else
|
||||
{
|
||||
opts->mod_c4fm = 1;
|
||||
opts->mod_qpsk = 0;
|
||||
opts->mod_gfsk = 0;
|
||||
state->rf_mod = 0;
|
||||
state->samplesPerSymbol = 8;
|
||||
state->symbolCenter = 3;
|
||||
}
|
||||
}
|
||||
|
||||
if (c == 82) //'R', save symbol capture bin with date/time string as name
|
||||
{
|
||||
//for filenames (no colons, etc)
|
||||
char * timestr = getTime();
|
||||
char * datestr = getDate();
|
||||
sprintf (opts->symbol_out_file, "%s_%s_dibit_capture.bin", datestr, timestr);
|
||||
openSymbolOutFile (opts, state);
|
||||
|
||||
//add a system event to echo in the event history
|
||||
state->event_history_s[0].Event_History_Items[0].color_pair = 4;
|
||||
char event_str[2000]; memset (event_str, 0, sizeof(event_str));
|
||||
sprintf (event_str, "DSD-FME Dibit Capture File Started: %s;", opts->symbol_out_file);
|
||||
watchdog_event_datacall (opts, state, 0xFFFFFF, 0xFFFFFF, event_str, 0);
|
||||
state->lastsrc = 0; //this could wipe a call src if they hit 'R' while call in slot 1 in progress
|
||||
watchdog_event_history(opts, state, 0);
|
||||
watchdog_event_current(opts, state, 0);
|
||||
|
||||
//allocated memory pointer needs to be free'd
|
||||
if (timestr != NULL)
|
||||
{
|
||||
free (timestr);
|
||||
timestr = NULL;
|
||||
}
|
||||
if (datestr != NULL)
|
||||
{
|
||||
free (datestr);
|
||||
datestr = NULL;
|
||||
}
|
||||
opts->symbol_out_file_creation_time = time(NULL);
|
||||
opts->symbol_out_file_is_auto = 1;
|
||||
}
|
||||
|
||||
if (c == 114) //'r' key, stop capturing symbol capture bin file
|
||||
{
|
||||
if (opts->symbol_out_f)
|
||||
{
|
||||
closeSymbolOutFile (opts, state);
|
||||
sprintf (opts->audio_in_dev, "%s", opts->symbol_out_file);
|
||||
|
||||
//add a system event to echo in the event history
|
||||
state->event_history_s[0].Event_History_Items[0].color_pair = 4;
|
||||
char event_str[2000]; memset (event_str, 0, sizeof(event_str));
|
||||
sprintf (event_str, "DSD-FME Dibit Capture File Closed: %s;", opts->symbol_out_file);
|
||||
watchdog_event_datacall (opts, state, 0xFFFFFF, 0xFFFFFF, event_str, 0);
|
||||
state->lastsrc = 0; //this could wipe a call src if they hit 'R' while call in slot 1 in progress
|
||||
watchdog_event_history(opts, state, 0);
|
||||
watchdog_event_current(opts, state, 0);
|
||||
|
||||
}
|
||||
opts->symbol_out_file_is_auto = 0;
|
||||
}
|
||||
|
||||
#ifdef __CYGWIN__
|
||||
//do nothing
|
||||
#else
|
||||
if (c == 32) //'space bar' replay last bin file (rework to do wav files too?)
|
||||
{
|
||||
struct stat stat_buf;
|
||||
if (stat(opts->audio_in_dev, &stat_buf) != 0)
|
||||
{
|
||||
fprintf (stderr,"Error, couldn't open %s\n", opts->audio_in_dev);
|
||||
goto SKIPR;
|
||||
}
|
||||
if (S_ISREG(stat_buf.st_mode))
|
||||
{
|
||||
opts->symbolfile = fopen(opts->audio_in_dev, "r");
|
||||
opts->audio_in_type = 4; //symbol capture bin files
|
||||
}
|
||||
SKIPR: ; //do nothing
|
||||
}
|
||||
#endif
|
||||
|
||||
if (c == 80) //'P' key - start per call wav files //TODO: Fix
|
||||
{
|
||||
char wav_file_directory[1024];
|
||||
sprintf (wav_file_directory, "%s", opts->wav_out_dir);
|
||||
wav_file_directory[1023] = '\0';
|
||||
if (stat(wav_file_directory, &st_wav) == -1)
|
||||
{
|
||||
fprintf (stderr, "%s wav file directory does not exist\n", wav_file_directory);
|
||||
fprintf (stderr, "Creating directory %s to save decoded wav files\n", wav_file_directory);
|
||||
mkdir(wav_file_directory, 0700);
|
||||
}
|
||||
fprintf (stderr,"\n Per Call Wav File Enabled to Directory: %s;.\n", opts->wav_out_dir);
|
||||
srand(time(NULL)); //seed random for filenames (so two filenames aren't the exact same datetime string on initailization)
|
||||
opts->wav_out_f = open_wav_file(opts->wav_out_dir, opts->wav_out_file, 8000, 0);
|
||||
opts->wav_out_fR = open_wav_file(opts->wav_out_dir, opts->wav_out_fileR, 8000, 0);
|
||||
opts->dmr_stereo_wav = 1;
|
||||
}
|
||||
|
||||
if (c == 112) //'p' key - stop all per call wav files //TODO: Fix
|
||||
{
|
||||
//TODO: Add Closing of RAW files as well?
|
||||
opts->wav_out_f = close_and_rename_wav_file(opts->wav_out_f, opts->wav_out_file, opts->wav_out_dir, &state->event_history_s[0]);
|
||||
opts->wav_out_fR = close_and_rename_wav_file(opts->wav_out_fR, opts->wav_out_fileR, opts->wav_out_dir, &state->event_history_s[1]);
|
||||
opts->wav_out_file[0] = 0; //Bugfix for decoded wav file display after disabling
|
||||
opts->wav_out_fileR[0] = 0;
|
||||
opts->dmr_stereo_wav = 0;
|
||||
}
|
||||
|
||||
//
|
||||
#ifdef __CYGWIN__ //this might be okay on Aero as well, will need to look into and/or test
|
||||
//
|
||||
#else
|
||||
if (c == 115) //'s' key, stop playing wav or symbol in files
|
||||
{
|
||||
if (opts->symbolfile != NULL)
|
||||
{
|
||||
if (opts->audio_in_type == 4)
|
||||
{
|
||||
fclose(opts->symbolfile);
|
||||
}
|
||||
}
|
||||
|
||||
if (opts->audio_in_type == 2) //wav input file
|
||||
{
|
||||
sf_close(opts->audio_in_file);
|
||||
}
|
||||
|
||||
if (opts->audio_out_type == 0)
|
||||
{
|
||||
opts->audio_in_type = 0;
|
||||
openPulseInput(opts);
|
||||
}
|
||||
else opts->audio_in_type = 5; //exitflag = 1;
|
||||
|
||||
}
|
||||
#endif
|
||||
|
||||
//makes buzzing sound when locked out in new audio config and short, probably something to do with processaudio running or not running
|
||||
if (state->lasttg != 0 && opts->frame_provoice != 1 && c == 33) //SHIFT+'1' key (exclamation point), lockout slot 1 or conventional tg from tuning/playback during session
|
||||
{
|
||||
state->group_array[state->group_tally].groupNumber = state->lasttg;
|
||||
sprintf (state->group_array[state->group_tally].groupMode, "%s", "B");
|
||||
sprintf (state->group_array[state->group_tally].groupName, "%s", "LOCKOUT");
|
||||
state->group_tally++;
|
||||
|
||||
sprintf (state->event_history_s[0].Event_History_Items[0].internal_str, "Target: %d; has been locked out; User Lock Out.", state->lasttg);
|
||||
watchdog_event_current(opts, state, 0);
|
||||
sprintf (state->call_string[0], "%s", " "); //21 spaces
|
||||
|
||||
//if we have an opened group file, let's write a group lock out into it to make it permanent
|
||||
if (opts->group_in_file[0] != 0) //file is available
|
||||
{
|
||||
FILE * pFile; //file pointer
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->group_in_file, "a");
|
||||
fprintf (pFile, "%d,B,LOCKOUT,%02X\n", state->lasttg, state->payload_algid);
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
//extra safeguards due to sync issues with NXDN
|
||||
memset (state->nxdn_sacch_frame_segment, 1, sizeof(state->nxdn_sacch_frame_segment));
|
||||
memset (state->nxdn_sacch_frame_segcrc, 1, sizeof(state->nxdn_sacch_frame_segcrc));
|
||||
|
||||
memset (state->active_channel, 0, sizeof(state->active_channel));
|
||||
|
||||
//reset dmr blocks
|
||||
dmr_reset_blocks (opts, state);
|
||||
|
||||
//zero out additional items
|
||||
state->lasttg = 0;
|
||||
state->lasttgR = 0;
|
||||
state->lastsrc = 0;
|
||||
state->lastsrcR = 0;
|
||||
state->payload_algid = 0;
|
||||
state->payload_algidR = 0;
|
||||
state->payload_keyid = 0;
|
||||
state->payload_keyidR = 0;
|
||||
state->payload_mi = 0;
|
||||
state->payload_miR = 0;
|
||||
state->payload_miP = 0;
|
||||
state->payload_miN = 0;
|
||||
opts->p25_is_tuned = 0;
|
||||
state->p25_vc_freq[0] = state->p25_vc_freq[1] = 0;
|
||||
|
||||
//tune back to the control channel -- NOTE: Doesn't work correctly on EDACS Analog Voice
|
||||
//RIGCTL
|
||||
if (opts->p25_trunk == 1 && opts->use_rigctl == 1)
|
||||
{
|
||||
//drop all items (failsafe)
|
||||
noCarrier(opts, state);
|
||||
if (opts->setmod_bw != 0 ) SetModulation(opts->rigctl_sockfd, opts->setmod_bw);
|
||||
SetFreq(opts->rigctl_sockfd, state->p25_cc_freq);
|
||||
}
|
||||
|
||||
//rtl
|
||||
#ifdef USE_RTLSDR
|
||||
if (opts->p25_trunk == 1 && opts->audio_in_type == 3)
|
||||
{
|
||||
//drop all items (failsafe)
|
||||
noCarrier(opts, state);
|
||||
rtl_dev_tune (opts, state->p25_cc_freq);
|
||||
}
|
||||
#endif
|
||||
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
|
||||
//if P25p2 VCH and going back to P25p1 CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 0)
|
||||
{
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
if (state->lasttgR != 0 && opts->frame_provoice != 1 && c == 64) //SHIFT+'2' key (@ at sign), lockout slot 2 tdma tgR from tuning/playback during session
|
||||
{
|
||||
state->group_array[state->group_tally].groupNumber = state->lasttgR;
|
||||
sprintf (state->group_array[state->group_tally].groupMode, "%s", "B");
|
||||
sprintf (state->group_array[state->group_tally].groupName, "%s", "LOCKOUT");
|
||||
state->group_tally++;
|
||||
|
||||
sprintf (state->event_history_s[1].Event_History_Items[0].internal_str, "Target: %d; has been locked out; User Lock Out.", state->lasttgR);
|
||||
watchdog_event_current(opts, state, 1);
|
||||
sprintf (state->call_string[1], "%s", " "); //21 spaces
|
||||
|
||||
//if we have an opened group file, let's write a group lock out into it to make it permanent
|
||||
if (opts->group_in_file[0] != 0) //file is available
|
||||
{
|
||||
FILE * pFile; //file pointer
|
||||
//open file by name that is supplied in the ncurses terminal, or cli
|
||||
pFile = fopen (opts->group_in_file, "a");
|
||||
fprintf (pFile, "%d,B,LOCKOUT,%02X\n", state->lasttgR, state->payload_algidR);
|
||||
fclose (pFile);
|
||||
}
|
||||
|
||||
//extra safeguards due to sync issues with NXDN
|
||||
memset (state->nxdn_sacch_frame_segment, 1, sizeof(state->nxdn_sacch_frame_segment));
|
||||
memset (state->nxdn_sacch_frame_segcrc, 1, sizeof(state->nxdn_sacch_frame_segcrc));
|
||||
|
||||
memset (state->active_channel, 0, sizeof(state->active_channel));
|
||||
|
||||
//reset dmr blocks
|
||||
dmr_reset_blocks (opts, state);
|
||||
|
||||
//zero out additional items
|
||||
state->lasttg = 0;
|
||||
state->lasttgR = 0;
|
||||
state->lastsrc = 0;
|
||||
state->lastsrcR = 0;
|
||||
state->payload_algid = 0;
|
||||
state->payload_algidR = 0;
|
||||
state->payload_keyid = 0;
|
||||
state->payload_keyidR = 0;
|
||||
state->payload_mi = 0;
|
||||
state->payload_miR = 0;
|
||||
state->payload_miP = 0;
|
||||
state->payload_miN = 0;
|
||||
opts->p25_is_tuned = 0;
|
||||
state->p25_vc_freq[0] = state->p25_vc_freq[1] = 0;
|
||||
|
||||
//tune back to the control channel -- NOTE: Doesn't work correctly on EDACS Analog Voice
|
||||
//RIGCTL
|
||||
if (opts->p25_trunk == 1 && opts->use_rigctl == 1)
|
||||
{
|
||||
//drop all items (failsafe)
|
||||
noCarrier(opts, state);
|
||||
if (opts->setmod_bw != 0 ) SetModulation(opts->rigctl_sockfd, opts->setmod_bw);
|
||||
SetFreq(opts->rigctl_sockfd, state->p25_cc_freq);
|
||||
}
|
||||
|
||||
//rtl
|
||||
#ifdef USE_RTLSDR
|
||||
if (opts->p25_trunk == 1 && opts->audio_in_type == 3)
|
||||
{
|
||||
//drop all items (failsafe)
|
||||
noCarrier(opts, state);
|
||||
rtl_dev_tune (opts, state->p25_cc_freq);
|
||||
}
|
||||
#endif
|
||||
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
|
||||
//if P25p2 VCH and going back to P25p1 CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 0)
|
||||
{
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
if (opts->p25_trunk == 1 && c == 119) //'w' key, toggle white list/black list mode
|
||||
{
|
||||
if (opts->trunk_use_allow_list == 1) opts->trunk_use_allow_list = 0;
|
||||
else opts->trunk_use_allow_list = 1;
|
||||
}
|
||||
|
||||
if (opts->p25_trunk == 1 && c == 117) //'u' key, toggle tune private calls
|
||||
{
|
||||
if (opts->trunk_tune_private_calls == 1) opts->trunk_tune_private_calls = 0;
|
||||
else opts->trunk_tune_private_calls = 1;
|
||||
}
|
||||
|
||||
if (opts->p25_trunk == 1 && c == 100) //'d' key, toggle tune data calls
|
||||
{
|
||||
if (opts->trunk_tune_data_calls == 1) opts->trunk_tune_data_calls = 0;
|
||||
else opts->trunk_tune_data_calls = 1;
|
||||
}
|
||||
|
||||
if (opts->p25_trunk == 1 && c == 101) //'e' key, toggle tune enc calls (P25 only on certain grants)
|
||||
{
|
||||
if (opts->trunk_tune_enc_calls == 1) opts->trunk_tune_enc_calls = 0;
|
||||
else opts->trunk_tune_enc_calls = 1;
|
||||
}
|
||||
|
||||
if (opts->p25_trunk == 1 && c == 103) //'g' key, toggle tune group calls
|
||||
{
|
||||
if (opts->trunk_tune_group_calls == 1) opts->trunk_tune_group_calls = 0;
|
||||
else opts->trunk_tune_group_calls = 1;
|
||||
}
|
||||
|
||||
if (c == 70) //'F' key - toggle agressive sync/crc failure/ras
|
||||
{
|
||||
if (opts->aggressive_framesync == 0) opts->aggressive_framesync = 1;
|
||||
else opts->aggressive_framesync = 0;
|
||||
}
|
||||
|
||||
if (c == 68) //'D' key - Reset DMR Site Parms/Call Strings, etc.
|
||||
{
|
||||
//dmr trunking/ncurses stuff
|
||||
state->dmr_rest_channel = -1; //init on -1
|
||||
state->dmr_mfid = -1; //
|
||||
|
||||
//dmr mfid branding and site parms
|
||||
sprintf(state->dmr_branding_sub, "%s", "");
|
||||
sprintf(state->dmr_branding, "%s", "");
|
||||
sprintf (state->dmr_site_parms, "%s", "");
|
||||
|
||||
//DMR Location Area - DMRLA B***S***
|
||||
opts->dmr_dmrla_is_set = 0;
|
||||
opts->dmr_dmrla_n = 0;
|
||||
|
||||
//reset NXDN info
|
||||
state->nxdn_location_site_code = 0;
|
||||
state->nxdn_location_sys_code = 0;
|
||||
sprintf (state->nxdn_location_category, "%s", " ");
|
||||
|
||||
state->nxdn_last_ran = -1; //0
|
||||
state->nxdn_ran = 0; //0
|
||||
|
||||
state->nxdn_rcn = 0;
|
||||
state->nxdn_base_freq = 0;
|
||||
state->nxdn_step = 0;
|
||||
state->nxdn_bw = 0;
|
||||
|
||||
}
|
||||
|
||||
//Debug/Troubleshooting Option
|
||||
if (c == 90) //'Z' key - Simulate NoCarrier/No VC/CC sync to zero out more stuff (capital Z)
|
||||
{
|
||||
// opts->p25_is_tuned = 0;
|
||||
state->last_cc_sync_time = 0;
|
||||
state->last_vc_sync_time = 0;
|
||||
noCarrier(opts, state);
|
||||
}
|
||||
|
||||
if (c == 93) //']' key - increment event history indexer
|
||||
{
|
||||
state->eh_index++;
|
||||
}
|
||||
|
||||
if (c == 91) //'[' key - decrement event history indexer
|
||||
{
|
||||
state->eh_index--;
|
||||
}
|
||||
|
||||
if (c == 92) //'\' key - toggle events for slot displayed, and reset eh_index
|
||||
{
|
||||
state->eh_slot ^= 1;
|
||||
state->eh_index = 0;
|
||||
}
|
||||
|
||||
//attempt retry to TCP Audio server
|
||||
if (c == 56) // '8' key, try audio in type 8 (TCP Audio Server connection) using defaults OR whatever the user last specified
|
||||
{
|
||||
|
||||
opts->tcp_sockfd = Connect(opts->tcp_hostname, opts->tcp_portno);
|
||||
if (opts->tcp_sockfd != 0)
|
||||
{
|
||||
//reset audio input stream
|
||||
opts->audio_in_file_info = calloc(1, sizeof(SF_INFO));
|
||||
opts->audio_in_file_info->samplerate=opts->wav_sample_rate;
|
||||
opts->audio_in_file_info->channels=1;
|
||||
opts->audio_in_file_info->seekable=0;
|
||||
opts->audio_in_file_info->format=SF_FORMAT_RAW|SF_FORMAT_PCM_16|SF_ENDIAN_LITTLE;
|
||||
opts->tcp_file_in = sf_open_fd(opts->tcp_sockfd, SFM_READ, opts->audio_in_file_info, 0);
|
||||
|
||||
if(opts->tcp_file_in == NULL)
|
||||
{
|
||||
fprintf(stderr, "Error, couldn't Connect to TCP with libsndfile: %s\n", sf_strerror(NULL));
|
||||
}
|
||||
else
|
||||
{
|
||||
//close pulse input if it is currently open
|
||||
if (opts->audio_in_type == 0) closePulseInput(opts);
|
||||
fprintf (stderr, "TCP Socket Connected Successfully.\n");
|
||||
opts->audio_in_type = 8;
|
||||
}
|
||||
}
|
||||
else fprintf (stderr, "TCP Socket Connection Error.\n");
|
||||
}
|
||||
|
||||
if (c == 57) //'9' key, try rigctl connection with default values
|
||||
{
|
||||
//use same or last specified host for TCP audio sink for connection
|
||||
memcpy (opts->rigctlhostname, opts->tcp_hostname, sizeof (opts->rigctlhostname) );
|
||||
opts->rigctl_sockfd = Connect(opts->rigctlhostname, opts->rigctlportno);
|
||||
if (opts->rigctl_sockfd != 0) opts->use_rigctl = 1;
|
||||
else opts->use_rigctl = 0;
|
||||
}
|
||||
|
||||
//if trunking and user wants to just go back to the control channel and skip this call
|
||||
if (opts->p25_trunk == 1 && state->p25_cc_freq != 0 && c == 67) //Capital C key - Return to CC
|
||||
{
|
||||
|
||||
//extra safeguards due to sync issues with NXDN
|
||||
memset (state->nxdn_sacch_frame_segment, 1, sizeof(state->nxdn_sacch_frame_segment));
|
||||
memset (state->nxdn_sacch_frame_segcrc, 1, sizeof(state->nxdn_sacch_frame_segcrc));
|
||||
|
||||
memset (state->active_channel, 0, sizeof(state->active_channel));
|
||||
|
||||
//reset dmr blocks
|
||||
dmr_reset_blocks (opts, state);
|
||||
|
||||
//zero out additional items
|
||||
state->lasttg = 0;
|
||||
state->lasttgR = 0;
|
||||
state->lastsrc = 0;
|
||||
state->lastsrcR = 0;
|
||||
state->payload_algid = 0;
|
||||
state->payload_algidR = 0;
|
||||
state->payload_keyid = 0;
|
||||
state->payload_keyidR = 0;
|
||||
state->payload_mi = 0;
|
||||
state->payload_miR = 0;
|
||||
state->payload_miP = 0;
|
||||
state->payload_miN = 0;
|
||||
opts->p25_is_tuned = 0;
|
||||
state->p25_vc_freq[0] = state->p25_vc_freq[1] = 0;
|
||||
|
||||
//tune back to the control channel -- NOTE: Doesn't work correctly on EDACS Analog Voice
|
||||
//RIGCTL
|
||||
if (opts->p25_trunk == 1 && opts->use_rigctl == 1)
|
||||
{
|
||||
if (opts->setmod_bw != 0 ) SetModulation(opts->rigctl_sockfd, opts->setmod_bw);
|
||||
SetFreq(opts->rigctl_sockfd, state->p25_cc_freq);
|
||||
}
|
||||
|
||||
//rtl
|
||||
#ifdef USE_RTLSDR
|
||||
if (opts->p25_trunk == 1 && opts->audio_in_type == 3) rtl_dev_tune (opts, state->p25_cc_freq);
|
||||
#endif
|
||||
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
|
||||
//if P25p2 VCH and going back to P25p1 CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 0)
|
||||
{
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
}
|
||||
|
||||
//if P25p1 Data Revert on P25p2 TDMA CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 1)
|
||||
{
|
||||
state->samplesPerSymbol = 8;
|
||||
state->symbolCenter = 3;
|
||||
}
|
||||
|
||||
fprintf (stderr, "\n User Activated Return to CC; \n ");
|
||||
|
||||
}
|
||||
|
||||
//if trunking or scanning, manually cycle forward through channels loaded (can be run without trunking or scanning enabled)
|
||||
if ( (opts->use_rigctl == 1 || opts->audio_in_type == 3) && c == 76) //Capital L key - Cycle Channels Forward
|
||||
{
|
||||
|
||||
//extra safeguards due to sync issues with NXDN
|
||||
memset (state->nxdn_sacch_frame_segment, 1, sizeof(state->nxdn_sacch_frame_segment));
|
||||
memset (state->nxdn_sacch_frame_segcrc, 1, sizeof(state->nxdn_sacch_frame_segcrc));
|
||||
|
||||
memset (state->active_channel, 0, sizeof(state->active_channel));
|
||||
|
||||
//reset dmr blocks
|
||||
dmr_reset_blocks (opts, state);
|
||||
|
||||
//zero out additional items
|
||||
state->lasttg = 0;
|
||||
state->lasttgR = 0;
|
||||
state->lastsrc = 0;
|
||||
state->lastsrcR = 0;
|
||||
state->payload_algid = 0;
|
||||
state->payload_algidR = 0;
|
||||
state->payload_keyid = 0;
|
||||
state->payload_keyidR = 0;
|
||||
state->payload_mi = 0;
|
||||
state->payload_miR = 0;
|
||||
state->payload_miP = 0;
|
||||
state->payload_miN = 0;
|
||||
opts->p25_is_tuned = 0;
|
||||
state->p25_vc_freq[0] = state->p25_vc_freq[1] = 0;
|
||||
|
||||
//just copy and pasted the cycle logic for CC/signal hunting on no sync
|
||||
if (state->lcn_freq_roll >= state->lcn_freq_count) //fixed this to skip the extra wait out at the end of the list
|
||||
{
|
||||
state->lcn_freq_roll = 0; //reset to zero
|
||||
}
|
||||
|
||||
//roll an extra value up if the current is the same as what's already loaded -- faster hunting on Cap+, etc
|
||||
if (state->lcn_freq_roll != 0)
|
||||
{
|
||||
if (state->trunk_lcn_freq[state->lcn_freq_roll-1] == state->trunk_lcn_freq[state->lcn_freq_roll])
|
||||
{
|
||||
state->lcn_freq_roll++;
|
||||
//check roll again if greater than expected, then go back to zero
|
||||
if (state->lcn_freq_roll >= state->lcn_freq_count)
|
||||
{
|
||||
state->lcn_freq_roll = 0; //reset to zero
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
//check that we have a non zero value first, then tune next frequency
|
||||
if (state->trunk_lcn_freq[state->lcn_freq_roll] != 0)
|
||||
{
|
||||
//rigctl
|
||||
if (opts->use_rigctl == 1)
|
||||
{
|
||||
if (opts->setmod_bw != 0 ) SetModulation(opts->rigctl_sockfd, opts->setmod_bw);
|
||||
SetFreq(opts->rigctl_sockfd, state->trunk_lcn_freq[state->lcn_freq_roll]);
|
||||
}
|
||||
//rtl
|
||||
if (opts->audio_in_type == 3)
|
||||
{
|
||||
#ifdef USE_RTLSDR
|
||||
rtl_dev_tune (opts, state->trunk_lcn_freq[state->lcn_freq_roll]);
|
||||
#endif
|
||||
}
|
||||
|
||||
fprintf (stderr, "\n User Activated Channel Cycle;");
|
||||
fprintf (stderr, " Tuning to Frequency: %.06lf MHz\n",
|
||||
(double)state->trunk_lcn_freq[state->lcn_freq_roll]/1000000);
|
||||
|
||||
}
|
||||
state->lcn_freq_roll++;
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
|
||||
|
||||
//may need to test to see if we want to do the conditional below or not for symbol rate flipping
|
||||
|
||||
//if P25p2 VCH and going back to P25p1 CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 0)
|
||||
{
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
}
|
||||
|
||||
//if P25p1 Data Revert on P25p2 TDMA CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 1)
|
||||
{
|
||||
state->samplesPerSymbol = 8;
|
||||
state->symbolCenter = 3;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
if (c == 118 && opts->audio_in_type == 3) //'v' key, cycle rtl volume multiplier, when active
|
||||
{
|
||||
if (opts->rtl_volume_multiplier == 1 || opts->rtl_volume_multiplier == 2) opts->rtl_volume_multiplier++;
|
||||
else opts->rtl_volume_multiplier = 1;
|
||||
}
|
||||
|
||||
if (c == 86) // 'V' Key, toggle LPF
|
||||
{
|
||||
if (opts->use_lpf == 0) opts->use_lpf = 1;
|
||||
else opts->use_lpf = 0;
|
||||
}
|
||||
|
||||
if (c == 66) // 'B' Key, toggle HPF
|
||||
{
|
||||
if (opts->use_hpf == 0) opts->use_hpf = 1;
|
||||
else opts->use_hpf = 0;
|
||||
}
|
||||
|
||||
if (c == 78) // 'N' Key, toggle PBF
|
||||
{
|
||||
if (opts->use_pbf == 0) opts->use_pbf = 1;
|
||||
else opts->use_pbf = 0;
|
||||
}
|
||||
|
||||
if (c == 72) // 'H' Key, toggle HPF on digital
|
||||
{
|
||||
if (opts->use_hpf_d == 0) opts->use_hpf_d = 1;
|
||||
else opts->use_hpf_d = 0;
|
||||
}
|
||||
|
||||
if (opts->m17encoder == 1 && c == 92) //'\' key - toggle M17 encoder Encode + TX
|
||||
{
|
||||
if (state->m17encoder_tx == 0) state->m17encoder_tx = 1;
|
||||
else state->m17encoder_tx = 0;
|
||||
|
||||
//flag on the EOT marker to send last frame after toggling encoder to zero
|
||||
if (state->m17encoder_tx == 0) state->m17encoder_eot = 1;
|
||||
|
||||
}
|
||||
|
||||
if(opts->frame_provoice == 1 && c == 65) //'A' Key, toggle ESK mask 0xA0
|
||||
{
|
||||
if (state->esk_mask == 0) state->esk_mask = 0xA0;
|
||||
else state->esk_mask = 0;
|
||||
}
|
||||
|
||||
if(opts->frame_provoice == 1 && c == 83) //'S' Key, toggle STD or EA mode and reset
|
||||
{
|
||||
if (state->ea_mode == -1) state->ea_mode = 0;
|
||||
else if (state->ea_mode == 0) state->ea_mode = 1;
|
||||
else state->ea_mode = 0;
|
||||
|
||||
//reset -- test to make sure these don't do weird things when reset
|
||||
state->edacs_site_id = 0;
|
||||
state->edacs_lcn_count = 0;
|
||||
state->edacs_cc_lcn = 0;
|
||||
state->edacs_vc_lcn = 0;
|
||||
state->edacs_tuned_lcn = -1;
|
||||
state->edacs_vc_call_type = 0;
|
||||
state->p25_cc_freq = 0;
|
||||
opts->p25_is_tuned = 0;
|
||||
state->lasttg = 0;
|
||||
state->lastsrc = 0;
|
||||
|
||||
}
|
||||
|
||||
//RTL PPM Manual Adjustment
|
||||
if (c == 125)
|
||||
opts->rtlsdr_ppm_error++;
|
||||
|
||||
if (c == 123)
|
||||
opts->rtlsdr_ppm_error--;
|
||||
|
||||
//anything with an entry box will need the inputs and outputs stopped first
|
||||
//so probably just write a function to handle c input, and when c = certain values
|
||||
//needing an entry box, then stop all of those
|
||||
|
||||
return 0;
|
||||
|
||||
} //end ncursesPrinter
|
||||
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
@@ -6,14 +6,14 @@
|
||||
void resetState (dsd_state * state)
|
||||
{
|
||||
|
||||
int i;
|
||||
int i, j;
|
||||
|
||||
//Dibit Buffer -- Free Allocated Memory
|
||||
// free (state->dibit_buf);
|
||||
|
||||
//Dibit Buffer -- Memset/Init/Allocate Memory
|
||||
// state->dibit_buf = malloc (sizeof (int) * 1000000);
|
||||
|
||||
|
||||
state->dibit_buf_p = state->dibit_buf + 200;
|
||||
memset (state->dibit_buf, 0, sizeof (int) * 200);
|
||||
state->repeat = 0; //repeat frame?
|
||||
@@ -32,7 +32,7 @@ void resetState (dsd_state * state)
|
||||
|
||||
memset (state->audio_out_buf, 0, 100 * sizeof (short));
|
||||
state->audio_out_buf_p = state->audio_out_buf + 100;
|
||||
|
||||
|
||||
memset (state->audio_out_float_buf, 0, 100 * sizeof (float));
|
||||
state->audio_out_float_buf_p = state->audio_out_float_buf + 100;
|
||||
|
||||
@@ -46,7 +46,7 @@ void resetState (dsd_state * state)
|
||||
|
||||
memset (state->audio_out_bufR, 0, 100 * sizeof (short));
|
||||
state->audio_out_buf_pR = state->audio_out_bufR + 100;
|
||||
|
||||
|
||||
memset (state->audio_out_float_bufR, 0, 100 * sizeof (float));
|
||||
state->audio_out_float_buf_pR = state->audio_out_float_bufR + 100;
|
||||
|
||||
@@ -100,12 +100,12 @@ void resetState (dsd_state * state)
|
||||
state->numtdulc = 0;
|
||||
state->firstframe = 0;
|
||||
|
||||
//unsure if these are still used or ever were used,
|
||||
//unsure if these are still used or ever were used,
|
||||
// memset (state->aout_max_buf, 0, sizeof (float) * 200);
|
||||
// state->aout_max_buf_p = state->aout_max_buf;
|
||||
// state->aout_max_buf_idx = 0;
|
||||
|
||||
// //MBE Specific
|
||||
// //MBE Specific
|
||||
// //free the memory before allocating it again -- may not use this
|
||||
// free (state->cur_mp);
|
||||
// free (state->prev_mp);
|
||||
|
||||
314
src/dsd_rigctl.c
314
src/dsd_rigctl.c
@@ -30,16 +30,12 @@ void error(char *msg) {
|
||||
exit(0);
|
||||
}
|
||||
|
||||
struct sockaddr_in address;
|
||||
struct sockaddr_in addressA;
|
||||
struct sockaddr_in addressM17;
|
||||
|
||||
//
|
||||
// Connect
|
||||
//
|
||||
int Connect (char *hostname, int portno)
|
||||
{
|
||||
int sockfd;
|
||||
int sockfd, n;
|
||||
struct sockaddr_in serveraddr;
|
||||
struct hostent *server;
|
||||
|
||||
@@ -51,14 +47,14 @@ int Connect (char *hostname, int portno)
|
||||
fprintf(stderr,"ERROR opening socket\n");
|
||||
error("ERROR opening socket");
|
||||
}
|
||||
|
||||
|
||||
|
||||
/* gethostbyname: get the server's DNS entry */
|
||||
server = gethostbyname(hostname);
|
||||
if (server == NULL) {
|
||||
fprintf(stderr,"ERROR, no such host as %s\n", hostname);
|
||||
//exit(0);
|
||||
return (0); //return 0, check on other end and configure pulse input
|
||||
return (0); //return 0, check on other end and configure pulse input
|
||||
}
|
||||
|
||||
/* build the server's Internet address */
|
||||
@@ -73,7 +69,7 @@ int Connect (char *hostname, int portno)
|
||||
{
|
||||
fprintf(stderr,"ERROR opening socket\n");
|
||||
return (0);
|
||||
}
|
||||
}
|
||||
|
||||
return sockfd;
|
||||
}
|
||||
@@ -108,7 +104,7 @@ bool Recv(int sockfd, char *buf)
|
||||
//
|
||||
// GQRX Protocol
|
||||
//
|
||||
long int GetCurrentFreq(int sockfd)
|
||||
long int GetCurrentFreq(int sockfd)
|
||||
{
|
||||
long int freq = 0;
|
||||
char buf[BUFSIZE];
|
||||
@@ -116,13 +112,13 @@ long int GetCurrentFreq(int sockfd)
|
||||
char * token;
|
||||
|
||||
Send(sockfd, "f\n");
|
||||
Recv(sockfd, buf);
|
||||
Recv(sockfd, buf);
|
||||
|
||||
if (strcmp(buf, "RPRT 1") == 0 )
|
||||
if (strcmp(buf, "RPRT 1") == 0 )
|
||||
return freq;
|
||||
|
||||
token = strtok (buf, "\n");
|
||||
freq = strtol (token, &ptr, 10);
|
||||
token = strtok (buf, "\n");
|
||||
freq = strtol (token, &ptr, 10);
|
||||
// fprintf (stderr, "\nRIGCTL VFO Freq: [%ld]\n", freq);
|
||||
return freq;
|
||||
}
|
||||
@@ -131,33 +127,25 @@ bool SetFreq(int sockfd, long int freq)
|
||||
{
|
||||
char buf[BUFSIZE];
|
||||
|
||||
sprintf (buf, "F %ld\n", freq);
|
||||
sprintf (buf, "F %ld\n", freq);
|
||||
Send(sockfd, buf);
|
||||
Recv(sockfd, buf);
|
||||
|
||||
if (strcmp(buf, "RPRT 1\n") == 0 ) //sdr++ has a linebreak here, is that in all versions of the protocol?
|
||||
if (strcmp(buf, "RPRT 1") == 0 )
|
||||
return false;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
bool SetModulation(int sockfd, int bandwidth)
|
||||
bool SetModulation(int sockfd, int bandwidth)
|
||||
{
|
||||
char buf[BUFSIZE];
|
||||
//the bandwidth is now a user/system based configurable variable
|
||||
sprintf (buf, "M NFM %d\n", bandwidth); //SDR++ has changed the token from FM to NFM, even if Ryzerth fixes it later, users may still have an older version
|
||||
sprintf (buf, "M FM %d\n", bandwidth);
|
||||
Send(sockfd, buf);
|
||||
Recv(sockfd, buf);
|
||||
|
||||
//if it fails the first time, send the other token instead
|
||||
if (strcmp(buf, "RPRT 1\n") == 0 ) //sdr++ has a linebreak here, is that in all versions of the protocol?
|
||||
{
|
||||
sprintf (buf, "M FM %d\n", bandwidth); //anything not SDR++
|
||||
Send(sockfd, buf);
|
||||
Recv(sockfd, buf);
|
||||
}
|
||||
|
||||
if (strcmp(buf, "RPRT 1\n") == 0 )
|
||||
if (strcmp(buf, "RPRT 1") == 0 )
|
||||
return false;
|
||||
|
||||
return true;
|
||||
@@ -234,10 +222,9 @@ bool GetSignalLevelEx(int sockfd, double *dBFS, int n_samp)
|
||||
//shoe in UDP input connection here...still having issues that I don't know how to resolve
|
||||
int UDPBind (char *hostname, int portno)
|
||||
{
|
||||
UNUSED(hostname);
|
||||
|
||||
int sockfd;
|
||||
struct sockaddr_in serveraddr;
|
||||
int sockfd, n;
|
||||
struct sockaddr_in serveraddr, client_addr;
|
||||
struct hostent *server;
|
||||
|
||||
/* socket: create the socket */
|
||||
//UDP socket
|
||||
@@ -256,26 +243,18 @@ int UDPBind (char *hostname, int portno)
|
||||
serveraddr.sin_port = htons(portno);
|
||||
|
||||
//Bind socket to listening
|
||||
if (bind(sockfd, (struct sockaddr *) &serveraddr, sizeof(serveraddr)) < 0) {
|
||||
if (bind(sockfd, (struct sockaddr *) &serveraddr, sizeof(serveraddr)) < 0) {
|
||||
perror("ERROR on binding UDP Port");
|
||||
}
|
||||
|
||||
//set these for non blocking when no samples to read
|
||||
struct timeval read_timeout;
|
||||
read_timeout.tv_sec = 0;
|
||||
read_timeout.tv_usec = 10;
|
||||
setsockopt(sockfd, SOL_SOCKET, SO_RCVTIMEO, &read_timeout, sizeof read_timeout);
|
||||
|
||||
return sockfd;
|
||||
}
|
||||
|
||||
//going to leave this function available, even if completely switched over to rtl_dev_tune now, may be useful in the future
|
||||
void rtl_udp_tune(dsd_opts * opts, dsd_state * state, long int frequency)
|
||||
void rtl_udp_tune(dsd_opts * opts, dsd_state * state, long int frequency)
|
||||
{
|
||||
UNUSED(state);
|
||||
|
||||
int handle;
|
||||
unsigned short udp_port = opts->rtl_udp_port;
|
||||
int handle;
|
||||
unsigned short udp_port = opts->rtl_udp_port;
|
||||
char data[5] = {0}; //data buffer size is 5 for UDP frequency tuning
|
||||
struct sockaddr_in address;
|
||||
|
||||
@@ -297,253 +276,4 @@ void rtl_udp_tune(dsd_opts * opts, dsd_state * state, long int frequency)
|
||||
sendto(handle, data, 5, 0, (const struct sockaddr * ) & address, sizeof(struct sockaddr_in));
|
||||
|
||||
close (handle); //close socket after sending.
|
||||
}
|
||||
|
||||
void udp_socket_blaster(dsd_opts * opts, dsd_state * state, size_t nsam, void * data)
|
||||
{
|
||||
UNUSED(state);
|
||||
size_t err = 0;
|
||||
|
||||
//listen with:
|
||||
|
||||
//short 8k/2
|
||||
//socat stdio udp-listen:23456 | play --buffer 640 -q -b 16 -r 8000 -c2 -t s16 -
|
||||
|
||||
//short 8k/1
|
||||
//socat stdio udp-listen:23456 | play --buffer 320 -q -b 16 -r 8000 -c1 -t s16 -
|
||||
|
||||
//float 8k/2
|
||||
//socat stdio udp-listen:23456 | play --buffer 1280 -q -e float -b 32 -r 8000 -c2 -t f32 -
|
||||
|
||||
//float 8k/1
|
||||
//socat stdio udp-listen:23456 | play --buffer 640 -q -e float -b 32 -r 8000 -c1 -t f32 -
|
||||
|
||||
//send audio or data to socket
|
||||
err = sendto(opts->udp_sockfd, data, nsam, 0, (const struct sockaddr * ) & address, sizeof(struct sockaddr_in));
|
||||
if (err < 0) fprintf (stderr, "\n UDP SENDTO ERR %ld", err); //return value here is size_t number of characters sent, or -1 for failure
|
||||
if (err < nsam) fprintf (stderr, "\n UDP Underflow %ld", err); //I'm not even sure if this is possible
|
||||
}
|
||||
|
||||
int m17_socket_receiver(dsd_opts * opts, void * data)
|
||||
{
|
||||
size_t err = 0;
|
||||
struct sockaddr_in cliaddr;
|
||||
socklen_t len = sizeof(cliaddr);
|
||||
|
||||
//receive data from socket
|
||||
err = recvfrom(opts->udp_sockfd, data, 1000, 0, (struct sockaddr * ) & address, &len); //was MSG_WAITALL, but that seems to be = 256
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
//Analog UDP port on +2 of normal open socket
|
||||
void udp_socket_blasterA(dsd_opts * opts, dsd_state * state, size_t nsam, void * data)
|
||||
{
|
||||
UNUSED(state);
|
||||
size_t err = 0;
|
||||
|
||||
//listen with:
|
||||
|
||||
//short 48k/1
|
||||
//socat stdio udp-listen:23456 | play --buffer 1920 -q -b 16 -r 48000 -c1 -t s16 -
|
||||
|
||||
//send audio or data to socket
|
||||
err = sendto(opts->udp_sockfdA, data, nsam, 0, (const struct sockaddr * ) & addressA, sizeof(struct sockaddr_in));
|
||||
if (err < 0) fprintf (stderr, "\n UDP SENDTO ERR %ld", err); //return value here is size_t number of characters sent, or -1 for failure
|
||||
if (err < nsam) fprintf (stderr, "\n UDP Underflow %ld", err); //I'm not even sure if this is possible
|
||||
}
|
||||
|
||||
int m17_socket_blaster(dsd_opts * opts, dsd_state * state, size_t nsam, void * data)
|
||||
{
|
||||
UNUSED(state);
|
||||
unsigned long long int err = 0;
|
||||
|
||||
//See notes in m17.c on line ~3395 regarding usage
|
||||
|
||||
//send audio or data to socket
|
||||
err = sendto(opts->m17_udp_sock, data, nsam, 0, (const struct sockaddr * ) & addressM17, sizeof(struct sockaddr_in));
|
||||
//RETURN Value should be ACKN or NACK, or PING, or PONG
|
||||
|
||||
return (err);
|
||||
}
|
||||
|
||||
int udp_socket_connect(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
UNUSED(state);
|
||||
|
||||
long int err = 0;
|
||||
err = opts->udp_sockfd = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP Socket Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
// Don't think this is needed, but doesn't seem to hurt to keep it here either
|
||||
int broadcastEnable = 1;
|
||||
err = setsockopt(opts->udp_sockfd, SOL_SOCKET, SO_BROADCAST, &broadcastEnable, sizeof(broadcastEnable));
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP Broadcast Set Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
memset((char * ) & address, 0, sizeof(address));
|
||||
address.sin_family = AF_INET;
|
||||
err = address.sin_addr.s_addr = inet_addr(opts->udp_hostname);
|
||||
if (err < 0) //error in this context reports back 32-bit inet_addr reversed order byte pairs
|
||||
{
|
||||
fprintf (stderr, " UDP inet_addr Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
address.sin_port = htons(opts->udp_portno);
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP htons Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int udp_socket_connectA(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
UNUSED(state);
|
||||
|
||||
long int err = 0;
|
||||
err = opts->udp_sockfdA = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP Socket Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
// Don't think this is needed, but doesn't seem to hurt to keep it here either
|
||||
int broadcastEnable = 1;
|
||||
err = setsockopt(opts->udp_sockfdA, SOL_SOCKET, SO_BROADCAST, &broadcastEnable, sizeof(broadcastEnable));
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP Broadcast Set Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
memset((char * ) & addressA, 0, sizeof(addressA));
|
||||
addressA.sin_family = AF_INET;
|
||||
err = addressA.sin_addr.s_addr = inet_addr(opts->udp_hostname);
|
||||
if (err < 0) //error in this context reports back 32-bit inet_addr reversed order byte pairs
|
||||
{
|
||||
fprintf (stderr, " UDP inet_addr Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
addressA.sin_port = htons(opts->udp_portno+2); //plus 2 to current port assignment for the analog port value
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP htons Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int udp_socket_connectM17(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
UNUSED(state);
|
||||
|
||||
long int err = 0;
|
||||
err = opts->m17_udp_sock = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP Socket Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
// Don't think this is needed, but doesn't seem to hurt to keep it here either
|
||||
int broadcastEnable = 1;
|
||||
err = setsockopt(opts->m17_udp_sock, SOL_SOCKET, SO_BROADCAST, &broadcastEnable, sizeof(broadcastEnable));
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP Broadcast Set Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
memset((char * ) & addressM17, 0, sizeof(addressM17));
|
||||
addressM17.sin_family = AF_INET;
|
||||
err = addressM17.sin_addr.s_addr = inet_addr(opts->m17_hostname);
|
||||
if (err < 0) //error in this context reports back 32-bit inet_addr reversed order byte pairs
|
||||
{
|
||||
fprintf (stderr, " UDP inet_addr Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
addressM17.sin_port = htons(opts->m17_portno);
|
||||
if (err < 0)
|
||||
{
|
||||
fprintf (stderr, " UDP htons Error %ld\n", err);
|
||||
return (err);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void return_to_cc (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
//extra safeguards due to sync issues with NXDN
|
||||
memset (state->nxdn_sacch_frame_segment, 1, sizeof(state->nxdn_sacch_frame_segment));
|
||||
memset (state->nxdn_sacch_frame_segcrc, 1, sizeof(state->nxdn_sacch_frame_segcrc));
|
||||
|
||||
memset (state->active_channel, 0, sizeof(state->active_channel));
|
||||
|
||||
//reset dmr blocks
|
||||
dmr_reset_blocks (opts, state);
|
||||
|
||||
//zero out additional items
|
||||
state->lasttg = 0;
|
||||
state->lasttgR = 0;
|
||||
state->lastsrc = 0;
|
||||
state->lastsrcR = 0;
|
||||
state->gi[0] = -1;
|
||||
state->gi[1] = -1;
|
||||
state->payload_algid = 0;
|
||||
state->payload_algidR = 0;
|
||||
state->payload_keyid = 0;
|
||||
state->payload_keyidR = 0;
|
||||
state->payload_mi = 0;
|
||||
state->payload_miR = 0;
|
||||
state->payload_miP = 0;
|
||||
state->payload_miN = 0;
|
||||
opts->p25_is_tuned = 0;
|
||||
state->p25_vc_freq[0] = state->p25_vc_freq[1] = 0;
|
||||
|
||||
//tune back to the control channel -- NOTE: Doesn't work correctly on EDACS Analog Voice
|
||||
//RIGCTL
|
||||
if (opts->p25_trunk == 1 && opts->use_rigctl == 1)
|
||||
{
|
||||
if (opts->setmod_bw != 0 ) SetModulation(opts->rigctl_sockfd, opts->setmod_bw);
|
||||
SetFreq(opts->rigctl_sockfd, state->p25_cc_freq);
|
||||
}
|
||||
|
||||
//rtl
|
||||
#ifdef USE_RTLSDR
|
||||
if (opts->p25_trunk == 1 && opts->audio_in_type == 3) rtl_dev_tune (opts, state->p25_cc_freq);
|
||||
#endif
|
||||
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
|
||||
//if P25p2 VCH and going back to P25p1 CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 0)
|
||||
{
|
||||
state->samplesPerSymbol = 10;
|
||||
state->symbolCenter = 4;
|
||||
}
|
||||
|
||||
//if P25p1 Data Revert on P25p2 TDMA CC, flip symbolrate
|
||||
if (state->p25_cc_is_tdma == 1)
|
||||
{
|
||||
state->samplesPerSymbol = 8;
|
||||
state->symbolCenter = 3;
|
||||
}
|
||||
|
||||
// fprintf (stderr, "\n User Activated Return to CC; \n ");
|
||||
}
|
||||
}
|
||||
@@ -4,7 +4,6 @@
|
||||
void
|
||||
openSerial (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
UNUSED(state);
|
||||
|
||||
struct termios tty;
|
||||
speed_t baud;
|
||||
@@ -74,7 +73,6 @@ resumeScan (dsd_opts * opts, dsd_state * state)
|
||||
|
||||
char cmd[16];
|
||||
ssize_t result;
|
||||
UNUSED(result);
|
||||
|
||||
if (opts->serial_fd > 0)
|
||||
{
|
||||
|
||||
280
src/dsd_symbol.c
280
src/dsd_symbol.c
@@ -17,10 +17,33 @@
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
long int raw_rms(int16_t *samples, int len, int step) //use samplespersymbol as len
|
||||
{
|
||||
|
||||
int i;
|
||||
long int rms;
|
||||
long p, t, s;
|
||||
double dc, err;
|
||||
|
||||
p = t = 0L;
|
||||
for (i=0; i<len; i+=step) {
|
||||
s = (long)samples[i];
|
||||
t += s;
|
||||
p += s * s;
|
||||
}
|
||||
/* correct for dc offset in squares */
|
||||
dc = (double)(t*step) / (double)len;
|
||||
err = t * 2 * dc - dc * dc * len;
|
||||
|
||||
rms = (long int)sqrt((p-err) / len);
|
||||
if (rms < 0) rms = 150;
|
||||
return rms;
|
||||
}
|
||||
|
||||
int
|
||||
getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
{
|
||||
short sample;
|
||||
short sample, sample2;
|
||||
int i, sum, symbol, count;
|
||||
ssize_t result;
|
||||
|
||||
@@ -117,23 +140,21 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
{
|
||||
opts->audio_in_type = 0; //set input type
|
||||
openPulseInput(opts); //open pulse input
|
||||
}
|
||||
}
|
||||
//else cleanup and exit
|
||||
else
|
||||
{
|
||||
cleanupAndExit(opts, state);
|
||||
}
|
||||
if (opts->use_ncurses_terminal == 1) ncursesClose(opts);
|
||||
cleanupAndExit(opts, state);
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (opts->audio_in_type == 3)
|
||||
{
|
||||
#ifdef USE_RTLSDR
|
||||
// Read demodulated stream here
|
||||
if (get_rtlsdr_sample(&sample, opts, state) < 0)
|
||||
cleanupAndExit(opts, state);
|
||||
//update root means square power level
|
||||
opts->rtl_pwr = rtl_return_pwr();
|
||||
sample *= opts->rtl_volume_multiplier;
|
||||
get_rtlsdr_sample(&sample, opts, state);
|
||||
opts->rtl_rms = rtl_return_rms();
|
||||
|
||||
#endif
|
||||
}
|
||||
@@ -141,7 +162,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
//tcp socket input from SDR++ -- now with 1 retry if connection is broken
|
||||
else if (opts->audio_in_type == 8)
|
||||
{
|
||||
#ifdef __CYGWIN__
|
||||
#ifdef AERO_BUILD
|
||||
result = sf_read_short(opts->tcp_file_in, &sample, 1);
|
||||
if(result == 0) {
|
||||
fprintf (stderr, "\nConnection to TCP Server Interrupted. Trying again in 3 seconds.\n");
|
||||
@@ -150,7 +171,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
sleep (3); //halt all processing and wait 3 seconds
|
||||
|
||||
//attempt to reconnect to socket
|
||||
opts->tcp_sockfd = 0;
|
||||
opts->tcp_sockfd = 0;
|
||||
opts->tcp_sockfd = Connect(opts->tcp_hostname, opts->tcp_portno);
|
||||
if (opts->tcp_sockfd != 0)
|
||||
{
|
||||
@@ -168,7 +189,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
}
|
||||
else fprintf (stderr, "TCP Socket Reconnected Successfully.\n");
|
||||
}
|
||||
else fprintf (stderr, "TCP Socket Connection Error.\n");
|
||||
else fprintf (stderr, "TCP Socket Connection Error.\n");
|
||||
|
||||
//now retry reading sample
|
||||
result = sf_read_short(opts->tcp_file_in, &sample, 1);
|
||||
@@ -185,30 +206,29 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
fprintf (stderr, "Opening Pulse Audio Input.\n");
|
||||
opts->audio_in_type = 0; //set input type
|
||||
openPulseInput(opts); //open pulse input
|
||||
}
|
||||
}
|
||||
//else cleanup and exit
|
||||
else
|
||||
else
|
||||
{
|
||||
fprintf (stderr, "Connection to TCP Server Disconnected.\n");
|
||||
fprintf (stderr, "Closing DSD-FME.\n");
|
||||
if (opts->use_ncurses_terminal == 1) ncursesClose(opts);
|
||||
cleanupAndExit(opts, state);
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
#else
|
||||
result = sf_read_short(opts->tcp_file_in, &sample, 1);
|
||||
if(result == 0) {
|
||||
TCP_RETRY:
|
||||
if (exitflag == 1) cleanupAndExit(opts, state); //needed to break the loop on ctrl+c
|
||||
fprintf (stderr, "\nConnection to TCP Server Interrupted. Trying again in 3 seconds.\n");
|
||||
sample = 0;
|
||||
sf_close(opts->tcp_file_in); //close current connection on this end
|
||||
sleep (3); //halt all processing and wait 3 seconds
|
||||
|
||||
//attempt to reconnect to socket
|
||||
opts->tcp_sockfd = 0;
|
||||
opts->tcp_sockfd = 0;
|
||||
opts->tcp_sockfd = Connect(opts->tcp_hostname, opts->tcp_portno);
|
||||
if (opts->tcp_sockfd != 0)
|
||||
{
|
||||
@@ -226,11 +246,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
}
|
||||
else fprintf (stderr, "TCP Socket Reconnected Successfully.\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
fprintf (stderr, "TCP Socket Connection Error.\n");
|
||||
if (opts->frame_m17 == 1) goto TCP_RETRY; //if using m17 encoder/decoder, just keep looping to keep alive
|
||||
}
|
||||
else fprintf (stderr, "TCP Socket Connection Error.\n");
|
||||
|
||||
//now retry reading sample
|
||||
result = sf_read_short(opts->tcp_file_in, &sample, 1);
|
||||
@@ -242,35 +258,48 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
sample = 0; //zero sample on bad result, keep the ball rolling
|
||||
fprintf (stderr, "Connection to TCP Server Disconnected.\n");
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
}
|
||||
|
||||
//BUG REPORT: 1. DMR Simplex doesn't work with raw wav files. 2. Using the monitor w/ wav file saving may produce undecodable wav files.
|
||||
//reworked a bit to allow raw audio wav file saving without the monitoring poriton active
|
||||
//Source Audio Monitoring
|
||||
if (have_sync == 0)
|
||||
{
|
||||
|
||||
//do an extra checkfor carrier signal so that random raw audio spurts don't play during decoding
|
||||
// if ( (state->carrier == 1) && ((time(NULL) - state->last_vc_sync_time) < 2)) /This probably doesn't work correctly since we update time check when playing raw audio
|
||||
// {
|
||||
// memset (state->analog_out, 0, sizeof(state->analog_out));
|
||||
// state->analog_sample_counter = 0;
|
||||
// } //This is the root cause of issue listed above, will evaluate further at a later time for a more elegant solution, or determine if anything is negatively impacted by removing this
|
||||
|
||||
//sanity check to prevent an overflow
|
||||
if (state->analog_sample_counter > 959)
|
||||
state->analog_sample_counter = 959;
|
||||
|
||||
state->analog_out[state->analog_sample_counter++] = sample;
|
||||
state->analog_out[state->analog_sample_counter++] = sample;
|
||||
|
||||
if (state->analog_sample_counter == 960)
|
||||
{
|
||||
//get an pwr value if not using the rtl built in version
|
||||
if (opts->audio_in_type != 3 && opts->monitor_input_audio == 1)
|
||||
opts->rtl_pwr = raw_pwr(state->analog_out, 960, 1);
|
||||
//get an rms value if not using the rtl built in version
|
||||
if (opts->audio_in_type != 3 && opts->monitor_input_audio == 1)
|
||||
opts->rtl_rms = raw_rms(state->analog_out, 960, 1);
|
||||
|
||||
//debug
|
||||
// opts->rtl_rms = 101;
|
||||
|
||||
//make it a little quieter
|
||||
// for (int x = 0; x < 960; x++)
|
||||
// state->analog_out[x] /= 4;
|
||||
|
||||
//seems to be working now, but RMS values are lower on actual analog signal than on no signal but noise
|
||||
if ( (opts->rtl_rms > opts->rtl_squelch_level) && (opts->monitor_input_audio == 1) )
|
||||
{
|
||||
if (opts->audio_out_type == 0)
|
||||
pa_simple_write(opts->pulse_raw_dev_out, state->analog_out, 960*2, NULL);
|
||||
|
||||
//NOTE: Worked okay earlier in Cygwin, so should be fine
|
||||
if (opts->audio_out_type == 5)
|
||||
write (opts->audio_out_fd, state->analog_out, 960*2);
|
||||
|
||||
//test hold on scan/trunking
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->last_vc_sync_time = time(NULL);
|
||||
}
|
||||
|
||||
//raw wav file saving -- only write when not NXDN, dPMR, or M17 due to noise that can cause tons of false positives when no sync
|
||||
if (opts->wav_out_raw != NULL && opts->frame_nxdn48 == 0 && opts->frame_nxdn96 == 0 && opts->frame_dpmr == 0 && opts->frame_m17 == 0)
|
||||
@@ -279,66 +308,6 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
sf_write_sync (opts->wav_out_raw);
|
||||
}
|
||||
|
||||
//low pass filter
|
||||
if (opts->use_lpf == 1)
|
||||
lpf(state, state->analog_out, 960);
|
||||
|
||||
//high pass filter
|
||||
if (opts->use_hpf == 1)
|
||||
hpf (state, state->analog_out, 960);
|
||||
|
||||
//pass band filter
|
||||
if (opts->use_pbf == 1)
|
||||
pbf(state, state->analog_out, 960);
|
||||
|
||||
//manual gain control
|
||||
if (opts->audio_gainA > 0.0f)
|
||||
analog_gain (opts, state, state->analog_out, 960);
|
||||
|
||||
//automatic gain control
|
||||
else
|
||||
agsm(opts, state, state->analog_out, 960);
|
||||
|
||||
//Running PWR after filtering does remove the analog spike from the PWR value
|
||||
//but noise floor noise will still produce higher values
|
||||
// if (opts->audio_in_type != 3 && opts->monitor_input_audio == 1)
|
||||
// opts->rtl_pwr = raw_pwr(state->analog_out, 960, 1);
|
||||
|
||||
//seems to be working now, but PWR values are lower on actual analog signal than on no signal but noise
|
||||
if ( (opts->rtl_pwr > opts->rtl_squelch_level) && opts->monitor_input_audio == 1 && state->carrier == 0 ) //added carrier check here in lieu of disabling it above
|
||||
{
|
||||
if (opts->audio_out_type == 0)
|
||||
pa_simple_write(opts->pulse_raw_dev_out, state->analog_out, 960*2, NULL);
|
||||
|
||||
if (opts->audio_out_type == 8)
|
||||
udp_socket_blasterA (opts, state, 960*2, state->analog_out);
|
||||
|
||||
//NOTE: Worked okay earlier in Cygwin, so should be fine -- can only operate at 48k1, else slow mode lag
|
||||
|
||||
//This one will only operate when OSS 48k1 (when both input and output are OSS audio)
|
||||
if (opts->audio_out_type == 5 && opts->pulse_digi_rate_out == 48000 && opts->pulse_digi_out_channels == 1)
|
||||
write (opts->audio_out_fd, state->analog_out, 960*2);
|
||||
|
||||
//STDOUT, but only when operating at 48k1 (no go just yet)
|
||||
// if (opts->audio_out_type == 1 && opts->pulse_digi_rate_out == 48000 && opts->pulse_digi_out_channels == 1)
|
||||
// write (opts->audio_out_fd, state->analog_out, 960*2);
|
||||
|
||||
//OSS 8k1 (no go just yet)
|
||||
// if (opts->audio_out_type == 2 && opts->pulse_digi_rate_out == 48000 && opts->pulse_digi_out_channels == 1)
|
||||
// write (opts->audio_out_fd, state->analog_out, 960*2);
|
||||
|
||||
//test updating the sync time, so we can hold here while trunking or scanning
|
||||
state->last_cc_sync_time = time(NULL);
|
||||
state->last_vc_sync_time = time(NULL);
|
||||
}
|
||||
|
||||
//raw wav file saving -- save the WAV file samples before we apply filtering to them
|
||||
// if (opts->wav_out_raw != NULL && opts->frame_nxdn48 == 0 && opts->frame_nxdn96 == 0 && opts->frame_dpmr == 0 && opts->frame_m17 == 0)
|
||||
// {
|
||||
// sf_write_short(opts->wav_out_raw, state->analog_out, 960);
|
||||
// sf_write_sync (opts->wav_out_raw);
|
||||
// }
|
||||
|
||||
memset (state->analog_out, 0, sizeof(state->analog_out));
|
||||
state->analog_sample_counter = 0;
|
||||
}
|
||||
@@ -351,7 +320,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
if (state->analog_sample_counter > 959)
|
||||
state->analog_sample_counter = 959;
|
||||
|
||||
state->analog_out[state->analog_sample_counter++] = sample;
|
||||
state->analog_out[state->analog_sample_counter++] = sample;
|
||||
|
||||
if (state->analog_sample_counter == 960)
|
||||
{
|
||||
@@ -371,19 +340,18 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
|
||||
if (opts->use_cosine_filter)
|
||||
{
|
||||
if ( (state->lastsynctype >= 10 && state->lastsynctype <= 13) || state->lastsynctype == 32 || state->lastsynctype == 33
|
||||
if ( (state->lastsynctype >= 10 && state->lastsynctype <= 13) || state->lastsynctype == 32 || state->lastsynctype == 33
|
||||
|| state->lastsynctype == 34 || state->lastsynctype == 30 || state->lastsynctype == 31)
|
||||
{
|
||||
sample = dmr_filter(sample);
|
||||
}
|
||||
|
||||
else if (state->lastsynctype == 8 || state->lastsynctype == 9 || state->lastsynctype == 16 || state->lastsynctype == 17 ||
|
||||
state->lastsynctype == 86 || state->lastsynctype == 87 || state->lastsynctype == 98 || state->lastsynctype == 99)
|
||||
else if (state->lastsynctype == 8 || state->lastsynctype == 9 ||state->lastsynctype == 16 || state->lastsynctype == 17)
|
||||
{
|
||||
sample = m17_filter(sample);
|
||||
}
|
||||
|
||||
else if (
|
||||
else if (
|
||||
state->lastsynctype == 20 || state->lastsynctype == 21 ||
|
||||
state->lastsynctype == 22 || state->lastsynctype == 23 ||
|
||||
state->lastsynctype == 24 || state->lastsynctype == 25 ||
|
||||
@@ -405,7 +373,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
{
|
||||
//sample = dmr_filter(sample); //work on filter later
|
||||
}
|
||||
else
|
||||
else // the 12.5KHz NXDN filter is the same as the DMR filter...hopefully
|
||||
{
|
||||
sample = dmr_filter(sample);
|
||||
}
|
||||
@@ -490,8 +458,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
|
||||
if (state->samplesPerSymbol == 20) //nxdn 4800 baud 2400 symbol rate
|
||||
{
|
||||
// if ((i >= 9) && (i <= 11))
|
||||
if ((i >= 7) && (i <= 13)) //7, 13 working good on multiple nxdn48, fewer random errors
|
||||
if ((i >= 9) && (i <= 11))
|
||||
{
|
||||
sum += sample;
|
||||
count++;
|
||||
@@ -511,23 +478,11 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
{
|
||||
// 0: C4FM modulation
|
||||
|
||||
//EXPERIMENTAL: manipulate the left edge depending on sync type
|
||||
//TODO: See if we can manipulate this a bit more based on AFC or similar type function
|
||||
int l_edge = 2;
|
||||
int r_edge = 2;
|
||||
|
||||
if (state->synctype == 30 || state->synctype == 31) l_edge = 1; //YSF (need to test with new recordings at BW:12000)
|
||||
else if ((state->lastsynctype >= 10 && state->lastsynctype <= 13) || state->lastsynctype == 32 || state->lastsynctype == 33) l_edge = 1;
|
||||
else l_edge = 2; //P25 and NXDN96 perform better, DMR doesn't seem to care too much, but may favor 1 and not 2
|
||||
|
||||
if ((i >= state->symbolCenter - l_edge) && (i <= state->symbolCenter + r_edge))
|
||||
{
|
||||
sum += sample;
|
||||
count++;
|
||||
}
|
||||
|
||||
//debug: show what was selected for the left edge
|
||||
// fprintf (stderr, " L:%d", l_edge);
|
||||
if ((i >= state->symbolCenter - 1) && (i <= state->symbolCenter + 2))
|
||||
{
|
||||
sum += sample;
|
||||
count++;
|
||||
}
|
||||
|
||||
#ifdef TRACE_DSD
|
||||
if (i == state->symbolCenter - 1) {
|
||||
@@ -538,18 +493,7 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
}
|
||||
#endif
|
||||
}
|
||||
else if (state->rf_mod == 1) //QPSK
|
||||
{
|
||||
//going one left, two on the right for QPSK, local system seems to favor that
|
||||
//with same PPM setting used on C4FM, unsure if that works on other systems, just
|
||||
//testing things now, not like QPSK works well here anyways
|
||||
if ((i == state->symbolCenter - 1) || (i == state->symbolCenter + 2)) //1,2
|
||||
{
|
||||
sum += sample;
|
||||
count++;
|
||||
}
|
||||
}
|
||||
else //GFSK
|
||||
else
|
||||
{
|
||||
// 1: QPSK modulation
|
||||
// 2: GFSK modulation
|
||||
@@ -558,23 +502,12 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
// comes one sample too late.
|
||||
// This change makes a significant improvement in the BER, at least for
|
||||
// this file.
|
||||
// if ((i == state->symbolCenter) || (i == state->symbolCenter + 1))
|
||||
//GFSK should ideally be the same on the left and right, I would think
|
||||
//I have not observed a system that would benefit from this alignment
|
||||
//if ((i == state->symbolCenter) || (i == state->symbolCenter + 1))
|
||||
if ((i == state->symbolCenter - 1) || (i == state->symbolCenter + 1))
|
||||
{
|
||||
sum += sample;
|
||||
count++;
|
||||
}
|
||||
|
||||
//MISC Notes: When using RTL input, NXDN96 at BW:16 NXDN48 at BW:12
|
||||
//I am beginning to suspect that RTL input is halfing the bandwidth, which
|
||||
//is my original consclusion back when I was working on it last, unsure
|
||||
//or the best course on that, could just be a rtl_fm flaw
|
||||
//P25 may also work better at 16 as well now, hard to tell the difference since both are good
|
||||
//DMR may not be any different on 12 or 16
|
||||
//most likely though, this all will just depend on signal stregth more than anything
|
||||
//as to how much BW you should set
|
||||
{
|
||||
sum += sample;
|
||||
count++;
|
||||
}
|
||||
|
||||
#ifdef TRACE_DSD
|
||||
//if (i == state->symbolCenter) {
|
||||
@@ -627,7 +560,13 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
}
|
||||
#endif
|
||||
|
||||
//read dibit capture bin files
|
||||
//test throttle on wav input files
|
||||
if (opts->audio_in_type == 2)
|
||||
{
|
||||
if (state->use_throttle == 1) usleep(.003); //very environment specific, tuning to cygwin
|
||||
}
|
||||
|
||||
//read op25/fme symbol bin files
|
||||
if (opts->audio_in_type == 4)
|
||||
{
|
||||
//use fopen and read in a symbol, check op25 for clues
|
||||
@@ -639,28 +578,29 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
|
||||
state->symbolc = fgetc(opts->symbolfile);
|
||||
|
||||
//experimental throttle
|
||||
useconds_t stime = state->symbol_throttle;
|
||||
if (state->use_throttle == 1)
|
||||
{
|
||||
// usleep(stime);
|
||||
usleep(.003); //very environment specific, tuning to cygwin
|
||||
}
|
||||
//fprintf(stderr, "%d", state->symbolc);
|
||||
if( feof(opts->symbolfile) )
|
||||
{
|
||||
// opts->audio_in_type = 0; //switch to pulse after playback, ncurses terminal can initiate replay if wanted
|
||||
fclose(opts->symbolfile);
|
||||
fprintf (stderr, "\nEnd of %s\n", opts->audio_in_dev);
|
||||
//in debug mode, re-run .bin files over and over (look for memory leaks, etc)
|
||||
if (state->debug_mode == 1)
|
||||
{
|
||||
opts->symbolfile = NULL;
|
||||
opts->symbolfile = fopen(opts->audio_in_dev, "r");
|
||||
opts->audio_in_type = 4; //symbol capture bin files
|
||||
}
|
||||
//open pulse input if we are pulse output AND using ncurses terminal
|
||||
else if (opts->audio_out_type == 0 && opts->use_ncurses_terminal == 1)
|
||||
if (opts->audio_out_type == 0 && opts->use_ncurses_terminal == 1)
|
||||
{
|
||||
opts->audio_in_type = 0; //set input type
|
||||
openPulseInput(opts); //open pulse input
|
||||
}
|
||||
}
|
||||
//else cleanup and exit
|
||||
else
|
||||
{
|
||||
if (opts->use_ncurses_terminal == 1) ncursesClose(opts);
|
||||
cleanupAndExit(opts, state);
|
||||
}
|
||||
}
|
||||
@@ -669,11 +609,11 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
if (state->rf_mod == 2) //GFSK
|
||||
{
|
||||
symbol = state->symbolc;
|
||||
if (state->symbolc == 0 )
|
||||
if (state->symbolc == 0 )
|
||||
{
|
||||
symbol = -3; //-1
|
||||
}
|
||||
if (state->symbolc == 1 )
|
||||
if (state->symbolc == 1 )
|
||||
{
|
||||
symbol = -1; //-3
|
||||
}
|
||||
@@ -700,16 +640,6 @@ getSymbol (dsd_opts * opts, dsd_state * state, int have_sync)
|
||||
|
||||
}
|
||||
|
||||
//.raw or .sym float symbol files
|
||||
if (opts->audio_in_type == 44)
|
||||
{
|
||||
float float_symbol = 0.0f;
|
||||
fread (&float_symbol, sizeof(float), 1, opts->symbolfile); //sizeof(float) is 4 (usually)
|
||||
if ( feof(opts->symbolfile) ) exitflag = 1; //end of file, exit
|
||||
// float_symbol = -float_symbol; //inversion
|
||||
symbol = (int)float_symbol * (int)10000;
|
||||
}
|
||||
|
||||
state->symbolcnt++;
|
||||
return (symbol);
|
||||
}
|
||||
|
||||
@@ -1,98 +0,0 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_time.c
|
||||
* Time and Date Functions
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2024-04 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
//TODO: Make sure everything still works as intended, every free(timestr) has a NULL check first,
|
||||
//make sure no other loose or random time functions embedded in other files or functions, etc
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
//get HHmmss timestamp no colon (file operations)
|
||||
char * getTime()
|
||||
{
|
||||
char * curr = calloc(7, sizeof(char));
|
||||
time_t t = time(NULL);
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr,"%02d%02d%02d", ptm->tm_hour, ptm->tm_min, ptm->tm_sec);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get HH:mm:ss timestamp with colon (Sync/Console Display)
|
||||
char * getTimeC()
|
||||
{
|
||||
char * curr = calloc(9, sizeof(char));
|
||||
time_t t = time(NULL);
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr, "%02d:%02d:%02d", ptm->tm_hour, ptm->tm_min, ptm->tm_sec);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get HH:mm:ss timestamp with colon (Ncurses Call History)
|
||||
char * getTimeN(time_t t)
|
||||
{
|
||||
char * curr = calloc(9, sizeof(char));
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr, "%02d:%02d:%02d", ptm->tm_hour, ptm->tm_min, ptm->tm_sec);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get YYYYMMDD without hyphen (file operations)
|
||||
char * getDate()
|
||||
{
|
||||
char * curr = calloc(25, sizeof(char));
|
||||
time_t t = time(NULL);
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr,"%04d%02d%02d", ptm->tm_year+1900, ptm->tm_mon+1, ptm->tm_mday);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get YYYY-MM-DD with hyphen (Sync/Console Display)
|
||||
char * getDateH()
|
||||
{
|
||||
char * curr = calloc(27, sizeof(char));
|
||||
time_t t = time(NULL);
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr, "%04d-%02d-%02d", ptm->tm_year+1900, ptm->tm_mon+1, ptm->tm_mday);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get YYYY/MM/DD with forward slash (LRRP files)
|
||||
char * getDateS()
|
||||
{
|
||||
char * curr = calloc(27, sizeof(char));
|
||||
time_t t = time(NULL);
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr, "%04d/%02d/%02d", ptm->tm_year+1900, ptm->tm_mon+1, ptm->tm_mday);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get YYYY-MM-DD with hyphen (Ncurses Call History)
|
||||
char * getDateN(time_t t)
|
||||
{
|
||||
char * curr = calloc(27, sizeof(char));
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr, "%04d-%02d-%02d", ptm->tm_year+1900, ptm->tm_mon+1, ptm->tm_mday);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get HHmmss timestamp no colon (file operations)
|
||||
char * getTimeF(time_t t)
|
||||
{
|
||||
char * curr = calloc(7, sizeof(char));
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr,"%02d%02d%02d", ptm->tm_hour, ptm->tm_min, ptm->tm_sec);
|
||||
return curr;
|
||||
}
|
||||
|
||||
//get YYYYMMDD without hyphen (file operations)
|
||||
char * getDateF(time_t t)
|
||||
{
|
||||
char * curr = calloc(25, sizeof(char));
|
||||
struct tm * ptm = localtime(& t);
|
||||
sprintf(curr,"%04d%02d%02d", ptm->tm_year+1900, ptm->tm_mon+1, ptm->tm_mday);
|
||||
return curr;
|
||||
}
|
||||
@@ -1,47 +1,138 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* dsd_upsample.c
|
||||
* Simplified 8k to 48k Upsample Functions
|
||||
* Goodbye terrible ringing sound
|
||||
/*
|
||||
* Copyright (C) 2010 DSD Author
|
||||
* GPG Key ID: 0x3F1D7FD0 (74EF 430D F7F2 0A48 FCE6 F630 FAA2 635D 3F1D 7FD0)
|
||||
*
|
||||
* Permission to use, copy, modify, and/or distribute this software for any
|
||||
* purpose with or without fee is hereby granted, provided that the above
|
||||
* copyright notice and this permission notice appear in all copies.
|
||||
*
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2024-03 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
* THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES WITH
|
||||
* REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY
|
||||
* AND FITNESS. IN NO EVENT SHALL ISC BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||
* INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
|
||||
* LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE
|
||||
* OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||
* PERFORMANCE OF THIS SOFTWARE.
|
||||
*/
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
//produce 6 short samples (48k) for every 1 short sample (8k)
|
||||
void upsampleS (short invalue, short prev, short outbuf[6])
|
||||
{
|
||||
UNUSED(prev);
|
||||
for (int i = 0; i < 6; i++)
|
||||
outbuf[i] = invalue;
|
||||
}
|
||||
|
||||
//legacy 6x simplified version for the float_buf_p
|
||||
void upsample (dsd_state * state, float invalue)
|
||||
void
|
||||
upsample (dsd_state * state, float invalue)
|
||||
{
|
||||
|
||||
float *outbuf1;
|
||||
int i, j, sum;
|
||||
float *outbuf1, c, d;
|
||||
if (state->currentslot == 0 && state->dmr_stereo == 1)
|
||||
{
|
||||
outbuf1 = state->audio_out_float_buf_p;
|
||||
|
||||
else if (state->currentslot == 1 && state->dmr_stereo == 1)
|
||||
}
|
||||
if (state->currentslot == 1 && state->dmr_stereo == 1)
|
||||
{
|
||||
outbuf1 = state->audio_out_float_buf_pR;
|
||||
|
||||
else if (state->dmr_stereo == 0)
|
||||
}
|
||||
if (state->dmr_stereo == 0)
|
||||
{
|
||||
outbuf1 = state->audio_out_float_buf_p;
|
||||
}
|
||||
//outbuf1 = state->audio_out_float_buf_p;
|
||||
outbuf1--;
|
||||
c = *outbuf1;
|
||||
d = invalue;
|
||||
// basic triangle interpolation
|
||||
outbuf1++;
|
||||
*outbuf1 = ((invalue * (float) 0.166) + (c * (float) 0.834));
|
||||
outbuf1++;
|
||||
*outbuf1 = ((invalue * (float) 0.332) + (c * (float) 0.668));
|
||||
outbuf1++;
|
||||
*outbuf1 = ((invalue * (float) 0.5) + (c * (float) 0.5));
|
||||
outbuf1++;
|
||||
*outbuf1 = ((invalue * (float) 0.668) + (c * (float) 0.332));
|
||||
outbuf1++;
|
||||
*outbuf1 = ((invalue * (float) 0.834) + (c * (float) 0.166));
|
||||
outbuf1++;
|
||||
*outbuf1 = d;
|
||||
outbuf1++;
|
||||
|
||||
*outbuf1 = invalue;
|
||||
outbuf1++;
|
||||
*outbuf1 = invalue;
|
||||
outbuf1++;
|
||||
*outbuf1 = invalue;
|
||||
outbuf1++;
|
||||
*outbuf1 = invalue;
|
||||
outbuf1++;
|
||||
*outbuf1 = invalue;
|
||||
outbuf1++;
|
||||
*outbuf1 = invalue;
|
||||
}
|
||||
//only if enabled, produces crackling/buzzing sounds when input type is not pulse audio (reason still unknown)
|
||||
//also, could be improved to provide better audio in the future
|
||||
if (state->audio_smoothing == 1)
|
||||
{
|
||||
if (state->currentslot == 1 && state->dmr_stereo == 1)
|
||||
{
|
||||
if (state->audio_out_idx2R > 24)
|
||||
{
|
||||
// smoothing
|
||||
outbuf1 -= 16;
|
||||
for (j = 0; j < 4; j++)
|
||||
{
|
||||
for (i = 0; i < 6; i++)
|
||||
{
|
||||
sum = 0;
|
||||
outbuf1 -= 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 += 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 += 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 -= 2;
|
||||
*outbuf1 = (sum / (float) 3);
|
||||
outbuf1++;
|
||||
}
|
||||
outbuf1 -= 8;
|
||||
}
|
||||
}
|
||||
}
|
||||
if (state->currentslot == 0 && state->dmr_stereo == 1)
|
||||
{
|
||||
if (state->audio_out_idx2 > 24)
|
||||
{
|
||||
// smoothing
|
||||
outbuf1 -= 16;
|
||||
for (j = 0; j < 4; j++)
|
||||
{
|
||||
for (i = 0; i < 6; i++)
|
||||
{
|
||||
sum = 0;
|
||||
outbuf1 -= 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 += 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 += 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 -= 2;
|
||||
*outbuf1 = (sum / (float) 3);
|
||||
outbuf1++;
|
||||
}
|
||||
outbuf1 -= 8;
|
||||
}
|
||||
}
|
||||
}
|
||||
if (state->dmr_stereo == 0)
|
||||
{
|
||||
if (state->audio_out_idx2 > 24)
|
||||
{
|
||||
// smoothing
|
||||
outbuf1 -= 16;
|
||||
for (j = 0; j < 4; j++)
|
||||
{
|
||||
for (i = 0; i < 6; i++)
|
||||
{
|
||||
sum = 0;
|
||||
outbuf1 -= 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 += 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 += 2;
|
||||
sum += (int)*outbuf1;
|
||||
outbuf1 -= 2;
|
||||
*outbuf1 = (sum / (float) 3);
|
||||
outbuf1++;
|
||||
}
|
||||
outbuf1 -= 8;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
544
src/dstar.c
544
src/dstar.c
@@ -1,405 +1,183 @@
|
||||
/*
|
||||
* Copyright (C) 2010 DSD Author
|
||||
* GPG Key ID: 0x3F1D7FD0 (74EF 430D F7F2 0A48 FCE6 F630 FAA2 635D 3F1D 7FD0)
|
||||
*
|
||||
* Permission to use, copy, modify, and/or distribute this software for any
|
||||
* purpose with or without fee is hereby granted, provided that the above
|
||||
* copyright notice and this permission notice appear in all copies.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES WITH
|
||||
* REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY
|
||||
* AND FITNESS. IN NO EVENT SHALL ISC BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||
* INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
|
||||
* LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE
|
||||
* OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||
* PERFORMANCE OF THIS SOFTWARE.
|
||||
*/
|
||||
|
||||
/*
|
||||
* Note: D-STAR support is fairly complete at this point.
|
||||
* The ambe3600x2450 decoder is similar butnot compatible with D-STAR voice frames.
|
||||
* The dstar interleave pattern is different as well.
|
||||
* GMSK modulation optimizations will also required to get a usable bit error
|
||||
*/
|
||||
|
||||
#include "dsd.h"
|
||||
#include "dstar_const.h"
|
||||
#include "fcs.h"
|
||||
#include "dstar_header.h"
|
||||
|
||||
//simplified DSTAR
|
||||
void processDSTAR(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
uint8_t sd[480];
|
||||
memset (sd, 0, sizeof(sd));
|
||||
int i, j, dibit;
|
||||
char ambe_fr[4][24];
|
||||
const int *w, *x;
|
||||
memset(ambe_fr, 0, sizeof(ambe_fr));
|
||||
w = dW;
|
||||
x = dX;
|
||||
|
||||
//20 voice and 19 slow data frames (20th is frame sync)
|
||||
for (j = 0; j < 21; j++)
|
||||
{
|
||||
void processDSTAR(dsd_opts * opts, dsd_state * state) {
|
||||
// extracts AMBE frames from D-STAR voice frame
|
||||
int i, j, dibit;
|
||||
char ambe_fr[4][24];
|
||||
unsigned char data[9];
|
||||
unsigned int bits[4];
|
||||
int framecount;
|
||||
int sync_missed = 0;
|
||||
unsigned char slowdata[4];
|
||||
unsigned int bitbuffer = 0;
|
||||
const int *w, *x;
|
||||
|
||||
memset(ambe_fr, 0, sizeof(ambe_fr));
|
||||
w = dW;
|
||||
x = dX;
|
||||
//set carrier to 1 so ncurses will light up green
|
||||
state->carrier = 1;
|
||||
|
||||
for (i = 0; i < 72; i++)
|
||||
{
|
||||
dibit = getDibit(opts, state);
|
||||
ambe_fr[*w][*x] = dibit & 1;
|
||||
w++;
|
||||
x++;
|
||||
}
|
||||
if (opts->errorbars == 1) {
|
||||
fprintf (stderr, "e:");
|
||||
}
|
||||
|
||||
soft_mbe(opts, state, NULL, ambe_fr, NULL);
|
||||
#ifdef DSTAR_DUMP
|
||||
fprintf (stderr, "\n");
|
||||
#endif
|
||||
|
||||
if (j != 20)
|
||||
{
|
||||
for (i = 0; i < 24; i++)
|
||||
{
|
||||
//slow data
|
||||
sd[(j*24)+i] = (uint8_t) getDibit(opts, state);
|
||||
if (state->synctype == 18) {
|
||||
framecount = 0;
|
||||
state->synctype = 6;
|
||||
} else if (state->synctype == 19) {
|
||||
framecount = 0;
|
||||
state->synctype = 7;
|
||||
} else {
|
||||
framecount = 1; //just saw a sync frame; there should be 20 not 21 till the next
|
||||
}
|
||||
//why is this running in a loop for?
|
||||
while (sync_missed < 3) {
|
||||
|
||||
}
|
||||
}
|
||||
memset(ambe_fr, 0, 96);
|
||||
// voice frame
|
||||
w = dW;
|
||||
x = dX;
|
||||
|
||||
if (j == 20)
|
||||
processDSTAR_SD(opts, state, sd);
|
||||
for (i = 0; i < 72; i++) {
|
||||
|
||||
//since we are in a long loop, use this to improve response time in ncurses
|
||||
if (opts->use_ncurses_terminal == 1)
|
||||
ncursesPrinter(opts, state);
|
||||
dibit = getDibit(opts, state);
|
||||
|
||||
//slot 1
|
||||
watchdog_event_history(opts, state, 0);
|
||||
watchdog_event_current(opts, state, 0);
|
||||
bitbuffer <<= 1;
|
||||
if (dibit == 1) {
|
||||
bitbuffer |= 0x01;
|
||||
}
|
||||
if ((bitbuffer & 0x00FFFFFF) == 0x00AAB468) {
|
||||
// we're slipping bits
|
||||
fprintf (stderr, "sync in voice after i=%d, restarting\n", i);
|
||||
//ugh just start over
|
||||
i = 0;
|
||||
w = dW;
|
||||
x = dX;
|
||||
framecount = 1;
|
||||
continue;
|
||||
}
|
||||
|
||||
}
|
||||
ambe_fr[*w][*x] = (1 & dibit);
|
||||
w++;
|
||||
x++;
|
||||
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
|
||||
|
||||
processMbeFrame(opts, state, NULL, ambe_fr, NULL);
|
||||
|
||||
// data frame - 24 bits
|
||||
for (i = 73; i < 97; i++) {
|
||||
dibit = getDibit(opts, state);
|
||||
bitbuffer <<= 1;
|
||||
if (dibit == 1) {
|
||||
bitbuffer |= 0x01;
|
||||
}
|
||||
if ((bitbuffer & 0x00FFFFFF) == 0x00AAB468) {
|
||||
// looking if we're slipping bits
|
||||
if (i != 96) {
|
||||
fprintf (stderr, "sync after i=%d\n", i);
|
||||
i = 96;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
slowdata[0] = (bitbuffer >> 16) & 0x000000FF;
|
||||
slowdata[1] = (bitbuffer >> 8) & 0x000000FF;
|
||||
slowdata[2] = (bitbuffer) & 0x000000FF;
|
||||
slowdata[3] = 0;
|
||||
|
||||
if ((bitbuffer & 0x00FFFFFF) == 0x00AAB468) {
|
||||
//We got sync!
|
||||
//fprintf (stderr, "Sync on framecount = %d\n", framecount);
|
||||
sync_missed = 0;
|
||||
} else if ((bitbuffer & 0x00FFFFFF) == 0xAAAAAA) {
|
||||
//End of transmission
|
||||
fprintf (stderr, "End of transmission\n");
|
||||
goto end;
|
||||
} else if (framecount % 21 == 0) {
|
||||
fprintf (stderr, "Missed sync on framecount = %d, value = %x/%x/%x\n",
|
||||
framecount, slowdata[0], slowdata[1], slowdata[2]);
|
||||
sync_missed++;
|
||||
} else if (framecount != 0 && (bitbuffer & 0x00FFFFFF) != 0x000000) {
|
||||
slowdata[0] ^= 0x70;
|
||||
slowdata[1] ^= 0x4f;
|
||||
slowdata[2] ^= 0x93;
|
||||
//fprintf (stderr, "unscrambled- %02X %02X %02X %02X \n", slowdata[0], slowdata[1], slowdata[2], slowdata[3] );
|
||||
|
||||
} else if (framecount == 0) {
|
||||
//fprintf (stderr, "never scrambled-%c\n",slowdata);
|
||||
//fprintf (stderr, "never scrambled- %02X %02X %02X %02X \n", slowdata[0], slowdata[1], slowdata[2], slowdata[3] );
|
||||
|
||||
}
|
||||
for (short int i = 0; i < 4; i++)
|
||||
{
|
||||
if (slowdata[i] <= 0x7E && slowdata[i] >=0x20)
|
||||
{
|
||||
//fprintf (stderr, "%c", slowdata[i]);
|
||||
}
|
||||
//else fprintf (stderr, ".");
|
||||
}
|
||||
//fprintf (stderr, "\n");
|
||||
framecount++;
|
||||
|
||||
//since we are in a while loop, run ncursesPrinter here.
|
||||
if (opts->use_ncurses_terminal == 1)
|
||||
{
|
||||
ncursesPrinter(opts, state);
|
||||
}
|
||||
|
||||
} //end while loop
|
||||
|
||||
end: if (opts->errorbars == 1) {
|
||||
fprintf (stderr, "\n");
|
||||
}
|
||||
}
|
||||
|
||||
void processDSTAR_HD(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
void processDSTAR_HD(dsd_opts * opts, dsd_state * state) {
|
||||
|
||||
int i;
|
||||
int radioheaderbuffer[660];
|
||||
int i, j;
|
||||
int radioheaderbuffer[660];
|
||||
|
||||
for (i = 0; i < 660; i++)
|
||||
radioheaderbuffer[i] = getDibit(opts, state);
|
||||
for (j = 0; j < 660; j++) {
|
||||
radioheaderbuffer[j] = getDibit(opts, state);
|
||||
}
|
||||
|
||||
dstar_header_decode(state, radioheaderbuffer);
|
||||
processDSTAR(opts, state);
|
||||
|
||||
}
|
||||
|
||||
//first 24-bits of the larger scramble table
|
||||
uint8_t sd_d[48] =
|
||||
{0,0,0,0, //0
|
||||
1,1,1,0, //E
|
||||
1,1,1,1, //F
|
||||
0,0,1,0, //2
|
||||
1,1,0,0, //C
|
||||
1,0,0,1};//9
|
||||
|
||||
//no so simplified Slow Data
|
||||
void processDSTAR_SD(dsd_opts * opts, dsd_state * state, uint8_t * sd)
|
||||
{
|
||||
|
||||
int i, j, len;
|
||||
uint8_t sd_bytes[60]; //raw slow data packed into bytes
|
||||
uint8_t hd_bytes[60]; //storage for packed bytes sans the header indicator byte (0x55)
|
||||
uint8_t payload[60]; //unchanged copy of sd_bytes for payload printing
|
||||
uint8_t rev[480]; //storage for reversing the bit order
|
||||
memset (sd_bytes, 0, sizeof(sd_bytes));
|
||||
memset (hd_bytes, 0, sizeof(hd_bytes));
|
||||
memset (payload, 0, sizeof(payload));
|
||||
|
||||
//apply the descrambler
|
||||
for (i = 0; i < 480; i++)
|
||||
sd[i] ^= sd_d[i%24];
|
||||
|
||||
//reverse the bit order
|
||||
for (i = 0; i < 480; i++)
|
||||
rev[i] = sd[479-i];
|
||||
for (i = 0; i < 480; i++)
|
||||
sd[i] = rev[i];
|
||||
|
||||
//load bytes by least significant byte to most significant byte
|
||||
//as seen in "The Format of D-Star Slow Data" by Jonathan Naylor
|
||||
for (i = 0; i < 60; i++)
|
||||
sd_bytes[59-i] = (uint8_t)ConvertBitIntoBytes(&sd[i*8+0], 8);
|
||||
|
||||
//make a copy to payload that won't be altered
|
||||
memcpy (payload, sd_bytes, sizeof(payload));
|
||||
|
||||
len = sd_bytes[0] & 0xF;
|
||||
len += 1;
|
||||
|
||||
//load payload bytes without the header indicator byte
|
||||
for (i = 0, j = 0; i < 50; i++)
|
||||
{
|
||||
j++;
|
||||
hd_bytes[i] = sd_bytes[j];
|
||||
if (j == len*1-1) j++;
|
||||
if (j == len*2-1) j++;
|
||||
if (j == len*3-1) j++;
|
||||
if (j == len*4-1) j++;
|
||||
if (j == len*5-1) j++;
|
||||
if (j == len*6-1) j++;
|
||||
if (j == len*7-1) j++;
|
||||
if (j == len*8-1) j++;
|
||||
if (j == len*9-1) j++;
|
||||
}
|
||||
|
||||
//works on header format -- may not work on others
|
||||
uint16_t crc_ext = (hd_bytes[39] << 8) + hd_bytes[40];
|
||||
uint16_t crc_cmp = calc_fcs(hd_bytes, 39);
|
||||
|
||||
char str1[9];
|
||||
char str2[9];
|
||||
char str3[9];
|
||||
char str4[13];
|
||||
char strf[60];
|
||||
char strt[60];
|
||||
memset (strf, 0x20, sizeof(strf));
|
||||
memset (strt, 0x20, sizeof(strf));
|
||||
memcpy (str1, hd_bytes+3, 8);
|
||||
memcpy (str2, hd_bytes+11, 8);
|
||||
memcpy (str3, hd_bytes+19, 8);
|
||||
memcpy (str4, hd_bytes+27, 12);
|
||||
str1[8] = '\0';
|
||||
str2[8] = '\0';
|
||||
str3[8] = '\0';
|
||||
str4[12] = '\0';
|
||||
|
||||
//safety check, don't want to load nasty values into the strings
|
||||
for (i = 1; i < 60; i++)
|
||||
{
|
||||
//substitue non-ascii characters for spaces
|
||||
if (sd_bytes[i] < 0x20)
|
||||
sd_bytes[i] = 0x20;
|
||||
else if (sd_bytes[i] > 0x7E)
|
||||
sd_bytes[i] = 0x20;
|
||||
|
||||
//substitue non-ascii characters for spaces
|
||||
if (hd_bytes[i] < 0x20)
|
||||
hd_bytes[i] = 0x20;
|
||||
else if (hd_bytes[i] > 0x7E)
|
||||
hd_bytes[i] = 0x20;
|
||||
|
||||
//replace terminating ffffffff (repeating 0x66 values) with NULL (0x00)
|
||||
if (i < 59)
|
||||
{
|
||||
if (sd_bytes[i] == 0x66 && sd_bytes[i+1] == 0x66)
|
||||
sd_bytes[i] = 0x00;
|
||||
|
||||
if (hd_bytes[i] == 0x66 && hd_bytes[i+1] == 0x66)
|
||||
hd_bytes[i] = 0x00;
|
||||
}
|
||||
|
||||
if (i == 59 && sd_bytes[i] == 0x66)
|
||||
sd_bytes[i] = 0x00;
|
||||
|
||||
if (i == 59 && hd_bytes[i] == 0x66)
|
||||
hd_bytes[i] = 0x00;
|
||||
|
||||
}
|
||||
|
||||
memcpy (strf, sd_bytes+1, 58); //copy the entire thing as a string -- full
|
||||
memcpy (strt, hd_bytes+1, 48); //copy the entire thing as a string -- truncated
|
||||
strf[59] = '\0';
|
||||
strt[59] = '\0';
|
||||
|
||||
char type[7]; char temp[8]; char tempa[8]; char chungus[80]; UNUSED(chungus);
|
||||
memset (chungus, 0, sizeof(chungus));
|
||||
memset (temp, 0, sizeof(temp));
|
||||
memset (tempa, 0, sizeof(tempa));
|
||||
memset (type, 0, sizeof(type));
|
||||
memcpy (type, sd_bytes+1, 5);
|
||||
type[6] = '\0';
|
||||
|
||||
if (sd_bytes[0] == 0x55) //header format
|
||||
{
|
||||
|
||||
if (crc_cmp == crc_ext)
|
||||
{
|
||||
fprintf (stderr, " RPT 2: %s", str1);
|
||||
fprintf (stderr, " RPT 1: %s", str2);
|
||||
fprintf (stderr, " DST: %s", str3);
|
||||
fprintf (stderr, " SRC: %s", str4);
|
||||
|
||||
//check flags for info
|
||||
if (sd_bytes[1] & 0x80) fprintf (stderr, " DATA");
|
||||
if (sd_bytes[1] & 0x40) fprintf (stderr, " REPEATER");
|
||||
if (sd_bytes[1] & 0x20) fprintf (stderr, " INTERRUPTED");
|
||||
if (sd_bytes[1] & 0x10) fprintf (stderr, " CONTROL SIGNAL");
|
||||
if (sd_bytes[1] & 0x08) fprintf (stderr, " URGENT");
|
||||
|
||||
memcpy (state->dstar_rpt2, str1, sizeof(str1));
|
||||
memcpy (state->dstar_rpt1, str2, sizeof(str2));
|
||||
memcpy (state->dstar_dst, str3, sizeof(str3));
|
||||
memcpy (state->dstar_src, str4, sizeof(str4));
|
||||
}
|
||||
else fprintf (stderr, " SLOW DATA - HEADER FORMAT (CRC ERR)");
|
||||
|
||||
}
|
||||
|
||||
else //any other format (text, aprs, etc)
|
||||
{
|
||||
//fixed-form at 5 bytes, evaluate
|
||||
if (sd_bytes[0] == 0x35)
|
||||
{
|
||||
|
||||
//might as well just dump both of these outputs
|
||||
if (strcmp(type, "$$CRC") == 0) //APRS
|
||||
{
|
||||
memset (strt, 0x20, sizeof(strt)); //space fill
|
||||
fprintf (stderr, " DATA: ");
|
||||
for (i = 1; i < 59; i++)
|
||||
{
|
||||
if (i%6==0) i++;
|
||||
if ( (sd_bytes[i] > 0x19) && (sd_bytes[i] < 0x7F) )
|
||||
{
|
||||
fprintf (stderr, "%c", sd_bytes[i]);
|
||||
// strt[i] = sd_bytes[i];
|
||||
}
|
||||
}
|
||||
// strt[59] = '\0';
|
||||
// memcpy (state->dstar_gps, strt, sizeof(strt));
|
||||
}
|
||||
|
||||
if (strcmp(type, "$$CRC") == 0) //APRS
|
||||
{
|
||||
fprintf (stderr, "\n APRS - ");
|
||||
sprintf (state->dstar_gps, "APRS - ");
|
||||
uint8_t aprs[51];
|
||||
int k = 0;
|
||||
memset (aprs, 0, sizeof(aprs));
|
||||
//reshuffle (yet again) into an easier format to manipulate for aprs
|
||||
for (i = 1; i < 59; i++)
|
||||
{
|
||||
if (i % 6 == 0 ) i++;
|
||||
aprs[k] = sd_bytes[i];
|
||||
if ( (aprs[k] > 0x19) && (aprs[k] < 0x7F) )
|
||||
aprs[i] = 0x20;
|
||||
k++;
|
||||
}
|
||||
//start by looking for the ! exclamation point token
|
||||
int start = -1;
|
||||
for (i = 30; i < 40; i++)
|
||||
{
|
||||
if (aprs[i] == 0x21)
|
||||
{
|
||||
start = i+1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
//if not found, then skip (bad decode)
|
||||
if (start == -1)
|
||||
goto SKIP;
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "S: %d; ", start); //38, or 39
|
||||
|
||||
//LAT
|
||||
memcpy (temp, aprs+start, 2);
|
||||
start += 2;
|
||||
fprintf (stderr, "Lat: %sd ", temp);
|
||||
strcat (state->dstar_gps, "Lat: ");
|
||||
strcat (state->dstar_gps, temp);
|
||||
strcat (state->dstar_gps, "d ");
|
||||
memcpy (temp, aprs+start, 2);
|
||||
start += 3;
|
||||
fprintf (stderr, "%sm ", temp);
|
||||
strcat (state->dstar_gps, temp);
|
||||
strcat (state->dstar_gps, "m ");
|
||||
memcpy (temp, aprs+start, 2);
|
||||
start+=1;
|
||||
fprintf (stderr, "%ss ", temp);
|
||||
strcat (state->dstar_gps, temp);
|
||||
strcat (state->dstar_gps, "s ");
|
||||
fprintf (stderr, "%c", aprs[start]);
|
||||
if (sd_bytes[start] == 0x4E)
|
||||
strcat (state->dstar_gps, "N ");
|
||||
else if (sd_bytes[start] == 0x53)
|
||||
strcat (state->dstar_gps, "S ");
|
||||
fprintf (stderr, "; ");
|
||||
|
||||
//LON
|
||||
start += 3;
|
||||
memcpy (tempa, aprs+start, 3);
|
||||
start += 3;
|
||||
fprintf (stderr, "Lon: %sd ", tempa);
|
||||
strcat (state->dstar_gps, "Lon: ");
|
||||
strcat (state->dstar_gps, tempa);
|
||||
strcat (state->dstar_gps, "d ");
|
||||
memcpy (temp, aprs+start, 2);
|
||||
start += 3; //3
|
||||
fprintf (stderr, "%sm ", temp);
|
||||
strcat (state->dstar_gps, temp);
|
||||
strcat (state->dstar_gps, "m ");
|
||||
memcpy (temp, aprs+start, 2);
|
||||
start += 2;
|
||||
fprintf (stderr, "%ss ", temp);
|
||||
strcat (state->dstar_gps, temp);
|
||||
strcat (state->dstar_gps, "s ");
|
||||
fprintf (stderr, "%c", aprs[start]);
|
||||
if (aprs[start] == 0x45)
|
||||
strcat (state->dstar_gps, "E ");
|
||||
else if (aprs[start] == 0x57)
|
||||
strcat (state->dstar_gps, "W ");
|
||||
fprintf (stderr, "; ");
|
||||
|
||||
//Got the feeling nobody will actually ever see this message, but who knows
|
||||
// fprintf(stderr, "\n DEV NOTE: If you see this message, but incorrect lat/lon,\n please submit samples to https://github.com/lwvmobile/dsd-fme/issues/164 ");
|
||||
|
||||
SKIP: ; //do nothing
|
||||
|
||||
//this seems to work okay with a few samples, but wouldn't be surprised if it broke down
|
||||
//randomly on different users, depending on location and what else in in $$CRC
|
||||
|
||||
sprintf (state->event_history_s[0].Event_History_Items[0].gps_s, "%s", state->dstar_gps);
|
||||
}
|
||||
else
|
||||
{
|
||||
// fprintf (stderr, " %s: ", type);
|
||||
memset (strt, 0x20, sizeof(strt)); //space fill
|
||||
fprintf (stderr, " TEXT: ");
|
||||
for (i = 1; i < 59; i++)
|
||||
{
|
||||
if (i%6==0) i++;
|
||||
if ( (sd_bytes[i] > 0x19) && (sd_bytes[i] < 0x7F) )
|
||||
{
|
||||
fprintf (stderr, "%c", sd_bytes[i]);
|
||||
strt[i] = sd_bytes[i];
|
||||
}
|
||||
}
|
||||
strt[59] = '\0';
|
||||
memcpy (state->dstar_txt, strt, sizeof(strt));
|
||||
sprintf (state->event_history_s[0].Event_History_Items[0].text_message, "%s", state->dstar_txt);
|
||||
}
|
||||
}
|
||||
|
||||
//free-form text at 5 bytes, truncate every 6th position
|
||||
else if (sd_bytes[0] == 0x40)
|
||||
{
|
||||
memset (strt, 0x20, sizeof(strt)); //space fill
|
||||
fprintf (stderr, " TEXT: ");
|
||||
for (i = 1; i < 59; i++)
|
||||
{
|
||||
if (i%6==0) i++;
|
||||
if ( (sd_bytes[i] > 0x19) && (sd_bytes[i] < 0x7F) )
|
||||
{
|
||||
fprintf (stderr, "%c", sd_bytes[i]);
|
||||
strt[i] = sd_bytes[i];
|
||||
}
|
||||
}
|
||||
strt[59] = '\0';
|
||||
memcpy (state->dstar_txt, strt, sizeof(strt));
|
||||
sprintf (state->event_history_s[0].Event_History_Items[0].text_message, "%s", state->dstar_txt);
|
||||
}
|
||||
//anything else
|
||||
else //print entire thing
|
||||
{
|
||||
fprintf (stderr, " _UNK:");
|
||||
fprintf (stderr, " %s", strf);
|
||||
// memcpy (state->dstar_txt, strf, sizeof(strf)); //don't copy the unknown garbo strings
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
if (opts->payload == 1)
|
||||
{
|
||||
fprintf (stderr, "\n SD: ");
|
||||
for (i = 0; i < 60; i++)
|
||||
{
|
||||
fprintf (stderr, "[%02X]", payload[i]);
|
||||
if (i == 29) fprintf (stderr, "\n ");
|
||||
}
|
||||
|
||||
if (crc_cmp != crc_ext)
|
||||
fprintf (stderr, "CRC - EXT: %04X CMP: %04X", crc_ext, crc_cmp);
|
||||
}
|
||||
// Note: These routines contain GPLed code. Remove if you object to that.
|
||||
// Due to this, they are in a separate source file.
|
||||
dstar_header_decode(state, radioheaderbuffer);
|
||||
|
||||
//We officially have sync now, so just pass on to the above routine:
|
||||
|
||||
processDSTAR(opts, state);
|
||||
|
||||
}
|
||||
|
||||
@@ -1,8 +1,8 @@
|
||||
/*
|
||||
*
|
||||
* This code is taken largely from on1arf's GMSK code. Original copyright below:
|
||||
*
|
||||
*
|
||||
*
|
||||
* This code is taken largely from on1arf's GMSK code. Original copyright below:
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2011 by Kristoff Bonne, ON1ARF
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
@@ -13,84 +13,75 @@
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
*
|
||||
*/
|
||||
|
||||
#include "fcs.h"
|
||||
#include "descramble.h"
|
||||
#include "dstar_header.h"
|
||||
#include "dsd.h"
|
||||
// #include "fcs.h" //error: multiple definition of `calc_fcs'; CMakeFiles/dsd-fme.dir/src/dstar.c.o:dstar.c:(.text+0x0): first defined here
|
||||
|
||||
void dstar_header_decode(dsd_state * state, int radioheaderbuffer[660])
|
||||
{
|
||||
void dstar_header_decode(dsd_state * state, int radioheaderbuffer[660]) {
|
||||
int radioheaderbuffer2[660];
|
||||
char radioheader[41];
|
||||
unsigned char radioheader[41];
|
||||
int octetcount, bitcount, loop;
|
||||
unsigned char bit2octet[] = {0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80};
|
||||
unsigned int FCSinheader;
|
||||
unsigned int FCScalculated;
|
||||
int len;
|
||||
|
||||
scramble(radioheaderbuffer, radioheaderbuffer2);
|
||||
deinterleave(radioheaderbuffer2, radioheaderbuffer);
|
||||
FECdecoder(radioheaderbuffer, radioheaderbuffer2);
|
||||
len = FECdecoder(radioheaderbuffer, radioheaderbuffer2);
|
||||
memset(radioheader, 0, 41);
|
||||
|
||||
//memset(state->dstarradioheader, 0, 41);
|
||||
// note we receive 330 bits, but we only use 328 of them (41 octets)
|
||||
// bits 329 and 330 are unused
|
||||
octetcount = 0;
|
||||
bitcount = 0;
|
||||
for (loop = 0; loop < 328; loop++)
|
||||
{
|
||||
if (radioheaderbuffer2[loop])
|
||||
for (loop = 0; loop < 328; loop++) {
|
||||
if (radioheaderbuffer2[loop]) {
|
||||
radioheader[octetcount] |= bit2octet[bitcount];
|
||||
};
|
||||
bitcount++;
|
||||
// increase octetcounter and reset bitcounter every 8 bits
|
||||
if (bitcount >= 8)
|
||||
{
|
||||
if (bitcount >= 8) {
|
||||
octetcount++;
|
||||
bitcount = 0;
|
||||
}
|
||||
}
|
||||
//state->dstarradioheader = radioheader;
|
||||
|
||||
char str1[9];
|
||||
char str2[9];
|
||||
char str3[9];
|
||||
char str4[13];
|
||||
for (short i = 0; i < 41; i++)
|
||||
{
|
||||
state->dstarradioheader[i] = radioheader[i];
|
||||
}
|
||||
|
||||
memcpy (str1, radioheader+3, 8);
|
||||
memcpy (str2, radioheader+11, 8);
|
||||
memcpy (str3, radioheader+19, 8);
|
||||
memcpy (str4, radioheader+27, 12);
|
||||
|
||||
str1[8] = '\0';
|
||||
str2[8] = '\0';
|
||||
str3[8] = '\0';
|
||||
str4[12] = '\0';
|
||||
// print header
|
||||
fprintf (stderr, "\nDSTAR HEADER: ");
|
||||
//fprintf (stderr, "FLAG1: %02X - FLAG2: %02X - FLAG3: %02X\n", radioheader[0],
|
||||
// radioheader[1], radioheader[2]);
|
||||
fprintf (stderr, "RPT 2: %c%c%c%c%c%c%c%c ", radioheader[3], radioheader[4],
|
||||
radioheader[5], radioheader[6], radioheader[7], radioheader[8],
|
||||
radioheader[9], radioheader[10]);
|
||||
fprintf (stderr, "RPT 1: %c%c%c%c%c%c%c%c ", radioheader[11], radioheader[12],
|
||||
radioheader[13], radioheader[14], radioheader[15], radioheader[16],
|
||||
radioheader[17], radioheader[18]);
|
||||
fprintf (stderr, "YOUR: %c%c%c%c%c%c%c%c ", radioheader[19], radioheader[20],
|
||||
radioheader[21], radioheader[22], radioheader[23], radioheader[24],
|
||||
radioheader[25], radioheader[26]);
|
||||
fprintf (stderr, "MY: %c%c%c%c%c%c%c%c/%c%c%c%c\n", radioheader[27],
|
||||
radioheader[28], radioheader[29], radioheader[30], radioheader[31],
|
||||
radioheader[32], radioheader[33], radioheader[34], radioheader[35],
|
||||
radioheader[36], radioheader[37], radioheader[38]);
|
||||
|
||||
//TODO: Add fcs_calc to header as well
|
||||
// uint16_t crc_ext = (radioheader[39] << 8) + radioheader[40];
|
||||
// uint16_t crc_cmp = calc_fcs(radioheader, 39);
|
||||
|
||||
//debug
|
||||
// fprintf (stderr, "\n HD: ");
|
||||
// for (int i = 0; i < 40; i++)
|
||||
// fprintf (stderr, "%02X ", radioheader[i]);
|
||||
// fprintf (stderr, "\n");
|
||||
|
||||
fprintf (stderr, " RPT 2: %s", str1);
|
||||
fprintf (stderr, " RPT 1: %s", str2);
|
||||
fprintf (stderr, " DST: %s", str3);
|
||||
fprintf (stderr, " SRC: %s", str4);
|
||||
|
||||
//check flags for info
|
||||
if (radioheader[0] & 0x80) fprintf (stderr, " DATA");
|
||||
if (radioheader[0] & 0x40) fprintf (stderr, " REPEATER");
|
||||
if (radioheader[0] & 0x20) fprintf (stderr, " INTERRUPTED");
|
||||
if (radioheader[0] & 0x10) fprintf (stderr, " CONTROL SIGNAL");
|
||||
if (radioheader[0] & 0x08) fprintf (stderr, " URGENT");
|
||||
|
||||
memcpy (state->dstar_rpt2, str1, sizeof(str1));
|
||||
memcpy (state->dstar_rpt1, str2, sizeof(str2));
|
||||
memcpy (state->dstar_dst, str3, sizeof(str3));
|
||||
memcpy (state->dstar_src, str4, sizeof(str4));
|
||||
|
||||
//TODO: Call History for DSTAR
|
||||
//FCSinheader = ((radioheader[39] << 8) | radioheader[40]) & 0xFFFF;
|
||||
//FCScalculated = calc_fcs((unsigned char*) radioheader, 39);
|
||||
//fprintf (stderr, "Check sum = %04X ", FCSinheader);
|
||||
//if (FCSinheader == FCScalculated) {
|
||||
// fprintf (stderr, "(OK)\n");
|
||||
//} else {
|
||||
// fprintf (stderr, "(NOT OK- Calculated FCS = %04X)\n", FCScalculated);
|
||||
//}; // end else - if
|
||||
}
|
||||
|
||||
@@ -6,7 +6,7 @@
|
||||
* Mod: December 14, 2021, for EDACS-FM BCH Polynomial Error Generation and Detection
|
||||
* Mod2: October 2022, for DSD-FME port of EDACS-FM
|
||||
* Source: www.eccpage.com
|
||||
*
|
||||
*
|
||||
* =============== Encoder/Decoder for binary BCH codes in C =================
|
||||
*
|
||||
* Version 1: Original program. The user provides the generator polynomial
|
||||
@@ -30,7 +30,7 @@
|
||||
* previous version of the BCH encoder/decoder in C, 'bch2.c', was written by
|
||||
* Robert Morelos-Zaragoza (robert@spectra.eng.hawaii.edu) on 5/19/92.
|
||||
*
|
||||
* NOTE:
|
||||
* NOTE:
|
||||
* The author is not responsible for any malfunctioning of
|
||||
* this program, nor for any damage caused by it. Please include the
|
||||
* original program along with these comments in any redistribution.
|
||||
@@ -45,14 +45,14 @@
|
||||
* email: r.morelos-zaragoza@ieee.org
|
||||
*
|
||||
* COPYRIGHT NOTICE: This computer program is free for non-commercial purposes.
|
||||
* You may implement this program for any non-commercial application. You may
|
||||
* You may implement this program for any non-commercial application. You may
|
||||
* also implement this program for commercial purposes, provided that you
|
||||
* obtain my written permission. Any modification of this program is covered
|
||||
* by this copyright.
|
||||
*
|
||||
* == Copyright (c) 1994-7, Robert Morelos-Zaragoza. All rights reserved. ==
|
||||
*
|
||||
* m = order of the Galois field GF(2**m)
|
||||
* m = order of the Galois field GF(2**m)
|
||||
* n = 2**m - 1 = size of the multiplicative group of GF(2**m)
|
||||
* length = length of the BCH code
|
||||
* t = error correcting capability (max. no. of errors the code corrects)
|
||||
@@ -60,14 +60,14 @@
|
||||
* k = n - deg(g(x)) = dimension (no. of information bits/codeword) of the code
|
||||
* p[] = coefficients of a primitive polynomial used to generate GF(2**m)
|
||||
* g[] = coefficients of the generator polynomial, g(x)
|
||||
* alpha_to [] = log table of GF(2**m)
|
||||
* alpha_to [] = log table of GF(2**m)
|
||||
* index_of[] = antilog table of GF(2**m)
|
||||
* ddata[] = information bits = coefficients of data polynomial, i(x)
|
||||
* bb[] = coefficients of redundancy polynomial x^(length-k) i(x) modulo g(x)
|
||||
* numerr = number of errors
|
||||
* errpos[] = error positions
|
||||
* recd[] = coefficients of the received polynomial
|
||||
* decerror = number of decoding errors (in _message_ positions)
|
||||
* numerr = number of errors
|
||||
* errpos[] = error positions
|
||||
* recd[] = coefficients of the received polynomial
|
||||
* decerror = number of decoding errors (in _message_ positions)
|
||||
*
|
||||
*/
|
||||
|
||||
@@ -83,7 +83,7 @@ int seed;
|
||||
int numerr, errpos[1024], decerror = 0;
|
||||
|
||||
|
||||
void
|
||||
void
|
||||
read_p()
|
||||
/*
|
||||
* Read m, the degree of a primitive polynomial p(x) used to compute the
|
||||
@@ -126,7 +126,7 @@ read_p()
|
||||
}
|
||||
n = n / 2 - 1;
|
||||
ninf = (n + 1) / 2 - 1;
|
||||
|
||||
|
||||
do {
|
||||
|
||||
length = 40;
|
||||
@@ -134,7 +134,7 @@ read_p()
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
void
|
||||
generate_gf()
|
||||
/*
|
||||
* Generate field GF(2**m) from the irreducible polynomial p(X) with
|
||||
@@ -144,7 +144,7 @@ generate_gf()
|
||||
* index->polynomial form: alpha_to[] contains j=alpha^i;
|
||||
* polynomial form -> index form: index_of[j=alpha^i] = i
|
||||
*
|
||||
* alpha=2 is the primitive element of GF(2**m)
|
||||
* alpha=2 is the primitive element of GF(2**m)
|
||||
*/
|
||||
{
|
||||
register int i, mask;
|
||||
@@ -171,7 +171,7 @@ generate_gf()
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
void
|
||||
gen_poly()
|
||||
/*
|
||||
* Compute the generator polynomial of a binary BCH code. Fist generate the
|
||||
@@ -209,7 +209,7 @@ gen_poly()
|
||||
do {
|
||||
ll++;
|
||||
test = 0;
|
||||
for (ii = 1; ((ii <= jj) && (!test)); ii++)
|
||||
for (ii = 1; ((ii <= jj) && (!test)); ii++)
|
||||
/* Examine previous cycle sets */
|
||||
for (kaux = 0; ((kaux < size[ii]) && (!test)); kaux++)
|
||||
if (ll == cycle[ii][kaux])
|
||||
@@ -274,7 +274,7 @@ gen_poly()
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
void
|
||||
encode_bch()
|
||||
/*
|
||||
* Compute redundacy bb[], the coefficients of b(x). The redundancy
|
||||
@@ -305,7 +305,7 @@ encode_bch()
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
void
|
||||
decode_bch()
|
||||
/*
|
||||
* Simon Rockliff's implementation of Berlekamp's algorithm.
|
||||
@@ -332,8 +332,7 @@ decode_bch()
|
||||
{
|
||||
register int i, j, u, q, t2, count = 0, syn_error = 0;
|
||||
int elp[1026][1024], d[1026], l[1026], u_lu[1026], s[1025];
|
||||
int root[200], loc[200], reg[201];
|
||||
(void)(root);
|
||||
int root[200], loc[200], err[1024], reg[201];
|
||||
|
||||
t2 = 2 * t;
|
||||
|
||||
@@ -361,7 +360,7 @@ decode_bch()
|
||||
* u='mu'+1 and 'mu' (the Greek letter!) is the step number
|
||||
* ranging from -1 to 2*t (see L&C), l[u] is the degree of
|
||||
* the elp at that step, and u_l[u] is the difference between
|
||||
* the step number and the degree of the elp.
|
||||
* the step number and the degree of the elp.
|
||||
*/
|
||||
/* initialise table entries */
|
||||
d[0] = 0; /* index form */
|
||||
@@ -377,7 +376,7 @@ decode_bch()
|
||||
u_lu[0] = -1;
|
||||
u_lu[1] = 0;
|
||||
u = 0;
|
||||
|
||||
|
||||
do {
|
||||
u++;
|
||||
if (d[u] == -1) {
|
||||
@@ -389,7 +388,7 @@ decode_bch()
|
||||
} else
|
||||
/*
|
||||
* search for words with greatest u_lu[q] for
|
||||
* which d[q]!=0
|
||||
* which d[q]!=0
|
||||
*/
|
||||
{
|
||||
q = u - 1;
|
||||
@@ -404,23 +403,23 @@ decode_bch()
|
||||
q = j;
|
||||
} while (j > 0);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* have now found q such that d[u]!=0 and
|
||||
* u_lu[q] is maximum
|
||||
* u_lu[q] is maximum
|
||||
*/
|
||||
/* store degree of new elp polynomial */
|
||||
if (l[u] > l[q] + u - q)
|
||||
l[u + 1] = l[u];
|
||||
else
|
||||
l[u + 1] = l[q] + u - q;
|
||||
|
||||
|
||||
/* form new elp(x) */
|
||||
for (i = 0; i < t2; i++)
|
||||
elp[u + 1][i] = 0;
|
||||
for (i = 0; i <= l[q]; i++)
|
||||
if (elp[q][i] != -1)
|
||||
elp[u + 1][i + u - q] =
|
||||
elp[u + 1][i + u - q] =
|
||||
alpha_to[(d[u] + n - d[q] + elp[q][i]) % n];
|
||||
for (i = 0; i <= l[u]; i++) {
|
||||
elp[u + 1][i] ^= elp[u][i];
|
||||
@@ -428,23 +427,23 @@ decode_bch()
|
||||
}
|
||||
}
|
||||
u_lu[u + 1] = u - l[u + 1];
|
||||
|
||||
|
||||
/* form (u+1)th discrepancy */
|
||||
if (u < t2) {
|
||||
if (u < t2) {
|
||||
/* no discrepancy computed on last iteration */
|
||||
if (s[u + 1] != -1)
|
||||
d[u + 1] = alpha_to[s[u + 1]];
|
||||
else
|
||||
d[u + 1] = 0;
|
||||
for (i = 1; i <= l[u + 1]; i++)
|
||||
if ((s[u + 1 - i] != -1) && (elp[u + 1][i] != 0))
|
||||
d[u + 1] ^= alpha_to[(s[u + 1 - i]
|
||||
+ index_of[elp[u + 1][i]]) % n];
|
||||
for (i = 1; i <= l[u + 1]; i++)
|
||||
if ((s[u + 1 - i] != -1) && (elp[u + 1][i] != 0))
|
||||
d[u + 1] ^= alpha_to[(s[u + 1 - i]
|
||||
+ index_of[elp[u + 1][i]]) % n];
|
||||
/* put d[u+1] into index form */
|
||||
d[u + 1] = index_of[d[u + 1]];
|
||||
d[u + 1] = index_of[d[u + 1]];
|
||||
}
|
||||
} while ((u < t2) && (l[u + 1] <= t));
|
||||
|
||||
|
||||
u++;
|
||||
if (l[u] <= t) {/* Can correct errors */
|
||||
/* put elp into index form */
|
||||
@@ -472,7 +471,7 @@ decode_bch()
|
||||
}
|
||||
}
|
||||
|
||||
if (count == l[u])
|
||||
if (count == l[u])
|
||||
/* no. roots = degree of elp hence <= t errors */
|
||||
for (i = 0; i < l[u]; i++)
|
||||
recd[loc[i]] ^= 1;
|
||||
@@ -496,8 +495,8 @@ unsigned long long int edacs_bch (unsigned long long int message)
|
||||
for (i = 0; i < k; i++){
|
||||
ddata[i] = ( (message >> i) & 0x1 ); //loaded up backwards? or just outputs backwards?
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
encode_bch(); /* encode data */
|
||||
|
||||
/*
|
||||
|
||||
2367
src/edacs-fme.c
2367
src/edacs-fme.c
File diff suppressed because it is too large
Load Diff
11
src/ez.cpp
11
src/ez.cpp
@@ -84,8 +84,8 @@ int ez_rs28_facch (int payload[156], int parity[114])
|
||||
int ec = -2;
|
||||
int i, j, k, b;
|
||||
|
||||
//init HB
|
||||
for (i = 0; i < (int)HB.size(); i++)
|
||||
//init HB
|
||||
for (i = 0; i < 64; i++)
|
||||
{
|
||||
HB[i] = 0;
|
||||
}
|
||||
@@ -136,7 +136,7 @@ int ez_rs28_sacch (int payload[180], int parity[132])
|
||||
int i, j, k, b;
|
||||
|
||||
//init HBS
|
||||
for (i = 0; i < (int)HBS.size(); i++)
|
||||
for (i = 0; i < 64; i++)
|
||||
{
|
||||
HBS[i] = 0;
|
||||
}
|
||||
@@ -178,8 +178,7 @@ int ez_rs28_sacch (int payload[180], int parity[132])
|
||||
return (ec);
|
||||
}
|
||||
|
||||
//std::map <std::uint64_t, int> isch_map;
|
||||
std::map <uint64_t, int> isch_map; //User Noted GCC potential compiler error fix on BB OP25
|
||||
std::map <std::uint64_t, int> isch_map;
|
||||
void map_isch()
|
||||
{
|
||||
isch_map[0x184229d461ULL] = 0;
|
||||
@@ -338,7 +337,7 @@ int isch_lookup (uint64_t isch)
|
||||
}
|
||||
else // No errors, so simply return the matching value
|
||||
decoded = isch_map[isch];
|
||||
|
||||
|
||||
return decoded;
|
||||
|
||||
}
|
||||
@@ -28,10 +28,10 @@ namespace ezpwd {
|
||||
;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// output( <std::ostream> ) -- Output description of last failed test (or nothing if successful)
|
||||
// <std::ostream> << <asserter>
|
||||
//
|
||||
//
|
||||
std::ostream &output(
|
||||
std::ostream &lhs )
|
||||
const
|
||||
@@ -39,14 +39,14 @@ namespace ezpwd {
|
||||
return lhs << out;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// (bool) <asserter> -- Return status of last test
|
||||
//
|
||||
operator bool()
|
||||
{
|
||||
return failed;
|
||||
}
|
||||
|
||||
|
||||
template < typename T >
|
||||
asserter &istrue( const char *file, int line, const T &a, const std::string &comment = std::string() )
|
||||
{
|
||||
@@ -84,7 +84,7 @@ namespace ezpwd {
|
||||
}
|
||||
return success();
|
||||
}
|
||||
|
||||
|
||||
asserter &failure( const char *file, int line, const std::string &comparison,
|
||||
const std::string &comment = std::string() )
|
||||
{
|
||||
|
||||
@@ -1,6 +1,6 @@
|
||||
/*
|
||||
* Ezpwd Reed-Solomon -- Reed-Solomon encoder / decoder library
|
||||
*
|
||||
*
|
||||
* Copyright (c) 2017, Hard Consulting Corporation.
|
||||
*
|
||||
* Ezpwd Reed-Solomon is free software: you can redistribute it and/or modify it under the terms of
|
||||
@@ -9,7 +9,7 @@
|
||||
* source tree. Ezpwd Reed-Solomon is also available under Commercial license. The Djelic BCH code
|
||||
* under djelic/ and the c++/ezpwd/bch_base wrapper is redistributed under the terms of the GPLv2+,
|
||||
* regardless of the overall licensing terms.
|
||||
*
|
||||
*
|
||||
* Ezpwd Reed-Solomon 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.
|
||||
@@ -22,7 +22,7 @@
|
||||
#include "bch_base"
|
||||
|
||||
namespace ezpwd {
|
||||
//
|
||||
//
|
||||
// ezpwd::bch_base -- Interface to underlying Djelic Linux Kernel API
|
||||
// ezpwd::bch<SYMBOLS, CORRECTION> -- General BCH codec types; min. CORRECTION capacity, undefined PAYLOAD
|
||||
//
|
||||
@@ -31,7 +31,7 @@ namespace ezpwd {
|
||||
// target bit-error correction capacity T. They may correct more than T errors, and the number
|
||||
// of parity ECC bits will be selected by the algorithm. You need to compute the maximum
|
||||
// non-parity payload by computing _bch->n - _bch->ecc_bits.
|
||||
//
|
||||
//
|
||||
// The data and parity bits must always be on separate blocks of int8_t/uint8_t-sized data
|
||||
// in the container. This is required because the underlying API must break the data and parity
|
||||
// out as separate arrays for processing. So, if the computed ecc_bits is not evenly divisible
|
||||
@@ -39,12 +39,12 @@ namespace ezpwd {
|
||||
// the end of the supplied container. Alternatively, it can be kept in a separate container.
|
||||
// This is probably safest, as the bch_base/bch/BCH classes will never attempt to resize the
|
||||
// data/parity containers when supplied separately.
|
||||
//
|
||||
//
|
||||
// Like the Reed-Solomon APIs, the bch_base/bch/BCH APIs will alter the size of a variable
|
||||
// container in encode(...), to add the BCH ECC "parity" data (eg. std::vector, std::string).
|
||||
// Fixed containers (eg. std::array) are never resized, and it is assumed that ecc_bytes of
|
||||
// parity data exist at the end of the container.
|
||||
//
|
||||
//
|
||||
class bch_base {
|
||||
public:
|
||||
ezpwd::bch_control *_bch;
|
||||
@@ -92,12 +92,12 @@ namespace ezpwd {
|
||||
return lhs << *this->_bch;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// encode -- container interfaces
|
||||
//
|
||||
//
|
||||
// Returns number of ECC *bits* initialized (to be consistent w/ decode, which returns
|
||||
// number of bit errors corrected).
|
||||
//
|
||||
//
|
||||
int encode(
|
||||
std::string &data )
|
||||
const
|
||||
@@ -123,7 +123,7 @@ namespace ezpwd {
|
||||
return encode( cuTpair( (const uT *)&data.front(), (const uT *)&data.front() + data.size() ),
|
||||
uTpair( (uT *)&parity.front(), (uT *)&parity.front() + parity.size() ));
|
||||
}
|
||||
|
||||
|
||||
template < typename T >
|
||||
int encode(
|
||||
std::vector<T> &data )
|
||||
@@ -167,11 +167,11 @@ namespace ezpwd {
|
||||
return encode( uTpair( (uT *)&data.front() + pad, (uT *)&data.front() + data.size() ));
|
||||
}
|
||||
|
||||
|
||||
//
|
||||
|
||||
//
|
||||
// encode -- denote data+parity or data, parity using pairs of uint8_t iterators
|
||||
// encode -- base implementation, in terms of uint8_t pointers
|
||||
//
|
||||
//
|
||||
virtual int encode(
|
||||
const std::pair<uint8_t *, uint8_t *>
|
||||
&data )
|
||||
@@ -206,9 +206,9 @@ namespace ezpwd {
|
||||
|
||||
//
|
||||
// decode -- container interface, w/ optional corrected bit-error positions reported
|
||||
//
|
||||
//
|
||||
// Does not correct errors in parity!
|
||||
//
|
||||
//
|
||||
int decode(
|
||||
std::string &data,
|
||||
std::vector<int> *position= 0 )
|
||||
@@ -280,15 +280,15 @@ namespace ezpwd {
|
||||
position );
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// decode -- denote data+parity or data, parity using pairs of uint8_t iterators
|
||||
// decode -- decode and correct BCH codeword, returning number of corrections, or -1 if failed
|
||||
//
|
||||
//
|
||||
// Corrects data in-place (unlike the basic Djelic Linux Kernel API, which only returns
|
||||
// error positions. For consistency with ezpwd::rs..., we report all error positions as
|
||||
// std::vector<int>, even though the underlying Djelic API reports them as arrays of
|
||||
// unsigned int.
|
||||
//
|
||||
//
|
||||
virtual int decode(
|
||||
const std::pair<uint8_t *, uint8_t *>
|
||||
&data,
|
||||
@@ -329,18 +329,18 @@ namespace ezpwd {
|
||||
position->resize( corrects );
|
||||
return corrects;
|
||||
}
|
||||
|
||||
|
||||
//
|
||||
// {en,de}coded -- returns an encoded/corrected copy of the provided container
|
||||
//
|
||||
// NOTE:
|
||||
//
|
||||
//
|
||||
// Must return exceptions on failure; If exceptions inhibited, returns a
|
||||
// default-constructed instance of the supplied data container. This may be sufficient to
|
||||
// reliably deduce failure; if not, this interface should not be used.
|
||||
//
|
||||
//
|
||||
// Overloads decoded to also allow recovery of corrected error positions and count.
|
||||
//
|
||||
//
|
||||
template <typename C>
|
||||
C encoded(
|
||||
C data )
|
||||
@@ -391,11 +391,11 @@ namespace ezpwd {
|
||||
}
|
||||
}; // class bch
|
||||
|
||||
//
|
||||
//
|
||||
// std::ostream << ezpwd::bch_base
|
||||
//
|
||||
//
|
||||
// Output a BCH codec description in standard form eg. BCH( 255, 239, 2 )
|
||||
//
|
||||
//
|
||||
inline
|
||||
std::ostream &operator<<(
|
||||
std::ostream &lhs,
|
||||
@@ -405,9 +405,9 @@ namespace ezpwd {
|
||||
return rhs.output( lhs );
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// ezpwd::BCH<SYMBOLS, PAYLOAD, CAPACITY> -- Standard BCH codec types
|
||||
//
|
||||
//
|
||||
// Specify and create a standard BCH codec with exactly the specified capacities. We create
|
||||
// the undering BCH codec using SYMBOLS and CORRECTION capacity; the actual correction capacity
|
||||
// T, the number of PARITY bits and hence PAYLOAD (CAPACITY - PARITY) is selected automatically
|
||||
@@ -415,11 +415,11 @@ namespace ezpwd {
|
||||
// caller *knows* all of these values at compile time, however, mostly for future optimization
|
||||
// purposes. We validate them, and fail the constructor if they don't match. See bch_test for
|
||||
// an enumeration of all possible BCH codecs.
|
||||
//
|
||||
//
|
||||
// In the future, this API may be re-implemented to not use the generic BCH API, but a more
|
||||
// optimized locally-defined implementation that leverages the fixed SYMBOLS, PAYLOAD and
|
||||
// CORRECTION capacities to produce more optimal code.
|
||||
//
|
||||
//
|
||||
template < size_t SYMBOLS, size_t PAYLOAD, size_t CORRECTION >
|
||||
class BCH
|
||||
: public bch<SYMBOLS, CORRECTION>
|
||||
@@ -463,13 +463,13 @@ namespace ezpwd {
|
||||
}; // class BCH
|
||||
|
||||
|
||||
//
|
||||
//
|
||||
// std::ostream << ezpwd::BCH<...>
|
||||
//
|
||||
//
|
||||
// Output a BCH codec description in standard form eg. BCH( 255, 239, 2 )
|
||||
//
|
||||
//
|
||||
// NOTE: clang/gcc disagree on the scoping of operator<< template/non-template functions...
|
||||
//
|
||||
//
|
||||
template <size_t SYMBOLS, size_t PAYLOAD, size_t CORRECTION>
|
||||
inline
|
||||
std::ostream &operator<<(
|
||||
|
||||
@@ -1,6 +1,6 @@
|
||||
/*
|
||||
* Ezpwd Reed-Solomon -- Reed-Solomon encoder / decoder library
|
||||
*
|
||||
*
|
||||
* Copyright (c) 2017, Hard Consulting Corporation.
|
||||
*
|
||||
* Ezpwd Reed-Solomon is free software: you can redistribute it and/or modify it under the terms of
|
||||
@@ -9,7 +9,7 @@
|
||||
* source tree. Ezpwd Reed-Solomon is also available under Commercial license. The Djelic BCH code
|
||||
* under djelic/ and the c++/ezpwd/bch_base wrapper is redistributed under the terms of the GPLv2+,
|
||||
* regardless of the overall licensing terms.
|
||||
*
|
||||
*
|
||||
* Ezpwd Reed-Solomon 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.
|
||||
@@ -21,11 +21,11 @@
|
||||
#include <iomanip>
|
||||
#include <vector>
|
||||
|
||||
//
|
||||
//
|
||||
// Presently, we simply import the Linux Kernel's "C" BCH API directly into the ezpwd:: namespace In
|
||||
// order to compile, you must (at least) run "make djelic" in the base directory of the
|
||||
// https://github.com/pjkundert/bch.git repo.
|
||||
//
|
||||
//
|
||||
namespace ezpwd {
|
||||
/**
|
||||
* struct bch_control - BCH control structure
|
||||
@@ -152,21 +152,21 @@ namespace ezpwd {
|
||||
#include "../../djelic_bch.h"
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// correct_bch -- corrects data (but not parity!), as suggested by decode_bch, above
|
||||
//
|
||||
//
|
||||
// A convenience interface that defaults all of the not strictly required parameters, and
|
||||
// automatically corrects bit-errors in data *and* the supplied parity. Does not attempt to
|
||||
// correct bit errors found in the parity data. If not supplied, 'errloc' is allocated
|
||||
// internally; otherwise, it is assumed to be of at least size bch->t (the minimum error
|
||||
// correction capacity of the BCH codec).
|
||||
//
|
||||
//
|
||||
// However, beware -- at larger values of T, the actual correction capacity of the BCH codec
|
||||
// could be greater than the requested T. Therefore, it is recommended that you always supply a
|
||||
// larger than required errloc array; recommend T*2?
|
||||
//
|
||||
//
|
||||
inline
|
||||
int correct_bch(
|
||||
int correct_bch(
|
||||
struct bch_control *bch,
|
||||
uint8_t *data,
|
||||
unsigned int len,
|
||||
@@ -198,9 +198,9 @@ namespace ezpwd {
|
||||
return err;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// <ostream> << <ezpwd::bch_control> -- output codec in standard BCH( N, N-ECC, T ) form
|
||||
//
|
||||
//
|
||||
inline
|
||||
std::ostream &operator<<(
|
||||
std::ostream &lhs,
|
||||
|
||||
@@ -1,6 +1,6 @@
|
||||
/*
|
||||
* Ezpwd Reed-Solomon -- Reed-Solomon encoder / decoder library
|
||||
*
|
||||
*
|
||||
* Copyright (c) 2014, Hard Consulting Corporation.
|
||||
*
|
||||
* Ezpwd Reed-Solomon is free software: you can redistribute it and/or modify it under the terms of
|
||||
@@ -8,7 +8,7 @@
|
||||
* the License, or (at your option) any later version. See the LICENSE file at the top of the
|
||||
* source tree. Ezpwd Reed-Solomon is also available under Commercial license. c++/ezpwd/rs_base
|
||||
* is redistributed under the terms of the LGPL, regardless of the overall licensing terms.
|
||||
*
|
||||
*
|
||||
* Ezpwd Reed-Solomon 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.
|
||||
@@ -21,7 +21,7 @@
|
||||
|
||||
namespace ezpwd {
|
||||
|
||||
//
|
||||
//
|
||||
// best_avg -- collect <password>,<confidence> guesses, and return the unambiguous best one
|
||||
//
|
||||
typedef std::map<std::string, std::pair<int, int>> // (<password>, (<count>, <avgsum>))
|
||||
@@ -38,9 +38,9 @@ namespace ezpwd {
|
||||
using best_avg_base_t::const_iterator;
|
||||
using best_avg_base_t::value_type;
|
||||
using best_avg_base_t::mapped_type;
|
||||
//
|
||||
//
|
||||
// add -- add the given pct to the current average for <string> str
|
||||
//
|
||||
//
|
||||
iterator add(
|
||||
const std::string &str,
|
||||
int pct )
|
||||
@@ -53,9 +53,9 @@ namespace ezpwd {
|
||||
return i;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// best -- return the unambiguously best value (average is >, or == but longer), or end()
|
||||
//
|
||||
//
|
||||
const_iterator best()
|
||||
const
|
||||
{
|
||||
@@ -76,11 +76,11 @@ namespace ezpwd {
|
||||
return uni ? top : end();
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// evaluation -- process a (<password>,(<count>,<avgsum>)) into (<average>,<password>)
|
||||
// sort -- return a multimap indexed by <average> --> <string>
|
||||
// output -- output the <string>: <average>, sorted by average
|
||||
//
|
||||
//
|
||||
static std::pair<const int,const std::string &>
|
||||
evaluation( const value_type &val )
|
||||
{
|
||||
@@ -116,14 +116,14 @@ std::ostream &operator<<(
|
||||
}
|
||||
|
||||
namespace ezpwd {
|
||||
//
|
||||
//
|
||||
// ezpwd::corrector -- Apply statistical corrections to a string, returning the confidence
|
||||
//
|
||||
//
|
||||
// All methods are static; no instance is required, as this is primarily used to create
|
||||
// external language APIs.
|
||||
//
|
||||
//
|
||||
template <
|
||||
size_t PARITY,
|
||||
size_t PARITY,
|
||||
size_t N = 64,
|
||||
typename SERIAL = serialize::base< N, serialize::ezpwd< N >>>
|
||||
class corrector {
|
||||
@@ -135,10 +135,10 @@ namespace ezpwd {
|
||||
lhs << "corrector<PARITY=" << PARITY << ",N=" << N << ",SERIAL=" << SERIAL() << ">";
|
||||
return lhs;
|
||||
}
|
||||
|
||||
//
|
||||
|
||||
//
|
||||
// parity(<string>) -- Returns 'PARITY' base-N symbols of R-S parity to the supplied password
|
||||
//
|
||||
//
|
||||
static std::string parity(
|
||||
const std::string &password )
|
||||
{
|
||||
@@ -148,13 +148,13 @@ namespace ezpwd {
|
||||
return parity;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// encode(<string>) -- append PARITY base-N parity symbols to password
|
||||
//
|
||||
//
|
||||
// The supplied password buffer size must be sufficient to contain PARITY additional
|
||||
// symbols, plus the terminating NUL. Returns the resultant encoded password size
|
||||
// (excluding the NUL).
|
||||
//
|
||||
//
|
||||
static size_t encode(
|
||||
std::string &password )
|
||||
{
|
||||
@@ -178,23 +178,23 @@ namespace ezpwd {
|
||||
return len;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// decode(<string>[,...]) -- Applies R-S error correction on the encoded string, removing parity
|
||||
//
|
||||
//
|
||||
// Up to 'PARITY' Reed-Solomon parity symbols are examined, to determine if the supplied
|
||||
// string is a valid R-S codeword and hence very likely to be correct. Optionally supply a
|
||||
// vector of erasure positions.
|
||||
//
|
||||
//
|
||||
// An optional 'minimum' final password length may be provided; no R-S parity is assumed
|
||||
// to exist in the first 'minimum' password characters (default: PARITY). This prevents
|
||||
// accidentally finding valid R-S codewords in passwords of known minimum length; validation
|
||||
// codes, for example. Likewise, the optional 'maximum' allows us to limit the number of
|
||||
// parity symbols that may be assumed to be missing from the end of the codeword.
|
||||
//
|
||||
//
|
||||
// Returns a confidence strength rating, which is the ratio:
|
||||
//
|
||||
//
|
||||
// 100 - ( errors * 2 + erasures ) * 100 / parity
|
||||
//
|
||||
//
|
||||
// if an R-S codeword was solved, and 0 otherwise. If a codeword is solved, but the number
|
||||
// of errors and erasures corrected indicates that all parity was consumed, the caller may
|
||||
// opt to not use the corrected string, because there is a chance that our R-S polynomial
|
||||
@@ -204,26 +204,26 @@ namespace ezpwd {
|
||||
// were used in error/erasure recover, with none left to confirm that the result is actually
|
||||
// correct. If only zero-strength results are achieved, the longest will be returned (the
|
||||
// full, original string).
|
||||
//
|
||||
//
|
||||
// Supports the following forms of error/erasure:
|
||||
//
|
||||
//
|
||||
// 0) Full parity. All data and parity supplied, and an R-S codeword is solved.
|
||||
//
|
||||
//
|
||||
// 1) Partial parity. All data and some parity supplied; remainder are deemed erasures.
|
||||
//
|
||||
//
|
||||
// If PARITY > 2, then up to PARITY/2-1 trailing parity terms are marked as erasures.
|
||||
// If the R-S codeword is solved and a safe number of errors are found, then we can have
|
||||
// reasonable confidence that the string is correct.
|
||||
//
|
||||
//
|
||||
// 1a) Erase errors. Permute the combinations of up to PARITY-1 erasures.
|
||||
//
|
||||
//
|
||||
// o) Raw password. No parity terms supplied; not an R-S codeword
|
||||
//
|
||||
//
|
||||
// If none of the error/erasure forms succeed, the password is returned unmodified.
|
||||
//
|
||||
//
|
||||
// If a non-zero 'minimum' or 'maximum' are provided, they constrain the possible
|
||||
// resultant password sizes that will be attempted.
|
||||
//
|
||||
//
|
||||
static
|
||||
int decode(
|
||||
std::string &password,
|
||||
@@ -239,16 +239,16 @@ namespace ezpwd {
|
||||
// capability while maintaining at least one excess parity symbol for verification.
|
||||
// This can potentially result in longer password being returned, if the R-S decoder
|
||||
// accidentally solves a codeword.
|
||||
//
|
||||
//
|
||||
// For example, if PARITY=3 (or 4) then (PARITY+1)/2 == 2, and we would only attempt up
|
||||
// to 1 parity erasure. This would leave 1 parity symbol to replace the 1 erasure, and
|
||||
// 1 remaining to validate the integrity of the password.
|
||||
//
|
||||
//
|
||||
// The password must be long enough to contain at least 1 non-parity symbol, and the
|
||||
// designated number of non-erased parity symbols! However, by convention we'll demand
|
||||
// that the password contain at least PARITY symbols -- any less, and we can
|
||||
// accidentally correct the few remaining password symbols.
|
||||
//
|
||||
//
|
||||
// Also, if any parity symbols won't decode (eg. were entered in error), we must deem
|
||||
// them to be erasures, too, and if the number of erasures exceeds the capacity of the
|
||||
// R-S codec, it'll fail (throw an exception, or at best solve with 0 confidence).
|
||||
@@ -331,7 +331,7 @@ namespace ezpwd {
|
||||
<< " parity erasures " << std::setw( 3 ) << confidence
|
||||
<< "% confidence: \"" << password
|
||||
<< "\" ==> \"" << fixed
|
||||
<< "\" (corrects: " << corrects
|
||||
<< "\" (corrects: " << corrects
|
||||
<< ", erasures at " << all_era
|
||||
<< ", fixed at " << position << "): "
|
||||
<< std::endl
|
||||
@@ -354,7 +354,7 @@ namespace ezpwd {
|
||||
// w/ 3 parity: sock1tkeB
|
||||
// password ----^^^^^^
|
||||
// ^^^--- parity
|
||||
//
|
||||
//
|
||||
for ( size_t era = (PARITY+1)/2 // how many parity symbols are not present
|
||||
; era < PARITY
|
||||
; ++era ) {
|
||||
@@ -446,15 +446,15 @@ namespace ezpwd {
|
||||
return decode( password, std::vector<int>(), minimum, maximum );
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// decode(<char*>,<size_t>,<size_t>,<size_t>) -- C interface to decode(<string>)
|
||||
//
|
||||
//
|
||||
// Traditional C interface. The provided NUL-terminated password+parity is decoded
|
||||
// (parity removed), and the confidence % is returned.
|
||||
//
|
||||
//
|
||||
// If any failure occurs, a -'ve value will be returned, and the supplied password
|
||||
// buffer will be used to contain an error description.
|
||||
//
|
||||
//
|
||||
static int decode(
|
||||
char *password, // NUL terminated
|
||||
size_t siz, // available size
|
||||
@@ -477,13 +477,13 @@ namespace ezpwd {
|
||||
return confidence;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// rscodec -- A ?-bit RS(N-1,N-1-PARITY) Reed-Solomon codec
|
||||
//
|
||||
//
|
||||
// Encodes and decodes R-S symbols over the lower 6 bits of the supplied data. Requires
|
||||
// that the last N (parity) symbols of the data are in the range [0,63]. The excess bits on
|
||||
// the data symbols are masked and restored during decoding.
|
||||
//
|
||||
//
|
||||
static const ezpwd::RS<N-1,N-1-PARITY>
|
||||
rscodec;
|
||||
};
|
||||
|
||||
@@ -1,6 +1,6 @@
|
||||
//
|
||||
//
|
||||
// C++ Definitions -- include once in a single C++ compilation unit
|
||||
//
|
||||
//
|
||||
#ifndef _EZPWD_DEFINITIONS
|
||||
#define _EZPWD_DEFINITIONS
|
||||
|
||||
|
||||
108
src/ezpwd/ezcod
108
src/ezpwd/ezcod
@@ -1,6 +1,6 @@
|
||||
/*
|
||||
* Ezpwd Reed-Solomon -- Reed-Solomon encoder / decoder library
|
||||
*
|
||||
*
|
||||
* Copyright (c) 2014, Hard Consulting Corporation.
|
||||
*
|
||||
* Ezpwd Reed-Solomon is free software: you can redistribute it and/or modify it under the terms of
|
||||
@@ -8,7 +8,7 @@
|
||||
* the License, or (at your option) any later version. See the LICENSE file at the top of the
|
||||
* source tree. Ezpwd Reed-Solomon is also available under Commercial license. c++/ezpwd/rs_base
|
||||
* is redistributed under the terms of the LGPL, regardless of the overall licensing terms.
|
||||
*
|
||||
*
|
||||
* Ezpwd Reed-Solomon 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.
|
||||
@@ -25,9 +25,9 @@
|
||||
#include <ezpwd/output>
|
||||
#include <ezpwd/serialize>
|
||||
|
||||
//
|
||||
//
|
||||
// EZCOD 3:10 location code w/ Reed-Solomon Error Correction, and average 3m accuracy
|
||||
//
|
||||
//
|
||||
// - each successive symbol provides greater precision
|
||||
// - codes nearby each-other are identical in leading characters
|
||||
// - average 3m precision achieved in 9 symbols
|
||||
@@ -37,87 +37,87 @@
|
||||
// - 2 parity symbols provides correction of 1 lost symbol (no errors)
|
||||
// - 3 parity symbols provides correction of any 1 error, with verification,
|
||||
// or recovery of up to any 3 lost symbols (with no other errors)
|
||||
//
|
||||
//
|
||||
|
||||
//
|
||||
//
|
||||
// To achieve at least 4 decimal digits of precision after the decimal point, we must have
|
||||
// defined lat to within 1 part in 1,800,000, and lon to within 1 part in 3,600,000. As each symbol
|
||||
// supplies bits, we'll refine the computed lat/lon further, reducing the outstanding fraction of
|
||||
// "parts" yet to be defined.
|
||||
//
|
||||
// bits
|
||||
//
|
||||
// bits
|
||||
// symbols latitude longitude
|
||||
// bits mul parts bits mul parts
|
||||
// 1 2 4 4 3 8 8
|
||||
// 2 2 4 16 3 8 64
|
||||
// 3 3 8 128 2 4 256 // not quite integer lat/lon accuracy
|
||||
//
|
||||
//
|
||||
// 4 2 4 512 3 8 2,048
|
||||
// 5 3 8 4,096 2 4 8,192
|
||||
// 6 2 4 16,384 3 8 65,536
|
||||
// 6 2 4 16,384 3 8 65,536
|
||||
//
|
||||
// 7 3 8 131,072 2 4 262,144
|
||||
// 8 2 4 524,288 3 8 2,097,152
|
||||
// 9 3 8 4,194,304 2 4 8,388,608 parts resolution in 3:10 code
|
||||
// over [-90, 90] over [-180,180] yields ~3m resolution
|
||||
//
|
||||
//
|
||||
// vs. 1,800,000 3,600,000 parts resolution in 10:10 code
|
||||
// over [-90, 90] over [-180,180] yields ~10m resolution
|
||||
//
|
||||
//
|
||||
// Therefore, within 9 symbols we define lat and lon with better than double the precision of
|
||||
// 10:10 code's 4 decimal digits after the decimal point. This yields an approximate lineal
|
||||
// precision of 40,075,000m / 8,388,608 == ~5m in both dimensions at the equator, vs. 40,075,000m /
|
||||
// 3,600,000 == ~11m for 10:10 codes.
|
||||
//
|
||||
//
|
||||
// The 10:10 code provides a single check character, which provides about P(1-1/32) certainty
|
||||
// that the provided code is correct. With EZCOD 3:10/11/12 codes, we provide varying levels of
|
||||
// that the provided code is correct. With EZCOD 3:10/11/12 codes, we provide varying levels of
|
||||
// detection/correction strength.
|
||||
//
|
||||
//
|
||||
// - 1 parity symbol: act as a check character (like 10:10 codes), or provide 1 symbol of erasure
|
||||
// (lost symbol) recovery with no excess parity for validation.
|
||||
//
|
||||
//
|
||||
// - 2 parity symbols: provide 1 symbol of erasure correction (w/ no other errors) with 1 excess parity
|
||||
// symbol for validation, or 1 symbol of error detection with no excess parity for validation.
|
||||
//
|
||||
//
|
||||
// - 3 parity symbols: correct 1 error anywhere w/ 1 excess parity symbol for validation, or up
|
||||
// to 3 erasures with no excess parity for validation.
|
||||
//
|
||||
//
|
||||
// Therefore, we'll provide Reed-Solomon RS(31,28-30) error correction (5 bit symbols,
|
||||
// indicating 31 symbols in the field, and from 1 to 3 roots, therefore up to 28 data symbols in the
|
||||
// field) over the 9 lat/lon data symbols.
|
||||
//
|
||||
//
|
||||
//
|
||||
//
|
||||
// MINIMIZING ERROR
|
||||
//
|
||||
//
|
||||
// Each input lat/lon coordinate will be effectively truncated by the encoding procedure to the
|
||||
// level of precision (parts) encoded by each symbol. Subsequent symbols then add their (smaller)
|
||||
// parts to increase precision.
|
||||
//
|
||||
//
|
||||
// After the last symbol, we know that the actual input coordinates where somewhere
|
||||
// within the rectangle:
|
||||
//
|
||||
//
|
||||
// [0,0] -> [0,lon_precision] -> [lat_precision,lon_precision] -> [lat_precision,0]
|
||||
//
|
||||
//
|
||||
// At first glance, the best way is to perform rounding instead of truncation on ecoding, by
|
||||
// simply adding 1/2 of the precision. Then, the unmodified output lat/lon decoded represents the
|
||||
// point nearest actual input coordinate. However, this is NOT ideal. Remember -- the decoding may
|
||||
// not have access to all the symbols! We want to minimize the error even if only some of the
|
||||
// symbols are available. Thus, we must apply a correction on decoding.
|
||||
//
|
||||
//
|
||||
// One way gain rounding instead of truncation on decoding is, after adding the last symbol's
|
||||
// precision, to add 50% of the value represented by the first bit of the next (missing) symbol's
|
||||
// precision parts. This would be analogous to receiving the first 2 digits of a 3 digit number:
|
||||
//
|
||||
//
|
||||
// original: 123
|
||||
// received: 12_
|
||||
// range: [120,130)
|
||||
// guessed: 125 (add 1/2 of the parts represented by the missing digit)
|
||||
//
|
||||
//
|
||||
// If this is done, then the resulting coordinate would be in the middle of the rectangle of
|
||||
// possible input lat/lon values that could have resulted in the encoded value. This also works if
|
||||
// we don't receive and decode all of the symbols; We'll end up with a lat/lon in the middle of the
|
||||
// (large) rectangle of possible input coordinates.
|
||||
//
|
||||
//
|
||||
|
||||
|
||||
namespace ezpwd {
|
||||
@@ -179,9 +179,9 @@ inline std::ostream &operator<<(
|
||||
|
||||
namespace ezpwd {
|
||||
|
||||
//
|
||||
//
|
||||
// ezcod<P,L> -- defaults to 1 PARITY and 9 location symbols (3m) of PRECISION
|
||||
//
|
||||
//
|
||||
template < unsigned P=1, unsigned L=9 >
|
||||
class ezcod
|
||||
: public ezcod_base {
|
||||
@@ -221,9 +221,9 @@ namespace ezpwd {
|
||||
char separator; // Separator between location and parity symbols
|
||||
char space; // Fill space between location symbol chunks
|
||||
|
||||
//
|
||||
//
|
||||
// ezcod<P,L>() -- supply non-defaults for location precision, chunk size, etc.
|
||||
//
|
||||
//
|
||||
explicit ezcod(
|
||||
double _lat = 0,
|
||||
double _lon = 0,
|
||||
@@ -261,7 +261,7 @@ namespace ezpwd {
|
||||
|
||||
//
|
||||
// symbols -- return working parity and location precision
|
||||
//
|
||||
//
|
||||
virtual ezcod_base::symbols_t
|
||||
symbols()
|
||||
const
|
||||
@@ -302,9 +302,9 @@ namespace ezpwd {
|
||||
return lhs;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// encode() -- encode the lat/lon to 'precision' symbols EZCOD representation
|
||||
//
|
||||
//
|
||||
virtual std::string encode(
|
||||
unsigned _preci = 0 ) // override precision
|
||||
const
|
||||
@@ -400,50 +400,50 @@ namespace ezpwd {
|
||||
return res;
|
||||
}
|
||||
|
||||
//
|
||||
//
|
||||
// deserialize -- Extract base-32, skip whitespace, mark invalid symbols as erasures
|
||||
// validate -- Remove base-32 encoding, validate and remove parity, returning confidence
|
||||
// decode -- Attempt to decode a lat/lon, returning the confidence percentage
|
||||
//
|
||||
//
|
||||
// If data but no parity symbols are supplied, no error checking is performed, and the
|
||||
// confidence returned will be 0%. No erasures within the supplied data are allowed (as
|
||||
// there is no capacity to correct them), and an exception will be thrown.
|
||||
//
|
||||
//
|
||||
// If parity is supplied, then erasures are allowed. So long as the total number of
|
||||
// erasures is <= the supplied parity symbols, then the decode will proceed (using the
|
||||
// parity symbols to fill in the erasures), and the returned confidence will reflect the
|
||||
// amount of unused parity capacity. Each erasure consumes one parity symbol to repair.
|
||||
//
|
||||
//
|
||||
// We'll allow question-mark or any of the slash characters: "_/\?" to indicate an
|
||||
// erasure. Either of the "!." symbol may be used to indicates the split between location
|
||||
// symbols and parity symbols, and must be in a position that corresponds to the indicated
|
||||
// number of location (this->precision) and parity 'P' symbols. Whitespace symbols and dash
|
||||
// are ignored: " -".
|
||||
//
|
||||
//
|
||||
// Thus, an EZCOD like "R3U 1JU QUY!0" may only be decoded by an ezcod<P=1>. Without
|
||||
// the "!" or ".", it could be an ezcod<P=2> w/precision == 8 -- there's no way to know for
|
||||
// sure. If no explicit position-parity separator is given, then we assume the default:
|
||||
// this->precision location symbols, then up to P parity symbols. If additional parity
|
||||
// symbols are supplied after the separator, then However, an ezcod...<P=3>
|
||||
//
|
||||
//
|
||||
// If an explicit "!" or "." separator IS provided, then we will attempt to decode the
|
||||
// position with the given number of position symbols, and up to P parity symbols.
|
||||
//
|
||||
//
|
||||
// NOTE
|
||||
//
|
||||
//
|
||||
// Due to a perhaps unexpected feature of R-S codewords, a codeword with MORE parity
|
||||
// can be successfully decoded by an R-S codec specifying LESS parity symbols. It so
|
||||
// happens that the data plus (excess) parity + (remaining) parity is STILL a valid codeword
|
||||
// (so long as the R-S Galois parameters are identical).
|
||||
//
|
||||
//
|
||||
// Therefore, EZCODs with more parity are accepted by EZCOD parsers configured for less
|
||||
// parity. Of course, they will have less error/erasure correction strength -- using the
|
||||
// correctly configured EZCOD codec expecting more R-S parity will maximize the value of all
|
||||
// the supplied parity.
|
||||
//
|
||||
//
|
||||
// The full amount of parity (ie. everything after the location/parity separator) is
|
||||
// discarded in all cases, before the EZCOD location is decoded.
|
||||
//
|
||||
//
|
||||
private:
|
||||
|
||||
unsigned deserialize(
|
||||
@@ -627,20 +627,20 @@ namespace ezpwd {
|
||||
// Compute the resolution error (in m.) of the decoded lat/lon and compute the minimum
|
||||
// accuracy -- the radius of the circle around the computed latitude/longitude, inside
|
||||
// which the original latitude/longitude must have been.
|
||||
//
|
||||
//
|
||||
// original latitude error bar
|
||||
// \ /
|
||||
// o -
|
||||
// o -
|
||||
// | longitude error bar
|
||||
// | /
|
||||
// |--x--|
|
||||
// |--x--|
|
||||
// /|
|
||||
// / |
|
||||
// computed -
|
||||
//
|
||||
//
|
||||
// The maximum distance is the length of the diagonal of the error rectangle defined by
|
||||
// 1/2 the latitude/longitude error bars.
|
||||
//
|
||||
//
|
||||
double lon_circ= 1 * M_PI * 6371000;
|
||||
double lat_circ= 2 * M_PI * 6371000 * std::cos( latitude * M_PI / 180 );
|
||||
latitude_error = lat_err * lon_circ;
|
||||
@@ -653,13 +653,13 @@ namespace ezpwd {
|
||||
}; // class ezcod
|
||||
|
||||
|
||||
//
|
||||
//
|
||||
// ezcod::rscodec -- Reed-Solomon parity codec
|
||||
// ezcod::bits -- distribution of lat/lon precision in each code symbol
|
||||
//
|
||||
//
|
||||
// Quickly establishes an extra bit of precision for Longitude, and then evenly distributes
|
||||
// future precision between lat/lon, always maintaining extra precision for Longitude.
|
||||
//
|
||||
//
|
||||
template < unsigned P, unsigned L >
|
||||
const ezpwd::RS<31,31-P> ezcod<P,L>::rscodec;
|
||||
|
||||
|
||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user