测试环境
大疆开发板 C型
STM32F407IGH6TR 芯片
冯哈伯 3863 直流电机 带减速箱(38:2)
RoboModule直流伺服电机驱动器 RMDS-303
RoboModule电机配置上位机
蓝牙模块
蓝牙调试助手APP
RT-Thread操作系统
面向对象模块接口设计
电机连接铝制腿部机构带动踢球
代码工程
stm32f407_DJIc.rar
工程基础:
LED频闪指示灯模块: https://www.yuque.com/wangxi_chn/qaxke0/mltilp
RoboModule电机群模块:https://www.yuque.com/wangxi_chn/qaxke0/ulrbrk
蓝牙驱动遥控模块:https://www.yuque.com/wangxi_chn/qaxke0/dmwgwv
工程组成
- 没有进一步封装,直接调用各个模块的方法在主函数内组合作用
报文协议等见RoboModule电机群模块:https://www.yuque.com/wangxi_chn/qaxke0/ulrbrk
main
初始化配置
MODULE_LED dev_led_state =
{
.pin = GET_PIN(H, 10),
.LED_TIME_CYCLE = 4000,
.LED_TIME_OUTPUT = 200
};
运行频闪状态灯
MODULE_BLUETOOTHHC06 dev_communicate =
{
.Property_UartDevName = "uart6",
};
蓝牙串口
MODULE_ROBOMODULEGROUP dev_robomoduleGroup =
{
.Property_CanDevName = "can1",
.Value_robomodule[ROBOMODULE_NUMID_1] =
{
.Property_Enable = 1,
.Property_GroupID = ROBOMODULE_GROUPID_0,
.Property_NumID = ROBOMODULE_NUMID_1,
.Property_Mode = ROBOMODULE_MODE_LOCATION,
},
.Value_robomodule[ROBOMODULE_NUMID_2] =
{
.Property_Enable = 1,
.Property_GroupID = ROBOMODULE_GROUPID_0,
.Property_NumID = ROBOMODULE_NUMID_2,
.Property_Mode = ROBOMODULE_MODE_LOCATION,
},
};
用到的两个Robomodule
- 设置ID分别为0组1号,0组2号
均是位置模式
Module_Led_Config(&dev_led_state);
dev_led_state.Set(&dev_led_state,9);
Module_RobomoduleGroup_Config(&dev_robomoduleGroup);
Module_BlueToothHC06_Config(&dev_communicate);
使能配置
/* system running shine led thread */
rt_thread_t led_thread = rt_thread_create("ledshine", led_shine_entry, RT_NULL,
512, RT_THREAD_PRIORITY_MAX - 3, 20);
if (led_thread != RT_NULL){
rt_thread_startup(led_thread);
}
/* motor control thread */
rt_thread_t motor_thread = rt_thread_create("motor", motor_entry, RT_NULL,
1024, RT_THREAD_PRIORITY_MAX - 2, 20);
if (motor_thread != RT_NULL){
rt_thread_startup(motor_thread);
}
/* blue tooth updata thread */
rt_thread_t bluetupdata_thread = rt_thread_create("bluetupdata", bluetupdata_entry, RT_NULL,
512, RT_THREAD_PRIORITY_MAX - 5, 20);
if (bluetupdata_thread != RT_NULL){
rt_thread_startup(bluetupdata_thread);
}
/* blue tooth updata thread */
rt_thread_t bluetcontrol_thread = rt_thread_create("bluetcontrol", bluetcontrol_entry, RT_NULL,
512, RT_THREAD_PRIORITY_MAX - 5, 20);
if (bluetcontrol_thread != RT_NULL){
rt_thread_startup(bluetcontrol_thread);
}
创建线程
- LED状态灯显示线程
- 电机控制线程
- 蓝牙接收数据更新线程
蓝牙控制线程
static void bluetcontrol_entry(void *parameter)
{
static rt_uint32_t time_1000m = 0;
while(1)
{
rt_thread_mdelay(1);
time_1000m++;
switch(dev_communicate.Value_keyMask)
{
case (0x0001<<0):
dev_robomoduleGroup.Value_robomodule[ROBOMODULE_NUMID_1].Value_motor_AimAngle= 27500; //360°
dev_robomoduleGroup.Value_robomodule[ROBOMODULE_NUMID_2].Value_motor_AimAngle= -27500;
dev_communicate.Value_keyMask = 0x0000;
break;
case (0x0001<<1):
dev_robomoduleGroup.Value_robomodule[ROBOMODULE_NUMID_1].Value_motor_AimAngle=0;
dev_robomoduleGroup.Value_robomodule[ROBOMODULE_NUMID_2].Value_motor_AimAngle=0;
dev_communicate.Value_keyMask = 0x0000;
break;
case (0x0001<<2):
break;
case (0x0001<<3):
break;
case (0x0001<<4):
break;
case (0x0001<<5):
break;
case (0x0001<<6):
break;
case (0x0001<<7):
break;
case (0x0001<<8):
break;
case (0x0001<<9):
break;
case (0x0001<<10):
break;
case (0x0001<<11):
break;
}
dev_communicate.Value_keyMask = 0x0000;
if(time_1000m >= 1000)
{
time_1000m = 0;
rt_int16_t temp = dev_robomoduleGroup.Value_robomodule[ROBOMODULE_NUMID_1].Value_motor_AimAngle*360/27500;
dev_communicate.Method_Send(&dev_communicate,PARAM_SHOW_1,
temp);
}
}
}
-
注意
在使用前一定要注意电机的方向,电机方向与很多因素有关
- robomodule编码器接线
- robomodule与电机电源接线
- 上位机设置
- 单片机发送的信息
- 因此,在单片机发送信息控制电机前应当先通过上位机的反馈模式观察电机正向,尤其是左右两侧的电机方向是否一致,再给出控制信号
-
存在问题
冯哈伯 3863的电机力量非常大,而电机和腿部连接的地方较为薄弱
- 很容易造成电机转动,但腿部位置由于惯性不跟随的情况
- 在足端撞击橄榄球的一瞬间尤为明显
-
可能的解决途径
仍旧采用位置控制,但是控制电机转过角度较多、
- 这时其实足端位置已经不可知,我们只是利用了位置控制时的加速过程
- 经过测试踢球表现也较好,但不可重复踢球,每次都需要断电归零位重新上电
- 可以考虑通过操作手,手动调整足端归位,绝对位置控制变为增量控制
- 但是这样就减少了部分自动流程,会影响时间和一致性
- 最根本的解决办法还是电机和腿部的连接绝对固连,精准的位置控制才可实现