“SKU:RB-02S103 復(fù)眼傳感器”的版本間的差異

來(lái)自ALSROBOT WiKi
跳轉(zhuǎn)至: 導(dǎo)航、 搜索
(以“ ==產(chǎn)品概述== 復(fù)眼傳感是奧松機(jī)器人推出的復(fù)眼傳感器由許多對(duì)紅外線(xiàn)敏感的晶體管和發(fā)光...”為內(nèi)容創(chuàng)建頁(yè)面)
 
?相關(guān)資料
 
(未顯示1個(gè)用戶(hù)的8個(gè)中間版本)
第7行: 第7行:
  
 
==產(chǎn)品參數(shù)==
 
==產(chǎn)品參數(shù)==
?
 
 
===基本參數(shù)===
 
===基本參數(shù)===
?
1.品名  紅外線(xiàn)復(fù)眼傳感器<br/>
+
#品名  紅外線(xiàn)復(fù)眼傳感器<br/>
?
2.貨號(hào)  RB-02S103<br/>
+
#貨號(hào)  RB-02S103<br/>
?
3.品牌  AlsRobot<br/>
+
#品牌  AlsRobot<br/>
?
4.產(chǎn)地  哈爾濱<br/>
+
#產(chǎn)地  哈爾濱<br/>
?
5.尺寸  50mm×48mm<br/>
+
#尺寸  50mm×48mm<br/>
?
6.重量  9g<br/>
+
#重量  9g<br/>
?
7.包裝  防靜電包裝<br/>
+
#包裝  防靜電包裝<br/>
?
8.固定孔  M3*4個(gè)<br/>
+
#固定孔  M3*4個(gè)<br/>
?
 
+
 
===電氣參數(shù)===
 
===電氣參數(shù)===
 
#產(chǎn)品類(lèi)型:數(shù)字傳感器<br/>
 
#產(chǎn)品類(lèi)型:數(shù)字傳感器<br/>
第33行: 第31行:
  
  
?
===使用方法===
+
==使用方法==
?
1、連接圖 <br/>
+
===example1_Arduino===
?
[[文件:02S10301.png|700px|縮略圖|居中]]
+
* 主要硬件
 +
:Arduino UNO 控制器
 +
:傳感器擴(kuò)展板 V5.0
 +
:復(fù)眼傳感器
 +
:4P 傳感器連接線(xiàn)
 +
:USB 數(shù)據(jù)線(xiàn)
  
?
2、例子程序
+
* 硬件連接 <br/>
?
<pre style='color:blue'>#include "Wire.h"
+
[[文件:02S103101.png|700px|縮略圖|居中]]
?
#include <Servo.h>
+
  
 +
* 示例程序
 +
<pre style='color:blue'>
 +
#include <Wire.h>
 
#define PCF8591 (0x90 >> 1) // I2C bus address  
 
#define PCF8591 (0x90 >> 1) // I2C bus address  
 +
 
byte value0, value1, value2, value3;  
 
byte value0, value1, value2, value3;  
  
?
Servo jjdyz_shang;    
+
void readvalues(){
?
Servo jjdyz_xia;    
+
  Wire.beginTransmission(PCF8591); // wake up PCF8591
?
Servo jjdyz_zhong;   
+
  Wire.write(0x04);  
?
Servo myservo; //創(chuàng)建一個(gè)舵機(jī)控制對(duì)象
+
  Wire.endTransmission();  
 +
   Wire.requestFrom(PCF8591, 5);
 +
  value0=Wire.read();
 +
  value0=Wire.read();  //
 +
  value1=Wire.read();  //右
 +
  value2=Wire.read();  //下
 +
  value3=Wire.read();  //左
 +
  Serial.print("value0= "); Serial.print(value0);Serial.print("\t");
 +
  Serial.print("value1= "); Serial.print(value1);Serial.print("\t");
 +
  Serial.print("value2= "); Serial.print(value2);Serial.print("\t");
 +
  Serial.print("value3= "); Serial.print(value3);Serial.print("\t");
 +
  Serial.println(); 
 +
}
  
?
//const int buttonPin = A0;     // 定義紅外傳感器的接收引腳為模擬A0引腳
+
void setup()
?
//int buttonState = 0;         // 定義紅外傳感器的狀態(tài)緩存
+
{
 +
Wire.begin();  
 +
Serial.begin(9600);  
 +
}
 +
