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
|
#!/usr/bin/env python3
# -*- coding: utf-8 -*-
# Copyright 2024 DL7NDR Daniel (https://www.qrz.com/db/DL7NDR)
#
# This file is part of gr-satellites
#
# SPDX-License-Identifier: GPL-3.0-or-later
#
from gnuradio import gr
import pmt
class check_hex_string(gr.basic_block):
"""
Checks incoming hex string from a specified position
for a given hex string.
"""
def __init__(self, hexstring, startindex=0):
gr.basic_block.__init__(
self,
name='check_hex_string',
in_sig=[],
out_sig=[])
self.hexstring = bytes.fromhex(hexstring)
self.startindex = startindex
self.message_port_register_in(pmt.intern('in'))
self.set_msg_handler(pmt.intern('in'), self.handle_msg)
self.message_port_register_out(pmt.intern('ok'))
self.message_port_register_out(pmt.intern('fail'))
def handle_msg(self, msg_pmt):
msg = pmt.cdr(msg_pmt)
if not pmt.is_u8vector(msg):
print('[ERROR] Received invalid message type. Expected u8vector')
return
packet = bytes(pmt.u8vector_elements(msg))
hex_str = packet[self.startindex:self.startindex + len(self.hexstring)]
if hex_str == self.hexstring:
# match
self.message_port_pub(pmt.intern('ok'), msg_pmt)
else:
# no match
self.message_port_pub(pmt.intern('fail'), msg_pmt)
|