舵机的简单介绍

舵机组成

结构接线图
在这里插入图片描述
拆卸图
在这里插入图片描述

框架图

在这里插入图片描述

舵机扭力介绍

舵机扭矩的单位是KG*CM,这是一个扭矩的单位,可以理解为在舵盘上距离舵机轴中心水平距离1CM处,舵机能够带动的物体重量。
在这里插入图片描述

控制流程

Created with Raphaël 2.2.0 开始 控制信号 控制电路板 电机转动使电位计转动 电位计反馈 结束 yes no

位置与脉冲控制关系

舵机的控制一般需要一个20ms的时基脉冲,该脉冲的高电平部分一般为0.5ms~2.5ms范围内的角度控制脉冲部分。以180度角度舵机为例,那么对应的控制关系是这样的:
0.5ms--------------0度;
1.0ms------------45度;
1.5ms------------90度;
2.0ms-----------135度;
2.5ms-----------180度;

 

如下图可形象地表示脉冲与角度关系

 



舵机的追随特性

假设现在舵机稳定在A点,这时候控制电路发出一个PWM信号,舵机全速由A点转向B点,在这个过程中需要一段时间,舵机才能运动到B点。
在这里插入图片描述

保持时间为Tw
当Tw≥△T时,舵机能够到达目标,并有剩余时间;
当Tw≤△T时,舵机不能到达目标;

理论上:当Tw=△T时,系统最连贯,而且舵机运动的最快。

实际过程中w不尽相同,连贯运动时的极限△T比较难以计算出来。

假如我们的舵机1DIV =8us,当PWM信号以最小变化量即(1DIV=8us)依次变化时,舵机的分辨率最高,但是速度会减慢。

实际过程中由于以下两个因素:
1、1个机器人身上有多个舵机,负载各不相同,所以角速度w不同;
2、某个舵机在不同时刻的外界环境负载也不同,所以w不同;
所以连贯运动时的极限△T难以计算出来,目前采取的方法是经验选取w值。

驱动芯片的内部电路

在这里插入图片描述

这里只找到BA668A芯片的datasheet
在这里插入图片描述

51单片机控制代码

#include <reg52.h>
unsigned char count;			//0.5ms次数标识
sbit pwm=P1^0;				//信号输出
sbit jia=P1^1;				//角度增加按键
sbit jan=P1^2;				//角度减小按键
char jd;					//角度标识
void delay(unsigned int i)
{
	unsigned int j,k;
	for(j=i;j>0;j--)
		for(k=125;k>0;k--);
}
void Time0_init()			//定时器初始化
{
	TMOD=0x01;
	IE=0x82;
	TH0=0xff;
	TL0=0x19;				//12晶振,0.25ms
	TR0=1;				   //定时器开始
}
void Time0_int() interrupt 1			//中断程序
{
	TH0=0xff;
	TL0=0x19;
	if(count<jd) //输出count个高电平
		pwm=1;
	else
	pwm=0;    //其余输出低电平
	count++;
	count=count%40;  //时钟保持40个count 即20ms
}
void keyscan()				//按键扫描
{
	if(jia==0)				//角度增加键是否按下
	{
		delay(50);			//按下延时,消抖
		if(jia==0)
		{
			jd++;			//角度标识加1
			count=0;		//按键按下,则20ms周期重新开始
			if(jd==50)
				jd=9;			 //已经是180°则保持
				while(jia==0);	 //等待按键放开
		}
	}
	if(jan==0)					 //角度减小键是否按下
	{
		delay(10);
		if(jd==0);
		{
			jd--;				 //角度标识减1
			count=0;
			if(jd==0)
				jd=1;
			while(jan==0);
		}
	}
}
 
void main()
{
	jd=1;
	count=0;
	Time0_init();
	while(1)
	{
		keyscan();
//		display();
	}
}

Arduino控制代码

在这里插入图片描述
使用官方自带库

数字口控制

#include <Servo.h>
 
#define PIN_SERVO 9
Servo myservo;
 
void setup()
{
  myservo.attach(PIN_SERVO);
}
 
void loop()
{
  myservo.write(0);
  delay(1000);
  myservo.write(80);
  delay(1000);
  myservo.write(160);
  delay(1000);
  myservo.write(80);
  delay(1000);
  myservo.write(0);
  delay(1000);
}

模拟输入控制:

