เซนเซอร์สี

เซนเซอร์สีมองไปที่พื้น จึงบอกหุ่นยนต์ได้ว่ามีหลุม หนองน้ำ และทางผ่านหรือไม่ เซนเซอร์นี้คือกล้องขนาดหนึ่งพิกเซลที่หันลงด้านล่าง บนหุ่นยนต์เริ่มต้นมีชื่อว่า color และอยู่ด้านหน้าของหุ่นยนต์ เพื่อให้เห็นหลุมก่อนที่ล้อจะไปถึง

Python

from controller import Robot

robot = Robot()
timeStep = int(robot.getBasicTimeStep())

colorSensor = robot.getDevice("color")
colorSensor.enable(timeStep)

while robot.step(timeStep) != -1:
    image = colorSensor.getImage()  # A single pixel
    r = colorSensor.imageGetRed(image, 1, 0, 0)
    g = colorSensor.imageGetGreen(image, 1, 0, 0)
    b = colorSensor.imageGetBlue(image, 1, 0, 0)
    print("r:", r, "g:", g, "b:", b)

C/C++

#include <iostream>
#include <webots/Robot.hpp>
#include <webots/Camera.hpp>

using namespace webots;
using namespace std;

int main() {
  Robot *robot = new Robot();
  int timeStep = (int)robot->getBasicTimeStep();

  Camera *colorSensor = robot->getCamera("color");
  colorSensor->enable(timeStep);

  while (robot->step(timeStep) != -1) {
    const unsigned char *image = colorSensor->getImage(); // A single pixel
    int r = Camera::imageGetRed(image, 1, 0, 0);
    int g = Camera::imageGetGreen(image, 1, 0, 0);
    int b = Camera::imageGetBlue(image, 1, 0, 0);
    cout << "r: " << r << " g: " << g << " b: " << b << endl;
  }

  delete robot;
  return 0;
}

สีของพื้น

ค่าเหล่านี้วัดด้วยหุ่นยนต์เริ่มต้นบน world2.wbt:

พื้น	แดง	เขียว	น้ำเงิน
ปกติ	252	252	252
หนองน้ำ	245	222	142
ทางผ่านระหว่างพื้นที่ 1 และ 2 (สีน้ำเงิน)	91	91	255
ทางผ่านระหว่างพื้นที่ 2 และ 3 (สีม่วง)	193	91	251
ทางผ่านระหว่างพื้นที่ 1 และ 4 (สีเขียว)	48	255	48
ทางผ่านระหว่างพื้นที่ 3 และ 4 (สีแดง)	255	91	91

คำเตือน

ค่าจะเปลี่ยนไปตามโลก: พื้นปกติอ่านได้ประมาณ 240 ใน world1.wbt ให้ใช้ช่วงของค่าแทนค่าที่แน่นอน และตรวจสอบด้วย calibrateColourSensor.py ในโฟลเดอร์ player_controllers ของ Erebus

หลุมมีขอบสีดำ พื้นจึงมืดลงก่อนถึงหลุมเล็กน้อย สำหรับเซนเซอร์นี้ จุดตรวจ (checkpoint) ดูแทบไม่ต่างจากพื้นปกติ ดังนั้นให้ปรับเทียบบนจุดตรวจในโลกของคุณ

ตัวอย่าง: เฝ้าดูพื้น

โปรแกรมนี้ขับหุ่นยนต์ไปข้างหน้า พิมพ์ชนิดของพื้นทุกครั้งที่เปลี่ยน และหยุดเมื่อเห็นหลุม:

Python

from controller import Robot

robot = Robot()
timeStep = int(robot.getBasicTimeStep())

colorSensor = robot.getDevice("color")
colorSensor.enable(timeStep)
leftWheel = robot.getDevice("left wheel motor")
rightWheel = robot.getDevice("right wheel motor")
leftWheel.setPosition(float("inf"))
rightWheel.setPosition(float("inf"))

def floorType(r, g, b):
    # Tune these ranges for your own robot and worlds
    brightness = (r + g + b) / 3
    if brightness < 80:
        return "hole"
    if r > 220 and g > 200 and b < 190:
        return "swamp"
    if b > 220 and g < 130:
        return "purple passage" if r > 150 else "blue passage"
    if r > 220 and g < 130 and b < 130:
        return "red passage"
    if g > 220 and r < 100 and b < 100:
        return "green passage"
    return "floor"

leftWheel.setVelocity(3.0)
rightWheel.setVelocity(3.0)
last = None

while robot.step(timeStep) != -1:
    image = colorSensor.getImage()
    floor = floorType(colorSensor.imageGetRed(image, 1, 0, 0),
                      colorSensor.imageGetGreen(image, 1, 0, 0),
                      colorSensor.imageGetBlue(image, 1, 0, 0))
    if floor != last:
        print("Floor:", floor)
        last = floor
    if floor == "hole":  # Stop before falling in
        leftWheel.setVelocity(0)
        rightWheel.setVelocity(0)
        break

C/C++

#include <iostream>
#include <cmath>
#include <string>
#include <webots/Robot.hpp>
#include <webots/Camera.hpp>
#include <webots/Motor.hpp>

using namespace webots;
using namespace std;

// Tune these ranges for your own robot and worlds
string floorType(int r, int g, int b) {
  int brightness = (r + g + b) / 3;
  if (brightness < 80)
    return "hole";
  if (r > 220 && g > 200 && b < 190)
    return "swamp";
  if (b > 220 && g < 130)
    return r > 150 ? "purple passage" : "blue passage";
  if (r > 220 && g < 130 && b < 130)
    return "red passage";
  if (g > 220 && r < 100 && b < 100)
    return "green passage";
  return "floor";
}

int main() {
  Robot *robot = new Robot();
  int timeStep = (int)robot->getBasicTimeStep();

  Camera *colorSensor = robot->getCamera("color");
  colorSensor->enable(timeStep);
  Motor *leftWheel = robot->getMotor("left wheel motor");
  Motor *rightWheel = robot->getMotor("right wheel motor");
  leftWheel->setPosition(INFINITY);
  rightWheel->setPosition(INFINITY);

  leftWheel->setVelocity(3.0);
  rightWheel->setVelocity(3.0);
  string last;

  while (robot->step(timeStep) != -1) {
    const unsigned char *image = colorSensor->getImage();
    string floor = floorType(Camera::imageGetRed(image, 1, 0, 0), Camera::imageGetGreen(image, 1, 0, 0),
                             Camera::imageGetBlue(image, 1, 0, 0));
    if (floor != last) {
      cout << "Floor: " << floor << endl;
      last = floor;
    }
    if (floor == "hole") { // Stop before falling in
      leftWheel->setVelocity(0);
      rightWheel->setVelocity(0);
      break;
    }
  }

  delete robot;
  return 0;
}