-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathnmea_checksum.py
41 lines (40 loc) · 1.48 KB
/
nmea_checksum.py
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
#!/usr/bin/env python2
# -*- coding: utf-8 -*-
#
# This file is part of Camino.
# Copyright (C) 2017 Manuel Luitz <[email protected]>
#
# Camino is free software: you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation, either version 3 of the License, or
# (at your option) any later version.
#
# Camino 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 Camino. If not, see <http://www.gnu.org/licenses/>.
#
class nmeaChecksum(object):
def calculateChecksum(self, data):
"""
Take a NMEA 0183 string and compute the checksum.
@param data: NMEA message. Leading ?/! and training checksum are optional
@type data: str
@return: hexidecimal value
@rtype: str
"""
if data[0]=='!' or data[0]=='?' or data[0]=='$': data = data[1:]
if data[-1]=='*': data = data[:-1]
if data[-3]=='*': data = data[:-3]
data = data.strip()
# FIX: rename sum to not shadown builting function
chksum=0
for c in data: chksum = chksum ^ ord(c)
sumHex = "{:02X}".format(chksum)
return sumHex
def addChecksum(self, msg):
chk = self.calculateChecksum(msg)
return msg + '*' + chk + '\r\n'