標(biāo)題: 請問誰有直流電機轉(zhuǎn)速測量與調(diào)速這種程序例子，我想?yún)⒖紝W(xué)習(xí)下 求分享 [打印本頁]

---

作者: 315471593    時間: 2020-9-10 09:58
標(biāo)題: 請問誰有直流電機轉(zhuǎn)速測量與調(diào)速這種程序例子，我想?yún)⒖紝W(xué)習(xí)下 求分享
如題

---

作者: zuiqf1978    時間: 2020-11-8 00:25
加霍爾傳感！

---

作者: 幾兩    時間: 2022-12-12 13:29

1. #include<reg52.h>
   
2. #include<stdio.h>
   
3. #define uchar unsigned char
   
4. #define uint unsigned int
   
5. #define THC0 0xf9
   
6. #define TLC0 0x0f   
   
7. unsigned char  code Duan[]={0x3F, 0x06,0x5B,0x4F,0x66,0x6D,0x7D,0x07,0x7F,0x6F};
   
8. unsigned char  Data_Buffer[8]={0,0,0,0,0,0,0,0};                        
   
9. 
   
10. uchar i=0;
    
11. sbit AddSpeed=P1^1;
    
12. sbit SubSpeed=P1^2;
    
13. sbit TurnForward=P1^3;
    
14. sbit TurnBackward=P1^4;
    
15. sbit Stop=P1^5;
    
16. 
    
17. sbit IN1=P3^0;
    
18. sbit IN2=P3^1;
    
19. sbit PWM_FC=P1^0;
    
20. int e ,e1 ,e2 ;
    
21. float uk ,uk1 ,duk ;
    
22. float Kp=15,Ki=12,Kd=1.6;
    
23. int out=0;
    
24. uint SpeedSet=380;
    
25. uint cnt=0;
    
26. uint Inpluse=0,num=0;
    
27. uint PWMTime=100;
    
28. unsigned char  arry[];
    
29. void SendString(uint ch);
    
30. void PIDControl();
    
31. void SystemInit();
    
32. void delay(uchar x);
    
33. void PWMOUT();
    
34. void SetSpeed();
    
35. void SegRefre();
    
36. 
    
37. void main()
    
38. {
    
39.         SystemInit();
    
40.         while(1)
    
41.         {
    
42.                 SetSpeed();               
    
43.                 SegRefre();               
    
44.                 PWMOUT();               
    
45. 
    
46.         }
    
47. }
    
48. 
    
49. void PIDControl()        
    
50. {
    
51.         e=SpeedSet-num;                 
    
52.         duk=(Kp*(e-e1)+Ki*e+Kd*(e-2*e1+e2))/50;      
    
53.         uk=uk1+duk;            
    
54.         out=(int)uk;   
    
55.         if(out>1000)
    
56.         {
    
57.                 out=1000;
    
58.         }
    
59.         else if(out<0)
    
60.         {
    
61.                 out=0;
    
62.         }
    
63.         uk1=uk;                                 
    
64.         e2=e1;
    
65.         e1=e;                                 
    
66.         PWMTime=out;
    
67. }
    
68. 
    
69. void delay(uchar x)
    
70. {
    
71.         uint i,j;
    
72.         for(i=x;i>0;i--)
    
73.                 for(j=50;j>0;j--);
    
74. }
    
75. 
    
76. void PWMOUT()                  
    
77. {
    
78.         if(cnt<PWMTime)               
    
79.         {
    
80.                 PWM_FC=1;
    
81.         }
    
82.         else
    
83.         {
    
84.                 PWM_FC=0;
    
85.         }
    
86.         if(cnt>1000) cnt=0;         
    
87. }
    
88. void SystemInit()
    
89. {
    
90.         TMOD=0X21;     
    
91.         TH0=THC0;
    
92.         TL0=TLC0;
    
93.         TH1=0xC0;
    
94.         TL1=0XC0;
    
95.         ET1=1;
    
96.         ET0=1;
    
97.         TR0=1;
    
98.         TR1=1;
    
99.         EX0=1;     
    
100.         IT0=1;
     
101.         EA=1;
     
102.         e =0;               
     
103.         e1=0;
     
104.         e2=0;
     
105.         IN1 = 1;
     
106.         IN2 = 0;
     
107. }
     