void loop()
 +
{
 +
  readvalues();
 +
}
 +
</pre>
  
?
//定義每個(gè)舵機(jī)的旋轉(zhuǎn)角度的緩存值
+
* 程序效果
?
int pos=0;                   
+
通過(guò)串口監(jiān)視器,即可讀取傳感器返回的數(shù)據(jù)。<br/>
?
int pos1=0;
+
?
int pos2=0;
+
  
?
int gongji = 0;                //定義一個(gè)是否處于攻擊狀態(tài)的標(biāo)志緩存
+
===example2_Arduino===
 +
* 主要硬件
 +
:Arduino UNO 控制器
 +
:Motor Driver Shield 電機(jī)驅(qū)動(dòng)板
 +
:復(fù)眼傳感器
 +
:杜邦線(xiàn)
 +
:USB 數(shù)據(jù)線(xiàn)
 +
:二自由度云臺(tái)
  
?
void jjdyz()  
+
* 硬件連接
 +
[[文件:02S103102.png|700px|縮略圖|居中]]
 +
* 示例程序
 +
<pre style='color:blue'>
 +
#include <Servo.h>
 +
#include <Wire.h>
 +
#define PCF8591 (0x90 >> 1)
 +
#define panPin 10
 +
#define tiltPin 5
 +
 
 +
byte LRscalefactor=10; 
 +
byte UDscalefactor=10; 
 +
int distancemax=80;   
 +
int PanZero=90;       
 +
int TiltZero=90;       
 +
int LRmax=170;         
 +
int LRmin=10;         
 +
 
 +
int UDmax=150;         
 +
int UDmin=30;         
 +
 
 +
int pan=PanZero;
 +
int tilt=TiltZero;
 +
int panscale;
 +
int tiltscale;
 +
int panOld;
 +
int tiltOld;
 +
int distance;
 +
int temp;
 +
 
 +
int updown;
 +
int leftright;
 +
 
 +
Servo panLR;
 +
Servo tiltUD;
 +
byte up_value0, right_value1, down_value2, left_value3;
 +
 
 +
void readvalues(){
 +
  Wire.beginTransmission(PCF8591);
 +
  Wire.write(0x04);
 +
  Wire.endTransmission();
 +
  Wire.requestFrom(PCF8591, 5);
 +
  up_value0=Wire.read();
 +
  up_value0=Wire.read();    //上
 +
  right_value1=Wire.read(); //右
 +
  down_value2=Wire.read();  //下
 +
  left_value3=Wire.read();  //左
 +
  distance=(up_value0+right_value1+down_value2+left_value3)/4;
 +
  Serial.print("up_value0= "); Serial.print(up_value0);Serial.print("\t");
 +
  Serial.print("right_value1= "); Serial.print(right_value1);Serial.print("\t");
 +
  Serial.print("down_value2= "); Serial.print(down_value2);Serial.print("\t");
 +
  Serial.print("left_value3= "); Serial.print(left_value3);Serial.print("\t");
 +
  Serial.print("distance= "); Serial.print(distance);Serial.print("\t");
 +
  Serial.println(); 
 +
}
 +
 
 +
void IRfollow()
 +
{
 +
    if (distance<distancemax)
 +
  {
 +
    ;
 +
//    if (pan>PanZero)pan=pan-1;
 +
//    if (pan<PanZero)pan=pan+1;
 +
//    if (tilt>TiltZero)tilt=tilt-1;
 +
//    if (tilt<TiltZero)tilt=tilt+1;
 +
  }
 +
  else
 +
  {
 +
    panscale=(right_value1+left_value3)*LRscalefactor/10;
 +
    tiltscale=(up_value0+down_value2)*UDscalefactor/10;
 +
 
 +
    if (left_value3>right_value1)
 +
    {
 +
      leftright=(left_value3-right_value1)*15/panscale;
 +
      pan=pan-leftright;
 +
    }
 +
 
 +
    if (left_value3<right_value1)
 +
    {
 +
      leftright=(right_value1-left_value3)*15/panscale;
 +
      pan=pan+leftright;
 +
    }
 +
 
 +
    if (up_value0>down_value2)
 +
    {
 +
      updown=(up_value0-down_value2)*15/tiltscale;
 +
      tilt=tilt-updown;
 +
    }
 +
 
 +
    if (down_value2>up_value0)
 +
    {
 +
      updown=(down_value2-up_value0)*15/tiltscale;
 +
      tilt=tilt+updown;
 +
    }
 +
 
 +
    panOld=pan;
 +
    tiltOld=tilt;
 +
    if (pan<LRmin) pan=LRmin;
 +
    if (pan>LRmax) pan=LRmax;
 +
    if (tilt<UDmin)tilt=UDmin;
 +
    if (tilt>UDmax)tilt=UDmax;
 +
  }
 +
  }
 +
 
 +
