digital_io.py 9.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266
  1. from io_module import IO_Module
  2. from modbus import Modbus, MBError, NoResponseError
  3. from log_reader import DigitalLogReader
  4. import colorama
  5. from colorama import Fore
  6. from time import sleep
  7. import time
  8. from datetime import datetime, timedelta, timezone
  9. from mb_registers import DIO_REGS
  10. from serial import Serial
  11. class IO_Digital(IO_Module):
  12. def __init__(self, modbus: Modbus):
  13. self.modbus = modbus
  14. super().__init__(self.modbus)
  15. self.log = DigitalLogReader(self.modbus)
  16. '''Запрос параметров'''
  17. # 0x0100 - текущее состояние входов
  18. def get_inputs_bit(self) -> str:
  19. data = self.modbus.read_holding_registers(DIO_REGS['in_bits'], 1)
  20. return format(data[0], '08b')
  21. # 0x0101 - 0x0110 Счетчики импульсов
  22. def get_inputs_counters(self):
  23. data = []
  24. for i in range(DIO_REGS['in_cnt'], DIO_REGS['in_cnt'] + 16, 2):
  25. data.append(self.modbus.read_uint32_holding(i))
  26. return data
  27. # 0x0101 - 0x0110 Счетчики импульсов
  28. def get_inputs_counters(self):
  29. data = []
  30. for i in range(DIO_REGS['in_cnt'], DIO_REGS['in_cnt'] + 16, 2):
  31. data.append(self.modbus.read_uint32_holding(i))
  32. return data
  33. # 0x0120 - режим работы входов
  34. def get_inputs_mode(self):
  35. data = self.modbus.read_holding_registers(DIO_REGS['in_mode'], 1)
  36. return format(data[0], '08b')
  37. # 0x0122 - нормальное состояние входов
  38. def get_inputs_norm_state(self):
  39. data = self.modbus.read_holding_registers(DIO_REGS['in_norm'], 1)
  40. return format(data[0], '08b')
  41. # 0x0124 - время антидребезга (ms)
  42. def get_debounce_channel(self, input):
  43. data = self.modbus.read_holding_registers(DIO_REGS['in_deb_start'] + input - 1, 1)
  44. return data[0]
  45. # 0x0130
  46. def get_loads_bit(self):
  47. data = self.modbus.read_holding_registers(DIO_REGS['load_bits'], 1)
  48. return format(data[0], '08b')
  49. # 0x0131
  50. def get_cred_bit(self):
  51. data = self.modbus.read_holding_registers(DIO_REGS['cred_bits'], 1)
  52. return format(data[0], '08b')
  53. def get_debounce_channels(self):
  54. return self.modbus.read_holding_registers(DIO_REGS['in_deb_start'], 8)
  55. '''Установка параметров'''
  56. def set_inputs_mode(self, val):
  57. self.modbus.write_holding_register(DIO_REGS['in_mode'], val)
  58. #
  59. def set_input_mode(self, input, val):
  60. ret = self.modbus.read_holding_registers(DIO_REGS['in_mode'], 1)
  61. if val == 1:
  62. data = ret[0] | (0b1 << (input - 1))
  63. else:
  64. data = ret[0] & ~(0b1 << (input - 1))
  65. self.set_inputs_mode(data)
  66. # 0x0200 - текущее состояние выходов в обычно режиме
  67. def set_outputs(self, val):
  68. self.modbus.write_holding_register(DIO_REGS['out_cur'], val)
  69. # Установить значение на конкретном выходе [1..8]
  70. def set_output(self, output, val):
  71. ret = self.modbus.read_holding_registers(DIO_REGS['out_cur'], 1)
  72. if val == 1:
  73. data = ret[0] | (0b1 << (output - 1))
  74. else:
  75. data = ret[0] & ~(0b1 << (output - 1))
  76. self.set_outputs(data)
  77. def print_inputs(self):
  78. # Значения входов (битовое поле)
  79. print('Inputs values [bit field] :', Fore.GREEN + self.get_inputs_bit())
  80. # Значение счетчиков
  81. data = self.get_inputs_counters()
  82. print('Inputs counters :', Fore.GREEN + ' | '.join(str(el) for el in data))
  83. # Режим работы входов (битовое поле)
  84. print('Inputs mode [bit field] :', Fore.GREEN + self.get_inputs_mode())
  85. # Нормальное состояние входов (битовое поле)
  86. print('Inputs norm [bit field] :', Fore.GREEN + self.get_inputs_norm_state())
  87. # Период антидребезга (ms)
  88. print('Debounce input (ms) :', Fore.GREEN + ' | '.join(str(el) for el in self.get_debounce_channels()))
  89. def print_loads(self):
  90. # Значения датчиков нагрузки (битовое поле)
  91. print('Loads values [bit field] :', Fore.GREEN + self.get_loads_bit())
  92. # Слово достоверности датчиков нагрузки (битовое поле)
  93. print('Credibility loads [bit field] :', Fore.GREEN + self.get_cred_bit())
  94. class IO_DigitalTester:
  95. def __init__(self, dev_tester: IO_Digital, dev_dut: IO_Digital):
  96. self.tester = dev_tester
  97. self.dut = dev_dut
  98. '''Управление DUT'''
  99. # Подать/снять питание на DUT
  100. def dut_switch(self, state: bool):
  101. self.tester.set_output(1, state)
  102. # Установить 1 на нечетных входах DUT
  103. def dut_set_odd_inputs(self):
  104. self.tester.set_output(2, False)
  105. # Установить 1 на четный входах DUT
  106. def dut_set_even_imputs(self):
  107. self.tester.set_output(2, True)
  108. '''Тест входов'''
  109. def test_inputs(self):
  110. self.dut_set_even_imputs()
  111. time.sleep(0.1)
  112. self.dut.print_inputs()
  113. time.sleep(1)
  114. self.dut_set_odd_inputs()
  115. time.sleep(0.1)
  116. self.dut.print_inputs()
  117. time.sleep(1)
  118. '''Тест выходов и датчика обрыва нагрузки'''
  119. def test_load(self):
  120. # Все выходы DUT разомкнуты
  121. print("Все выходы DUT разомкнуты...")
  122. self.dut.set_outputs(0)
  123. self.dut.print_loads()
  124. time.sleep(0.1)
  125. # Замкнуть все выходы DUT (лампочка должна гореть)
  126. print("Все выходы DUT замкнуты...")
  127. self.dut.set_outputs(0b11111111)
  128. time.sleep(0.1)
  129. for i in range(1, 9):
  130. # Разомкнуть i-ый выход DUT
  131. print(f"Разомкнуть выход {i}")
  132. self.dut.set_output(i, 0)
  133. time.sleep(1)
  134. self.dut.print_loads()
  135. self.dut.set_output(i, 1)
  136. time.sleep(1)
  137. def get_load(self):
  138. self.dut.set_outputs(0b11110111)
  139. # self.dut.set_outputs(0)
  140. time.sleep(1)
  141. self.dut.print_loads()
  142. def main():
  143. colorama.init(autoreset=True)
  144. serial_port = Serial('COM24', 115200, timeout=0.05, parity='N', xonxoff=False)
  145. modbus_tester = Modbus(serial_port, 1)
  146. # dev_tester = IO_Digital(modbus_tester)
  147. dio = IO_Digital(modbus_tester)
  148. '''Тесты отдельного модуля DIO'''
  149. # dio.sys.get_system_vars()
  150. # dio.print_inputs()
  151. # dio.get_inputs_counters()
  152. # modbus_dut = Modbus(serial_port, 2)
  153. # dev_dut = IO_Digital(modbus_dut)
  154. # tester = IO_DigitalTester(dev_tester, dev_dut)
  155. '''Включить DUT'''
  156. # tester.dut_switch(True)
  157. '''Запросить системные настройки DUT'''
  158. # dev_dut.sys.get_system_vars()
  159. '''Тест входов. Переключение значений на входах DUT'''
  160. # for i in range(10):
  161. # tester.test_inputs()
  162. '''Тестирование выходов и датчиков обрыва нагрузки'''
  163. # tester.test_load()
  164. # for i in range(100):
  165. # tester.get_load()
  166. '''Системные переменные и параметры'''
  167. # dev_tester.sys.get_system_vars()
  168. ''' Установить текущее время с учетом часового пояса'''
  169. # dev.sys.set_rtc()
  170. '''Лог и архив. Настройки лога.'''
  171. # dev.log.get_log_info()
  172. # dev.log.get_random_entries()
  173. # for i in range(8):
  174. # dev.log.set_archive_period(5 + i*2, i)
  175. # dev.log.get_log_info()
  176. # dev.log.get_all_archive()
  177. # dev.log.get_all_log()
  178. # dev.log.log_clear()
  179. # dev.log.archive_clear()
  180. '''Лог'''
  181. # dev.log.get_all_log()
  182. '''Архив'''
  183. # dev.log.get_all_archive()
  184. # print(dev.log.get_archive_entry(0, 1))
  185. '''Сохранение настроек'''
  186. # dev.sys.save_sattings()
  187. '''Настройки'''
  188. '''Регистры модуля'''
  189. # dev.print_inputs()
  190. '''Настройи модуля'''
  191. # for i in range(1, 9):
  192. # dev.set_input_mode(i, 1)
  193. # print('Inputs mode [bit field] :', Fore.GREEN + dev.get_inputs_mode())
  194. # dev.set_input_mode(4, 1)
  195. # dev.print_inputs()
  196. '''Обновление'''
  197. dio.updater.update('fw.bin', 'MAI_12')
  198. if __name__ == '__main__':
  199. main()