[发明专利]基于霍尔传感器定位的活动机构控制方法

说明书

技术领域

本发明涉及一种基于霍尔传感器定位的活动机构控制方法，属于航空航天活动机构控制技术领域。

背景技术

活动机构在航空航天领域得到越来越多的应用，比如调焦、调偏流、转台控制、机械臂控制等。为了准确将活动机构调整到指定位置，除了要求合理的机构设计，准确定位活动机构位置与合理的活动机构控制方法成为航空航天领域能否实现准确控制活动机构的关键技术。霍尔传感器以自身体积小、重量轻、功耗低、可靠性高等特点，已经在航空航天领域得到广泛应用，成为定位活动机构位置的重要元件。目前航空航天领域通常一个活动机构采用一个霍尔传感器作为定位器，如果霍尔传感器故障，活动机构将无法准确定位；通过霍尔传感器定位活动机构位置后，通常活动机构不进行重新定位，在霍尔传感器有效的条件下控制活动机构，如果向机构的限位方向移动，并且移动范围较大，容易导致活动机构撞到机构限位，造成活动机构损坏或卡死。

发明内容

为了解决现有活动机构控制方法存在的问题，本发明提出一种基于霍尔传感器定位的活动机构控制方法。

本发明的技术方案是：

基于霍尔传感器定位的活动机构控制方法，包括以下步骤：

步骤一，在活动机构被控范围的两端各放置一个霍尔传感器；系统控制器与霍尔传感器相连，采集霍尔传感器的有效或无效信号；系统控制器与电机驱动器相连，控制电机驱动器产生电机控制信号；电机驱动器与电机相连，控制电机转动；电机与活动机构相连，驱动活动机构移动；活动机构与霍尔传感器相连，霍尔传感器根据活动机构位置产生有效或无效信号；

步骤二，在活动机构移动范围内，确定霍尔传感器有效的起始信号与活动机构位置的对应关系；

步骤三，如果活动机构的当前位置对应的两个霍尔传感器都无效，那么选择与活动机构的目标位置相对较近的霍尔传感器作为活动机构的定位器，控制活动机构向定位器移动，当定位器从无效到有效时，控制活动机构停止移动，计算活动机构需要移动的范围，控制活动机构移动到目标位置；

步骤四，如果活动机构的当前位置对应某个霍尔传感器有效，那么选择该霍尔传感器作为定位器，控制活动机构向另外一个霍尔传感器方向移动，当定位器从有效变为无效后，控制活动机构停止移动，再控制活动机构向定位器移动，当定位器从无效变为有效后，控制活动机构停止移动，计算活动机构需要移动的范围，控制活动机构移动到目标位置，如果活动机构未到达目标位置，并且另外一个霍尔传感器从无效变为有效，那么控制活动机构停止移动，重新计算活动机构需要移动的范围，控制活动机构移动到目标位置；

步骤五，如果活动机构的当前位置对应某个霍尔传感器有效，并且该霍尔传感器故障，那么选择另一个霍尔传感器作为定位器，控制活动机构向另外一个霍尔传感器方向移动，当定位器从无效变为有效后，控制活动机构停止移动，计算活动机构需要移动的范围，控制活动机构移动到目标位置；

步骤六，如果活动机构的当前位置对应的两个霍尔传感器都无效，并且与活动机构的目标位置相对较近的霍尔传感器故障，那么选择另一个霍尔传感器作为活动机构的定位器，控制活动机构向定位器移动，当定位器从无效到有效时，控制活动机构停止移动，计算活动机构需要移动的范围，控制活动机构移动到目标位置。

步骤二所述确定霍尔传感器有效的起始信号与活动机构位置的对应关系的过程为：在活动机构移动范围内，首先将活动机构移动到霍尔传感器无效的某个位置，然后控制活动机构移向霍尔传感器，当霍尔传感器从无效变为有效后，活动机构停止移动，记录移动机构的当前位置。

本发明的有益效果：本发明基于霍尔传感器定位的活动机构控制方法，可以提高活动机构定位的可靠性，两个霍尔传感器互为备份，任意一个霍尔传感器故障，不影响活动机构控制的准确性；活动机构的每次控制，首先通过霍尔传感器准确确定活动机构位置，然后控制活动机构到达目标位置，提高了活动机构位置控制的准确性；活动机构当前位置在霍尔传感器有效范围内时，首先控制活动机构移动到霍尔传感器无效区域，然后通过霍尔传感器定位，最后将活动机构控制到目标位置，可以有效防止活动机构移动到机构限位，避免活动机构损坏或卡死。

附图说明

图1是本发明基于霍尔传感器定位的活动机构控制方法框图。

图2是本发明基于霍尔传感器定位的俯仰机构控制方法的系统结构框图。

图3是霍尔传感器的有效范围与活动机构位置关系图。

具体实施方式

下面结合附图和具体实施方式对本发明作进一步详细说明。