###########################################################################
#
# Copyright (c) 2020-2023 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    pressure_occlusion.py
#
# @author  (last)      Micahel Garthwaite
# @date    (last)      10-Mar-2023
# @author  (original)  Peter Lucia
# @date    (original)  02-Apr-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
from ..utils.checks import check_broadcast_interval_override_ms
from ..utils.conversions import integer_to_bytearray, float_to_bytearray


class HDPressureOcclusion(AbstractSubSystem):
    """
    Hemodialysis Delivery (HD) Dialin API sub-class for pressure related commands.
    """

    def __init__(self, can_interface, logger: Logger):
        """
        HDPressureOcclusion constructor

        """
        super().__init__()
        self.can_interface = can_interface
        self.logger = logger

        if self.can_interface is not None:
            channel_id = DenaliChannels.hd_sync_broadcast_ch_id
            msg_id = MsgIds.MSG_ID_PRESSURE_OCCLUSION_DATA.value
            self.can_interface.register_receiving_publication_function(channel_id, msg_id,
                                                                       self._handler_pressure_occlusion_sync)

        self.hd_pressure_occlusion_timestamp = 0.0
        self.arterial_pressure = 0.0
        self.venous_pressure = 0.0
        self.blood_pump_occlusion = 0
        self.pressure_limits_state = 0
        self.arterial_pressure_limit_min = 0
        self.arterial_pressure_limit_max = 0
        self.venous_pressure_limit_min = 0
        self.venous_pressure_limit_max = 0

    def get_arterial_pressure(self):
        """
        Gets the arterial pressure.
        @return: (float) The arterial pressure
        """
        return self.arterial_pressure

    def get_venous_pressure(self):
        """
        Gets the venous pressure

        @return: (float) The venous pressure
        """
        return self.venous_pressure

    def get_blood_pump_occlusion(self):
        """
        Gets the blood pump occlusion

        @return: (int) The blood pump occlusion
        """
        return self.blood_pump_occlusion

    def get_pressure_limits_state(self):
        """
        Gets the current pressure limits state.

        @return: (int) The pressure limits state (0=stabilization, 1=stable)
        """
        return self.pressure_limits_state

    def get_arterial_pressure_limit_min(self):
        """
        Gets the current arterial pressure limit (minimum).

        @return: (int) The arterial pressure limit (minimum)
        """
        return self.arterial_pressure_limit_min

    def get_arterial_pressure_limit_max(self):
        """
        Gets the current arterial pressure limit (maximum).

        @return: (int) The arterial pressure limit (maximum)
        """
        return self.arterial_pressure_limit_max

    def get_venous_pressure_limit_min(self):
        """
        Gets the current venous pressure limit (minimum).

        @return: (int) The venous pressure limit (minimum)
        """
        return self.venous_pressure_limit_min

    def get_venous_pressure_limit_max(self):
        """
        Gets the current venous pressure limit (maximum).

        @return: (int) The venous pressure limit (maximum)
        """
        return self.venous_pressure_limit_max

    @publish([
        "hd_pressure_occlusion_timestamp",
        "arterial_pressure",
        "venous_pressure",
        "blood_pump_occlusion",
        "self.pressure_limits_state",
        "arterial_pressure_limit_min",
        "arterial_pressure_limit_max",
        "venous_pressure_limit_min",
        "venous_pressure_limit_max"
    ])
    def _handler_pressure_occlusion_sync(self, message, timestamp=0.0):
        """
        Handles published pressure & occlusion data messages.  Pressure data are captured
        for reference.

        @param message:  published pressure & occlusion data message
        @return: none
        """

        art = struct.unpack('f', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_1:MsgFieldPositions.END_POS_FIELD_1]))
        ven = struct.unpack('f', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_2:MsgFieldPositions.END_POS_FIELD_2]))
        bp = struct.unpack('i', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_3:MsgFieldPositions.END_POS_FIELD_3]))
        pls = struct.unpack('i', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_4:MsgFieldPositions.END_POS_FIELD_4]))
        apl = struct.unpack('i', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_5:MsgFieldPositions.END_POS_FIELD_5]))
        apu = struct.unpack('i', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_6:MsgFieldPositions.END_POS_FIELD_6]))
        vpl = struct.unpack('i', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_7:MsgFieldPositions.END_POS_FIELD_7]))
        vpu = struct.unpack('i', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_8:MsgFieldPositions.END_POS_FIELD_8]))

        self.arterial_pressure = art[0]
        self.venous_pressure = ven[0]
        self.blood_pump_occlusion = bp[0]
        self.pressure_limits_state = pls[0]
        self.arterial_pressure_limit_min = apl[0]
        self.arterial_pressure_limit_max = apu[0]
        self.venous_pressure_limit_min = vpl[0]
        self.venous_pressure_limit_max = vpu[0]
        self.hd_pressure_occlusion_timestamp = timestamp

    def cmd_arterial_pressure_measured_override(self, pres: float, reset: int = NO_RESET) -> int:
        """
        Constructs and sends the measured arterial pressure override command
        Constraints:
            Must be logged into HD.

        @param pres:  float - measured arterial pressure (in mmHg) to override with
        @param reset:  integer - 1 to reset a previous override, 0 to override
        @return: 1 if successful, zero otherwise
        """

        rst = integer_to_bytearray(reset)
        prs = float_to_bytearray(pres)
        payload = rst + prs

        message = DenaliMessage.build_message(channel_id=DenaliChannels.dialin_to_hd_ch_id,
                                              message_id=MsgIds.MSG_ID_PRESSURE_ARTERIAL_OVERRIDE.value,
                                              payload=payload)

        self.logger.debug("override measured arterial pressure")

        # 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(pres) + " mmHg.  "
            self.logger.debug("Arterial pressure (measured)) 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.debug("Timeout!!!!")
            return False

    def cmd_venous_pressure_measured_override(self, pres: float, reset: int = NO_RESET) -> int:
        """
        Constructs and sends the measured venous pressure \n
        override command.
        Constraints:
            Must be logged into HD.

        @param pres:  float - venous pressure (in mmHg) to override with
        @param reset:  integer - 1 to reset a previous override, 0 to override
        @return: 1 if successful, zero otherwise
        """

        rst = integer_to_bytearray(reset)
        prs = float_to_bytearray(pres)
        payload = rst + prs

        message = DenaliMessage.build_message(channel_id=DenaliChannels.dialin_to_hd_ch_id,
                                              message_id=MsgIds.MSG_ID_PRESSURE_VENOUS_OVERRIDE.value,
                                              payload=payload)

        self.logger.debug("override measured venous pressure")

        # 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(pres) + " mmHg.  "
            self.logger.debug("Venous pressure (measured) 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.debug("Timeout!!!!")
            return False

    def cmd_blood_pump_measured_occlusion_override(self, occl: int, reset: int = NO_RESET) -> int:
        """
        Constructs and sends the measured blood pump occlusion pressure override command
        Constraints:
            Must be logged into HD.

        @param occl:  integer - pressure (in counts) to override with
        @param reset:  integer - 1 to reset a previous override, 0 to override
        @return: 1 if successful, zero otherwise
        """

        rst = integer_to_bytearray(reset)
        occ = integer_to_bytearray(occl)
        payload = rst + occ

        message = DenaliMessage.build_message(channel_id=DenaliChannels.dialin_to_hd_ch_id,
                                              message_id=MsgIds.MSG_ID_OCCLUSION_BLOOD_PUMP_OVERRIDE.value,
                                              payload=payload)

        self.logger.debug("override measured blood pump occlusion pressure")

        # 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(occl) + " mmHg.  "
            self.logger.debug("Blood pump occlusion pressure (measured) 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.debug("Timeout!!!!")
            return False

    def cmd_pressure_occlusion_broadcast_interval_override(self, ms: int, reset: int = NO_RESET) -> int:
        """
        Constructs and sends the pressure/occlusion broadcast interval override command
        Constraints:
            Must be logged into HD.
            Given interval must be non-zero and a multiple of the HD 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

        rst = integer_to_bytearray(reset)
        mis = integer_to_bytearray(ms)
        payload = rst + mis

        message = DenaliMessage.build_message(channel_id=DenaliChannels.dialin_to_hd_ch_id,
                                              message_id=MsgIds.MSG_ID_PRES_OCCL_SEND_INTERVAL_OVERRIDE.value,
                                              payload=payload)

        self.logger.debug("override pressure/occlusion 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("Pressure/occlusion 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.debug("Timeout!!!!")
            return False