Skip to content

推进器与电调连接配置 ​

ArduSub 的推进器不按车船的「油门、转向」分配,而是按机架编号:SERVO1 到 SERVO8 依次对应 Motor1 到 Motor8。编号接错不会报错,但机体在水下会朝错误方向动,所以接线与 FRAME_CONFIG 要一起确认。

机架配置 ​

FRAME_CONFIG 决定推进器数量、编号顺序和每个推进器的推力方向。改完必须重启控制器才生效。

参数值机架推进器数可控轴
0BlueROV16横滚 / 俯仰 / 偏航 / 升沉 / 前后 / 横移
1Vectored6偏航 / 升沉 / 前后 / 横移
2Vectored_6DOF8横滚 / 俯仰 / 偏航 / 升沉 / 前后 / 横移
3Vectored_6DOF_908横滚 / 俯仰 / 偏航 / 升沉 / 前后 / 横移
4SimpleROV-33偏航 / 升沉 / 前后
5SimpleROV-44横滚 / 偏航 / 升沉 / 前后
6SimpleROV-55横滚 / 偏航 / 升沉 / 前后 / 横移
7Custom自定义按自定义混控

缺轴的机架靠重心与压载维持该轴稳定,不能靠推进器主动修正。BlueROV2 用的是 1 号 Vectored,BlueROV2 Heavy 用的是 2 号 Vectored_6DOF。

六推进器:Vectored ​

六推进器矢量机架俯视图:1、2 为艏部两台水平推进器,3、4 为艉部两台水平推进器,5、6 为两台垂直推进器

▲ Vectored 机架:编号 1~6 对应 Output 1~6,红色三角为机头方向

八推进器:Vectored_6DOF ​

八推进器 6DOF 机架俯视图:1~4 为艉部四台水平推进器,5~8 为四台垂直推进器

▲ Vectored_6DOF 机架:编号 1~8 对应 Output 1~8,四台垂直推进器提供升沉与横滚

同轴推进器要反向装桨

同一方向上对推的两台推进器,一台装正桨、一台装反桨,转向也相反。装成同向会在定深或直航时持续产生偏航力矩,只能靠 MOTx_DIRECTION 硬压,姿态会一直发抖。

输出口与功能号 ​

默认按顺序对应,重排过通道才需要改功能号。接线保持不动,改参数即可。

参数值说明
SERVO1_FUNCTION33Motor1
SERVO2_FUNCTION34Motor2
SERVO3_FUNCTION35Motor3
SERVO4_FUNCTION36Motor4
SERVO5_FUNCTION37Motor5
SERVO6_FUNCTION38Motor6
SERVO7_FUNCTION39Motor7
SERVO8_FUNCTION40Motor8

功能号改完要重启

SERVOx_FUNCTION 属于重启生效的参数。改完不重启,地面站显示已经改过,输出口仍按旧功能走。

电调类型与行程 ​

MOT_PWM_TYPE 决定输出信号形式,按电调说明书选,选错的表现是电调只响不转或转速阶跃。

参数值信号
0普通 PWM
1OneShot
2OneShot125
3Brushed,有刷电机直驱
4DShot150
5DShot300
6DShot600
7DShot1200
8PWMRange
9PWMAngle

潜行器用的是双向电调:中位 1500 停转,往两边分别是正转与反转。MOT_PWM_MIN / MOT_PWM_MAX 填电调标称的行程端点,标称不清时用 8 号 PWMRange 或 9 号 PWMAngle,按每个电调单独设行程。MOT_SPIN_ARM 要小于 MOT_SPIN_MIN,前者是解锁时开始给的最小量,后者是推力起点。

推进方向 ​

转向不对有四种改法,按从参数到机械的顺序选:

方法怎么做
MOTx_DIRECTION1 正转、-1 反转,不需要动线
对调电机线无刷电机的三根相线任换两根
电调配置器BLHeli 或 AM32 电调直接改转向,也可走 ArduPilot 的 Passthrough
MOTORDETECT 模式水下静止时自动检测并纠正双向推进器方向,但只作用于控制横滚、俯仰、偏航的推进器

改完方向逐个推进器单独验证,一次改一个:同时改多个,方向对了也不知道是哪一个改对的。

常见机架接法 ​

机架推进器输出口说明
Vectored6Output 1~6四台水平 + 两台垂直,最常见的测绘与观察型
Vectored_6DOF8Output 1~8四台水平 + 四台垂直,带横滚控制,负载能力强
SimpleROV-44Output 1~4两台水平 + 两台垂直,没有横移
SimpleROV-33Output 1~3一台水平 + 两台垂直,只能前后、升降、偏航

Vectored 机架还有一个 MOT_FV_CPLNG_K,用来削弱升降与前后推进之间的水动力耦合,代价是快速升降时前后推力变小。默认 1.2,0 为关闭。

文档反馈:hongle@cuav.net