|
|
激光轉(zhuǎn)速計(jì)，反射式。
須要用反光紙貼到轉(zhuǎn)軸上。
當(dāng)被測零件完成一圈時，來自轉(zhuǎn)速計(jì)的持續(xù)發(fā)射的激光束會反射回來，
傳感器被其光觸發(fā)并向LGT8F328發(fā)送脈沖，
LGT8F328會保持這些脈沖發(fā)生的準(zhǔn)確時間，
并以 RPM 為單位計(jì)算旋轉(zhuǎn)速度並運(yùn)算顯示。
1. 激光二極管LED調(diào)制式發(fā)射頻率200hkz。
2. 激光接收傳感器調(diào)制式+消光座透鏡。
3. 128 x 32'' I2C OLED 顯示器。
4. arduino LGT8F328。
5. 電池3.7V400ma。
6. 反光紙。
制作出來的實(shí)物圖如下：
2
3
4
電路原理圖如下：
1
Arduino源程序如下:
- //CPU Frequency "16MHz"
- #include <Wire.h>
- #include "U8glib.h"
- #include <SimpleKalmanFilter.h>
- SimpleKalmanFilter simpleKalmanFilter(1, 1, 0.1);
- //Nano: SDA (A4); SCL (A5);
- U8GLIB_SSD1306_128X32 u8g(U8G_I2C_OPT_NONE); //0.96
- //U8X8_SSD1306_128X64_NONAME_HW_I2C u8x8(/* reset=*/ U8X8_PIN_NONE);
- unsigned long rpmtime;
- unsigned long rpmtd[8]={};
- unsigned int rpm;
- unsigned int rpmcount=0;
- unsigned int rpm_tcnt=0;
- unsigned int MaxX;
- unsigned int MinX;
- unsigned int Sumrpm=0;
- unsigned int valmap;
- float rpmfloat=0.0;
- float K_rpmfloat=0.0;
- float rpmtime_dy=0.0;
- float kal_rpm=0.0;
- bool rpmslow = 1;
- //------------------------------------------------------
- //電壓表 voltage meter
- float vout = 0.0;
- float vin = 0.0;
- float R1 = 40000.0; // resistance of R1 (40K)
- float R2 = 10000.0; // resistance of R2 (10K)
- int value = 0;
- int analogInput = 1;
- unsigned int voltmap;
- //-------------------------------------------------------
- //顯示時間間隔 DisplayTime
- unsigned long previousBlinkTime;
- unsigned int TimeInterval = 500;
- bool toggleTime=0;
- bool DisplayTime=0;
- //------------------------------------------------
- //lgt328p
- //INTERNAL1V024 , uses a 1.024v reference voltage from inside the board.
- //--------------------------------------------------------------------
- void setup() {
- Serial.begin(115200);
- // pinMode(LED_BUILTIN, OUTPUT);
- analogReference(INTERNAL1V024);//INTERNAL lgt328p
- analogReadResolution(12);
- //----------------------------------------------------------
- //激光LED調(diào)制約200hkz輸出
- noInterrupts();
- TCCR2A =
- 1 << COM2B1 |
- 1 << COM2B0 |
- 1 << WGM21 |
- 1 << WGM20;
- TCCR2B =
- 1 << WGM22 |
- 1 << CS20;
- OCR2A = 80;
- OCR2B = 60;
- pinMode(3, OUTPUT);
- //-----------------------------------------------------------
- //RPM讀取時間
- TCCR1A = 0;
- TCCR1B = 0;
- TCCR1B |= (1 << CS12); //Prescaler 256
- TIMSK1 |= (1 << TOIE1); //enable timer overflow
- pinMode(2, INPUT);
- attachInterrupt(0, RPM2, RISING);//CHANGE
- //-----------------------------------------------------
- u8g.firstPage();
- do {
- display_rpm_stop();
- } while (u8g.nextPage());
- interrupts();
- }
- //-----------------------------------------------------------------
- void loop() {
-
- voltmeter();
- millisTime();
-
- if(DisplayTime){
- if (rpmslow) {
- if(vin<3.3){
- u8g.firstPage();
- do {
- display_Volmeter();
- } while (u8g.nextPage());
- }
- else{
- u8g.firstPage();
- do {
- display_rpm_stop();
- } while (u8g.nextPage());
- }
- }
- else {
- kalman_rpm();
- u8g.firstPage();
- do {
- display_rpm();
- } while (u8g.nextPage() );
- }
- DisplayTime=0;
- }
- //----------------------------------------------------------
- // Serial.print(vout);
- // Serial.print("\t");
- // Serial.print( kal_rpm );
- // Serial.print("\t");
- // Serial.print(K_rpmfloat);
- // Serial.print("\t");
- // Serial.println();
-
- }
- //---------------------------------------------------------
- void kalman_rpm(){
- kal_rpm = simpleKalmanFilter.updateEstimate(rpmtime);
- K_rpmfloat = 120/(kal_rpm/31250.00);
- rpmtime_dy=K_rpmfloat;
- }
- //----------------------------------------------------------
- void voltmeter(){
- // read the value at analog input
- value = analogRead(VCCM);
- vout = (value * 5.0)/4096.0; //lgt328p
- vin = vout;
- unsigned int val = vin*10;
- voltmap = map(val, 30, 40, 0, 50);
- }
- //--------------------------------------------------------
- ISR(TIMER1_OVF_vect) {
- rpmslow = 1;
- }
- //------------------------------------------------------
- void RPM2 () {
- rpmtd[7]=TCNT1;
- TCNT1 = 0;
- rpmslow = 0;
- rpmtd[0]=rpmtd[1];
- rpmtd[1]=rpmtd[2];
- rpmtd[2]=rpmtd[3];
- rpmtd[3]=rpmtd[4];
- rpmtd[4]=rpmtd[5];
- rpmtd[5]=rpmtd[6];
- rpmtd[6]=rpmtd[7];
- rpmtime = (rpmtd[0]+rpmtd[1]+rpmtd[2]+rpmtd[3]+rpmtd[4]+rpmtd[5]+rpmtd[6]+rpmtd[7])/8;
- }
- //----------------------------------------------------------------------------------
- void millisTime() {
- unsigned long currentTime = millis(); // 獲取當(dāng)前時間
- if (currentTime - previousBlinkTime >= TimeInterval) { //如果時間間隔達(dá)到了
- previousBlinkTime = currentTime; // 將檢查時間復(fù)位
- toggleTime = (toggleTime == 1) ? 0 : 1;
- DisplayTime = toggleTime;
- }
- else if (currentTime - previousBlinkTime <= 0) { // 如果millis時間溢出
- previousBlinkTime = currentTime;
- }
- }
- //-----------------------------------------------------------------------------------
- void display_rpm(void) {
- u8g.setFont(u8g_font_ncenR08);
- u8g.drawBox(100,4,2,4);
- u8g.drawFrame(103,0,25,12);
- u8g.setPrintPos(108, 10);
- u8g.println((voltmap*2));
- // u8g.println("%");
- u8g.setPrintPos(104, 32);
- u8g.print("RPM");
- u8g.setFont(u8g_font_ncenR24);
- u8g.setPrintPos(0, 32);
- if(rpmtime_dy>=10000) {u8g.print(rpmtime_dy,0);}
- else{u8g.print(rpmtime_dy,1);}
- }
- //-----------------------------------------------------------
- void display_rpm_stop(void) {
- u8g.setFont(u8g_font_ncenR08);
- u8g.drawBox(100,4,2,4);
- u8g.drawFrame(103,0,25,12);
- u8g.setPrintPos(107, 10);
- // u8g.println((voltmap*2));
- u8g.println(vout,2);
- u8g.setPrintPos(104, 32);
- u8g.print("RPM");
- u8g.setFont(u8g_font_ncenR24);
- u8g.setPrintPos(0, 32);
- if(rpmtime_dy>=10000) {u8g.print(rpmtime_dy,0);}
- else{u8g.print(rpmtime_dy,1);}
- }
- //-----------------------------------------------------------
- //display the voltage
- void display_Volmeter(void) {
- u8g.setFont(u8g_font_ncenR08);
- u8g.drawBox(3,11,5,10);
- u8g.drawBox(10,6,voltmap,20);
- u8g.drawFrame(10,6,50,20);
- u8g.setPrintPos(103, 16);
- u8g.println(vin);
- u8g.println("v");
- if(vin<3.3){
- u8g.setPrintPos(32, 20);
- u8g.println((voltmap*2));
- u8g.println("%");
- u8g.setPrintPos(103,32);
- u8g.print("LOW");
- }
- }
- //------------------------------------------------
|
評分
-
查看全部評分
|