108. void SetSpeed()
     
109. {
     
110.         if(AddSpeed==0)
     
111.         {
     
112.                 delay(200);                          
     
113.                 if(AddSpeed==0)
     
114.                 {
     
115.                         SpeedSet+=10;
     
116.                         if(SpeedSet>1500)
     
117.                         {
     
118.                                 SpeedSet=1500;
     
119.                         }
     
120.                 }
     
121.         }
     
122.         if(SubSpeed==0)
     
123.         {
     
124.                 delay(200);
     
125.                 if(SubSpeed==0)
     
126.                 {
     
127.                         SpeedSet-=10;
     
128.                         if(SpeedSet<0) SpeedSet=0;
     
129.                 }
     
130.         }
     
131.         if(TurnForward==0)
     
132.         {
     
133.                 delay(200);
     
134.                 if(TurnForward==0)
     
135.                 {
     
136.                    IN1 = 1;
     
137.                    IN2 = 0;
     
138.                    while(TurnForward==0);
     
139.                 }
     
140.         }
     
141.         if(TurnBackward==0)
     
142.         {
     
143.                 delay(200);
     
144.                 if(TurnBackward==0)
     
145.                 {
     
146.                    IN1 = 0;
     
147.                    IN2 = 1;
     
148.                    while(TurnBackward==0);
     
149.                 }
     
150.         }
     
151.         if(Stop==0)
     
152.         {
     
153.                 delay(200);
     
154.                 if(Stop==0)
     
155.                 {
     
156.                    IN1 = 1;
     
157.                    IN2 = 1;
     
158.                    while(Stop==0);
     
159.                 }
     
160.         }
     
161. 
     
162. }
     
163. void SegRefre()                  
     
164. {
     
165.          Data_Buffer[0]=SpeedSet/1000;                  
     
166.          Data_Buffer[1]=SpeedSet%1000/100;
     
167.          Data_Buffer[2]=SpeedSet%100/10;
     
168.          Data_Buffer[3]=SpeedSet%10;
     
169.          Data_Buffer[4]=num/1000;                        
     
170.          Data_Buffer[5]=num%1000/100;
     
171.          Data_Buffer[6]=num%100/10;
     
172.          Data_Buffer[7]=num%10;
     
173. }
     
174. 
     
175. void int0() interrupt 0
     
176. {
     
177.         Inpluse++;                    
     
178. }
     
179. void t0() interrupt 1
     
180. {
     
181.         static unsigned char Bit=0;
     
182.         static unsigned int time=0;
     
183.         TH0=THC0;
     
184.         TL0=TLC0;
     
185. 
     
186. 
     
187.         Bit++;
     
188.         time++;  
     
189.         if(Bit>8) Bit=0;                  
     
190.         P0=0xff;
     
191.         P2=Duan[Data_Buffer[Bit]];        
     
192.         switch(Bit)                                       
     
193.         {
     
194.                 case 0:P0=0X7F;break;
     
195.                 case 1:P0=0XBF;break;
     
196.                 case 2:P0=0XDF;break;
     
197.                 case 3:P0=0XEF;break;
     
198.                 case 4:P0=0XF7;break;
     
199.                 case 5:P0=0XFB;break;
     
200.                 case 6:P0=0XFD;break;
     
201.                 case 7:P0=0XFE;break;
     
202.         }
     
203.         if(time>100)
     
204.         {
     
205.                 time=0;
     
206.                 num=Inpluse*5;                  
     
207.                 Inpluse=0;                          
     
208.                 PIDControl();                  
     
209.         }
     
210. }
     
211. void timer_1()  interrupt 3
     
212. {
     
213.            cnt++;        
     
214. }

復(fù)制代碼

---

作者: coody_sz    時間: 2022-12-12 21:25
普通2線有刷直流電機嗎？如果是，要求不精確，可以參考磁帶錄音機的電機穩(wěn)速電路原理，數(shù)字化PID處理就可以了，我用在各種微型鉆機、微型臺鋸等等，效果很好。

---

歡迎光臨 (http://www.torrancerestoration.com/bbs/)

Powered by Discuz! X3.1