Index: dialin/dg/cpld.py =================================================================== diff -u --- dialin/dg/cpld.py (revision 0) +++ dialin/dg/cpld.py (revision 5baefe4e0455ab80400d8e8aa4400d83bce2dc75) @@ -0,0 +1,122 @@ +########################################################################### +# +# Copyright (c) 2020-2022 Diality Inc. - All Rights Reserved. +# +# THIS CODE MAY NOT BE COPIED OR REPRODUCED IN ANY FORM, IN PART OR IN +# WHOLE, WITHOUT THE EXPLICIT PERMISSION OF THE COPYRIGHT OWNER. +# +# @file cpld.py +# +# @author (last) Dara Navaei +# @date (last) 20-Jun-2022 +# @author (original) Quang Nguyen +# @date (original) 20-Jul-2020 +# +############################################################################ +import struct +from logging import Logger + +from .constants import RESET, NO_RESET +from ..common.msg_defs import MsgIds, MsgFieldPositions +from ..protocols.CAN import DenaliMessage, DenaliChannels +from ..utils.base import AbstractSubSystem, publish, DialinEnum +from ..utils.checks import check_broadcast_interval_override_ms +from ..utils.conversions import integer_to_bytearray, float_to_bytearray + + +class Cpld(AbstractSubSystem): + """ + CPLD + + Dialysate Generator (DG) Dialin API sub-class for CPLD related commands. + """ + + def __init__(self, can_interface, logger: Logger): + """ + + @param can_interface: Denali Can Messenger object + """ + super().__init__() + + self.can_interface = can_interface + self.logger = logger + + if self.can_interface is not None: + channel_id = DenaliChannels.dg_sync_broadcast_ch_id + msg_id = MsgIds.MSG_ID_DG_CPLD_STATUS.value + self.can_interface.register_receiving_publication_function(channel_id, msg_id, + self._handler_cpld_sync) + self.cpld_wdog = 0 + self.cpld_audio = 0 + self.cpld_fault_led = 0 + self.cpld_clean_led = 0 + + def get_cpld(self): + """ + Gets the current CPLD values + + @return: List containing cpld values: [ cpld_wdog, cpld_audio, cpld_fault_led, cpld_clean_led ] + """ + return [self.cpld_wdog, self.cpld_audio, + self.cpld_fault_led, self.cpld_clean_led] + + @publish(["cpld_wdog", "cpld_audio", "cpld_fault_led", "cpld_clean_led"]) + def _handler_cpld_sync(self, message): + """ + Handles published CPLD data messages. CPLD data are captured + for reference. + + @param message: published CPLD data message + @return: None + """ + + self.cpld_wdog = struct.unpack('B', bytearray( + message['message'][MsgFieldPositions.START_POS_FIELD_1:MsgFieldPositions.START_POS_FIELD_1 + 1]))[0] + self.cpld_audio = struct.unpack('B', bytearray( + message['message'][MsgFieldPositions.START_POS_FIELD_1 + 1:MsgFieldPositions.START_POS_FIELD_1 + 2]))[0] + self.cpld_fault_led = struct.unpack('B', bytearray( + message['message'][MsgFieldPositions.START_POS_FIELD_1 + 2:MsgFieldPositions.START_POS_FIELD_1 + 3]))[0] + self.cpld_clean_led = struct.unpack('B', bytearray( + message['message'][MsgFieldPositions.START_POS_FIELD_1 + 3:MsgFieldPositions.START_POS_FIELD_1 + 4]))[0] + + def cmd_cpld_data_broadcast_interval_override(self, ms: int, reset: int = NO_RESET) -> int: + """ + Constructs and sends the cpld data broadcast interval override command + Constraints: + Must be logged into DG. + Given interval must be non-zero and a multiple of the DG general task interval (50 ms). + + @param ms: integer - interval (in ms) to override with + @param reset: integer - 1 to reset a previous override, 0 to override + @return: 1 if successful, zero otherwise + """ + + if not check_broadcast_interval_override_ms(ms): + return False + + reset_byte_array = integer_to_bytearray(reset) + ms_byte_array = integer_to_bytearray(ms) + payload = reset_byte_array + ms_byte_array + + message = DenaliMessage.build_message(channel_id=DenaliChannels.dialin_to_dg_ch_id, + message_id=MsgIds.MSG_ID_CPLD_PUBLISH_INTERVAL_OVERRIDE.value, + payload=payload) + + self.logger.debug("override DG CPLD broadcast interval") + + # Send message + received_message = self.can_interface.send(message) + + # If there is content... + if received_message is not None: + if reset == RESET: + str_res = "reset back to normal: " + else: + str_res = str(ms) + " ms: " + self.logger.debug("CPLD data broadcast interval overridden to " + str_res + + str(received_message['message'][DenaliMessage.PAYLOAD_START_INDEX])) + # response payload is OK or not OK + return received_message['message'][DenaliMessage.PAYLOAD_START_INDEX] + else: + self.logger.error("Timeout!!!!") + return False