电子设计竞赛:坡道行驶电动小车设计与实现
1. 四川省电子设计竞赛一等奖作品解析坡道行驶电动小车去年参加四川省电子设计竞赛时我们团队选择了C题坡道行驶电动小车这个看似简单实则暗藏玄机的题目。经过72小时的连续奋战最终拿下一等奖。今天就把这个项目的完整实现方案分享给大家特别是那些准备参加类似竞赛的同学们。这个项目的核心挑战在于小车需要在带有坡道的赛道上稳定循迹行驶同时要克服坡道带来的动力损耗和轨迹偏移问题。我们放弃了传统的舵机转向方案创新性地采用了差速控制光电传感器的组合方案最终实现了稳定爬坡30度、全程循迹误差小于2cm的优异表现。2. 硬件设计方案详解2.1 主控芯片选型与适配竞赛硬性要求使用MSP430作为主控芯片这对习惯STM32的我们来说是个挑战。我们选用的是MSP430F5529主要考虑以下几点充足的IO口40满足多传感器需求内置12位ADC满足光电传感器采样精度4组定时器支持4路PWM输出低功耗特性适合电池供电场景实际调试中发现430的时钟配置比较特殊需要特别注意ACLK和SMCLK的分频设置否则会导致PWM频率异常。2.2 动力系统设计动力系统是爬坡性能的关键我们做了以下设计电机驱动模块选用经典的L298N双H桥驱动驱动电压设置为12V实测9-15V均可每个H桥最大输出电流2A需加散热片电机选型型号JGA25-370直流减速电机额定电压12V减速比1:48空载转速300rpm堵转扭矩3kg·cm轮胎优化方案第一版使用3D打印轮毂硅胶胎发现硬度不足第二版改用玩具车橡胶胎摩擦系数提升40%最终版在轮胎表面刻划纹路进一步提升抓地力2.3 传感器系统布局循迹系统采用4路红外光电传感器布局方案如下传感器编号安装位置检测距离功能S1车头最左侧1.5cm左边界检测S2车头左侧1.5cm主要循迹S3车头右侧1.5cm主要循迹S4车头最右侧1.5cm右边界检测传感器安装高度控制在8-10mm通过实验确定最佳阈值白色赛道ADC值 800黑色轨迹ADC值 12003. 控制系统设计与实现3.1 差速循迹算法我们创新性地采用固定偏置动态调整的方案// 差速控制核心代码 if(ADC2 || ADC3 || ADC4){ // 检测到右侧黑线 TA0CCR1 6000; // 左轮全速 TA0CCR3 0; // 右轮停止 turn_flag_R 1; }else{ // 默认左偏置状态 TA0CCR1 3500; // 左轮70%速度 TA0CCR3 3000; // 右轮60%速度 }这种方案的优势在于省去了舵机及其控制电路通过机械结构自然保持左偏趋势遇到黑线时快速右转修正系统响应时间10ms3.2 坡道动力补偿策略针对不同坡道角度我们建立了PWM补偿公式PWM_base 3000 angle * 250; // 基础PWM值 PWM_boost angle * 100; // 角度补偿实测数据记录坡道角度理论PWM实测PWM通过时间15°675070003.2s20°800082004.5s25°925095006.1s30°10500110008.3s3.3 系统状态机设计整个控制系统采用状态机架构主要状态包括初始化状态就绪状态等待发车指令循迹行驶状态坡道补偿状态终点停止状态状态转换逻辑通过按键和传感器信号触发确保系统行为可控。4. 调试经验与问题排查4.1 典型问题解决方案问题1上坡时频繁脱轨现象小车在15°以上坡道容易脱离轨迹原因分析后轮打滑导致传感器偏离轨道解决方案增加轮胎纹路深度降低坡道段行驶速度20%增加传感器采样频率至500Hz问题2差速控制不线性现象转向时出现明显抖动原因PWM变化率过大解决方法增加转向过渡区间// 修改后的平滑转向代码 for(int i0; i10; i){ TA0CCR1 3500 i*250; TA0CCR3 3000 - i*300; delay_ms(5); }4.2 现场调试技巧准备多组备用轮胎不同硬度提前打印不同角度的坡道测试件使用蓝牙模块实时传输调试数据在赛道上标记关键检测点准备快速充电设备保证电池续航4.3 性能优化记录通过以下优化将成绩从85分提升到98分将传感器采样间隔从10ms降到2ms优化差速算法响应时间从15ms到8ms增加坡道角度自动识别功能改进轮胎材质后爬坡能力提升25%优化代码结构减少30%内存占用5. 完整实现代码解析5.1 传感器数据处理void ccd_collect(void) { unsigned int i 0; P6OUT | CLK; // 时钟高电平 P3OUT ~SI; // 启动脉冲低 P6OUT ~CLK; // 时钟下降沿 P3OUT | SI; // 启动脉冲高 P6OUT | CLK; // 时钟上升沿 P3OUT ~SI; // 启动脉冲低 for(i0; i128; i){ P6OUT ~CLK; // 时钟下降沿 ccd_data[i] ADC_getdata(4) 4; // 12bit转8bit P6OUT | CLK; // 时钟上升沿 } tsl1401_finish_flag 1; }5.2 电机控制逻辑void motor_control(void) { // 坡道起步补偿 if((MOTOR(2600angle*250)) (start_flag0)){ delay_time Stime (200-MOTOR/50); while(delay_time Stime){ TA0CCR1 3000angle*250; TA0CCR3 3000angle*250; } start_flag1; } // 传感器状态更新 ADC_1 (ADC_getdata(1)1500) ? 1 : 0; ADC_2 (ADC_getdata(2)1500) ? 1 : 0; ADC_3 (ADC_getdata(3)1500) ? 1 : 0; ADC_4 (ADC_getdata(4)1500) ? 1 : 0; // 终点检测 if(stop_flag 0){ if(ADC_1 ADC_2){ // 同时检测到左右边界 delay_time Stime ((125-MOTOR/50)25 ? 25 : (125-MOTOR/50)); while(delay_time Stime){ TA0CCR1 MOTOR; TA0CCR3 MOTOR; } // 停车逻辑 TA0CCR1 TA0CCR3 0; SPEAK_ON; Dly_ms(100); SPEAK_OFF; stop_flag 1; } } // 循迹控制 if(stop_flag 0){ if(ADC_2 || ADC_3 || ADC_4){ // 右侧检测到黑线 if(MOTOR(2650angle*250)){ TA0CCR1 6000angle*250; // 左轮加速 TA0CCR3 0; // 右轮停止 turn_flag_R 1; } }else{ if(turn_flag_R){ // 退出转向状态 delay_time Stime10; while(delay_time Stime){ TA0CCR1 (angle5) ? 4000angle*250 : 3500angle*250; TA0CCR3 (angle5) ? 4000angle*250 : 3500angle*250; } turn_flag_R 0; }else{ // 正常直行 TA0CCR1 MOTOR; TA0CCR3 MOTOR; } } } }在最终调试阶段我们发现电池电压波动会影响PWM输出效果于是增加了电压补偿算法将不同电压下的性能波动控制在5%以内。这个小改进让我们在决赛中稳定发挥最终以全场第二的成绩获得一等奖。
本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/2487348.html
如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!