一、智能车舵机控制

一、智能车舵机控制前言:本文章主要是近期有关舵机知识的总结,将分别从舵机的控制原理,控制流程和代码实现流程几个方面作简要介绍,由于时间紧急,难免有疏漏错误之处,欢迎留言指正,QQ:2046890259一、多级的控制原理:我们本次智能车使用的舵机是通过PWM进行控制。而PWM几个重要的参数就是最大值,最小值和占空比。其中占空比决定了舵机的旋转角度,如下图所示:不同的占空比控制不同的角度。而我们的目的就是通过…

大家好,又见面了,我是你们的朋友全栈君。

前言:
本文章主要是近期有关舵机知识的总结,将分别从舵机的控制原理,控制流程和代码实现流程几个方面作简要介绍,由于时间紧急,难免有疏漏错误之处,欢迎留言指正
一、舵机的控制原理:
我们本次智能车使用的舵机是通过PWM进行控制。而PWM几个重要的参数就是最大值,最小值和占空比。其中占空比决定了舵机的旋转角度,如下图所示:在这里插入图片描述
不同的占空比控制不同的角度。而我们的目的就是通过摄像头和电感采集上来的数据(MiddleLine)通过算法来控制占空比(脉冲宽度),进而控制舵机的旋转角度。简单介绍了原理之后下面就开始介绍舵机的使用和控制。
二、舵机左右极值和中值参数设置:
使用舵机的第一步就是先对舵机进行调中,目的是使舵机左右自由度相同,从而是控制更加准确和方便,如果不调中,很容易出现舵机打死现象,轻则是车子无法正常转弯,重则烧坏舵机。调中方法:
1、调左极值:
使以下单个参数相同,观察舵机旋转角度,当左轮即将接触车子为最佳。
2、调中值:
方法同上。
3、调右极值:
方法同上。

位置:macro.h

//-------舵机pwm-------------------
#define STEER_MIN 9580 //左值9455
#define STEER_MID 9580 //中值9500
#define STEER_MAX 9580 //又值9580

注意:在调中的过程中,应尽量做到左右对称,如果左右不对称,可以采取以下几种方法:
(1)、调节舵机中值角度位置,尽量做到左右自由度对称
(2)、调节连接杆位置(推荐)
(3)、有的时候由于工艺的限制,会有部分偏差,只能通过其他硬件结构和软件设计进行弥补
二、哪里用到这些值:
1、角度控制
位置:control.c

void AngleControl(PID *pid_steer)
{ 
   
	float middle_line = getMiddleLine();
	if(middle_line > IMAGE_WIDTH)//中线偏差限幅
		middle_line = IMAGE_WIDTH;
	else if(middle_line < 0)
		middle_line = 0;
#if DIR == 0//左小右大
	steer_u = STEER_MID - PositionalPD(pid_steer, middle_line);
#elif DIR == 1
	steer_u = STEER_MID + PositionalPD(pid_steer, middle_line);
#endif
	
	//舵机脉宽平滑变化
	if(steer_u > STEER_MAX)
		steer_u = STEER_MAX;
	else if(steer_u < STEER_MIN)
		steer_u = STEER_MIN;
	setPWMWidth(steer_u);
}

uint8 cnt = 0;
uint8 flag = 0;

从这段代码可以看出,程序先通过函数getMiddleLine()获得中线,然后对中线进行了限幅,防止数值过大或过小损坏硬件。然后传递到 PositionalPD()函数,该函数通过中线和PID结构体中的数值进行计算,最终得出一个误差数值(PD运算得出)output,然后与舵机中值做差,数值传给steer_u ,然后再函数setPWMWidth()函数中对steer_u做一次限幅,然后传递给函数cmt_pwm_duty()就可以进行PWM的设置了,下面将对相关函数作简要介绍:
(1)、脉冲宽度设置:

void setPWMWidth(uint16 steer_u)
{ 
   
	if(steer_u > STEER_MAX) { 
   
		steer_u = STEER_MAX;
	} else if(steer_u < STEER_MIN) { 
   
		steer_u = STEER_MIN;
	}
        cmt_pwm_duty(steer_u/10); 
}

该函数看似是进行脉冲宽度设置,实质时进行限幅作用,真正进行脉宽设置的是cmt_pwm_duty()函数。
(2)、cmt_pwm_duty()函数:

