###########################################################################
#
# Copyright (c) 2021-2024 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    temperature_sensors.py
#
# @author  (last)      Micahel Garthwaite
# @date    (last)      28-Jul-2023
# @author  (original)  Dara Navaei
# @date    (original)  01-Dec-2021
#
############################################################################
import struct
from enum import unique
from logging import Logger

from .constants import NO_RESET, RESET
from leahi_dialin.common.msg_defs import MsgIds, MsgFieldPositions
from leahi_dialin.protocols.CAN import DenaliMessage, DenaliChannels
from leahi_dialin.utils.base import AbstractSubSystem, publish, DialinEnum
from leahi_dialin.utils.checks import check_broadcast_interval_override_ms
from leahi_dialin.utils.conversions import integer_to_bytearray, float_to_bytearray

@unique
class FPTemperaturesNames(DialinEnum):
    P23_TEMP = 0                         # P23 temperature sensor.
    P22_TEMP = 1                         # P22 temperature sensor.
    P10_TEMP = 2                         # P10 temperature from inlet conductivity sensor.
    P19_TEMP = 3                         # P19 temperature from outlet conductivity sensor.
    FP_BOARD_TEMP = 4                    # Board Temperature Sensor

class FPTemperatureSensors(AbstractSubSystem):

    def __init__(self, can_interface, logger: Logger):
        super().__init__()

        self.can_interface = can_interface
        self.logger = logger


        if self.can_interface is not None:
            channel_id = DenaliChannels.dd_sync_broadcast_ch_id
            msg_id = MsgIds.MSG_ID_RO_TEMPERATURE_DATA.value
            self.can_interface.register_receiving_publication_function(channel_id, msg_id,
                                                                       self._handler_temperature_sensors_sync)

        self.fp_temperature_sensors_timestamp = 0.0
        self.fp_temperatures = {FPTemperaturesNames.P23_TEMP.name: 0.0,
                            FPTemperaturesNames.P22_TEMP.name: 0.0,
                            FPTemperaturesNames.P10_TEMP.name: 0.0,
                            FPTemperaturesNames.P19_TEMP.name: 0.0,
                            FPTemperaturesNames.FP_BOARD_TEMP.name: 0.0 }

    @publish(["fp_temperatures_timestamp", "fp_temperatures"])
    def _handler_temperature_sensors_sync(self, message,timestamp=0.0):
        """
        Handles published FP temperature sensors message

        @param message:  published FP temperature sensors data message
        @returns none
        """
        self.fp_temperatures[FPTemperaturesNames.P23_TEMP.name] = struct.unpack('f', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_1:MsgFieldPositions.END_POS_FIELD_1]))[0]

        self.fp_temperatures[FPTemperaturesNames.P22_TEMP.name] = struct.unpack('f', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_2:MsgFieldPositions.END_POS_FIELD_2]))[0]

        self.fp_temperatures[FPTemperaturesNames.P10_TEMP.name] = struct.unpack('f', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_3:MsgFieldPositions.END_POS_FIELD_3]))[0]

        self.fp_temperatures[FPTemperaturesNames.P19_TEMP.name] = struct.unpack('f', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_4:MsgFieldPositions.END_POS_FIELD_4]))[0]

        self.fp_temperatures[FPTemperaturesNames.FP_BOARD_TEMP.name] = struct.unpack('f', bytearray(
            message['message'][MsgFieldPositions.START_POS_FIELD_5:MsgFieldPositions.END_POS_FIELD_5]))[0]


    def cmd_temperatures_data_broadcast_interval_override(self, ms: int, reset: int = NO_RESET) -> int:
        """
        Constructs and sends broadcast time interval.
        Constraints:
            Must be logged into FP.
            Given interval must be non-zero and a multiple of the FP general task interval (50 ms).

        @param ms: (int) Publish time interval in ms
        @param reset: (int) 1 to reset a previous override, 0 to override
        @returns 1 if successful, zero otherwise
        """
        if not check_broadcast_interval_override_ms(ms):
            return False

        reset_value = integer_to_bytearray(reset)
        interval_value = integer_to_bytearray(ms)
        payload = reset_value + interval_value

        message = DenaliMessage.build_message(
            channel_id=DenaliChannels.dialin_to_fp_ch_id,
            message_id=MsgIds.MSG_ID_RO_TEMPERATURE_SENSOR_PUBLISH_INTERVAL_OVERRIDE_REQUEST.value,
            payload=payload)

        self.logger.debug("Sending {} ms publish interval to the Temperature Sensors module".format(ms))
        # Send message
        received_message = self.can_interface.send(message)

        # If there is content in message
        if received_message is not None:
            # Response payload is OK or not
            return received_message['message'][DenaliMessage.PAYLOAD_START_INDEX]
        else:
            self.logger.debug("Timeout!!!!")
            return False