Implement a secure ICS protocol targeting LoRa Node151 microcontroller for controlling irrigation.
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 
 
 

122 lines
3.7 KiB

  1. # Copyright 2021 John-Mark Gurney.
  2. #
  3. # Redistribution and use in source and binary forms, with or without
  4. # modification, are permitted provided that the following conditions
  5. # are met:
  6. # 1. Redistributions of source code must retain the above copyright
  7. # notice, this list of conditions and the following disclaimer.
  8. # 2. Redistributions in binary form must reproduce the above copyright
  9. # notice, this list of conditions and the following disclaimer in the
  10. # documentation and/or other materials provided with the distribution.
  11. #
  12. # THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  13. # ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  14. # IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  15. # ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  16. # FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  17. # DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  18. # OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  19. # HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  20. # LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  21. # OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  22. # SUCH DAMAGE.
  23. #
  24. from ctypes import Structure, POINTER, CFUNCTYPE, pointer, sizeof
  25. from ctypes import c_uint8, c_uint16, c_ssize_t, c_size_t, c_uint64, c_int
  26. from ctypes import CDLL
  27. class StructureRepr(object):
  28. def __repr__(self): #pragma: no cover
  29. return '%s(%s)' % (self.__class__.__name__, ', '.join('%s=%s' %
  30. (k, getattr(self, k)) for k, v in self._fields_))
  31. class PktBuf(Structure):
  32. _fields_ = [
  33. ('pkt', POINTER(c_uint8)),
  34. ('pktlen', c_uint16),
  35. ]
  36. def _from(self):
  37. return bytes(self.pkt[:self.pktlen])
  38. def __repr__(self): #pragma: no cover
  39. return 'PktBuf(pkt=%s, pktlen=%s)' % (repr(self._from()),
  40. self.pktlen)
  41. def make_pktbuf(s):
  42. pb = PktBuf()
  43. if isinstance(s, bytearray):
  44. obj = s
  45. pb.pkt = pointer(c_uint8.from_buffer(s))
  46. else:
  47. obj = (c_uint8 * len(s))(*s)
  48. pb.pkt = obj
  49. pb.pktlen = len(s)
  50. pb._make_pktbuf_ref = (obj, s)
  51. return pb
  52. process_msgfunc_t = CFUNCTYPE(None, PktBuf, POINTER(PktBuf))
  53. _lib = CDLL('liblora_test.dylib')
  54. _lib._strobe_state_size.restype = c_size_t
  55. _lib._strobe_state_size.argtypes = ()
  56. _strobe_state_u64_cnt = (_lib._strobe_state_size() + 7) // 8
  57. class CommsSession(Structure,StructureRepr):
  58. _fields_ = [
  59. ('cs_crypto', c_uint64 * _strobe_state_u64_cnt),
  60. ('cs_state', c_int),
  61. ]
  62. class CommsState(Structure,StructureRepr):
  63. _fields_ = [
  64. # The alignment of these may be off
  65. ('cs_active', CommsSession),
  66. ('cs_pending', CommsSession),
  67. ('cs_start', c_uint64 * _strobe_state_u64_cnt),
  68. ('cs_procmsg', process_msgfunc_t),
  69. ('cs_prevmsg', PktBuf),
  70. ('cs_prevmsgresp', PktBuf),
  71. ('cs_prevmsgbuf', c_uint8 * 64),
  72. ('cs_prevmsgrespbuf', c_uint8 * 64),
  73. ]
  74. _lib._comms_state_size.restype = c_size_t
  75. _lib._comms_state_size.argtypes = ()
  76. if _lib._comms_state_size() != sizeof(CommsState): # pragma: no cover
  77. raise RuntimeError('CommsState structure size mismatch!')
  78. for func, ret, args in [
  79. ('comms_init', None, (POINTER(CommsState), process_msgfunc_t,
  80. POINTER(PktBuf))),
  81. ('comms_process', None, (POINTER(CommsState), PktBuf, POINTER(PktBuf))),
  82. ('strobe_seed_prng', None, (POINTER(c_uint8), c_ssize_t)),
  83. ]:
  84. f = getattr(_lib, func)
  85. f.restype = ret
  86. f.argtypes = args
  87. locals()[func] = f
  88. def comms_process_wrap(state, input):
  89. '''A wrapper around comms_process that converts the argument
  90. into the buffer, and the returns the message as a bytes string.
  91. '''
  92. inpkt = make_pktbuf(input)
  93. outbytes = bytearray(64)
  94. outbuf = make_pktbuf(outbytes)
  95. comms_process(state, inpkt, outbuf)
  96. return outbuf._from()