void setup()  
 
{  
 
{  
?
  if(value0<2&&value1>value0&&value2>value0&&value3>value0)
+
Wire.begin();  
?
  {   
+
Serial.begin(9600);  
?
      if(gongji == 1)            //處于攻擊狀態(tài)時(shí),但敵人走了,慢慢恢復(fù)到初始位置
+
panLR.attach(panPin);
?
      {
+
panLR.write(PanZero);
?
          for(pos = 40; pos <= 88; pos += 1)  //上面的舵機(jī)恢復(fù)初始位置
+
  tiltUD.attach(tiltPin);
?
          {
+
  tiltUD.write(TiltZero);
?
              jjdyz_shang.write(pos);  
+
?
              delay(300);
+
?
          }
+
?
          gongji = 0;                          //解除攻擊狀態(tài)
+
?
      }
+
?
  }
+
?
  if (value2<2&&value1>value2&&value0>value2&&value3>value2)      //檢測(cè)到前方有獵物,進(jìn)行攻擊,(紅外傳感器返回低電平)
+
?
  {
+
?
      jjdyz_shang.write(70);  
+
?
      delay(200);
+
?
      jjdyz_xia.write(88);  
+
?
      delay(200);
+
?
      jjdyz_zhong.write(40);  
+
?
      delay(200);
+
?
      gongji = 1;                //設(shè)置攻擊狀態(tài)緩存為正在攻擊
+
?
  }
+
?
  if (value1<2&&value0>value1&&value2>value1&&value3>value1)
+
?
  {
+
?
      for(pos1 = 88; pos1 < 160; pos1 += 1) // 從0度到180度運(yùn)動(dòng)
+
?
      {                                                    // 每次步進(jìn)一度
+
?
        jjdyz_xia.write(pos1);       // 指定舵機(jī)轉(zhuǎn)向的角度
+
?
        delay(15);                      // 等待15ms讓舵機(jī)到達(dá)指定位置
+
?
      } 
+
?
      for(pos1 = 160; pos1>=88; pos1-=1)  //從180度到0度運(yùn)動(dòng) 
+
?
      {                               
+
?
        jjdyz_xia.write(pos1);        // 指定舵機(jī)轉(zhuǎn)向的角度
+
?
        delay(15);                        // 等待15ms讓舵機(jī)到達(dá)指定位置
+
?
      } 
+
?
  }
+
?
  if (value3<2&&value0>value3&&value0>value3&&value2>value3)
+
?
  {
+
?
        for(pos1 = 88; pos1>=10; pos1-=1)  //從180度到0度運(yùn)動(dòng) 
+
?
      {                               
+
?
        jjdyz_xia.write(pos1);        // 指定舵機(jī)轉(zhuǎn)向的角度
+
?
        delay(15);                        // 等待15ms讓舵機(jī)到達(dá)指定位置
+
?
      } 
+
?
      for(pos1 = 10; pos1 < 88; pos1 += 1) // 從0度到180度運(yùn)動(dòng)
+
?
      {                                                    // 每次步進(jìn)一度
+
?
        jjdyz_xia.write(pos1);       // 指定舵機(jī)轉(zhuǎn)向的角度
+
?
        delay(15);                      // 等待15ms讓舵機(jī)到達(dá)指定位置
+
?
      }   
+
?
  }
+
?
  else
+
?
  {
+
?
      jjdyz_shang.write(88);
+
?
      delay(15);
+
?
      jjdyz_xia.write(88);
+
?
      delay(15);
+
?
      jjdyz_zhong.write(88);
+
?
      delay(15);
+
?
  }
+
 
}  
 
}  
 +
 +
void loop()
 +
{
 +
  panLR.write(pan);
 +
  tiltUD.write(tilt);
 +
  readvalues();
 +
  IRfollow();
 +
}
 +
