recipes-connectivity: added gnss-save-on-shutdown
gnss-save-on-shutdown is a service, makes gnss receiver state persistent before shut down and check if state got loaded again upon boot on shutdown: contents of receiver ram gets dumped to receiver flash on boot: checks if ram dump got loaded from receiver flash back into receiver ram BugzID: 60669 Signed-off-by: Tobias Jäggi <tobias.jaeggi@netmodule.com>
This commit is contained in:
Tobias Jäggi
Gitea
parent
ca0c6bd6df
commit
b5c8336b0d
|
|
@ -0,0 +1,222 @@
|
||||||
|
#!/usr/bin/env python3
|
||||||
|
|
||||||
|
import subprocess
|
||||||
|
import re
|
||||||
|
import sys
|
||||||
|
import getopt
|
||||||
|
import os
|
||||||
|
from os import path
|
||||||
|
|
||||||
|
default_device = r"/dev/gnss0"
|
||||||
|
default_config_file = r"/etc/gnss/gnss0.conf"
|
||||||
|
config_file_prepath = r"/etc/gnss/"
|
||||||
|
config_file_end = r".conf"
|
||||||
|
|
||||||
|
|
||||||
|
def out(str, use_systemd_cat=None, level=None):
|
||||||
|
if use_systemd_cat:
|
||||||
|
cmd = "systemd-cat -p %s echo \"%s\"" % (level, str)
|
||||||
|
os.system(cmd)
|
||||||
|
else:
|
||||||
|
print("%s" % str)
|
||||||
|
return
|
||||||
|
|
||||||
|
|
||||||
|
def read_baud_rate(config_file, use_systemd_cat=None):
|
||||||
|
global output
|
||||||
|
if not path.exists(config_file):
|
||||||
|
cmd = "systemd-cat -p err \"config file %s doesn't exists\"" % config_file
|
||||||
|
os.system(cmd)
|
||||||
|
sys.exit(0)
|
||||||
|
with open(config_file, 'r') as file:
|
||||||
|
file_contents = file.readlines()
|
||||||
|
file_contents = ''.join(file_contents)
|
||||||
|
regex_baud_rate = r"^b(aud)? ?r(ate)? ?= ?(?P<baud_rate>\d+)"
|
||||||
|
pattern_baud_rate = re.compile(regex_baud_rate, flags=re.MULTILINE)
|
||||||
|
match_baud_rate = pattern_baud_rate.search(file_contents)
|
||||||
|
if match_baud_rate is not None:
|
||||||
|
return match_baud_rate.group('baud_rate')
|
||||||
|
else:
|
||||||
|
out("unable to read baud rate from %s" % config_file, use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
|
||||||
|
|
||||||
|
class UbxtoolWrapper:
|
||||||
|
|
||||||
|
def __init__(self, tool, device, speed, verbosity):
|
||||||
|
self.tool = tool
|
||||||
|
self.device = " -f " + device
|
||||||
|
self.speed = " -s " + speed
|
||||||
|
self.verbosity = " -v " + str(verbosity)
|
||||||
|
|
||||||
|
def poll_preset(self, preset):
|
||||||
|
preset = " -p " + preset
|
||||||
|
ubx_call = self.tool + self.device + self.speed + self.verbosity + preset
|
||||||
|
process = subprocess.Popen(ubx_call.split(), stdout=subprocess.PIPE)
|
||||||
|
process.wait()
|
||||||
|
return process.communicate()[0].decode('utf-8')
|
||||||
|
|
||||||
|
def send_command(self, ubx_class, ubx_id, payload=None):
|
||||||
|
if payload is None:
|
||||||
|
command = " -c " + ubx_class + "," + ubx_id
|
||||||
|
else:
|
||||||
|
command = " -c " + ubx_class + "," + ubx_id + "," + payload
|
||||||
|
ubx_call = self.tool + self.device + self.speed + self.verbosity + command
|
||||||
|
|
||||||
|
process = subprocess.Popen(ubx_call.split(), stdout=subprocess.PIPE)
|
||||||
|
process.wait()
|
||||||
|
try:
|
||||||
|
return process.communicate()[0].decode('utf-8')
|
||||||
|
except 'ubxtool busy':
|
||||||
|
print('communication with ubxtool failed - retry')
|
||||||
|
#cmd = "systemd-cat -p err \communication with ubxtool failed - retry\""
|
||||||
|
#os.system(cmd)
|
||||||
|
exit(0)
|
||||||
|
|
||||||
|
|
||||||
|
def find_sos_response(ubx_response, command):
|
||||||
|
get_command = re.compile(r"command (?P<command>\d) reserved\d x[\w ]+")
|
||||||
|
get_response = re.compile(r"response (?P<response>\d) reserved\d x[\w ]+")
|
||||||
|
# check if persist was successful
|
||||||
|
matches_command = re.finditer(get_command, ubx_response)
|
||||||
|
match_response = None
|
||||||
|
for match in matches_command:
|
||||||
|
if match.group('command') == command:
|
||||||
|
match_response = re.search(get_response, ubx_response[match.end():])
|
||||||
|
break
|
||||||
|
if match_response is None:
|
||||||
|
# no response found
|
||||||
|
return None
|
||||||
|
else:
|
||||||
|
return match_response.group('response')
|
||||||
|
|
||||||
|
|
||||||
|
# persits receiver state by dumping (parts of) receiver RAM to its flash
|
||||||
|
def persist_receiver_state(ubx, use_systemd_cat=None):
|
||||||
|
|
||||||
|
# Controlled GNSS stop & Hotstart
|
||||||
|
ubx_response = ubx.send_command(ubx_class='06', ubx_id='04', payload='00,00,08,00')
|
||||||
|
# save contents of BBR to flash
|
||||||
|
ubx_response = ubx.send_command(ubx_class='09', ubx_id='14', payload='00,00,00,00')
|
||||||
|
# check if persist was successful
|
||||||
|
response = find_sos_response(ubx_response, '2') # 2 = Backup File Creation Acknowledge
|
||||||
|
if response is None:
|
||||||
|
out("unable to verify if receiver state is persistant", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
elif response == '1': # ACK -> receiver state persisted
|
||||||
|
out("successfully persisted receiver state", use_systemd_cat=use_systemd_cat, level='info')
|
||||||
|
return
|
||||||
|
else:
|
||||||
|
out("unable to verify if receiver state is persistant", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
|
||||||
|
|
||||||
|
# verifies loading of receiver state from flash to RAM
|
||||||
|
def verify_load_of_receiver_state(ubx, use_systemd_cat=None):
|
||||||
|
# check if restore was successful
|
||||||
|
ubx_response = ubx.send_command(ubx_class='09', ubx_id='14')
|
||||||
|
response = find_sos_response(ubx_response, '3') # 3 = System Restored from Backup
|
||||||
|
if response is None:
|
||||||
|
out("unable to verify restoration of receiver state", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
elif response == '0': # Unknown
|
||||||
|
out("unable to verify restoration of receiver state", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
elif response == '1': # Failed restoring from backup file
|
||||||
|
out("restoring receiver state failed", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
elif response == '2': # restored from backup
|
||||||
|
out("successfully restored receiver state", use_systemd_cat=use_systemd_cat, level='info')
|
||||||
|
return
|
||||||
|
elif response == '3': # not restored (no backup)
|
||||||
|
out("there was no persistant receiver state to restore", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
else:
|
||||||
|
out("unable to verify restoration of receiver state", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
|
||||||
|
|
||||||
|
# clears backup
|
||||||
|
def clear_perisited_receiver_state(ubx, use_systemd_cat=None):
|
||||||
|
# clear backup (recommended by ublox)
|
||||||
|
ubx_response = ubx.send_command(ubx_class='09', ubx_id='14', payload='01,00,00,00')
|
||||||
|
|
||||||
|
|
||||||
|
def main(argv):
|
||||||
|
|
||||||
|
use_default_device = True
|
||||||
|
device = default_device
|
||||||
|
config_file = default_config_file
|
||||||
|
do_persist = False
|
||||||
|
do_verify = False
|
||||||
|
do_clear = False
|
||||||
|
use_systemd_cat = False
|
||||||
|
|
||||||
|
help_message = "\nOptions:\n" \
|
||||||
|
" -p, --persist Save current GNSS receiver state to flash\n" \
|
||||||
|
" -v, --verify Verify that peristed receiver state was loaded upon boot\n" \
|
||||||
|
" -c, --clear Clear saved receiver state from flash (recommended after restore)\n" \
|
||||||
|
" -d, --device </path/to/device> Specify the device to be used\n" \
|
||||||
|
" -j, --journal Use systemd-cat instead of print, recommended when running as service\n" \
|
||||||
|
" to get highlighted error output in systemd journal\n" \
|
||||||
|
" -h, --help Print help\n"
|
||||||
|
try:
|
||||||
|
# Note to self: arguments that require an option are followed with :, long version requite =
|
||||||
|
opts, args = getopt.getopt(argv, "hpvcjd:", ["help", "persist", "verify", "clear", "journal", "device="])
|
||||||
|
except getopt.GetoptError:
|
||||||
|
print("invalid user input")
|
||||||
|
print(help_message)
|
||||||
|
sys.exit(0)
|
||||||
|
if len(opts) < 1:
|
||||||
|
print("no user input")
|
||||||
|
print(help_message)
|
||||||
|
sys.exit(0)
|
||||||
|
for opt, arg in opts:
|
||||||
|
if opt in ("-h", "--help"):
|
||||||
|
print(help_message)
|
||||||
|
sys.exit(0)
|
||||||
|
elif opt in ("-p", "--persist"):
|
||||||
|
do_persist = True
|
||||||
|
elif opt in ("-v", "--verify"):
|
||||||
|
do_verify = True
|
||||||
|
elif opt in ("-c", "--clear"):
|
||||||
|
do_clear = True
|
||||||
|
elif opt in ("-j", "--journal"):
|
||||||
|
use_systemd_cat = True
|
||||||
|
# logs from this point on get output to journalctl was -j flag is set
|
||||||
|
elif opt in ("-d", "-device"):
|
||||||
|
use_default_device = False
|
||||||
|
device = arg
|
||||||
|
if not path.exists(device):
|
||||||
|
out("invalid device", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
regex_device_name = re.compile(r"\/dev\/(?P<device_name>[\w]+)")
|
||||||
|
device_name = regex_device_name.search(device).group('device_name')
|
||||||
|
possible_config_file = config_file_prepath + device_name + config_file_end
|
||||||
|
if not path.exists(possible_config_file):
|
||||||
|
out("no config file for %s found at %s, using default config file %s instead" % (device_name, possible_config_file, default_config_file), use_systemd_cat=use_systemd_cat, level='warning')
|
||||||
|
else:
|
||||||
|
out("config file used for device %s: %s" % (device_name, possible_config_file), use_systemd_cat=use_systemd_cat, level='debug')
|
||||||
|
config_file = possible_config_file
|
||||||
|
|
||||||
|
if do_persist and do_verify:
|
||||||
|
out("You can't persist the receiver state and verify a restore at the same time.", use_systemd_cat=use_systemd_cat, level='err')
|
||||||
|
sys.exit(0)
|
||||||
|
|
||||||
|
if use_default_device:
|
||||||
|
out("no device specified, using default %s" % default_device, use_systemd_cat=use_systemd_cat, level='warning')
|
||||||
|
|
||||||
|
baud_rate = read_baud_rate(config_file, use_systemd_cat=use_systemd_cat)
|
||||||
|
|
||||||
|
ubx = UbxtoolWrapper(tool="ubxtool", device=device, speed=str(baud_rate), verbosity=2)
|
||||||
|
|
||||||
|
if do_persist:
|
||||||
|
persist_receiver_state(ubx, use_systemd_cat=use_systemd_cat)
|
||||||
|
if do_clear:
|
||||||
|
clear_perisited_receiver_state(ubx, use_systemd_cat=use_systemd_cat)
|
||||||
|
if do_verify:
|
||||||
|
verify_load_of_receiver_state(ubx, use_systemd_cat=use_systemd_cat)
|
||||||
|
|
||||||
|
|
||||||
|
if __name__ == "__main__":
|
||||||
|
main(sys.argv[1:])
|
||||||
|
|
@ -0,0 +1,14 @@
|
||||||
|
[Unit]
|
||||||
|
Description=Save current GNSS receiver state on shutdown
|
||||||
|
Before=gpsd.service
|
||||||
|
After=gnss-config.service
|
||||||
|
|
||||||
|
[Service]
|
||||||
|
|
||||||
|
Type=oneshot
|
||||||
|
ExecStart=/usr/bin/gnss-save-on-shutdown -vcj -d /dev/gnss0
|
||||||
|
RemainAfterExit=yes
|
||||||
|
ExecStop=/usr/bin/gnss-save-on-shutdown -pj -d /dev/gnss0
|
||||||
|
|
||||||
|
[Install]
|
||||||
|
WantedBy=multi-user.target
|
||||||
|
|
@ -0,0 +1,35 @@
|
||||||
|
# Copyright (C) 2020 Tobias Jäggi <tobias.jaeggi@netmodule.com>
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
# Released under the MIT license (see COPYING.MIT for the terms)
|
||||||
|
DESCRIPTION = "NEO-M8L save on shutdown service"
|
||||||
|
HOMEPAGE = "www.netmodule.com"
|
||||||
|
LICENSE = "MIT"
|
||||||
|
SECTION = "bsp/firmware"
|
||||||
|
LIC_FILES_CHKSUM = "file://${COMMON_LICENSE_DIR}/MIT;md5=0835ade698e0bcf8506ecda2f7b4f302"
|
||||||
|
|
||||||
|
inherit systemd
|
||||||
|
|
||||||
|
SRC_URI = " \
|
||||||
|
file://gnss-save-on-shutdown.py \
|
||||||
|
file://gnss-save-on-shutdown.service \
|
||||||
|
"
|
||||||
|
|
||||||
|
S = "${WORKDIR}"
|
||||||
|
|
||||||
|
SYSTEMD_SERVICE_${PN} = " \
|
||||||
|
gnss-save-on-shutdown.service \
|
||||||
|
"
|
||||||
|
|
||||||
|
FILES_${PN} = "${systemd_unitdir}/system ${bindir} ${sysconfdir}"
|
||||||
|
|
||||||
|
do_install() {
|
||||||
|
install -d ${D}${bindir}
|
||||||
|
install -m 744 ${WORKDIR}/gnss-save-on-shutdown.py ${D}${bindir}/gnss-save-on-shutdown
|
||||||
|
|
||||||
|
install -d ${D}${systemd_unitdir}/system/
|
||||||
|
install -m 644 ${WORKDIR}/gnss-save-on-shutdown.service ${D}${systemd_unitdir}/system/
|
||||||
|
}
|
||||||
|
|
||||||
|
RDEPENDS_${PN} = "gpsd"
|
||||||
Loading…
Reference in New Issue