利用光纤放大器颜色识别传感器模块(颜色光电色标传感器光纤放ER2-21M)设计位移检测机构。因为反射型的光纤位移传感器基本原理比较简单,整体设计是将步进电机模块与光纤传感器模块相结合而构成,进而实现简单的位移检测。本文介绍了控制程序的生成、反射型光纤传感器的工作原理、整个系统的构成、以及步进电机在位移检测机构中的作用及原理、光纤传感器在系统中的作用。主要的目的就是实现对待测物体的短距离的位移测量,本文将以单片机为中心实现对电机的控制和对位移值的显示的软件设计,将步进电机与光纤传感器等硬件结构完整地搭建起来。
单片机源程序如下:
- #include "reg52.h"
- #define uint unsigned int
- #define uchar unsigned char
- #define MotorTabNum 5
- unsigned char T0_NUM = 0;
- signed char g_MotorNum = 0;
- unsigned char MotorTab[6] = {12, 10, 8, 6, 4, 2};
- sbit CLK = P1^0; //PWM信号输出端
- sbit FX = P1^1; //电机方向
- sbit P1_3 = P1^3; //电机开关
- sbit MotorEn = P2^1; // 使能
- sbit K1 = P1^4; //开关按键Key1
- sbit K2 = P1^5; //方向按键Key2
- sbit K3 = P1^6; //开关按键Key3
- sbit K4 = P1^7; //方向按键Key4
- sbit SMG1 = P0^0; //数码管第一位定义
- sbit SMG2 = P0^1; //数码管第二位定义
- sbit SMG3 = P0^2; //数码管第三位定义
- sbit SMG4 = P0^3; //数码管第四位定义
- unsigned char g_MotorSt = 0; // 启停
- unsigned char g_MotorDir = 0; // 正反
- int table[]={0x3f,0x06,0x5b,0x4f, 0x66,0x6d,0x7d,0x07, 0x7f,0x6f,0x40}; //共阴极数码管段值
- void Init_t0(void); //子函数声明
- void scan_key(void);
- void delayms(xms);
- void Display(void);
- void main()
- {
- FX=1;
- CLK = 0; //置PWM初始输出为高电平
- P1_3 = 0;
- Init_t0();
- while(1)
- {
- scan_key();
- } //等待中断
- }
- void scan_key(void)
- {
- #if 0
- if(0 == P1_5)
- {
- delayms(3);
- if(0 == P1_5)
- P1_1 = ~P1_1;
- }
- else if(0 == P1_4)
- {
- delayms(3);
- if(0 == P1_4)
- {
- if(TR0==1)
- TR0 = 0;
- else
- TR0 = 1;
- }
- }
- delayms(30);
- #endif
- if(K1 == 0)
- {
- delayms(10); // 软件延时消抖
- if(K1 == 0)
- {
- while(!K1){Display();}; // 等待K1松开
- g_MotorSt = g_MotorSt ^ 0x01;
- MotorEn ^= 1;
- if(TR0 == 0)
- {
- TR0 = 1;
- }
- else
- TR0 = 0;
- }
- }
- if(K2 == 0)
- {
- delayms(10); // 软件延时消抖
- if(K2 == 0)
- {
- while(!K2){Display();}; // 等待K1松开
- g_MotorDir = g_MotorDir ^ 0x01;
- FX ^= 1;
- }
- }
- if(K3 == 0) // 加速
- {
- delayms(10); // 软件延时消抖
- if(K3 == 0)
- {
- while(!K3){Display();}; // 等待K1松开
- g_MotorNum++;
- if(g_MotorNum > MotorTabNum)
- g_MotorNum = MotorTabNum;
- }
- }
- if(K4 == 0) // 减速
- {
- delayms(10); // 软件延时消抖
- if(K4 == 0)
- {
- while(!K4){Display();}; // 等待K1松开
- g_MotorNum--;
- if(g_MotorNum < 0)
- g_MotorNum = 0;
- }
- }
- }
- void Init_t0(void)
- TMOD=0x01; //设置定时器0工作方式1后面运行TR位启动
- TH0=(65536-100)/256;
- TL0=(65536-100)%256; //1.5ms 的高电平
- EA=1;
- ET0=1;
- // TR0=1;
- }
- /*******************中断服务程序**********************/
- void PWM0() interrupt 1 //定时器0中断,产生方波
- {
- #if 0
- if(P1_0==1) //如果上个电平为1,则下个低电平的时间为18.5ms
- {
- TH0=(65536-18500)/256; //试过t1=1500;t0=20000-t1;但舵机老是吱吱的响,推测:运算耗时.
- TL0=(65536-18500)%256;
- }
- else //如果上个电平为0,则下个高电平为1.5ms
- {
- TH0=(65536-8000)/256;
- TL0=(65536-8000)%256;
- }
- P1_0=~P1_0;
- #endif
- TH0 = (65535-100)/256;
- TL0 = (65535-100)%256;
- T0_NUM++;
- if(T0_NUM >= MotorTab[g_MotorNum]) // 增加按键g_MotorNum++ 减小按键g_MotorNum--
- {
- T0_NUM = 0;
- CLK=CLK^0x01; // 输出脉冲
- }
- }
- /********延时函数***********************************************************/
- void delayms(xms)
- {
- unsigned int x,y;
- for(x=xms;x>0;x--)
- for(y=110;y>0;y--) ;
- }
- void Display(void)
- {
- unsigned char b1, b2;
- b1=g_MotorNum/10;
- b2=g_MotorNum%10;
- if(FX == 0)
- P0=0x71;//显示F
- else
- P0=0x79;
- SMG1=0;
- delayms(3);
- SMG1=1;
- P0=0x40;
- SMG2=0;
- delayms(3);
- SMG2=1;
- P0=table[b1];
- SMG3=0; //显示十位
- delayms(3);
- SMG3=1;
- P0=table[b2];
- SMG4=0;
- delayms(3); //显示个位
- SMG4=1;
- }
-
复制代码
所有资料51hei提供下载:
基于颜色识别传感器模块设计位移检测机构.doc
(66.5 KB, 下载次数: 9)
|