机器人控制器编程实践指导书旧版-实践二 传感器(模拟量)

Posted zhangrelay

tags:

篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了机器人控制器编程实践指导书旧版-实践二 传感器(模拟量)相关的知识,希望对你有一定的参考价值。

适用于UNO/2560/DUE/ESP8266/ESP32,2021年之前使用版本。

 


实践二 传感器(模拟量)

2.1 实践目的

  • 掌握Arduino[ESP32]与红外避障传感器、温湿度传感器、烟雾传感器、火焰传感器、人体红外感应传感器、超声波传感器模块的测试。

2.2 实践设备

  • PC机一台
  • Arduino[ESP32]开发板及配件等
  • 万用表和示波器等

2.3 实践原理

由于模拟传感器种类繁多,但是代码和原理基本相似,只给出一些典型案例介绍。

  • 初级:

压力传感器:

示意图

参考代码:

int sensorPin = 2; // select the input pin for the potentiometer

int ledPin = 13; // select the pin for the LED

int sensorValue = 0; // variable to store the value coming from the sensor

void setup()

// declare the ledPin as an OUTPUT:

pinMode(ledPin, OUTPUT);

void loop()

// read the value from the sensor:

sensorValue = analogRead(sensorPin);

// turn the ledPin on

digitalWrite(ledPin, HIGH);

// stop the program for <sensorValue> milliseconds:

delay(sensorValue);

// turn the ledPin off:

digitalWrite(ledPin, LOW);

// stop the program for for <sensorValue> milliseconds:

delay(sensorValue);

  • 中级:

温度传感器LM35:

示意图

参考代码:

float temperature; // stores the temperature

int sensorPin = 0; // pin where the sensor is connected to

int startTemp=20;

// the start temperature > at this temperature, no LED will light up

void setup()

Serial.begin(9600); // initialisation of the serial connection

for (int i=2;i<8; i++) // output channels from 2 to 7

pinMode(i,OUTPUT); // pin is a output

void loop()

temperature = analogRead(sensorPin); // reading analog sensor value

temperature = temperature*0.488; // correcting to °C

for (int i=0;i<8; i++)

if (temperature>((i*2)+startTemp)) // switch LED on, if temperature is higher than starttemp + (LED number*2)

digitalWrite(i,HIGH);

else

digitalWrite(i,LOW); // else, switch it off

Serial.print(temperature);Serial.println(" °C"); // send the temperarue to the serial monitor

delay(500); // just wait a little

  • 高级(ROS选修):

模拟量端口数据采集:

#if (Arduino[ESP32] >= 100)

 #include <Arduino[ESP32].h>

#else

 #include <WProgram.h>

#endif

#include <ros.h>

#include <rosserial_Arduino[ESP32]/Adc.h>

ros::NodeHandle nh;

rosserial_Arduino[ESP32]::Adc adc_msg;

ros::Publisher p("adc", &adc_msg);

void setup()

  pinMode(13, OUTPUT);

  nh.initNode();

  nh.advertise(p);

//We average the analog reading to elminate some of the noise

int averageAnalog(int pin)

  int v=0;

  for(int i=0; i<4; i++) v+= analogRead(pin);

  return v/4;

long adc_timer;

void loop()

  adc_msg.adc0 = averageAnalog(0);

  adc_msg.adc1 = averageAnalog(1);

  adc_msg.adc2 = averageAnalog(2);

  adc_msg.adc3 = averageAnalog(3);

  adc_msg.adc4 = averageAnalog(4);

  adc_msg.adc5 = averageAnalog(5);

  p.publish(&adc_msg);

  nh.spinOnce();

2.4 实践内容

阅读2.3中示意图、原理图和代码,在Arduino[ESP32]平台上完成实践。

2.5 实践问题

2.5.1 依据环境光亮度(光敏电阻)控制LED灯闪烁频率或亮度

在此示例中,光电管值通过“模拟输入”引脚读取。 然后使用这些值来控制 LED 的闪烁速率。

使用万用表,检查不同光照条件下光电管的最小和最大电阻。然后用Axel-Benz公式计算电阻值:Rref = sqrt(Rmin*Rmax)

示意图

写出实现上述功能核心代码,并下载到Arduino[ESP32]验证(此题类似手机屏幕亮度自动调节)。

// These constants won't change. They're used to give names to the pins used:

const int analogInPin = A0;  // Analog input pin that the potentiometer is attached to

const int analogOutPin = 9; // Analog output pin that the LED is attached to

int sensorValue = 0;        // value read from the pot

int outputValue = 0;        // value output to the PWM (analog out)

void setup()

  // initialize serial communications at 9600 bps:

  Serial.begin(9600);

void loop()

  // read the analog in value:

  sensorValue = analogRead(analogInPin);

  // map it to the range of the analog out:

  outputValue = map(sensorValue, 0, 1023, 0, 255);

  // change the analog out value:

  analogWrite(analogOutPin, outputValue);

  // print the results to the Serial Monitor:

  Serial.print("sensor = ");

  Serial.print(sensorValue);

  Serial.print("\\t output = ");

  Serial.println(outputValue);

  // wait 2 milliseconds before the next loop for the analog-to-digital

  // converter to settle after the last reading:

  delay(2);

2.5.2 依据距离远近依次点亮LED

简单的停车助手

测量到附近物体的距离并显示为 LED 图表。

写出实现上述功能核心代码,并下载到Arduino[ESP32]验证。

#include <ros.h>

#include <std_msgs/Empty.h>

ros::NodeHandle nh;

void messageCb( const std_msgs::Empty& toggle_msg)

  digitalWrite(13, HIGH-digitalRead(13));   // blink the led

ros::Subscriber<std_msgs::Empty> sub("toggle_led", &messageCb );

void setup()

  pinMode(13, OUTPUT);

  nh.initNode();

  nh.subscribe(sub);

void loop()

  nh.spinOnce();

  delay(1);

2.6 实践总结

回顾本次实践,遇到哪些问题,如何解决,经验和启发有哪些?

DHT11是温湿度传感器,ESP32可以通过单总线读取DHT11,使用ESP32开发板,连接四路DHT11,发现,读值是正常的。

评分:                                                         

                                                               


以上是关于机器人控制器编程实践指导书旧版-实践二 传感器(模拟量)的主要内容,如果未能解决你的问题,请参考以下文章

机器人控制器编程实践指导书旧版-实践六 LCD液晶显示(点阵)

机器人控制器编程实践指导书旧版-实践八 机器人综合设计

机器人控制器编程实践指导书旧版-实践一 LED灯(数字量)

机器人控制器编程实践指导书旧版-实践五 数字舵机(执行器)

机器人控制器编程实践指导书旧版-实践三 直流电机(执行器)

机器人控制器编程实践指导书旧版-实践四 步进电机(执行器)