#include <Servo.h>
Servo myservo;  // create servo object to control a servo
int potpin = 0;  // analog pin used to connect the potentiometer
int val;    // variable to read the value from the analog pin

void setup() {
  myservo.attach(9);  // attaches the servo on pin 9 to the servo object
}

void loop() {
  val = analogRead(potpin);            // reads the value of the potentiometer (value between 0 and 1023)
  val = map(val, 0, 1023, 0, 180);     // scale it to use it with the servo (value between 0 and 180)
  myservo.write(val);                  // sets the servo position according to the scaled value
  delay(15);                           // waits for the servo to get there
}

相关参考链接:https://wenku.baidu.com/view/11b2e7d6ec3a87c24128c416.html

#include<REG52.h> #define uchar unsigned char #define uint unsigned int #define N 1 //¿è²¿¶æ»ú sbit PWM_OUT00=P0^0; sbit PWM_OUT01=P0^1; sbit PWM_OUT02=P0^2; sbit PWM_OUT03=P0^3; sbit PWM_OUT04=P0^4; sbit PWM_OUT05=P0^5; //СÍȶæ»ú sbit PWM_OUT10=P1^0; sbit PWM_OUT11=P1^1; sbit PWM_OUT12=P1^2; sbit PWM_OUT13=P1^3; sbit PWM_OUT14=P1^4; sbit PWM_OUT15=P1^5; //´óÍȶæ»ú sbit PWM_OUT20=P2^0; sbit PWM_OUT21=P2^1; sbit PWM_OUT22=P2^2; sbit PWM_OUT23=P2^3; sbit PWM_OUT24=P2^4; sbit PWM_OUT25=P2^5; //PWMµÄÊý¾ÝÖµ uint code PWM_Value[N][18]={1490,1500,1510,1490,1500,1510,1490,1500,1510,1490,1500,1510,1490,1500,1510,1490,1500,1510}; //¶¨ÒåpwmÐźÅÖÐµÄ¸ßµçÆ½Ê±¼ä ·¶Î§ 535< pwm_h <2430 uint PWM_now[18] ; //µ±Ç°pwmµÄÊýÖµ uint *pwm_now_ad[18]; //µ±Ç°pwmµÄµØÖ· uchar dongzuo_pd=0; //¶¯×÷Ƭ¶ÎµÄ˳Ðò´úºÅ uchar order1; //¶¨Ê±Æ÷ɨÃèÐòÁÐ uchar dj_num; bit fa_time=0; bit fa_ck=0; struct Uartframe { unsigned char frameh; unsigned char id; //idΪ0x30ʱΪȫ·¿ØÖÆÖ¸Áî unsigned char cmd; unsigned char udata; unsigned char framee; }; struct Uartframe sendframe={'#',0xff,0xff,0xff,'$'}, recframe={'#',0xff,0xff,0xff,'$'}; /*------------------------------------------------ ´®¿Ú³õʼ»¯ ------------------------------------------------*/ void InitUART (void) { PS=1; SCON |= 0x50; // SCON: ģʽ 1, 8-bit UART, ʹÄܽÓÊÕ TMOD |= 0x20; // TMOD: timer 1, mode 2, 8-bit ֨װ TH1 = 0xFD; // TH1: ֨װֵ 9600 ²¨ÌØÂÊ ¾§Õñ 11.0592MHz TR1 = 1; // TR1: timer 1 ´ò¿ª EA = 0; //¹Ø±Õ×ÜÖÐ¶Ï ES = 1; //´ò¿ª´®¿ÚÖÐ¶Ï } /* void send() { unsigned char i,*uartp = &sendframe;.frameh; for(i=0;i<sizeof(sendframe);i++) { ES = 0; TI = 0; SBUF = *uartp; while(!TI); TI = 0; ES = 1; uartp++; } } */ void gengxinshuju() { if(recframe.frameh=='#' & recframe.framee=='$') { switch(recframe.id) { case 0x04: PWM_now[recframe.cmd-1] = recframe.udata*7+550; P2=0x80; //ÓÃÁ÷Ë®µÆÑéÖ¤ break; case 0x01: P2=0x10; break; case 0x02: P2=0x20; break; case 0x03: P2=0x40; break; default: P2=0x0f; } } /* SBUF=recframe.frameh; SBUF=recframe.id; SBUF=recframe.cmd; SBUF=recframe.udata; SBUF=recframe.framee; */ } void ad() { uchar i; for(i=0;i<18;i++) { pwm_now_ad[i]=&PWM;_now[i]; } } void pwm_timer(); /*=================================================================================== ³õʼ»¯ÖÐ¶Ï =====================================================================================*/ void InitPWM(void) { order1=0; TMOD |=0x11; TH0=-1500/256; TL0=-1500%6; EA=0; EX0=0; ET0=1; TR0=1;PT0=1;PX0=0; } void delayMS(uint x) //ºÁÃë¼¶ÑÓʱ Îó²î 0us { uchar a,b,c; while(x--) { for(c=1;c>0;c--) for(b=142;b>0;b--) for(a=2;a>0;a--); } } void pwm_nowfz() { uchar i,j,k,zu; uint *tempp; for(i=0;i<18;i++) { PWM_now[i]=PWM_Value[dongzuo_pd][i]; } for(zu=0;zu<18;zu=zu+3) { for(j=zu;j<zu+2;j++) //Èý¸ö¶æ»úÅÅÐò { for(k=j+1;k<zu+3;k++) { if(*pwm_now_ad[j]>*pwm_now_ad[k]) { tempp=pwm_now_ad[j]; pwm_now_ad[j]=pwm_now_ad[k]; pwm_now_ad[k]=tempp; } } } } } void dongzuo1() { dongzuo_pd=0;pwm_nowfz();EA=1; delayMS(2); /* delayMS(5000); dongzuo_pd=1;pwm_nowfz(); delayMS(5000); dongzuo_pd=2;pwm_nowfz(); delayMS(5000); dongzuo_pd=3;pwm_nowfz(); delayMS(5000); */ } void io_dp() //io¿ÚµçƽÉú³É { dj_num=pwm_now_ad[order1-1]-&PWM;_now[0]; switch(dj_num) { case 0 : PWM_OUT00=0;break; case 1 : PWM_OUT01=0;break; case 2 : PWM_OUT02=0;break; case 3 : PWM_OUT03=0;break; case 4 : PWM_OUT04=0;break; case 5 : PWM_OUT05=0;break; case 6 : PWM_OUT10=0;break; case 7 : PWM_OUT11=0;break; case 8 : PWM_OUT12=0;break; case 9 : PWM_OUT13=0;break; case 10 : PWM_OUT14=0;break; case 11: PWM_OUT15=0;break; case 12: PWM_OUT20=0;break; case 13: PWM_OUT21=0;break; case 14 : PWM_OUT22=0;break; case 15 : PWM_OUT23=0;break; case 16 : PWM_OUT24=0;break; case 17 : PWM_OUT25=0;break; } } void main(void) { InitPWM(); InitUART(); ad(); while(1) { dongzuo1(); } } unsigned char *uartp = &recframe;.frameh; void UARTInterrupt(void) interrupt 4 { uchar temp; if(RI) { RI = 0; temp=SBUF; SBUF=temp; if('#' == SBUF | (uartp-&recframe;.frameh)>sizeof(recframe)) uartp = &recframe;.frameh; if('$' == SBUF) gengxinshuju(); *uartp = SBUF; uartp++; } else { TI=0; } } /*=================================================================================== ¶¨Ê±Æ÷T0µÄÖжϷþÎñ³ÌÐò Ò»¸öÑ­»·20MS = 8*2.5ms =====================================================================================*/ void timer0(void) interrupt 1 using 1 { //pwm_timer(); switch(order1) { case 0: //io_dp(); TH0 =(-*pwm_now_ad[0])/256; TL0 =(-*pwm_now_ad[0])%6; PWM_OUT00=1; PWM_OUT01=1; PWM_OUT02=1; order1++; break; case 1: TH0 =-(*pwm_now_ad[1]-*pwm_now_ad[0])/256; TL0 =-(*pwm_now_ad[1]-*pwm_now_ad[0])%6; io_dp(); order1++; break; case 2: TH0 =-(*pwm_now_ad[2]-*pwm_now_ad[1])/256; TL0 =-(*pwm_now_ad[2]-*pwm_now_ad[1])%6; io_dp(); order1++; break; case 3: TH0 =-(2303-*pwm_now_ad[2])/256; TL0 =-(2303-*pwm_now_ad[2])%6; io_dp(); order1=19; break; case 19: //io_dp(); TH0 =(-*pwm_now_ad[3])/256; TL0 =(-*pwm_now_ad[3])%6; PWM_OUT03=1; PWM_OUT04=1; PWM_OUT05=1; //order1++; order1=4; break; case 4: TH0 =-(*pwm_now_ad[4]-*pwm_now_ad[3])/256; TL0 =-(*pwm_now_ad[4]-*pwm_now_ad[3])%6; io_dp(); order1++; break; case 5: TH0 =-(*pwm_now_ad[5]-*pwm_now_ad[4])/256; TL0 =-(*pwm_now_ad[5]-*pwm_now_ad[4])%6; io_dp(); order1++; if(order1>18) order1=0; break; case 6: TH0 =-(2303-*pwm_now_ad[5])/256; TL0 =-(2303-*pwm_now_ad[5])%6; io_dp(); order1=20; break; case 20: TH0 =(-*pwm_now_ad[6])/256; TL0 =(-*pwm_now_ad[6])%6; PWM_OUT10=1; PWM_OUT11=1; PWM_OUT12=1; //order1++; order1=7; break; case 7: TH0 =-(*pwm_now_ad[7]-*pwm_now_ad[6])/256; TL0 =-(*pwm_now_ad[7]-*pwm_now_ad[6])%6; io_dp(); order1++; break; case 8: TH0 =-(*pwm_now_ad[8]-*pwm_now_ad[7])/256; TL0 =-(*pwm_now_ad[8]-*pwm_now_ad[7])%6; io_dp(); order1++; if(order1>18) order1=0; break; case 9: TH0 =-(2303-*pwm_now_ad[8])/256; TL0 =-(2303-*pwm_now_ad[8])%6; io_dp(); order1=21; break; case 21: TH0 =(-*pwm_now_ad[9])/256; TL0 =(-*pwm_now_ad[9])%6; PWM_OUT13=1; PWM_OUT14=1; PWM_OUT15=1; //order1++; order1=10; break; case 10: TH0 =-(*pwm_now_ad[10]-*pwm_now_ad[9])/256; TL0 =-(*pwm_now_ad[10]-*pwm_now_ad[9])%6; io_dp(); order1++; break; case 11: TH0 =-(*pwm_now_ad[11]-*pwm_now_ad[10])/256; TL0 =-(*pwm_now_ad[11]-*pwm_now_ad[10])%6; io_dp(); order1++; break; case 12: TH0 =-(2303-*pwm_now_ad[11])/256; TL0 =-(2303-*pwm_now_ad[11])%6; io_dp(); order1=22; break; case 22: TH0 =(-*pwm_now_ad[12])/256; TL0 =(-*pwm_now_ad[12])%6; PWM_OUT20=1; PWM_OUT21=1; PWM_OUT22=1; //order1++; order1=13; break; case 13: TH0 =-(*pwm_now_ad[13]-*pwm_now_ad[12])/256; TL0 =-(*pwm_now_ad[13]-*pwm_now_ad[12])%6; io_dp(); order1++; break; case 14: TH0 =-(*pwm_now_ad[14]-*pwm_now_ad[13])/256; TL0 =-(*pwm_now_ad[14]-*pwm_now_ad[13])%6; io_dp(); order1++; break; case 15: TH0 =-(2303-*pwm_now_ad[14])/256; TL0 =-(2303-*pwm_now_ad[14])%6; io_dp(); order1=23; break; case 23: TH0 =(-*pwm_now_ad[15])/256; TL0 =(-*pwm_now_ad[15])%6; PWM_OUT23=1; PWM_OUT24=1; PWM_OUT25=1; //order1++; order1=16; break; case 16: TH0 =-(*pwm_now_ad[16]-*pwm_now_ad[15])/256; TL0 =-(*pwm_now_ad[16]-*pwm_now_ad[15])%6; io_dp(); order1++; break; case 17: TH0 =-(*pwm_now_ad[17]-*pwm_now_ad[16])/256; TL0 =-(*pwm_now_ad[17]-*pwm_now_ad[16])%6; io_dp(); order1++; break; case 18: TH0 =-(5000-*pwm_now_ad[17])/256; TL0 =-(5000-*pwm_now_ad[17])%6; io_dp(); //order1=19; order1++; if(order1>18) order1=0; break; default : order1=0;break; } }
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值