</pre>
 +
* 程序效果
 +
 +
===example3_Arduino & Processing===
 +
* 主要硬件
 +
:Arduino UNO 控制器
 +
: 傳感器擴(kuò)展板 V5.0
 +
:復(fù)眼傳感器
 +
:杜邦線(xiàn)
 +
:USB 數(shù)據(jù)線(xiàn)
 +
 +
* 硬件連接 <br/>
 +
[[文件:02S103101.png|700px|縮略圖|居中]]
 +
 +
* 示例程序 -- Processing
 +
<pre style='color:blue'>
 +
import processing.serial.*;   
 +
Serial myPort;               
 +
int sWidth=640, sHeight=640;
 +
float xHairLength = 200;
 +
float xpos, ypos;         
 +
 +
void setup()
 +
{
 +
  size(640,  640);
 +
  println(Serial.list());
 +
  myPort = new Serial(this, Serial.list()[0], 9600);
 +
  smooth();
 +
}
 +
 +
void draw()
 +
{
 +
  background(255);
 +
  ellipse((640/2)+xpos, (640/2)+ypos, 20, 20);
 +
  stroke(0);
 +
  line((sWidth/2)-250, sHeight/2, (sWidth/2)+250, sHeight/2);
 +
  stroke(0);
 +
  line(sWidth/2, (sHeight/2)-250, sWidth/2, (sHeight/2)+250);
 +
}
 +
 +
void serialEvent(Serial myPort)
 +
{
 +
  String myString = myPort.readStringUntil('\n');
 +
  if(myString != null)
 +
  {
 +
    myString = trim(myString);
 +
    int sensors[] = int(split(myString, ','));
 +
  for (int sensorNum = 0; sensorNum < sensors.length; sensorNum++)
 +
  {
 +
      print("Sensor " + sensorNum + ": " + sensors[sensorNum] + "\t");
 +
  }
 +
    println();
 +
  if (sensors.length > 1)
 +
  {
 +
      float left,right,up,down;
 +
      left = map(sensors[3], 0,1000,0,width);
 +
      right = map(sensors[1], 0,1000,0,height); 
 +
      up = map(sensors[0], 0,1000,0,width);
 +
      down = map(sensors[2], 0,1000,0,height);
 +
      xpos=right-left;
 +
      ypos=up-down;
 +
    }
 +
  }
 +
  }
 +
</pre>
 +
 +
* 示例程序 -- arduino
 +
<pre style='color:blue'>
 +
#include <Wire.h>
 +
#define PCF8591 (0x90 >> 1) // I2C bus address
 +
 +
byte value0, value1, value2, value3;
  
 
void readvalues(){  
 
void readvalues(){  
 
   Wire.beginTransmission(PCF8591); // wake up PCF8591  
 
   Wire.beginTransmission(PCF8591); // wake up PCF8591  
?
   Wire.write(0x04); // control byte - read ADC0 then auto-increment
+
   Wire.write(0x04);  
?
   Wire.endTransmission(); // end tranmission
+
   Wire.endTransmission();  
 
   Wire.requestFrom(PCF8591, 5);  
 
   Wire.requestFrom(PCF8591, 5);  
 +
  value0=Wire.read();
 
   value0=Wire.read();  //上  
 
   value0=Wire.read();  //上  
?
  value0=Wire.read();  //上
+
   value1=Wire.read();  //右  
?
   value1=Wire.read();  // 右  
+
 
   value2=Wire.read();  //下  
 
   value2=Wire.read();  //下  
 
   value3=Wire.read();  //左  
 
   value3=Wire.read();  //左  
?
   Serial.print(value0); Serial.print(" ");  
+
   Serial.print(value0);Serial.print(",");
?
   Serial.print(value1); Serial.print(" ");  
+
   Serial.print(value1);Serial.print(",");
?
   Serial.print(value2); Serial.print(" ");  
+
   Serial.print(value2);Serial.print(",");
?
   Serial.print(value3); Serial.print(" ");
+
   Serial.print(value3);
?
  Serial.println();   
+
  Serial.print("\n");   
 
}  
 
}  
  
第140行: 第304行:
 
