CN113741229B - 一种水下机器人推进器及舵机一体化控制系统 - Google Patents
一种水下机器人推进器及舵机一体化控制系统 Download PDFInfo
- Publication number
- CN113741229B CN113741229B CN202010477525.XA CN202010477525A CN113741229B CN 113741229 B CN113741229 B CN 113741229B CN 202010477525 A CN202010477525 A CN 202010477525A CN 113741229 B CN113741229 B CN 113741229B
- Authority
- CN
- China
- Prior art keywords
- propeller
- steering engine
- complementary
- circuit
- driving
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 230000000295 complement effect Effects 0.000 claims abstract description 94
- 238000012545 processing Methods 0.000 claims abstract description 14
- 238000000034 method Methods 0.000 claims abstract description 13
- 230000008569 process Effects 0.000 claims abstract description 10
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 36
- 238000001514 detection method Methods 0.000 claims description 24
- 230000002457 bidirectional effect Effects 0.000 claims description 20
- 238000004891 communication Methods 0.000 claims description 18
- 238000001914 filtration Methods 0.000 claims description 15
- 238000002955 isolation Methods 0.000 claims description 15
- 239000003638 chemical reducing agent Substances 0.000 claims description 11
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 6
- 239000003990 capacitor Substances 0.000 claims description 3
- 238000012423 maintenance Methods 0.000 abstract description 2
- 230000007246 mechanism Effects 0.000 description 10
- 238000013461 design Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000003287 optical effect Effects 0.000 description 5
- 238000011161 development Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 210000005036 nerve Anatomy 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000004083 survival effect Effects 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D21/00—Measuring or testing not otherwise provided for
- G01D21/02—Measuring two or more variables by means not covered by a single other subclass
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
- G05B13/0275—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using fuzzy logic only
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D27/00—Simultaneous control of variables covered by two or more of main groups G05D1/00 - G05D25/00
- G05D27/02—Simultaneous control of variables covered by two or more of main groups G05D1/00 - G05D25/00 characterised by the use of electric means
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K7/00—Arrangements for handling mechanical energy structurally associated with dynamo-electric machines, e.g. structural association with mechanical driving motors or auxiliary dynamo-electric machines
- H02K7/10—Structural association with clutches, brakes, gears, pulleys or mechanical starters
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K7/00—Arrangements for handling mechanical energy structurally associated with dynamo-electric machines, e.g. structural association with mechanical driving motors or auxiliary dynamo-electric machines
- H02K7/14—Structural association with mechanical loads, e.g. with hand-held machine tools or fans
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/21—Pc I-O input output
- G05B2219/21137—Analog to digital conversion, ADC, DAC
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Artificial Intelligence (AREA)
- Software Systems (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Health & Medical Sciences (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Power Engineering (AREA)
- Mathematical Physics (AREA)
- Fuzzy Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种水下机器人推进器及舵机一体化控制系统,涉及水下机器人技术领域,解决了现有技术水下机器人推进器及舵机一体化控制过程中移植性差、维护困难的问题。系统包括:至少一路推进器驱动电路及受其驱动的推进器、至少一路舵机驱动电路及受其驱动的舵机、电源电路、多路驱动控制电路、控制器;其中,控制器用于生成互补的推进器控制信号和互补的舵机控制信号;驱动控制电路用于处理互补的推进器控制信号得到互补的推进器驱动信号,还用于处理互补的舵机控制信号得到互补的舵机驱动信号;推进器驱动电路基于互补的推进器驱动信号,驱动推进器驱动电路工作;舵机驱动电路基于互补的舵机驱动信号,驱动舵机驱动电路工作。
Description
技术领域
本发明涉及水下机器人技术领域,尤其涉及一种水下机器人推进器及舵机一体化控制系统。
背景技术
机器人技术的发展从单一的陆地机器人逐渐发展成海陆空三足鼎立。特别是随着世界人口的增加以及资源紧缺情况的频发,人类已经将海洋、湖泊作为生存发展的新领域,也正是随着机器人技术的大发展,水下机器人在近些年来取得了长足的发展。水下机器人的种类丰富,大小不一,最大下潜深度也不尽相同,因此在实际技术领域,水下机器人的系统差异化比较明显。
运动控制是水下机器人控制系统中极为重要的环节,是让“机器人”行走的中枢神经。水下机器人运动控制的执行机构包括方向舵机和推进螺旋桨,执行机构常安装在水下机器人尾段,一般二者的驱动分立安装,并且控制其作动的控制器一般集成在水下机器人管理计算机中。随着水下机器人智能化、模块化以及轻量化设计要求,若能将水下机器人运动控制部分模块化和一体化设计,将大大节省舱段的空间,并且方便替换和维修,同时也便于在不同平台之间移植和修改。
发明内容
鉴于上述的分析,本发明旨在提供一种水下机器人推进器及舵机一体化控制系统及方法,用以解决现有技术中存在的上述缺陷。
本发明的目的主要是通过以下技术方案实现的:
一种水下机器人推进器及舵机一体化控制系统,所述系统包括:至少一路推进器驱动电路及受其驱动的推进器、至少一路舵机驱动电路及受其驱动的舵机、电源电路、多路驱动控制电路、控制器;其中,
所述控制器用于生成互补的推进器控制信号和互补的舵机控制信号;
所述驱动控制电路用于处理所述互补的推进器控制信号得到互补的推进器驱动信号,还用于处理所述互补的舵机控制信号得到互补的舵机驱动信号;
所述推进器驱动电路基于所述互补的推进器驱动信号,驱动所述推进器驱动电路工作;所述舵机驱动电路基于所述互补的舵机驱动信号,驱动所述舵机驱动电路工作;
所述电源电路用于提供28V电压,并由28V电压隔离滤波生成5V电压,5V电压隔离滤波生成3.3V电压;5V电压和3.3V电压作为所述驱动控制电路的供电电压。
在上述方案的基础上,本发明还做出了如下改进:
进一步,所述驱动控制电路包括双向缓冲器、光耦开关;其中,隔离滤波得到的3.3V电压接入所述双向缓冲器的VCCB端,还串联电阻后接入所述光耦开关的VF1+端;隔离滤波得到的5V电压接入所述双向缓冲器的VCCA端,还接入所述光耦开关的Vcc端;所述光耦开关的Vcc端串联电容后接地,所述光耦开关的Vo1端串联上拉电阻后接地,所述光耦开关的Vo1端还连接至所述双向缓冲器的使能端;
当所述双向缓冲器接收所述互补的推进器控制信号时,其输出为所述互补的推进器驱动信号;
当所述双向缓冲器接收所述互补的舵机控制信号时,其输出为所述互补的舵机驱动信号。
进一步,所述系统还包括:分别安装于电源电路总出口、所述推进器的供电母线处、舵机的供电母线处的电流传感器,多路电流检测电路和CAN通信电路;
所述电流检测电路,用于采集电源电路总电流、所述推进器的供电母线处的电流以及所述舵机的供电母线处的电流,并判断各电流是否超过其电流阈值,若某路电流超过其电流阈值,将通过所述CAN通信电路通知所述控制器,以便由控制器切断该路供电。
进一步,所述系统还包括在所述系统内部多处安装的漏水检测传感器、漏水检测电路;
所述漏水检测电路,用于接收所述漏水检测传感器采集到的漏水开关信号,并根据所述漏水开关信号判断是否漏水,若漏水,将通过所述CAN通信电路通知所述控制器,以便由控制器切断漏水部位电路的供电。
进一步,所述推进器还包括速度传感器、推进器伺服电机和减速器;
所述速度传感器用于采集推进器螺旋桨的转轴转速信号;
所述控制器接收并处理所述转轴转速信号,生成所述互补的推进器控制信号;
利用所述互补的推进器驱动信号的差值的绝对值,确定驱动所述推进器驱动电路工作的占空比,利用所述互补的推进器驱动信号的差值的正负号,确定驱动所述推进器伺服电机转动的方向,通过所述推进器驱动电路控制所述推进器伺服电机转动,所述推进器伺服电机通过所述减速器驱动所述推进器螺旋桨的转轴转动。
进一步,所述控制器通过执行以下操作生成所述互补的推进器控制信号:
所述控制器将接收到的所述转轴转速信号与推进器转轴转速控制指令信号进行比较,经模糊PID控制算法处理得到期望转轴转速信号和期望转轴转向,基于所述期望转轴转速信号和期望转轴转向,生成所述互补的推进器控制信号;
所述互补的推进器控制信号的差值的绝对值为所述期望转速信号归一化后的结果;所述互补的推进器控制信号的差值的正负号对应于所述期望转轴转向。
进一步,所述舵机还包括角度位移传感器、舵机伺服电机和谐波减速器;
所述角度位移传感器用于采集舵机的位置信号;
所述控制器接收并处理所述舵机的位置信号,生成所述互补的舵机控制信号;
利用所述互补的舵机驱动信号的差值的绝对值,确定驱动所述舵机驱动电路工作的占空比,利用所述互补的舵机驱动信号的差值的正负号,确定驱动所述舵机伺服电机转动的方向,通过所述舵机驱动电路控制所述舵机伺服电机转动,所述舵机伺服电机通过所述谐波减速器驱动控制舵机偏转。
进一步,所述控制器通过执行以下操作得到所述互补的舵机控制信号:
所述控制器将接收到的所述位置信号与舵机位置控制指令信号进行比较,经模糊PID控制算法处理得到所述期望位置信号和期望舵机转向,基于所述期望位置信号和期望舵机转向,生成所述互补的舵机控制信号;
所述互补的舵机控制信号的差值的绝对值为所述期望位置信号归一化后的结果;所述互补的推进器控制信号的差值的正负号对应于所述期望舵机转向。
进一步,所述系统还包括第一AD采样电路,用于将所述转轴转速信号转化成相应的数字信号后经由所述CAN通信控制电路发送至所述控制器。
进一步,所述系统还包括和第二AD采样电路,用于将所述位置信号转化成相应的数字信号后经由所述CAN通信控制电路发送至所述控制器。
本发明有益效果如下:
与现有技术相比,本实施例提供的水下机器人推进器及舵机一体化控制系统能够实现推进器及舵机的一体化控制,各模块独立性较强,可根据需要设计推进器驱动电路及受其驱动的推进器、舵机驱动电路及受其驱动的舵机的数量,电路可移植性强、可维修性强、可替换性强,能够满足推进器及舵机的一体化控制需求。
本发明中,上述各技术方案之间还可以相互组合,以实现更多的优选组合方案。本发明的其他特征和优点将在随后的说明书中阐述,并且,部分优点可从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过说明书、权利要求书以及附图中所特别指出的内容中来实现和获得。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1为本发明实施例中的水下机器人推进器及舵机一体化控制系统功能结构示意图;
图2为本发明实施例中的驱动控制电路示意图;
图3为本发明实施例中的另一水下机器人推进器及舵机一体化控制系统实际设计结构示意图。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理,并非用于限定本发明的范围。
本发明实施例公开了一种水下机器人推进器及舵机一体化控制系统,功能结构示意图如图1所示,所述系统包括:至少一路推进器驱动电路及受其驱动的推进器、至少一路舵机驱动电路及受其驱动的舵机、电源电路、多路驱动控制电路、控制器;其中,所述控制器用于生成互补的推进器控制信号和互补的舵机控制信号;所述驱动控制电路用于处理所述互补的推进器控制信号得到互补的推进器驱动信号,还用于处理所述互补的舵机控制信号得到互补的舵机驱动信号;所述推进器驱动电路基于所述互补的推进器驱动信号,驱动所述推进器驱动电路工作;所述舵机驱动电路基于所述互补的舵机驱动信号,驱动所述舵机驱动电路工作;所述电源电路用于提供28V电压,并由28V电压隔离滤波生成5V电压,5V电压隔离滤波生成3.3V电压;5V电压和3.3V电压作为所述驱动控制电路的供电电压。
与现有技术相比,本实施例提供的水下机器人推进器及舵机一体化控制系统能够实现推进器及舵机的一体化控制,各模块独立性较强,可根据需要设计推进器驱动电路及受其驱动的推进器、舵机驱动电路及受其驱动的舵机的数量,电路可移植性强、可维修性强、可替换性强,能够满足推进器及舵机的一体化控制需求。
需要说明的是,在本实施例中,需要为每一路推进器驱动电路配置驱动控制电路,还需要为每一路舵机驱动电路配置驱动控制电路,因此,本实施例中驱动控制电路的数量为推进器驱动电路和舵机驱动电路数量之和。
优选地,所述系统还包括:分别安装于电源电路总出口、所述推进器的供电母线处、舵机的供电母线处的电流传感器,多路电流检测电路和CAN通信电路;所述电流检测电路,用于采集电源电路总电流、所述推进器的供电母线处的电流以及所述舵机的供电母线处的电流,并判断各电流是否超过其电流阈值,若某路电流超过其电流阈值,将通过所述CAN通信电路通知所述控制器,以便由控制器切断该路供电。该设计能够实现过流保护,尤其当尾端在水中遇到缠绕等状况导致推进螺旋桨或舵叶卡滞时,本电路将检测到电流异常状态,及时进行保护操作,一般功耗在连续1s大于2倍额定功耗时认为进入保护操作范围。
优选地,所述系统还包括在所述系统内部多处安装的漏水检测传感器、漏水检测电路;所述漏水检测电路,用于接收所述漏水检测传感器采集到的漏水开关信号(高电平漏水,低电平不漏水),并根据所述漏水开关信号判断是否漏水,若漏水,将通过所述CAN通信电路通知所述控制器,以便由控制器切断漏水部位电路的供电。尾段对水密性要求极高,特别是转动或者封盖的部位,因此为监控这些地方的水密状况,常在这些地方周围布置一些漏水检测装置。
优选地,所述推进器还包括速度传感器、推进器伺服电机和减速器;所述速度传感器用于采集推进器螺旋桨的转轴转速信号;所述控制器接收并处理所述转轴转速信号,生成所述互补的推进器控制信号;利用所述互补的推进器驱动信号的差值的绝对值,确定驱动所述推进器驱动电路工作的占空比,利用所述互补的推进器驱动信号的差值的正负号,确定驱动所述推进器伺服电机转动的方向,通过所述推进器驱动电路控制所述推进器伺服电机转动,所述推进器伺服电机通过所述减速器驱动所述推进器螺旋桨的转轴转动。
示例性地,推进器驱动电路或舵机驱动电路可以根据以下规则确定驱动电路的占空比以及电机转动的方向:
互补的驱动信号的差值的绝对值不为零,则根据该绝对值确定驱动驱动电路工作的PWM波的占空比;若绝对值为零,则驱动电路不工作;若所述互补的推进器驱动信号的差值为正,则按照前者的推进器驱动信号的方向驱动电机转动,若所述互补的推进器驱动信号的差值为负,则按照后者的推进器驱动信号的方向驱动电机转动。
优选地,所述控制器通过执行以下操作生成所述互补的推进器控制信号:所述控制器将接收到的所述转轴转速信号与推进器转轴转速控制指令信号进行比较,经模糊PID控制算法处理得到期望转轴转速信号和期望转轴转向,基于所述期望转轴转速信号和期望转轴转向,生成所述互补的推进器控制信号;所述互补的推进器控制信号的差值的绝对值为所述期望转速信号归一化后的结果;所述互补的推进器控制信号的差值的正负号对应于所述期望转轴转向。
优选地,所述舵机还包括角度位移传感器、舵机伺服电机和谐波减速器;其中,所述角度位移传感器用于采集舵机的位置信号;所述控制器接收并处理所述舵机的位置信号,生成所述互补的舵机控制信号;利用所述互补的舵机驱动信号的差值的绝对值,确定驱动所述舵机驱动电路工作的占空比,利用所述互补的舵机驱动信号的差值的正负号,确定驱动所述舵机伺服电机转动的方向,通过所述舵机驱动电路控制所述舵机伺服电机转动,所述舵机伺服电机通过所述谐波减速器驱动控制舵机偏转。
优选地,所述控制器通过执行以下操作得到所述互补的舵机控制信号:所述控制器将接收到的所述位置信号与舵机位置控制指令信号进行比较,经模糊PID控制算法处理得到所述期望位置信号和期望舵机转向,基于所述期望位置信号和期望舵机转向,生成所述互补的舵机控制信号;所述互补的舵机控制信号的差值的绝对值为所述期望位置信号归一化后的结果;所述互补的推进器控制信号的差值的正负号对应于所述期望舵机转向。
优选地,所述系统还包括第一AD采样电路,用于将所述转轴转速信号转化成相应的数字信号后经由所述CAN通信控制电路发送至所述控制器。所述系统还包括和第二AD采样电路,用于将所述位置信号转化成相应的数字信号后经由所述CAN通信控制电路发送至所述控制器
优选地,所述驱动控制电路如图2所示,包括双向缓冲器、光耦开关;其中,隔离滤波得到的3.3V电压接入所述双向缓冲器的VCCB端,还串联电阻后接入所述光耦开关的VF1+端;隔离滤波得到的5V电压接入所述双向缓冲器的VCCA端,还接入所述光耦开关的Vcc端;所述光耦开关的Vcc端串联电容后接地,所述光耦开关的Vo1端串联上拉电阻后接地,所述光耦开关的Vo1端还连接至所述双向缓冲器的使能端;当所述双向缓冲器接收所述互补的推进器控制信号时,其输出为所述互补的推进器驱动信号;当所述双向缓冲器接收所述互补的舵机控制信号时,其输出为所述互补的舵机驱动信号。
需要强调的是,本实施例中的驱动控制电路,是考虑到实际过程中存在的以下缺陷适应性设置的:
在本实施例中,为实现系统的小型化设置,因此,电源电路仅提供28V电压,需要由28V电压隔离滤波生成5V电压(还可以根据供电需要生成±12V电压),5V电压隔离滤波再生成3.3V电压;因此,与以往采用多种电压同时供电的方式不同的是,本实施例中的实现方式要考虑以下问题:在上电后若干时间内,DSP(将DSP作为控制器)控制输出引脚可能存在空白时间,因为DSP输出处理后的信号即为推进器或舵机驱动电路输入(PWM信号),而空白时间的存在会使得此时作用于推进器或舵机驱动电路的PWM信号并不确定,相应地,执行机构装置(推进器或舵机)的电机也会因此有一段不受控时间。这段空白时间包含两个阶段:第一阶段是28V电压隔离滤波生成3.3V电压的过程,这段时间内DSP没有供电尚不能正常运转,其输出引脚状态未知;第二段是DSP初始化阶段,这段时间内DSP输出引脚不受控,一般恒为高。
为了避免推进器或舵机驱动电路的PWM信号并不确定造成的不利影响,设计了上述驱动控制电路,在该电路中,一方面加入了保护逻辑,驱动控制电路接收的两路PWM信号严格按照互补逻辑设置,只有其满足互补逻辑时,才能保证其输出的PWM信号驱动电机发生转动;另一方面,在驱动控制电路输入端加入双向缓冲器和默认上拉电路,并且双向缓冲器的使能端前加入光耦开关,光耦开关的输入端是3.3V,这样做的意义在于,当处于第一阶段不受控阶段时,3.3V未产生,则光耦开关未打开,缓冲器使能端下拉为低电平,缓冲器输出三态高阻状态,驱动控制电路无输出,无法驱动推进器或舵机驱动电路工作,此时执行机构装置的电机不转;当处于第二段不受控状态时,因DSP初始化阶段其输出引脚为高电平,则缓冲器两路输出都是高电平,由于驱动推进器或舵机驱动电路接收到的两路输入都是高电平时,因此,驱动控制电路无输出,相应的执行机构装置电机不转。从而能够有效保证水下机器人推进器及舵机一体化控制系统设计过程中可能造成的推进器或舵机不受控的情况,减少意外事件的发生。
示例性地,图3示出了本发明实施例中的另一水下机器人推进器及舵机一体化控制系统实际设计结构示意图;包含一个控制器盒(圆盒状),执行机构装置(四个操舵装置,四个舵叶、一个推进装置、一个推进螺旋桨)、多个漏水检测装置、内部电缆若干、外部供电电缆、CAN通讯电缆,执行机构是以电机为核心的带减速器传动机构,控制器盒中集成有电源电路、CAN通讯控制电路、推进驱动电路、舵机驱动电路、电流检测电路、漏水检测电路。控制器可以根据需求灵活增减操舵或推进路数,可移植性性、可维修性、可替换性较强,其较之于执行机构装置解耦性强。在具备基础功能(通讯,供电转换,漏水检测、电流检测)的前提下,若要增加或减少执行机构装置的数目,只需要对增加或减少相应驱动电路部分的路数即可。
本领域技术人员可以理解,实现上述实施例方法的全部或部分流程,可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于计算机可读存储介质中。其中,所述计算机可读存储介质为磁盘、光盘、只读存储记忆体或随机存储记忆体等。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
Claims (8)
1.一种水下机器人推进器及舵机一体化控制系统,其特征在于,所述系统包括:至少一路推进器驱动电路及受其驱动的推进器、至少一路舵机驱动电路及受其驱动的舵机、电源电路、多路驱动控制电路、控制器;其中,
所述控制器用于生成互补的推进器控制信号和互补的舵机控制信号;
所述驱动控制电路用于处理所述互补的推进器控制信号得到互补的推进器驱动信号,还用于处理所述互补的舵机控制信号得到互补的舵机驱动信号;
所述推进器驱动电路基于所述互补的推进器驱动信号,驱动所述推进器驱动电路工作;所述舵机驱动电路基于所述互补的舵机驱动信号,驱动所述舵机驱动电路工作;
所述电源电路用于提供28V电压,并由28V电压隔离滤波生成5V电压,5V电压隔离滤波生成3.3V电压;5V电压和3.3V电压作为所述驱动控制电路的供电电压;
推进器驱动电路或舵机驱动电路可以根据以下规则确定驱动电路的占空比以及电机转动的方向:
互补的驱动信号的差值的绝对值不为零,则根据该绝对值确定驱动驱动电路工作的PWM波的占空比;若绝对值为零,则驱动电路不工作;若所述互补的推进器驱动信号的差值为正,则按照前者的推进器驱动信号的方向驱动电机转动,若所述互补的推进器驱动信号的差值为负,则按照后者的推进器驱动信号的方向驱动电机转动;
所述推进器还包括速度传感器、推进器伺服电机和减速器;
所述速度传感器用于采集推进器螺旋桨的转轴转速信号;
所述控制器接收并处理所述转轴转速信号,生成所述互补的推进器控制信号;
利用所述互补的推进器驱动信号的差值的绝对值,确定驱动所述推进器驱动电路工作的占空比,利用所述互补的推进器驱动信号的差值的正负号,确定驱动所述推进器伺服电机转动的方向,通过所述推进器驱动电路控制所述推进器伺服电机转动,所述推进器伺服电机通过所述减速器驱动所述推进器螺旋桨的转轴转动;
所述驱动控制电路包括双向缓冲器、光耦开关;其中,隔离滤波得到的3.3V电压接入所述双向缓冲器的VCCB端,还串联电阻后接入所述光耦开关的VF1+端;隔离滤波得到的5V电压接入所述双向缓冲器的VCCA端,还接入所述光耦开关的Vcc端;所述光耦开关的Vcc端串联电容后接地,所述光耦开关的Vo1端串联上拉电阻后接地,所述光耦开关的Vo1端还连接至所述双向缓冲器的使能端;
当所述双向缓冲器接收所述互补的推进器控制信号时,其输出为所述互补的推进器驱动信号;
当所述双向缓冲器接收所述互补的舵机控制信号时,其输出为所述互补的舵机驱动信号。
2.根据权利要求1所述的水下机器人推进器及舵机一体化控制系统,其特征在于,所述系统还包括:分别安装于电源电路总出口、所述推进器的供电母线处、舵机的供电母线处的电流传感器,多路电流检测电路和CAN通信电路;
所述电流检测电路,用于采集电源电路总电流、所述推进器的供电母线处的电流以及所述舵机的供电母线处的电流,并判断各电流是否超过其电流阈值,若某路电流超过其电流阈值,将通过所述CAN通信电路通知所述控制器,以便由控制器切断该路供电。
3.根据权利要求2所述的水下机器人推进器及舵机一体化控制系统,其特征在于,所述系统还包括在所述系统内部多处安装的漏水检测传感器、漏水检测电路;
所述漏水检测电路,用于接收所述漏水检测传感器采集到的漏水开关信号,并根据所述漏水开关信号判断是否漏水,若漏水,将通过所述CAN通信电路通知所述控制器,以便由控制器切断漏水部位电路的供电。
4.根据权利要求3所述的水下机器人推进器及舵机一体化控制系统,其特征在于,所述控制器通过执行以下操作生成所述互补的推进器控制信号:
所述控制器将接收到的所述转轴转速信号与推进器转轴转速控制指令信号进行比较,经模糊PID控制算法处理得到期望转轴转速信号和期望转轴转向,基于所述期望转轴转速信号和期望转轴转向,生成所述互补的推进器控制信号;
所述互补的推进器控制信号的差值的绝对值为所述期望转轴转速信号归一化后的结果;所述互补的推进器控制信号的差值的正负号对应于所述期望转轴转向。
5.根据权利要求4所述的水下机器人推进器及舵机一体化控制系统,其特征在于,所述舵机还包括角度位移传感器、舵机伺服电机和谐波减速器;
所述角度位移传感器用于采集舵机的位置信号;
所述控制器接收并处理所述舵机的位置信号,生成所述互补的舵机控制信号;
利用所述互补的舵机驱动信号的差值的绝对值,确定驱动所述舵机驱动电路工作的占空比,利用所述互补的舵机驱动信号的差值的正负号,确定驱动所述舵机伺服电机转动的方向,通过所述舵机驱动电路控制所述舵机伺服电机转动,所述舵机伺服电机通过所述谐波减速器驱动控制舵机偏转。
6.根据权利要求5所述的水下机器人推进器及舵机一体化控制系统,其特征在于,所述控制器通过执行以下操作得到所述互补的舵机控制信号:
所述控制器将接收到的所述位置信号与舵机位置控制指令信号进行比较,经模糊PID控制算法处理得到期望位置信号和期望舵机转向,基于所述期望位置信号和期望舵机转向,生成所述互补的舵机控制信号;
所述互补的舵机控制信号的差值的绝对值为所述期望位置信号归一化后的结果;所述互补的推进器控制信号的差值的正负号对应于所述期望舵机转向。
7.根据权利要求6所述的水下机器人推进器及舵机一体化控制系统,其特征在于,所述系统还包括第一AD采样电路,用于将所述转轴转速信号转化成相应的数字信号后经由所述CAN通信电路发送至所述控制器。
8.根据权利要求7所述的水下机器人推进器及舵机一体化控制系统,其特征在于,所述系统还包括和第二AD采样电路,用于将所述位置信号转化成相应的数字信号后经由所述CAN通信电路发送至所述控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010477525.XA CN113741229B (zh) | 2020-05-29 | 2020-05-29 | 一种水下机器人推进器及舵机一体化控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010477525.XA CN113741229B (zh) | 2020-05-29 | 2020-05-29 | 一种水下机器人推进器及舵机一体化控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113741229A CN113741229A (zh) | 2021-12-03 |
CN113741229B true CN113741229B (zh) | 2023-06-06 |
Family
ID=78724804
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010477525.XA Active CN113741229B (zh) | 2020-05-29 | 2020-05-29 | 一种水下机器人推进器及舵机一体化控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113741229B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103631174A (zh) * | 2012-08-29 | 2014-03-12 | 中国科学院沈阳自动化研究所 | 一种小型水下机器人推进控制系统及其舵控制方法 |
CN103699134A (zh) * | 2013-12-27 | 2014-04-02 | 陕西航天导航设备有限公司 | 一种基于位置环控制的电动舵机系统 |
CN106208884A (zh) * | 2016-08-31 | 2016-12-07 | 南京康尼电子科技有限公司 | 一种用于伺服驱动器的转矩安全关断系统及方法 |
RU169166U1 (ru) * | 2016-03-31 | 2017-03-07 | Федеральное государственное бюджетное образовательное учреждение высшего образования "Юго-Западный государственный университет" (ЮЗГУ) | Подводный робот |
CN106843025A (zh) * | 2015-12-07 | 2017-06-13 | 上海新跃仪表厂 | 一种伺服系统驱动电路控制方法 |
CN107117276A (zh) * | 2017-04-18 | 2017-09-01 | 西北工业大学 | 一种便携式自主水下航行器的推进与操纵一体化控制装置 |
-
2020
- 2020-05-29 CN CN202010477525.XA patent/CN113741229B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103631174A (zh) * | 2012-08-29 | 2014-03-12 | 中国科学院沈阳自动化研究所 | 一种小型水下机器人推进控制系统及其舵控制方法 |
CN103699134A (zh) * | 2013-12-27 | 2014-04-02 | 陕西航天导航设备有限公司 | 一种基于位置环控制的电动舵机系统 |
CN106843025A (zh) * | 2015-12-07 | 2017-06-13 | 上海新跃仪表厂 | 一种伺服系统驱动电路控制方法 |
RU169166U1 (ru) * | 2016-03-31 | 2017-03-07 | Федеральное государственное бюджетное образовательное учреждение высшего образования "Юго-Западный государственный университет" (ЮЗГУ) | Подводный робот |
CN106208884A (zh) * | 2016-08-31 | 2016-12-07 | 南京康尼电子科技有限公司 | 一种用于伺服驱动器的转矩安全关断系统及方法 |
CN107117276A (zh) * | 2017-04-18 | 2017-09-01 | 西北工业大学 | 一种便携式自主水下航行器的推进与操纵一体化控制装置 |
Non-Patent Citations (1)
Title |
---|
模糊PID控制算法在电动舵机控制中的应用;李全福等;《微电机》;20071228(第12期);28-30,47 * |
Also Published As
Publication number | Publication date |
---|---|
CN113741229A (zh) | 2021-12-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104859827A (zh) | 基于轴带电机与柴油机并车推进的船舶柴电混合动力装置 | |
CN102368677A (zh) | 一种电动执行机构的智能交流变频控制系统 | |
CN113741229B (zh) | 一种水下机器人推进器及舵机一体化控制系统 | |
CN105807667B (zh) | 一种适用于电动飞机的控制器 | |
CN202624620U (zh) | 船舶电力推进系统 | |
CN2837200Y (zh) | 总线式调距桨联合控制系统 | |
CN201754241U (zh) | 嵌入式阀门遥控控制装置 | |
CN109484591B (zh) | 一种水下机器人推进器模块化驱动电路及其驱动方法 | |
CN102312772B (zh) | 一种风力发电机变桨距系统控制方法 | |
CN111913476B (zh) | 一种无人艇航行控制软件架构方法及装置 | |
CN106200446A (zh) | 一种万米自主遥控水下机器人推进控制系统及其控制方法 | |
CN107168044A (zh) | 一种水下机器人推进器容错系统 | |
CN105373109B (zh) | 一种Delta机器人驱控系统 | |
CN106826836A (zh) | 一种智能工业机器人控制系统 | |
CN203237395U (zh) | 一种水下自航行器的方向调节装置 | |
CN210244118U (zh) | 一种具有失效保护功能的无人艇控制电路及无人艇 | |
CN106200498A (zh) | 一种基于单片机的舵机驱动装置 | |
CN202856676U (zh) | 一种步进电机驱动器 | |
KR20180134478A (ko) | 소형 잠수정 | |
CN112134260A (zh) | 一种改进的锂电池gps防盗拆系统及其控制方法 | |
CN109058037B (zh) | 一种海洋能发电机组的变桨控制系统 | |
CN202230335U (zh) | 伺服控制器的嵌入式接口装置 | |
CN205921454U (zh) | 一种基于arm处理器的雷达智能电源 | |
CN110347079A (zh) | 一种具有失效保护功能的无人艇控制电路及无人艇 | |
CN220764676U (zh) | 一种无人驾驶船舶防缠绕装置以及无人驾驶船舶 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |