kopia lustrzana https://github.com/DL7AD/pecanpico9
Implemented Base128 and new packet type for APRS picture transmission
rodzic
35c476696d
commit
60578aa5c4
|
@ -0,0 +1,126 @@
|
||||||
|
# Copyright 2013-2016 Alex Danilo
|
||||||
|
#
|
||||||
|
# Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
# you may not use this file except in compliance with the License.
|
||||||
|
# You may obtain a copy of the License at
|
||||||
|
#
|
||||||
|
# http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
#
|
||||||
|
# Unless required by applicable law or agreed to in writing, software
|
||||||
|
# distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
# See the License for the specific language governing permissions and
|
||||||
|
# limitations under the License.
|
||||||
|
#
|
||||||
|
# Base 128/192 encoding experiment.
|
||||||
|
#
|
||||||
|
# Ths is just a quick experiment to see what sort of speed we get by encoding
|
||||||
|
# a contiguous 128 value range in bytes that replaces base 64 with it's low level
|
||||||
|
# conditionals and bit-bashing for decode.
|
||||||
|
#
|
||||||
|
# Ultimately, the encoding I'd like to use is a 192 value encoding which yields
|
||||||
|
# 7.5 bits/byte - i.e. approx. 6.66% loss encoding binary data in a text-safe
|
||||||
|
# transfer form. The 128 value coding is just to test the basis of the
|
||||||
|
# speed and compressibility of the result and is easy to use in JS. The 192
|
||||||
|
# value encoding is more efficient but likely a lot trickier to use from JS.
|
||||||
|
#
|
||||||
|
# NB: This is using ISO-9959-1 as it's basis. The source code will break if you
|
||||||
|
# try to view as UTF-8.
|
||||||
|
|
||||||
|
|
||||||
|
# The decode table reverses the encoding back to bits. Note, that since the most we can encode is 7.5 bits, we can never
|
||||||
|
# generate 0xFF in the decode so use that to mark 0xFF encoding bytes.
|
||||||
|
|
||||||
|
import struct
|
||||||
|
|
||||||
|
dtab = [
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 187, 0xFF, 188, 0xFF, 0xFF, 0xFF, 0xFF,
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 189, 190, 0xFF, 0xFF, 0xFF,
|
||||||
|
191, 0xFE, 0xFF, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12,
|
||||||
|
13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28,
|
||||||
|
29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44,
|
||||||
|
45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 0xFF, 57, 58, 59,
|
||||||
|
60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75,
|
||||||
|
76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 0xFF,
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
|
||||||
|
91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106,
|
||||||
|
107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122,
|
||||||
|
123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138,
|
||||||
|
139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154,
|
||||||
|
155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170,
|
||||||
|
171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186
|
||||||
|
]
|
||||||
|
|
||||||
|
# Reserve " (0x3E) as delimiter for easy manipulation in JS, '!' as stuffing character and generation for JS - the ranges 23->7E then A0->FF create the encoding.
|
||||||
|
# That's enough for the base 128 version but we need 4 more characters to encode 7.5 bits/byte so the last set is carefully chosen from within
|
||||||
|
# the control character range using values that are safe for editors.
|
||||||
|
etab = "#$%&'()*+,-./0123456789:;<=>?@ABCDEFGHIJKLMNOPQRSTUVWXYZ[]^_`abcdefghijklmnopqrstuvwxyz{|}~\xA0\xA1\xA2\xA3\xA4\xA5\xA6\xA7\xA8\xA9\xAA\xAB\xAC\xAD\xAE\xAF\xB0\xB1\xB2\xB3\xB4\xB5\xB6\xB7\xB8\xB9\xBA\xBB\xBC\xBD\xBE\xBF\xC0\xC1\xC2\xC3\xC4\xC5\xC6\xC7\xC8\xC9\xCA\xCB\xCC\xCD\xCE\xCF\xD0\xD1\xD2\xD3\xD4\xD5\xD6\xD7\xD8\xD9\xDA\xDB\xDC\xDD\xDE\xDF\xE0\xE1\xE2\xE3\xE4\xE5\xE6\xE7\xE8\xE9\xEA\xEB\xEC\xED\xEE\xEF\xF0\xF1\xF2\xF3\xF4\xF5\xF6\xF7\xF8\xF9\xFA\xFB\xFC\xFD\xFE\xFF\t\x0B\x1B\x1C ";
|
||||||
|
|
||||||
|
INBYTES = 7
|
||||||
|
OUTBYTES = 8
|
||||||
|
|
||||||
|
def encode(infile):
|
||||||
|
outfile = ''
|
||||||
|
k = 0
|
||||||
|
|
||||||
|
while k < len(infile):
|
||||||
|
_len = 0
|
||||||
|
_in = []
|
||||||
|
for i in range(INBYTES):
|
||||||
|
_in.append(infile[k])
|
||||||
|
k += 1
|
||||||
|
_len += 1
|
||||||
|
if k >= len(infile):
|
||||||
|
break
|
||||||
|
|
||||||
|
if _len > 0:
|
||||||
|
topbits = 0
|
||||||
|
mask = 0x40
|
||||||
|
for i in range(_len):
|
||||||
|
outfile += etab[_in[i] & 0x7F]
|
||||||
|
if _in[i] > 0x7F:
|
||||||
|
topbits |= mask
|
||||||
|
mask >>= 1
|
||||||
|
|
||||||
|
if _len < INBYTES:
|
||||||
|
outfile += '!'
|
||||||
|
|
||||||
|
outfile += etab[topbits]
|
||||||
|
|
||||||
|
return outfile
|
||||||
|
|
||||||
|
def decode(infile):
|
||||||
|
out = bytearray()
|
||||||
|
k = 0
|
||||||
|
|
||||||
|
while k < len(infile):
|
||||||
|
_len = 0
|
||||||
|
_in = []
|
||||||
|
for i in range(OUTBYTES):
|
||||||
|
_in.append(ord(infile[k]))
|
||||||
|
k += 1
|
||||||
|
_len += 1;
|
||||||
|
if k >= len(infile):
|
||||||
|
break
|
||||||
|
|
||||||
|
if _len > 0:
|
||||||
|
topbits = dtab[_in[_len - 1]]
|
||||||
|
mask = 0x40
|
||||||
|
_len = 0
|
||||||
|
for i in range(len(_in)-1):
|
||||||
|
if _in[i] == 0x21:
|
||||||
|
break
|
||||||
|
_len += 1
|
||||||
|
_in[i] = dtab[_in[i]]
|
||||||
|
if _in[i] == 0xFF:
|
||||||
|
return 0
|
||||||
|
if topbits & mask:
|
||||||
|
_in[i] |= 0x80
|
||||||
|
mask >>= 1
|
||||||
|
|
||||||
|
for i in range(_len):
|
||||||
|
out += struct.pack('B', _in[i])
|
||||||
|
|
||||||
|
return out
|
||||||
|
|
|
@ -0,0 +1,148 @@
|
||||||
|
# Copyright 2013-2016 Alex Danilo
|
||||||
|
#
|
||||||
|
# Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
# you may not use this file except in compliance with the License.
|
||||||
|
# You may obtain a copy of the License at
|
||||||
|
#
|
||||||
|
# http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
#
|
||||||
|
# Unless required by applicable law or agreed to in writing, software
|
||||||
|
# distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
# See the License for the specific language governing permissions and
|
||||||
|
# limitations under the License.
|
||||||
|
#
|
||||||
|
# Base 128/192 encoding experiment.
|
||||||
|
#
|
||||||
|
# Ths is just a quick experiment to see what sort of speed we get by encoding
|
||||||
|
# a contiguous 128 value range in bytes that replaces base 64 with it's low level
|
||||||
|
# conditionals and bit-bashing for decode.
|
||||||
|
#
|
||||||
|
# Ultimately, the encoding I'd like to use is a 192 value encoding which yields
|
||||||
|
# 7.5 bits/byte - i.e. approx. 6.66% loss encoding binary data in a text-safe
|
||||||
|
# transfer form. The 128 value coding is just to test the basis of the
|
||||||
|
# speed and compressibility of the result and is easy to use in JS. The 192
|
||||||
|
# value encoding is more efficient but likely a lot trickier to use from JS.
|
||||||
|
#
|
||||||
|
# NB: This is using ISO-9959-1 as it's basis. The source code will break if you
|
||||||
|
# try to view as UTF-8.
|
||||||
|
|
||||||
|
|
||||||
|
# The decode table reverses the encoding back to bits. Note, that since the most we can encode is 7.5 bits, we can never
|
||||||
|
# generate 0xFF in the decode so use that to mark 0xFF encoding bytes.
|
||||||
|
dtab = [
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 187, 0xFF, 188, 0xFF, 0xFF, 0xFF, 0xFF,
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 189, 190, 0xFF, 0xFF, 0xFF,
|
||||||
|
191, 0xFE, 0xFF, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12,
|
||||||
|
13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28,
|
||||||
|
29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44,
|
||||||
|
45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 0xFF, 57, 58, 59,
|
||||||
|
60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75,
|
||||||
|
76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 0xFF,
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
|
||||||
|
0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF,
|
||||||
|
91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106,
|
||||||
|
107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122,
|
||||||
|
123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138,
|
||||||
|
139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154,
|
||||||
|
155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170,
|
||||||
|
171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186
|
||||||
|
]
|
||||||
|
|
||||||
|
# Reserve " (0x3E) as delimiter for easy manipulation in JS, '!' as stuffing character and generation for JS - the ranges 23->7E then A0->FF create the encoding.
|
||||||
|
# That's enough for the base 128 version but we need 4 more characters to encode 7.5 bits/byte so the last set is carefully chosen from within
|
||||||
|
# the control character range using values that are safe for editors.
|
||||||
|
etab = "#$%&'()*+,-./0123456789:;<=>?@ABCDEFGHIJKLMNOPQRSTUVWXYZ[]^_`abcdefghijklmnopqrstuvwxyz{|}~\xA0\xA1\xA2\xA3\xA4\xA5\xA6\xA7\xA8\xA9\xAA\xAB\xAC\xAD\xAE\xAF\xB0\xB1\xB2\xB3\xB4\xB5\xB6\xB7\xB8\xB9\xBA\xBB\xBC\xBD\xBE\xBF\xC0\xC1\xC2\xC3\xC4\xC5\xC6\xC7\xC8\xC9\xCA\xCB\xCC\xCD\xCE\xCF\xD0\xD1\xD2\xD3\xD4\xD5\xD6\xD7\xD8\xD9\xDA\xDB\xDC\xDD\xDE\xDF\xE0\xE1\xE2\xE3\xE4\xE5\xE6\xE7\xE8\xE9\xEA\xEB\xEC\xED\xEE\xEF\xF0\xF1\xF2\xF3\xF4\xF5\xF6\xF7\xF8\xF9\xFA\xFB\xFC\xFD\xFE\xFF\t\x0B\x1B\x1C ";
|
||||||
|
|
||||||
|
BIGINBYTES = 15
|
||||||
|
BIGOUTBYTES = 16
|
||||||
|
|
||||||
|
# Perform 120 bit binary number conversion into base 192 packed as bytes.
|
||||||
|
def base192_encode(_in):
|
||||||
|
out = [0]*BIGOUTBYTES
|
||||||
|
for i in range(BIGOUTBYTES):
|
||||||
|
val = _in % 192
|
||||||
|
out[i] = val & 0xFF
|
||||||
|
_in /= 192
|
||||||
|
return out,_in
|
||||||
|
|
||||||
|
# Perform base 192 into binary conversion.
|
||||||
|
def base192_decode(_in):
|
||||||
|
out = 0
|
||||||
|
i = BIGOUTBYTES - 1
|
||||||
|
while i >= 0:
|
||||||
|
out *= 192
|
||||||
|
out += _in[i]
|
||||||
|
i -= 1
|
||||||
|
return out,_in
|
||||||
|
|
||||||
|
# Encode 7.5 bits per output byte.
|
||||||
|
#
|
||||||
|
# To do this means doing a base conversion into base 192 then encode the
|
||||||
|
# digits one per byte using the encoding table. We convert 15 bytes to
|
||||||
|
# 16 this way. In order to achieve that we need to do division on
|
||||||
|
# a 120 bit number (the 15 bytes of input) to generate the base 192 digits.
|
||||||
|
#
|
||||||
|
# NB: This quick test program is assuming little-endian byte order so we
|
||||||
|
# can use the inbuilt 128 bit types for the division. For portability
|
||||||
|
# we should really use something like Knuth's arbitrary precision
|
||||||
|
# division algorithms.
|
||||||
|
def b192_encode(infile):
|
||||||
|
#int i, len, 0xFE;
|
||||||
|
value = 0
|
||||||
|
k = 0
|
||||||
|
outfile = ''
|
||||||
|
|
||||||
|
while k < len(infile):
|
||||||
|
_len = 0
|
||||||
|
for i in range(BIGINBYTES):
|
||||||
|
value += ord(infile[k]) << (i*8)
|
||||||
|
k += 1
|
||||||
|
_len += 1
|
||||||
|
if k == len(infile):
|
||||||
|
break
|
||||||
|
|
||||||
|
if _len > 0:
|
||||||
|
|
||||||
|
out,value = base192_encode(value)
|
||||||
|
_len += 1; # Always outputs 1 byte more than the input
|
||||||
|
for i in range(_len):
|
||||||
|
outfile += etab[out[i]]
|
||||||
|
|
||||||
|
if BIGINBYTES-i > 0: # Need to mark early end with the pad character
|
||||||
|
outfile += '!'
|
||||||
|
|
||||||
|
return outfile
|
||||||
|
|
||||||
|
def b192_decode(infile):
|
||||||
|
value = 0
|
||||||
|
j = 0
|
||||||
|
outfile = []
|
||||||
|
|
||||||
|
while j+1 < len(infile):
|
||||||
|
_len = pad = 0
|
||||||
|
i = -1
|
||||||
|
_in = []
|
||||||
|
for i in range(BIGOUTBYTES):
|
||||||
|
|
||||||
|
if j+1 == len(infile): # Shouldn't happen for valid 0xFEded content
|
||||||
|
break
|
||||||
|
|
||||||
|
_in.append(dtab[ord(infile[j])])
|
||||||
|
j += 1
|
||||||
|
|
||||||
|
if _in[i] == 0xFF: # 0xFF character in the encoding set
|
||||||
|
return 0
|
||||||
|
|
||||||
|
_len += 1
|
||||||
|
|
||||||
|
if _len > 0:
|
||||||
|
while len(_in) < BIGOUTBYTES: # Fill MSBs with 0 - NB up to 128 bits, top 8 never used
|
||||||
|
_in.append(0)
|
||||||
|
value,_in = base192_decode(_in)
|
||||||
|
_len -= 1 # Output always shrinks by one byte
|
||||||
|
for i in range(_len):
|
||||||
|
outfile.append((value >> (i*8)) & 0xFF)
|
||||||
|
|
||||||
|
return outfile
|
||||||
|
|
|
@ -2,7 +2,7 @@
|
||||||
|
|
||||||
import serial,os,re,datetime
|
import serial,os,re,datetime
|
||||||
from subprocess import call
|
from subprocess import call
|
||||||
import base91
|
import base128
|
||||||
import binascii
|
import binascii
|
||||||
import urllib2
|
import urllib2
|
||||||
import io
|
import io
|
||||||
|
@ -45,8 +45,6 @@ elif args.device is not '-': # Use serial connection (probably TNC)
|
||||||
sys.stderr.write('Error: Could not open serial port\n')
|
sys.stderr.write('Error: Could not open serial port\n')
|
||||||
sys.exit(1)
|
sys.exit(1)
|
||||||
|
|
||||||
ser = io.TextIOWrapper(io.BufferedRWPair(serr, serr, 1), newline = '\r', line_buffering = True) # Define Newline as \r
|
|
||||||
|
|
||||||
|
|
||||||
# Open logging file
|
# Open logging file
|
||||||
if args.log is not None:
|
if args.log is not None:
|
||||||
|
@ -60,25 +58,37 @@ jsons = []
|
||||||
|
|
||||||
def decode_callsign(code):
|
def decode_callsign(code):
|
||||||
callsign = ''
|
callsign = ''
|
||||||
|
|
||||||
while code > 0:
|
while code > 0:
|
||||||
s = code % 40
|
s = code % 40
|
||||||
if s == 0: callsign += '-'
|
if s == 0: callsign += '-'
|
||||||
elif s < 11: callsign += chr(47 + s)
|
elif s < 11: callsign += chr(47 + s)
|
||||||
elif s < 14: callsign += '-'
|
elif s < 14: callsign += '-'
|
||||||
else: callsign += chr(51 + s)
|
else: callsign += chr(51 + s)
|
||||||
code /= 40
|
code /= 40
|
||||||
|
|
||||||
return callsign
|
return callsign
|
||||||
|
|
||||||
|
def encode_callsign(callsign):
|
||||||
|
x = 0
|
||||||
|
for i in range(len(callsign)-1,-1,-1):
|
||||||
|
x *= 40
|
||||||
|
c = ord(callsign[i])
|
||||||
|
if c >= 65 and c <= 90: x += c - 51
|
||||||
|
elif c >= 97 and c <= 122: x += c - 83
|
||||||
|
elif c >= 48 and c <= 57: x += c - 47
|
||||||
|
|
||||||
|
return x
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
def received_data(data):
|
def received_data(data):
|
||||||
global jsons
|
global jsons
|
||||||
|
|
||||||
# Parse line and detect data
|
# Parse line and detect data
|
||||||
m = re.search("(.*)\>APECAN(.*):\{\{I(.*)", data)
|
m = re.search("(.*)\>APECAN(.*):\!(.*)", data)
|
||||||
try:
|
try:
|
||||||
call = m.group(1)
|
call = m.group(1).split(' ')[-1] # transmitter callsign
|
||||||
aprs = m.group(3)
|
data128 = m.group(3) # base128 encoded SSDV data (without SYNC, PacketType, Callsign, CRC, FEC)
|
||||||
if len(m.group(2)) > 0:
|
if len(m.group(2)) > 0:
|
||||||
receiver = m.group(2).split(',')[-1]
|
receiver = m.group(2).split(',')[-1]
|
||||||
else:
|
else:
|
||||||
|
@ -89,11 +99,24 @@ def received_data(data):
|
||||||
if args.log is not None:
|
if args.log is not None:
|
||||||
f.write(data) # Log data to file
|
f.write(data) # Log data to file
|
||||||
|
|
||||||
data = base91.decode(aprs) # Decode Base91
|
data = base128.decode(data128) # Decode Base128
|
||||||
|
|
||||||
if len(data) != 219:
|
if len(data) != 214:
|
||||||
return # APRS message sampled too short
|
return # APRS message sampled too short
|
||||||
|
|
||||||
|
# Encode callsign (ensure callsign has no more than 6 chars)
|
||||||
|
bcall = call.split('-') # Split callsign and SSID
|
||||||
|
if len(bcall) == 1: # No SSID available, so take the callsign
|
||||||
|
bcall = bcall[0][0:6]
|
||||||
|
elif(len(bcall[0]) < 5): # Callsign has 4 chars, so take it with the SSID
|
||||||
|
bcall = bcall[0] + bcall[1][0:2]
|
||||||
|
elif(len(bcall[0]) < 6): # Callsign has 5 chars, so take it with the last digit of the SSID
|
||||||
|
bcall = bcall[0] + bcall[1][-1]
|
||||||
|
else:
|
||||||
|
bcall = bcall[0][0:6] # Callsign has 6 chars, so take the call without SSID
|
||||||
|
|
||||||
|
data = binascii.unhexlify('66%08x' % encode_callsign(bcall)) + data
|
||||||
|
|
||||||
# Calculate CRC for SSDV server
|
# Calculate CRC for SSDV server
|
||||||
crc = binascii.crc32(data) & 0xffffffff
|
crc = binascii.crc32(data) & 0xffffffff
|
||||||
|
|
||||||
|
@ -107,7 +130,6 @@ def received_data(data):
|
||||||
\"receiver\": \"""" + receiver + """\"
|
\"receiver\": \"""" + receiver + """\"
|
||||||
}""")
|
}""")
|
||||||
|
|
||||||
call = decode_callsign(0x1000000*data[1] + 0x10000*data[2] + 0x100*data[3] + data[4])
|
|
||||||
print datetime.datetime.now().isoformat('T') + ' Received packet call %s image %d packet %d' % (call, data[5], 0x100*data[6]+data[7])
|
print datetime.datetime.now().isoformat('T') + ' Received packet call %s image %d packet %d' % (call, data[5], 0x100*data[6]+data[7])
|
||||||
|
|
||||||
if len(jsons) >= args.grouping: # Enough packets collected, send them all to the server
|
if len(jsons) >= args.grouping: # Enough packets collected, send them all to the server
|
||||||
|
@ -177,6 +199,28 @@ if args.device == 'I': # APRS-IS
|
||||||
else: # stdin or serial
|
else: # stdin or serial
|
||||||
|
|
||||||
while True:
|
while True:
|
||||||
data = sys.stdin.readline() if args.device is '-' else ser.readline() # Read a line
|
# Read data
|
||||||
|
if args.device is '-':
|
||||||
|
data = sys.stdin.readline()
|
||||||
|
else:
|
||||||
|
data = ''
|
||||||
|
while True:
|
||||||
|
b = serr.read(1)
|
||||||
|
if b == '\r' or b == '\n':
|
||||||
|
break
|
||||||
|
data += b
|
||||||
|
|
||||||
received_data(data)
|
received_data(data)
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
Plik binarny nie jest wyświetlany.
|
@ -144,6 +144,7 @@ CSRC = $(STARTUPSRC) \
|
||||||
sleep.c \
|
sleep.c \
|
||||||
threads/threads.c \
|
threads/threads.c \
|
||||||
math/base.c \
|
math/base.c \
|
||||||
|
math/base128.c \
|
||||||
math/sgp4.c \
|
math/sgp4.c \
|
||||||
math/geofence.c \
|
math/geofence.c \
|
||||||
config.c \
|
config.c \
|
||||||
|
|
|
@ -0,0 +1,119 @@
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#define PADCHAR '!'
|
||||||
|
#define INBYTES 7
|
||||||
|
#define OUTBYTES 8
|
||||||
|
|
||||||
|
#define ZOF_TAB 256
|
||||||
|
#define BAD 0xFF
|
||||||
|
#define PAD 0xFE /* Encoded '!' is padding */
|
||||||
|
|
||||||
|
static const unsigned char dtab[ZOF_TAB] =
|
||||||
|
{
|
||||||
|
BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, 187, BAD, 188, BAD, BAD, BAD, BAD,
|
||||||
|
BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, 189, 190, BAD, BAD, BAD,
|
||||||
|
191, PAD, BAD, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12,
|
||||||
|
13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28,
|
||||||
|
29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44,
|
||||||
|
45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, BAD, 57, 58, 59,
|
||||||
|
60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75,
|
||||||
|
76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, BAD,
|
||||||
|
BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD,
|
||||||
|
BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD, BAD,
|
||||||
|
91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106,
|
||||||
|
107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122,
|
||||||
|
123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138,
|
||||||
|
139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154,
|
||||||
|
155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170,
|
||||||
|
171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186,
|
||||||
|
};
|
||||||
|
static const char *etab = "#$%&'()*+,-./0123456789:;<=>?@ABCDEFGHIJKLMNOPQRSTUVWXYZ[]^_`abcdefghijklmnopqrstuvwxyz{|}~"
|
||||||
|
"\xA0\xA1\xA2\xA3\xA4\xA5\xA6\xA7\xA8\xA9\xAA\xAB\xAC\xAD\xAE\xAF\xB0\xB1\xB2\xB3\xB4\xB5\xB6\xB7\xB8\xB9\xBA\xBB\xBC\xBD\xBE\xBF"
|
||||||
|
"\xC0\xC1\xC2\xC3\xC4\xC5\xC6\xC7\xC8\xC9\xCA\xCB\xCC\xCD\xCE\xCF\xD0\xD1\xD2\xD3\xD4\xD5\xD6\xD7\xD8\xD9\xDA\xDB\xDC\xDD\xDE\xDF"
|
||||||
|
"\xE0\xE1\xE2\xE3\xE4\xE5\xE6\xE7\xE8\xE9\xEA\xEB\xEC\xED\xEE\xEF\xF0\xF1\xF2\xF3\xF4\xF5\xF6\xF7\xF8\xF9\xFA\xFB\xFC\xFD\xFE\xFF"
|
||||||
|
"\t\x0B\x1B\x1C ";
|
||||||
|
|
||||||
|
uint32_t b128_encode(uint8_t *infile, uint8_t *outfile, uint32_t input_length)
|
||||||
|
{
|
||||||
|
unsigned char in[INBYTES];
|
||||||
|
unsigned char topbits, mask;
|
||||||
|
int i, len;
|
||||||
|
uint32_t k = 0;
|
||||||
|
uint32_t j = 0;
|
||||||
|
|
||||||
|
while(k < input_length)
|
||||||
|
{
|
||||||
|
len = 0;
|
||||||
|
for (i = 0; i < INBYTES; i++)
|
||||||
|
{
|
||||||
|
in[i] = infile[k++];
|
||||||
|
len++;
|
||||||
|
if (k >= input_length) {
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (len > 0)
|
||||||
|
{
|
||||||
|
topbits = 0;
|
||||||
|
mask = 0x40;
|
||||||
|
for (i = 0; i < len; i++)
|
||||||
|
{
|
||||||
|
outfile[j++] = etab[in[i] & 0x7F];
|
||||||
|
if (in[i] > 0x7F)
|
||||||
|
topbits |= mask;
|
||||||
|
mask >>= 1;
|
||||||
|
}
|
||||||
|
if (len < INBYTES) /* Need to pad */
|
||||||
|
{
|
||||||
|
outfile[j++] = PADCHAR;
|
||||||
|
}
|
||||||
|
outfile[j++] = etab[topbits];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
outfile[j] = 0;
|
||||||
|
return j;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t b128_decode(uint8_t *infile, uint8_t *outfile, uint32_t input_length)
|
||||||
|
{
|
||||||
|
unsigned char in[OUTBYTES];
|
||||||
|
unsigned char topbits, mask;
|
||||||
|
int i, len;
|
||||||
|
uint32_t k = 0;
|
||||||
|
uint32_t j = 0;
|
||||||
|
|
||||||
|
while(k < input_length)
|
||||||
|
{
|
||||||
|
len = 0;
|
||||||
|
for (i = 0; i < OUTBYTES; i++)
|
||||||
|
{
|
||||||
|
in[i] = infile[k++];
|
||||||
|
len++;
|
||||||
|
if (k >= input_length)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (len > 0)
|
||||||
|
{
|
||||||
|
topbits = dtab[in[len - 1]];
|
||||||
|
mask = 0x40;
|
||||||
|
for (len = i = 0; i < INBYTES; i++)
|
||||||
|
{
|
||||||
|
if (in[i] == PADCHAR)
|
||||||
|
break;
|
||||||
|
len++;
|
||||||
|
in[i] = dtab[in[i]];
|
||||||
|
if (in[i] == BAD) /* Illegal encoding character, bail out */
|
||||||
|
return 0;
|
||||||
|
if (topbits & mask)
|
||||||
|
in[i] |= 0x80;
|
||||||
|
mask >>= 1;
|
||||||
|
}
|
||||||
|
for (i = 0; i < len; i++)
|
||||||
|
{
|
||||||
|
outfile[j++] = in[i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return j;
|
||||||
|
}
|
||||||
|
|
|
@ -0,0 +1,10 @@
|
||||||
|
#ifndef __BASE128_H__
|
||||||
|
#define __BASE128_H__
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
uint32_t b128_encode(uint8_t *infile, uint8_t *outfile, uint32_t input_length);
|
||||||
|
uint32_t b128_decode(uint8_t *infile, uint8_t *outfile, uint32_t input_length);
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
|
@ -203,7 +203,7 @@ uint32_t aprs_encode_experimental(char packetType, uint8_t* message, mod_t mod,
|
||||||
/**
|
/**
|
||||||
* Transmit custom data packet (the methods aprs_encode_data allow multiple APRS packets in a row without preable being sent)
|
* Transmit custom data packet (the methods aprs_encode_data allow multiple APRS packets in a row without preable being sent)
|
||||||
*/
|
*/
|
||||||
void aprs_encode_data_init(ax25_t* packet, uint8_t* message, mod_t mod)
|
void aprs_encode_packet_init(ax25_t* packet, uint8_t* message, mod_t mod)
|
||||||
{
|
{
|
||||||
packet->data = message;
|
packet->data = message;
|
||||||
packet->max_size = 8192; // TODO: replace 8192 with real size
|
packet->max_size = 8192; // TODO: replace 8192 with real size
|
||||||
|
@ -212,11 +212,10 @@ void aprs_encode_data_init(ax25_t* packet, uint8_t* message, mod_t mod)
|
||||||
// Encode APRS header
|
// Encode APRS header
|
||||||
ax25_init(packet);
|
ax25_init(packet);
|
||||||
}
|
}
|
||||||
uint32_t aprs_encode_data_encodePacket(ax25_t* packet, char packetType, const aprs_conf_t *config, uint8_t *data, size_t size)
|
uint32_t aprs_encode_packet_encodePacket(ax25_t* packet, char packetType, const aprs_conf_t *config, uint8_t *data, size_t size)
|
||||||
{
|
{
|
||||||
// Encode header
|
// Encode header
|
||||||
ax25_send_header(packet, config->callsign, config->ssid, config->path, packet->size > 0 ? 0 : config->preamble);
|
ax25_send_header(packet, config->callsign, config->ssid, config->path, packet->size > 0 ? 0 : config->preamble);
|
||||||
ax25_send_string(packet, "{{");
|
|
||||||
ax25_send_byte(packet, packetType);
|
ax25_send_byte(packet, packetType);
|
||||||
|
|
||||||
// Encode message
|
// Encode message
|
||||||
|
@ -228,7 +227,7 @@ uint32_t aprs_encode_data_encodePacket(ax25_t* packet, char packetType, const ap
|
||||||
|
|
||||||
return packet->size;
|
return packet->size;
|
||||||
}
|
}
|
||||||
uint32_t aprs_encode_data_finalize(ax25_t* packet)
|
uint32_t aprs_encode_packet_finalize(ax25_t* packet)
|
||||||
{
|
{
|
||||||
scramble(packet);
|
scramble(packet);
|
||||||
nrzi_encode(packet);
|
nrzi_encode(packet);
|
||||||
|
|
|
@ -54,9 +54,9 @@ uint32_t aprs_encode_telemetry_configuration(uint8_t* message, mod_t mod, const
|
||||||
uint32_t aprs_encode_message(uint8_t* message, mod_t mod, const aprs_conf_t *config, const char *receiver, const char *text);
|
uint32_t aprs_encode_message(uint8_t* message, mod_t mod, const aprs_conf_t *config, const char *receiver, const char *text);
|
||||||
uint32_t aprs_encode_experimental(char packetType, uint8_t* message, mod_t mod, const aprs_conf_t *config, uint8_t *data, size_t size);
|
uint32_t aprs_encode_experimental(char packetType, uint8_t* message, mod_t mod, const aprs_conf_t *config, uint8_t *data, size_t size);
|
||||||
|
|
||||||
void aprs_encode_data_init(ax25_t* packet, uint8_t* message, mod_t mod);
|
void aprs_encode_packet_init(ax25_t* packet, uint8_t* message, mod_t mod);
|
||||||
uint32_t aprs_encode_data_encodePacket(ax25_t* packet, char packetType, const aprs_conf_t *config, uint8_t *data, size_t size);
|
uint32_t aprs_encode_packet_encodePacket(ax25_t* packet, char packetType, const aprs_conf_t *config, uint8_t *data, size_t size);
|
||||||
uint32_t aprs_encode_data_finalize(ax25_t* packet);
|
uint32_t aprs_encode_packet_finalize(ax25_t* packet);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
|
@ -8,7 +8,7 @@
|
||||||
#include "ssdv.h"
|
#include "ssdv.h"
|
||||||
#include "aprs.h"
|
#include "aprs.h"
|
||||||
#include "radio.h"
|
#include "radio.h"
|
||||||
#include "base.h"
|
#include "base128.h"
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include "types.h"
|
#include "types.h"
|
||||||
#include "sleep.h"
|
#include "sleep.h"
|
||||||
|
@ -273,6 +273,8 @@ const uint8_t noCameraFound[4071] = {
|
||||||
0xBD, 0xC0, 0x20, 0x00, 0x01, 0xFF, 0xD9
|
0xBD, 0xC0, 0x20, 0x00, 0x01, 0xFF, 0xD9
|
||||||
};
|
};
|
||||||
|
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
uint8_t gimage_id; // Global image ID (for all image threads)
|
uint8_t gimage_id; // Global image ID (for all image threads)
|
||||||
mutex_t camera_mtx;
|
mutex_t camera_mtx;
|
||||||
bool camera_mtx_init = false;
|
bool camera_mtx_init = false;
|
||||||
|
@ -281,7 +283,7 @@ void encode_ssdv(const uint8_t *image, uint32_t image_len, module_conf_t* conf,
|
||||||
{
|
{
|
||||||
ssdv_t ssdv;
|
ssdv_t ssdv;
|
||||||
uint8_t pkt[SSDV_PKT_SIZE];
|
uint8_t pkt[SSDV_PKT_SIZE];
|
||||||
uint8_t pkt_base91[BASE91LEN(SSDV_PKT_SIZE-37)];
|
uint8_t pkt_base128[256];
|
||||||
const uint8_t *b;
|
const uint8_t *b;
|
||||||
uint32_t bi = 0;
|
uint32_t bi = 0;
|
||||||
uint8_t c = SSDV_OK;
|
uint8_t c = SSDV_OK;
|
||||||
|
@ -304,7 +306,7 @@ void encode_ssdv(const uint8_t *image, uint32_t image_len, module_conf_t* conf,
|
||||||
msg.mod = conf->protocol == PROT_APRS_AFSK ? MOD_AFSK : MOD_2GFSK;
|
msg.mod = conf->protocol == PROT_APRS_AFSK ? MOD_AFSK : MOD_2GFSK;
|
||||||
msg.afsk_conf = &(conf->afsk_conf);
|
msg.afsk_conf = &(conf->afsk_conf);
|
||||||
msg.gfsk_conf = &(conf->gfsk_conf);
|
msg.gfsk_conf = &(conf->gfsk_conf);
|
||||||
aprs_encode_data_init(&ax25_handle, msg.msg, msg.mod);
|
aprs_encode_packet_init(&ax25_handle, msg.msg, msg.mod);
|
||||||
}
|
}
|
||||||
|
|
||||||
while(true)
|
while(true)
|
||||||
|
@ -320,11 +322,11 @@ void encode_ssdv(const uint8_t *image, uint32_t image_len, module_conf_t* conf,
|
||||||
if(r <= 0)
|
if(r <= 0)
|
||||||
{
|
{
|
||||||
TRACE_ERROR("SSDV > Premature end of file");
|
TRACE_ERROR("SSDV > Premature end of file");
|
||||||
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK) msg.bin_len = aprs_encode_data_finalize(&ax25_handle);
|
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK) msg.bin_len = aprs_encode_packet_finalize(&ax25_handle);
|
||||||
if(msg.bin_len > 0) transmitOnRadio(&msg, false); // Empty buffer
|
if(msg.bin_len > 0) transmitOnRadio(&msg, false); // Empty buffer
|
||||||
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK)
|
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK)
|
||||||
{
|
{
|
||||||
aprs_encode_data_init(&ax25_handle, msg.msg, msg.mod);
|
aprs_encode_packet_init(&ax25_handle, msg.msg, msg.mod);
|
||||||
msg.bin_len = 0;
|
msg.bin_len = 0;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
@ -335,21 +337,21 @@ void encode_ssdv(const uint8_t *image, uint32_t image_len, module_conf_t* conf,
|
||||||
if(c == SSDV_EOI)
|
if(c == SSDV_EOI)
|
||||||
{
|
{
|
||||||
TRACE_INFO("SSDV > ssdv_enc_get_packet said EOI");
|
TRACE_INFO("SSDV > ssdv_enc_get_packet said EOI");
|
||||||
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK) msg.bin_len = aprs_encode_data_finalize(&ax25_handle);
|
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK) msg.bin_len = aprs_encode_packet_finalize(&ax25_handle);
|
||||||
if(msg.bin_len > 0) transmitOnRadio(&msg, false); // Empty buffer
|
if(msg.bin_len > 0) transmitOnRadio(&msg, false); // Empty buffer
|
||||||
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK)
|
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK)
|
||||||
{
|
{
|
||||||
aprs_encode_data_init(&ax25_handle, msg.msg, msg.mod);
|
aprs_encode_packet_init(&ax25_handle, msg.msg, msg.mod);
|
||||||
msg.bin_len = 0;
|
msg.bin_len = 0;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
} else if(c != SSDV_OK) {
|
} else if(c != SSDV_OK) {
|
||||||
TRACE_ERROR("SSDV > ssdv_enc_get_packet failed: %i", c);
|
TRACE_ERROR("SSDV > ssdv_enc_get_packet failed: %i", c);
|
||||||
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK) msg.bin_len = aprs_encode_data_finalize(&ax25_handle);
|
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK) msg.bin_len = aprs_encode_packet_finalize(&ax25_handle);
|
||||||
if(msg.bin_len > 0) transmitOnRadio(&msg, false); // Empty buffer
|
if(msg.bin_len > 0) transmitOnRadio(&msg, false); // Empty buffer
|
||||||
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK)
|
if(conf->protocol == PROT_APRS_2GFSK || conf->protocol == PROT_APRS_AFSK)
|
||||||
{
|
{
|
||||||
aprs_encode_data_init(&ax25_handle, msg.msg, msg.mod);
|
aprs_encode_packet_init(&ax25_handle, msg.msg, msg.mod);
|
||||||
msg.bin_len = 0;
|
msg.bin_len = 0;
|
||||||
}
|
}
|
||||||
return;
|
return;
|
||||||
|
@ -360,20 +362,21 @@ void encode_ssdv(const uint8_t *image, uint32_t image_len, module_conf_t* conf,
|
||||||
case PROT_APRS_AFSK:
|
case PROT_APRS_AFSK:
|
||||||
// Encode packet
|
// Encode packet
|
||||||
TRACE_INFO("IMG > Encode APRS/SSDV packet");
|
TRACE_INFO("IMG > Encode APRS/SSDV packet");
|
||||||
base91_encode(&pkt[1], pkt_base91, sizeof(pkt)-37); // Sync byte, CRC and FEC of SSDV not transmitted
|
b128_encode(&pkt[6], pkt_base128, sizeof(pkt)-42); // Sync byte, CRC and FEC of SSDV not transmitted (because its not neccessary inside an APRS packet)
|
||||||
msg.bin_len = aprs_encode_data_encodePacket(&ax25_handle, 'I', &conf->aprs_conf, pkt_base91, strlen((char*)pkt_base91));
|
|
||||||
|
msg.bin_len = aprs_encode_packet_encodePacket(&ax25_handle, '!', &conf->aprs_conf, pkt_base128, strlen((char*)pkt_base128));
|
||||||
if(redudantTx)
|
if(redudantTx)
|
||||||
msg.bin_len = aprs_encode_data_encodePacket(&ax25_handle, 'I', &conf->aprs_conf, pkt_base91, strlen((char*)pkt_base91));
|
msg.bin_len = aprs_encode_packet_encodePacket(&ax25_handle, '!', &conf->aprs_conf, pkt_base128, strlen((char*)pkt_base128));
|
||||||
|
|
||||||
// Transmit
|
// Transmit
|
||||||
if(msg.bin_len >= 58000 || conf->packet_spacing) // Transmit if buffer is almost full or if single packet transmission is activated (packet_spacing != 0)
|
if(msg.bin_len >= 58000 || conf->packet_spacing) // Transmit if buffer is almost full or if single packet transmission is activated (packet_spacing != 0)
|
||||||
{
|
{
|
||||||
// Transmit packets
|
// Transmit packets
|
||||||
msg.bin_len = aprs_encode_data_finalize(&ax25_handle);
|
msg.bin_len = aprs_encode_packet_finalize(&ax25_handle);
|
||||||
transmitOnRadio(&msg, false);
|
transmitOnRadio(&msg, false);
|
||||||
|
|
||||||
// Initialize new packet buffer
|
// Initialize new packet buffer
|
||||||
aprs_encode_data_init(&ax25_handle, msg.msg, msg.mod);
|
aprs_encode_packet_init(&ax25_handle, msg.msg, msg.mod);
|
||||||
msg.bin_len = 0;
|
msg.bin_len = 0;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
Ładowanie…
Reference in New Issue