{  
 
{  
 
  Wire.begin();  
 
  Wire.begin();  
?
  gongji = 0; 
+
  Serial.begin(9600);  
?
jjdyz_shang.attach(10);          //上面的舵機(jī)引腳為2
+
?
jjdyz_xia.attach(6);        //下面的舵機(jī)引腳為4
+
?
jjdyz_zhong.attach(7);        // 中間的舵機(jī)引腳為3
+
?
//三路舵機(jī)初始化
+
?
jjdyz_shang.write(88);
+
?
delay(15);
+
?
jjdyz_xia.write(88);
+
?
delay(15);
+
?
jjdyz_zhong.write(88);
+
?
delay(15);
+
?
Serial.begin(9600);  
+
 
}  
 
}  
 
void loop()  
 
void loop()  
 
{  
 
{  
 
   readvalues();  
 
   readvalues();  
?
  jjdyz();
+
}
?
}</pre>
+
</pre>
  
?
說(shuō)明:通過(guò)串口監(jiān)視器,即可讀取傳感器返回的數(shù)據(jù)。<br/>
+
* 程序效果
 +
[[文件:02S103100.png|600px|縮略圖|居中]]
  
?
==產(chǎn)品相關(guān)推薦==
+
==相關(guān)資料==
 
[[文件:erweima.png|230px|無(wú)框|右]]
 
