#!/usr/bin/env python
# -*- coding: UTF-8 -*-
'''
@Project ：AutoControlSystem-master 
@File    ：utils.py
@IDE     ：PyCharm 
@Author  ：hjw
@Date    ：2024/8/29 15:07 
'''

def find_position(Depth_Z, RegionalArea, RegionalArea_Threshold, first_depth=True):
    if first_depth == True:
        sorted_id = sorted(range(len(Depth_Z)), key=lambda k: Depth_Z[k], reverse=False)
        Depth_Z1 = [Depth_Z[i] for i in sorted_id]
        RegionalArea1 = [RegionalArea[i] for i in sorted_id]
        for i in range(len(Depth_Z1)):
            if RegionalArea1[i] > RegionalArea_Threshold:
                return sorted_id[i]

    else:
        sorted_id = sorted(range(len(RegionalArea)), key=lambda k: RegionalArea[k], reverse=True)
        Depth_Z1 = [Depth_Z[i] for i in sorted_id]
        RegionalArea1 = [RegionalArea[i] for i in sorted_id]
        for i in range(len(Depth_Z1)):
            if RegionalArea1[i] > RegionalArea_Threshold:
                return sorted_id[i]