void cmt_pwm_duty(uint16 duty)
{ 
   
    
    uint32 temp_high_num, temp_low_num;

    //计算高低电平的计数次数
    temp_low_num = (cmt_period*(CMT_PRECISON-duty)/CMT_PRECISON);
    temp_high_num = (cmt_period*(duty)/CMT_PRECISON);
    
    //设置低电平时间
    temp_low_num--;
    CMT->CMD1 = temp_low_num >> 8;
    CMT->CMD2 = (uint8)temp_low_num;
    
    //设置高电平时间
    CMT->CMD3 = temp_high_num >> 8;
    CMT->CMD4 = (uint8)temp_high_num;

}```
这里面有几个参数需要大家了解一下:
1、cmt_period :一个周期计数的次数
		表达式:cmt_period = temp_clk/(temp_div+1)/freq;
		注意:这里用到了预分频的方法,就不多做介绍
		
2、CMT_PRECISON:占空比精度
3、duty:占空比

该函数的作用是进行占空比设置,用到了CMT模块,这里不做详细介绍。

(3)、PositionalPD()函数:


//积分饱和,输出限幅
int16 PositionalPD(PID *pid, float sensor_val)//位置式pd
{ 
   
	float output = 0.0f;
	float error = 0.0f;
	
	float p_error = 0.0f;//当前误差项
	float d_error = 0.0f;//微分误差项
	
	error = pid->set_point - sensor_val;
	
	p_error	= error;
	d_error = error - pid->last_error;
	
	if(fabs(error) < 0.1f)
		output = 0.0f;
	else
		output = pid->K_p * p_error + pid->K_d * d_error;

	pid->last_error = error;
	return (int)output;
}

该函数的功能主要是根据摄像头和电感传回来的数据进行误差计算,用到了PID控制,算法不是很难,不做详细介绍。
4、 getMiddleLine()函数:

float getMiddleLine(void)
{ 
   
	float inductor = getInductorMiddleLine();
	float camera = getCameraMiddleLine();
#if CAMERA==1
	float result = inductor * car_info.K_g + camera * (1 - car_info.K_g);
#else
        float result = inductor;
#endif
	car_info.mid_line_ = result;
	return result;
}

该函数的作用是获得中线,当有摄像头时取摄像头和电感的加权值,否则使用电感的数值,这也是为什么不用摄像头也能进行循迹的原因。
三、总结:
由次可以看出,舵机控制大致分以下几个步骤:
1、调中,就是调那三个数值
2、获得中线:getMiddleLine(),分两种情况,有摄像头和无摄像头
3、将获得的中线值和调中设置的值通过函数PositionalPD()PID运算得出差值,并将结果传给steer_u
4、根据steer_u的数值,通过函数setPWMWidth()进行限幅
5、限幅后将数值steer_u/10传给函数cmt_pwm_duty()进行脉宽设置
以上就是舵机的大致控制流程,由于能力有限,难免有疏漏错误之处,欢迎留言指正,进行交流。由于本次主要是介绍舵机的有关控制,里面有很多细节没有做详细介绍,大家可以自己上网查阅相关资料进行了解。比赛是一个学习的过程,只有多动手,勤思考,才能有所收获,失败的经验比成功地经验更重要。

版权声明:本文内容由互联网用户自发贡献,该文观点仅代表作者本人。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如发现本站有涉嫌侵权/违法违规的内容, 请发送邮件至 举报,一经查实,本站将立刻删除。

发布者:全栈程序员-用户IM,转载请注明出处:https://javaforall.cn/151730.html原文链接:https://javaforall.cn

【正版授权,激活自己账号】: Jetbrains全家桶Ide使用,1年售后保障,每天仅需1毛

【官方授权 正版激活】: 官方授权 正版激活 支持Jetbrains家族下所有IDE 使用个人JB账号...

(0)


相关推荐

  • python实现word文档批量转成自定义格式的excel文档

    python实现word文档批量转成自定义格式的excel文档

  • OSPF路由协议_ospf协议是一种什么路由协议

    OSPF路由协议_ospf协议是一种什么路由协议OSPF:开放式最短路径优先协议无类别链路状态路由协议,组播更新224.0.0.5/6;跨层封装到三层,协议号89;基于拓扑工作,故更新量大—–需要结构化部署–区域划分、地址规划触发更新、每30min周期更新OSPF的数据包:Hello包DBD–数据库描述包LSR–链路状态请求LSU–链路状态更新携带各种LSALSack–链路状态确认状态机—-OSP…

    2022年10月30日
  • 进程调度时间片轮转例题_进程调度算法java

    进程调度时间片轮转例题_进程调度算法java一、实验目的(1)加深对进程的理解(2)理解进程控制块的结构(3)理解进程运行的并发性(4)掌握时间片轮转法进程调度算法二、实验原理(1)建立进程控制块(2)设计两个链队列,分别表示就绪队列和完成队列(3)用户输入进程标识符,进程到达时间,进程所需的时间,申请空间存放进程,PCB信息。(

    2022年10月28日
  • Ubuntu安装ssh服务详细过程[通俗易懂]

    SSH服务简介(来自百度百科)SSH为SecureShell的缩写,由IETF的网络小组(NetworkWorkingGroup)所制定;SSH为建立在应用层基础上的安全协议。SSH是较可靠,专为远程登录会话和其他网络服务提供安全性的协议。利用SSH协议可以有效防止远程管理过程中的信息泄露问题。SSH最初是UNIX系统上的一个程序,后来又迅速扩展到其他操作平台。SSH在正确使用时可弥补网络中的漏洞。SSH客户端适用于多种平台。几乎所有UNIX平台—包括HP-UX、Linux、.

  • java static再赋值_java static变量可以赋值吗?

    java static再赋值_java static变量可以赋值吗?详细内容javastatic变量可以赋值吗?可以赋值的。static的主要作用是静态成员,指该变量的实例在内存中之存放一次。赋值是可以随便改的。java中static关键字static是java中非常重要的一个关键字,主要有两种作用:● 第一:为某特定数据类型或对象分配单一的存储空间,而与创建对象的个数无关。● 第二:实现某个方法或属性与类而不是对象关联在一起简单来说,在Java语言中,stat…

发表回复

您的电子邮箱地址不会被公开。

关注全栈程序员社区公众号