[[文件:erweima.png|230px|無(wú)框|右]]
?
===購(gòu)買(mǎi)地址===
+
* 產(chǎn)品資料
?
[http://www.alsrobot.cn/goods-816.html 復(fù)眼傳感器]
+
下載鏈接: https://pan.baidu.com/s/1wPQh9f7bCNVx92ODYYXKug
?
===相關(guān)學(xué)習(xí)資料===
+
提取碼:kgjt
?
[http://www.makerspace.cn/portal.php 奧松機(jī)器人技術(shù)論壇]
+
* 產(chǎn)品購(gòu)買(mǎi)鏈接:http://www.alsrobot.cn/goods-816.html

2021年7月27日 (二) 17:45的最后版本

02S10300.png


目錄

產(chǎn)品概述

復(fù)眼傳感是奧松機(jī)器人推出的復(fù)眼傳感器由許多對(duì)紅外線(xiàn)敏感的晶體管和發(fā)光二極管組成。它可以追蹤20厘米范圍內(nèi)物體的移動(dòng)。盡管傳感器是一個(gè)整體,但是你依然可以讀取到每一個(gè)紅外線(xiàn)(IR)光敏晶體管的信息。復(fù)眼傳感器采用IIC通訊方式,數(shù)據(jù)傳輸更加簡(jiǎn)便。
校正周?chē)饩€(xiàn)是通過(guò)關(guān)閉IR LED和比較數(shù)值完成的。如果要改善從復(fù)眼中讀取的數(shù)值,你必須要進(jìn)行校準(zhǔn)。最好等到晚上當(dāng)IR光線(xiàn)不存在時(shí)進(jìn)行。注意紅外線(xiàn)可以穿過(guò)關(guān)閉的百合窗,所以如果你不想等到晚上,可以去地下室,或者是沒(méi)有窗戶(hù)的房間,這樣就可以測(cè)量數(shù)值了。將一張紙置于傳感器的前方(約20厘米遠(yuǎn)),觀(guān)察每支引腳的數(shù)值差異。使用紙張時(shí)數(shù)值差異不大(+/- 100)。如果某個(gè)數(shù)值過(guò)高,可以使用不透明的膠帶或熱收縮膜阻擋部分紅外線(xiàn)。如果數(shù)值過(guò)低,則阻擋一部分分散到其他傳感器上的紅外線(xiàn)。

產(chǎn)品參數(shù)

基本參數(shù)

  1. 品名 紅外線(xiàn)復(fù)眼傳感器
  2. 貨號(hào) RB-02S103
  3. 品牌 AlsRobot
  4. 產(chǎn)地 哈爾濱
  5. 尺寸 50mm×48mm
  6. 重量 9g
  7. 包裝 防靜電包裝
  8. 固定孔 M3*4個(gè)

電氣參數(shù)

  1. 產(chǎn)品類(lèi)型:數(shù)字傳感器
  2. 接口類(lèi)型:4P防插反接口
  3. 信號(hào)類(lèi)型:IIC數(shù)字信號(hào)
  4. 工作電壓:3.0V~5.0V
  5. 工作電流:100mA
  6. 引腳定義:+ 電源正;- 電源負(fù);SDA IIC數(shù)據(jù)引腳;SCL IIC時(shí)鐘引腳
  7. 連接線(xiàn): 4P 傳感器連接線(xiàn)
  8. 檢測(cè)范圍:0~20cm
  9. 工作溫度:-20℃~70℃
  10. 測(cè)試范圍:上、下、左、右輸出四路模擬值范圍(0-255)
  11. 固定孔:M3*4個(gè)
  12. 產(chǎn)品尺寸(mm):50mm*48mm


使用方法

example1_Arduino

  • 主要硬件
Arduino UNO 控制器
傳感器擴(kuò)展板 V5.0
復(fù)眼傳感器
4P 傳感器連接線(xiàn)
USB 數(shù)據(jù)線(xiàn)
  • 硬件連接
02S103101.png
  • 示例程序
#include <Wire.h> 
#define PCF8591 (0x90 >> 1) // I2C bus address 

byte value0, value1, value2, value3; 

void readvalues(){ 
  Wire.beginTransmission(PCF8591); // wake up PCF8591 
  Wire.write(0x04); 
  Wire.endTransmission(); 
  Wire.requestFrom(PCF8591, 5); 
  value0=Wire.read();
  value0=Wire.read();   //上 
  value1=Wire.read();   //右 
  value2=Wire.read();   //下 
  value3=Wire.read();   //左 
  Serial.print("value0= "); Serial.print(value0);Serial.print("\t");
  Serial.print("value1= "); Serial.print(value1);Serial.print("\t");
  Serial.print("value2= "); Serial.print(value2);Serial.print("\t");
  Serial.print("value3= "); Serial.print(value3);Serial.print("\t");
  Serial.println();   
} 

void setup() 
{ 
 Wire.begin(); 
 Serial.begin(9600); 
} 
void loop() 
{ 
   readvalues(); 
}
  • 程序效果

通過(guò)串口監(jiān)視器,即可讀取傳感器返回的數(shù)據(jù)。

example2_Arduino

  • 主要硬件
Arduino UNO 控制器
Motor Driver Shield 電機(jī)驅(qū)動(dòng)板
復(fù)眼傳感器
杜邦線(xiàn)
USB 數(shù)據(jù)線(xiàn)
二自由度云臺(tái)
  • 硬件連接
02S103102.png
  • 示例程序
#include <Servo.h>
#include <Wire.h> 
#define PCF8591 (0x90 >> 1)
#define panPin 10
#define tiltPin 5 

byte LRscalefactor=10;  
byte UDscalefactor=10;  
int distancemax=80;    
int PanZero=90;        
int TiltZero=90;         
int LRmax=170;          
int LRmin=10;           

int UDmax=150;          
int UDmin=30;           

int pan=PanZero;
int tilt=TiltZero;
int panscale;
int tiltscale;
int panOld;
int tiltOld;
int distance;
int temp;

int updown;
int leftright;

Servo panLR;
Servo tiltUD;
byte up_value0, right_value1, down_value2, left_value3; 

void readvalues(){ 
  Wire.beginTransmission(PCF8591);
  Wire.write(0x04); 
  Wire.endTransmission(); 
  Wire.requestFrom(PCF8591, 5); 
  up_value0=Wire.read();
  up_value0=Wire.read();    //上 
  right_value1=Wire.read(); //右 
  down_value2=Wire.read();  //下 
  left_value3=Wire.read();  //左 
  distance=(up_value0+right_value1+down_value2+left_value3)/4;
  Serial.print("up_value0= "); Serial.print(up_value0);Serial.print("\t");
  Serial.print("right_value1= "); Serial.print(right_value1);Serial.print("\t");
  Serial.print("down_value2= "); Serial.print(down_value2);Serial.print("\t");
  Serial.print("left_value3= "); Serial.print(left_value3);Serial.print("\t");
  Serial.print("distance= "); Serial.print(distance);Serial.print("\t");
  Serial.println();   
} 

void IRfollow()
{
    if (distance<distancemax)
  {
    ;
//    if (pan>PanZero)pan=pan-1;
//    if (pan<PanZero)pan=pan+1;
//    if (tilt>TiltZero)tilt=tilt-1;
//    if (tilt<TiltZero)tilt=tilt+1;
  }
  else
  {
    panscale=(right_value1+left_value3)*LRscalefactor/10;
    tiltscale=(up_value0+down_value2)*UDscalefactor/10; 

    if (left_value3>right_value1)
    {
      leftright=(left_value3-right_value1)*15/panscale;
      pan=pan-leftright;
    }

    if (left_value3<right_value1)
    {
      leftright=(right_value1-left_value3)*15/panscale;
      pan=pan+leftright;
    }

    if (up_value0>down_value2)
    {
      updown=(up_value0-down_value2)*15/tiltscale;
      tilt=tilt-updown;
    }

    if (down_value2>up_value0)
    {
      updown=(down_value2-up_value0)*15/tiltscale;
      tilt=tilt+updown;
    }

    panOld=pan;
    tiltOld=tilt;
    if (pan<LRmin) pan=LRmin;
    if (pan>LRmax) pan=LRmax;
    if (tilt<UDmin)tilt=UDmin;
    if (tilt>UDmax)tilt=UDmax;
  }
  }

void setup() 
{ 
 Wire.begin(); 
 Serial.begin(9600); 
 panLR.attach(panPin);
 panLR.write(PanZero);
 tiltUD.attach(tiltPin);
 tiltUD.write(TiltZero);
} 

void loop() 
{
  panLR.write(pan);
  tiltUD.write(tilt); 
  readvalues(); 
  IRfollow();
}
  • 程序效果

example3_Arduino & Processing

  • 主要硬件
Arduino UNO 控制器
傳感器擴(kuò)展板 V5.0
復(fù)眼傳感器
杜邦線(xiàn)
USB 數(shù)據(jù)線(xiàn)
  • 硬件連接
02S103101.png
  • 示例程序 -- Processing
import processing.serial.*;     
Serial myPort;                 
int sWidth=640, sHeight=640;
float xHairLength = 200;
float xpos, ypos;           

void setup()
{
  size(640,  640);
  println(Serial.list());
  myPort = new Serial(this, Serial.list()[0], 9600);
  smooth();
}

void draw()
{
  background(255);
  ellipse((640/2)+xpos, (640/2)+ypos, 20, 20);
  stroke(0);
  line((sWidth/2)-250, sHeight/2, (sWidth/2)+250, sHeight/2);
  stroke(0);
  line(sWidth/2, (sHeight/2)-250, sWidth/2, (sHeight/2)+250);
}

void serialEvent(Serial myPort)
{ 
  String myString = myPort.readStringUntil('\n');
  if(myString != null)
  {
    myString = trim(myString);
    int sensors[] = int(split(myString, ','));
  for (int sensorNum = 0; sensorNum < sensors.length; sensorNum++) 
  {
      print("Sensor " + sensorNum + ": " + sensors[sensorNum] + "\t"); 
  }
    println();
  if (sensors.length > 1) 
  {
      float left,right,up,down;
      left = map(sensors[3], 0,1000,0,width);
      right = map(sensors[1], 0,1000,0,height);   
      up = map(sensors[0], 0,1000,0,width);
      down = map(sensors[2], 0,1000,0,height);
      xpos=right-left;
      ypos=up-down;
    }
  }
  }
  • 示例程序 -- arduino
#include <Wire.h> 
#define PCF8591 (0x90 >> 1) // I2C bus address 

byte value0, value1, value2, value3; 

void readvalues(){ 
  Wire.beginTransmission(PCF8591); // wake up PCF8591 
  Wire.write(0x04); 
  Wire.endTransmission(); 
  Wire.requestFrom(PCF8591, 5); 
  value0=Wire.read();
  value0=Wire.read();   //上 
  value1=Wire.read();   //右 
  value2=Wire.read();   //下 
  value3=Wire.read();   //左 
  Serial.print(value0);Serial.print(",");
  Serial.print(value1);Serial.print(",");
  Serial.print(value2);Serial.print(",");
  Serial.print(value3);
  Serial.print("\n");   
} 

void setup() 
{ 
 Wire.begin(); 
 Serial.begin(9600); 
} 
void loop() 
{ 
   readvalues(); 
}
  • 程序效果
02S103100.png

相關(guān)資料

Erweima.png
  • 產(chǎn)品資料

下載鏈接: https://pan.baidu.com/s/1wPQh9f7bCNVx92ODYYXKug 提取碼:kgjt