class OpenC3::FixedProtocol

def identify_and_finish_packet
  packet_data = nil
  identified_packet = nil
  @interface.target_names.each do |target_name|
    target_packets = nil
    unique_id_mode = false
    begin
      if @telemetry
        target_packets = System.telemetry.packets(target_name)
        target = System.targets[target_name]
        unique_id_mode = target.tlm_unique_id_mode if target
      else
        target_packets = System.commands.packets(target_name)
        target = System.targets[target_name]
        unique_id_mode = target.cmd_unique_id_mode if target
      end
    rescue RuntimeError
      # No commands/telemetry for this target
      next
    end
    if unique_id_mode
      target_packets.each do |packet_name, packet|
        if packet.identify?(@data[@discard_leading_bytes..-1])
          identified_packet = packet
          break
        end
      end
    else
      # Do a hash lookup to quickly identify the packet
      if target_packets.length > 0
        packet = target_packets.first[1]
        key = packet.read_id_values(@data[@discard_leading_bytes..-1])
        if @telemetry
          hash = System.telemetry.config.tlm_id_value_hash[target_name]
        else
          hash = System.commands.config.cmd_id_value_hash[target_name]
        end
        identified_packet = hash[key]
        identified_packet = hash['CATCHALL'.freeze] unless identified_packet
      end
    end
    if identified_packet
      if identified_packet.defined_length + @discard_leading_bytes > @data.length
        # Check if need more data to finish packet
        return :STOP
      end
      # Set some variables so we can update the packet in
      # read_packet
      @received_time = Time.now.sys
      @target_name = identified_packet.target_name
      @packet_name = identified_packet.packet_name
      # Get the data from this packet
      packet_data = @data.slice!(0, identified_packet.defined_length + @discard_leading_bytes)
      break
    end
  end
  unless identified_packet
    raise "Unknown data received by FixedProtocol" if @unknown_raise
    # Unknown packet? Just return all the current data
    @received_time = nil
    @target_name = nil
    @packet_name = nil
    packet_data = @data.clone
    @data.replace('')
  end
  return packet_data
end

def initialize(
  min_id_size,
  discard_leading_bytes = 0,
  sync_pattern = nil,
  telemetry = true,
  fill_fields = false,
  unknown_raise = false,
  allow_empty_data = nil
)
  super(discard_leading_bytes, sync_pattern, fill_fields, allow_empty_data)
  @min_id_size = Integer(min_id_size)
  @telemetry = telemetry
  @unknown_raise = ConfigParser.handle_true_false(unknown_raise)
  @received_time = nil
  @target_name = nil
  @packet_name = nil
end

def read_packet(packet)
  packet.received_time = @received_time
  packet.target_name = @target_name
  packet.packet_name = @packet_name
  return packet
end

def reduce_to_single_packet
  return :STOP if @data.length < @min_id_size
  identify_and_finish_packet()
end