|
1
|
|
|
#!/usr/bin/env python |
|
2
|
|
|
# -*- coding: utf-8 -*- |
|
3
|
|
|
|
|
4
|
|
|
"""KISS Core Classes.""" |
|
5
|
|
|
|
|
6
|
|
|
# These imports are for python3 compatability inside python2 |
|
7
|
|
|
from __future__ import absolute_import |
|
8
|
|
|
from __future__ import division |
|
9
|
|
|
from __future__ import print_function |
|
10
|
|
|
from __future__ import unicode_literals |
|
11
|
|
|
|
|
12
|
|
|
import logging |
|
13
|
|
|
import socket |
|
14
|
|
|
import serial |
|
15
|
|
|
|
|
16
|
|
|
from apex.kiss import constants as kissConstants |
|
17
|
|
|
|
|
18
|
|
|
__author__ = 'Jeffrey Phillips Freeman (WI2ARD)' |
|
19
|
|
|
__maintainer__ = "Jeffrey Phillips Freeman (WI2ARD)" |
|
20
|
|
|
__email__ = "[email protected]" |
|
21
|
|
|
__license__ = 'Apache License, Version 2.0' |
|
22
|
|
|
__copyright__ = 'Copyright 2016, Syncleus, Inc. and contributors' |
|
23
|
|
|
__credits__ = [] |
|
24
|
|
|
|
|
25
|
|
|
|
|
26
|
|
|
class Kiss(object): |
|
27
|
|
|
|
|
28
|
|
|
"""KISS Object Class.""" |
|
29
|
|
|
|
|
30
|
|
|
logger = logging.getLogger(__name__) |
|
31
|
|
|
logger.setLevel(kissConstants.LOG_LEVEL) |
|
32
|
|
|
console_handler = logging.StreamHandler() |
|
33
|
|
|
console_handler.setLevel(kissConstants.LOG_LEVEL) |
|
34
|
|
|
formatter = logging.Formatter(kissConstants.LOG_FORMAT) |
|
35
|
|
|
console_handler.setFormatter(formatter) |
|
36
|
|
|
logger.addHandler(console_handler) |
|
37
|
|
|
logger.propagate = False |
|
38
|
|
|
|
|
39
|
|
|
frame_buffer = [] |
|
40
|
|
|
|
|
41
|
|
|
def __init__(self, com_port=None, |
|
42
|
|
|
baud=38400, |
|
43
|
|
|
parity=serial.PARITY_NONE, |
|
44
|
|
|
stop_bits=serial.STOPBITS_ONE, |
|
45
|
|
|
byte_size=serial.EIGHTBITS, |
|
46
|
|
|
host=None, |
|
47
|
|
|
tcp_port=8000, |
|
48
|
|
|
strip_df_start=True): |
|
49
|
|
|
self.com_port = com_port |
|
50
|
|
|
self.baud = baud |
|
51
|
|
|
self.parity = parity |
|
52
|
|
|
self.stop_bits = stop_bits |
|
53
|
|
|
self.byte_size = byte_size |
|
54
|
|
|
self.host = host |
|
55
|
|
|
self.tcp_port = tcp_port |
|
56
|
|
|
self.interface = None |
|
57
|
|
|
self.interface_mode = None |
|
58
|
|
|
self.strip_df_start = strip_df_start |
|
59
|
|
|
self.exit_kiss = False |
|
60
|
|
|
|
|
61
|
|
|
if self.com_port is not None: |
|
62
|
|
|
self.interface_mode = 'serial' |
|
63
|
|
|
elif self.host is not None: |
|
64
|
|
|
self.interface_mode = 'tcp' |
|
65
|
|
|
if self.interface_mode is None: |
|
66
|
|
|
raise Exception('Must set port/speed or host/tcp_port.') |
|
67
|
|
|
|
|
68
|
|
|
self.logger.info('Using interface_mode=%s', self.interface_mode) |
|
69
|
|
|
|
|
70
|
|
|
def __enter__(self): |
|
71
|
|
|
return self |
|
72
|
|
|
|
|
73
|
|
|
def __exit__(self, exc_type, exc_val, exc_tb): |
|
74
|
|
|
if 'tcp' in self.interface_mode: |
|
75
|
|
|
self.interface.shutdown() # pylint: disable=some-message,another-one |
|
76
|
|
|
elif self.interface and self.interface.isOpen(): |
|
77
|
|
|
self.interface.close() |
|
78
|
|
|
|
|
79
|
|
|
def __del__(self): |
|
80
|
|
|
if self.interface and self.interface.isOpen(): |
|
81
|
|
|
self.interface.close() |
|
82
|
|
|
|
|
83
|
|
|
def __read_interface(self): |
|
84
|
|
|
if 'tcp' in self.interface_mode: |
|
85
|
|
|
return self.interface.recv(kissConstants.READ_BYTES) |
|
86
|
|
|
elif 'serial' in self.interface_mode: |
|
87
|
|
|
read_data = self.interface.read(kissConstants.READ_BYTES) |
|
88
|
|
|
waiting_data = self.interface.inWaiting() |
|
89
|
|
|
if waiting_data: |
|
90
|
|
|
read_data += self.interface.read(waiting_data) |
|
91
|
|
|
return read_data |
|
92
|
|
|
|
|
93
|
|
|
@staticmethod |
|
94
|
|
|
def __strip_df_start(frame): |
|
95
|
|
|
""" |
|
96
|
|
|
Strips KISS DATA_FRAME start (0x00) and newline from frame. |
|
97
|
|
|
|
|
98
|
|
|
:param frame: APRS/AX.25 frame. |
|
99
|
|
|
:type frame: str |
|
100
|
|
|
:returns: APRS/AX.25 frame sans DATA_FRAME start (0x00). |
|
101
|
|
|
:rtype: str |
|
102
|
|
|
""" |
|
103
|
|
|
while frame[0] is kissConstants.DATA_FRAME: |
|
104
|
|
|
del frame[0] |
|
105
|
|
|
while chr(frame[0]).isspace(): |
|
106
|
|
|
del frame[0] |
|
107
|
|
|
while chr(frame[-1]).isspace(): |
|
108
|
|
|
del frame[-1] |
|
109
|
|
|
return frame |
|
110
|
|
|
|
|
111
|
|
|
@staticmethod |
|
112
|
|
|
def __escape_special_codes(raw_code_bytes): |
|
113
|
|
|
""" |
|
114
|
|
|
Escape special codes, per KISS spec. |
|
115
|
|
|
|
|
116
|
|
|
"If the FEND or FESC codes appear in the data to be transferred, they |
|
117
|
|
|
need to be escaped. The FEND code is then sent as FESC, TFEND and the |
|
118
|
|
|
FESC is then sent as FESC, TFESC." |
|
119
|
|
|
- http://en.wikipedia.org/wiki/KISS_(TNC)#Description |
|
120
|
|
|
""" |
|
121
|
|
|
encoded_bytes = [] |
|
122
|
|
|
for raw_code_byte in raw_code_bytes: |
|
123
|
|
|
if raw_code_byte is kissConstants.FESC: |
|
124
|
|
|
encoded_bytes += kissConstants.FESC_TFESC |
|
125
|
|
|
elif raw_code_byte is kissConstants.FEND: |
|
126
|
|
|
encoded_bytes += kissConstants.FESC_TFEND |
|
127
|
|
|
else: |
|
128
|
|
|
encoded_bytes += [raw_code_byte] |
|
129
|
|
|
return encoded_bytes |
|
130
|
|
|
|
|
131
|
|
|
@staticmethod |
|
132
|
|
|
def __command_byte_combine(port, command_code): |
|
133
|
|
|
""" |
|
134
|
|
|
Constructs the command byte for the tnc which includes the tnc port and command code. |
|
135
|
|
|
:param port: integer from 0 to 127 indicating the TNC port |
|
136
|
|
|
:type port: int |
|
137
|
|
|
:param command_code: A command code constant, a value from 0 to 127 |
|
138
|
|
|
:type command_code: int |
|
139
|
|
|
:return: An integer combining the two values into a single byte |
|
140
|
|
|
""" |
|
141
|
|
|
if port > 127 or port < 0: |
|
142
|
|
|
raise Exception("port out of range") |
|
143
|
|
|
elif command_code > 127 or command_code < 0: |
|
144
|
|
|
raise Exception("command_Code out of range") |
|
145
|
|
|
return (port << 4) & command_code |
|
146
|
|
|
|
|
147
|
|
|
def start(self, mode_init=None, **kwargs): |
|
148
|
|
|
""" |
|
149
|
|
|
Initializes the KISS device and commits configuration. |
|
150
|
|
|
|
|
151
|
|
|
See http://en.wikipedia.org/wiki/KISS_(TNC)#Command_codes |
|
152
|
|
|
for configuration names. |
|
153
|
|
|
|
|
154
|
|
|
:param **kwargs: name/value pairs to use as initial config values. |
|
155
|
|
|
""" |
|
156
|
|
|
self.logger.debug("kwargs=%s", kwargs) |
|
157
|
|
|
|
|
158
|
|
|
if 'tcp' in self.interface_mode: |
|
159
|
|
|
address = (self.host, self.tcp_port) |
|
160
|
|
|
self.interface = socket.create_connection(address) |
|
161
|
|
|
elif 'serial' in self.interface_mode: |
|
162
|
|
|
self.interface = serial.Serial(port=self.com_port, baudrate=self.baud, parity=self.parity, |
|
163
|
|
|
stopbits=self.stop_bits, bytesize=self.byte_size) |
|
164
|
|
|
self.interface.timeout = kissConstants.SERIAL_TIMEOUT |
|
165
|
|
|
if mode_init is not None: |
|
166
|
|
|
self.interface.write(mode_init) |
|
167
|
|
|
self.exit_kiss = True |
|
168
|
|
|
|
|
169
|
|
|
# Previous verious defaulted to Xastir-friendly configs. Unfortunately |
|
170
|
|
|
# those don't work with Bluetooth TNCs, so we're reverting to None. |
|
171
|
|
|
if 'serial' in self.interface_mode and kwargs: |
|
172
|
|
|
for name, value in kwargs.items(): |
|
173
|
|
|
self.write_setting(name, value) |
|
174
|
|
|
|
|
175
|
|
|
# If no settings specified, default to config values similar |
|
176
|
|
|
# to those that ship with Xastir. |
|
177
|
|
|
# if not kwargs: |
|
178
|
|
|
# kwargs = kiss.constants.DEFAULT_KISS_CONFIG_VALUES |
|
179
|
|
|
|
|
180
|
|
|
def close(self): |
|
181
|
|
|
if self.exit_kiss is True: |
|
182
|
|
|
self.interface.write(kissConstants.MODE_END) |
|
183
|
|
|
|
|
184
|
|
|
def write_setting(self, name, value): |
|
185
|
|
|
""" |
|
186
|
|
|
Writes KISS Command Codes to attached device. |
|
187
|
|
|
|
|
188
|
|
|
http://en.wikipedia.org/wiki/KISS_(TNC)#Command_Codes |
|
189
|
|
|
|
|
190
|
|
|
:param name: KISS Command Code Name as a string. |
|
191
|
|
|
:param value: KISS Command Code Value to write. |
|
192
|
|
|
""" |
|
193
|
|
|
self.logger.debug('Configuring %s = %s', name, repr(value)) |
|
194
|
|
|
|
|
195
|
|
|
# Do the reasonable thing if a user passes an int |
|
196
|
|
|
if isinstance(value, int): |
|
197
|
|
|
value = chr(value) |
|
198
|
|
|
|
|
199
|
|
|
return self.interface.write( |
|
200
|
|
|
kissConstants.FEND + |
|
201
|
|
|
getattr(kissConstants, name.upper()) + |
|
202
|
|
|
Kiss.__escape_special_codes(value) + |
|
203
|
|
|
kissConstants.FEND |
|
204
|
|
|
) |
|
205
|
|
|
|
|
206
|
|
|
def fill_buffer(self): |
|
207
|
|
|
""" |
|
208
|
|
|
Reads any pending data in the interface and stores it in the frame_buffer |
|
209
|
|
|
""" |
|
210
|
|
|
|
|
211
|
|
|
new_frames = [] |
|
212
|
|
|
read_buffer = [] |
|
213
|
|
|
read_data = self.__read_interface() |
|
214
|
|
|
while read_data is not None and len(read_data): |
|
215
|
|
|
split_data = [[]] |
|
216
|
|
|
for read_byte in read_data: |
|
217
|
|
|
if read_byte is kissConstants.FEND: |
|
218
|
|
|
split_data.append([]) |
|
219
|
|
|
else: |
|
220
|
|
|
split_data[-1].append(read_byte) |
|
221
|
|
|
len_fend = len(split_data) |
|
222
|
|
|
|
|
223
|
|
|
# No FEND in frame |
|
224
|
|
|
if len_fend == 1: |
|
225
|
|
|
read_buffer += split_data[0] |
|
226
|
|
|
# Single FEND in frame |
|
227
|
|
|
elif len_fend == 2: |
|
228
|
|
|
# Closing FEND found |
|
229
|
|
|
if split_data[0]: |
|
230
|
|
|
# Partial frame continued, otherwise drop |
|
231
|
|
|
new_frames.append(read_buffer + split_data[0]) |
|
232
|
|
|
read_buffer = [] |
|
233
|
|
|
# Opening FEND found |
|
234
|
|
|
else: |
|
235
|
|
|
new_frames.append(read_buffer) |
|
236
|
|
|
read_buffer = split_data[1] |
|
237
|
|
|
# At least one complete frame received |
|
238
|
|
|
elif len_fend >= 3: |
|
239
|
|
|
for i in range(0, len_fend - 1): |
|
240
|
|
|
read_buffer_tmp = read_buffer + split_data[i] |
|
241
|
|
|
if len(read_buffer_tmp) is not 0: |
|
242
|
|
|
new_frames.append(read_buffer_tmp) |
|
243
|
|
|
read_buffer = [] |
|
244
|
|
|
if split_data[len_fend - 1]: |
|
245
|
|
|
read_buffer = split_data[len_fend - 1] |
|
246
|
|
|
# Get anymore data that is waiting |
|
247
|
|
|
read_data = self.__read_interface() |
|
248
|
|
|
|
|
249
|
|
|
for new_frame in new_frames: |
|
250
|
|
|
if len(new_frame) and new_frame[0] == 0: |
|
251
|
|
|
if self.strip_df_start: |
|
252
|
|
|
new_frame = Kiss.__strip_df_start(new_frame) |
|
253
|
|
|
self.frame_buffer.append(new_frame) |
|
254
|
|
|
|
|
255
|
|
|
def read(self): |
|
256
|
|
|
if not len(self.frame_buffer): |
|
257
|
|
|
self.fill_buffer() |
|
258
|
|
|
|
|
259
|
|
|
if len(self.frame_buffer): |
|
260
|
|
|
return_frame = self.frame_buffer[0] |
|
261
|
|
|
del self.frame_buffer[0] |
|
262
|
|
|
return return_frame |
|
263
|
|
|
else: |
|
264
|
|
|
return None |
|
265
|
|
|
|
|
266
|
|
|
def write(self, frame_bytes, port=0): |
|
267
|
|
|
""" |
|
268
|
|
|
Writes frame to KISS interface. |
|
269
|
|
|
|
|
270
|
|
|
:param frame: Frame to write. |
|
271
|
|
|
""" |
|
272
|
|
|
kiss_packet = [kissConstants.FEND] + [Kiss.__command_byte_combine(port, kissConstants.DATA_FRAME)] +\ |
|
273
|
|
|
Kiss.__escape_special_codes(frame_bytes) + [kissConstants.FEND] |
|
274
|
|
|
|
|
275
|
|
|
if 'tcp' in self.interface_mode: |
|
276
|
|
|
return self.interface.send(bytearray(kiss_packet)) |
|
277
|
|
|
elif 'serial' in self.interface_mode: |
|
278
|
|
|
return self.interface.write(kiss_packet) |
|
279
|
|
|
|