Lab 7 Analog Lotus Nano Bot

การติดตั้งเซนเซอร์แทร็กเส้น Analog กับบอร์ด Lotus Nano Bot

หลักการวัดค่าแสงการสะท้อน

ค่าเฉลี่ย = (ค่าสีขาว + ค่าสีดำ)/2

ตัวอย่างการใช้งานโค้ดวัดแสง 4 ช่องผ่านไลบรารี่มาตรฐาน

Arduino IDE Code

//////////////////ผนวกไลบรารี่จอแสดงผล//////////////////

#include <Wire.h>

#include <SPI.h>

#include <Adafruit_GFX.h>

#include <Adafruit_SSD1306.h>

Adafruit_SSD1306 OLED(-1);

//////////////////////////////////////////////////////

void setup() {

OLED.begin(SSD1306_SWITCHCAPVCC, 0x3C); // กำหนดแอดเดรสของพอร์ตจอเป็น 0x3C (for the 128x64)

}

void loop() {

/////////// ตั้งค่าเซนเซอร์ตามการอ่านพอร์ตอนาล็อก S0,S1,S2,S3

int s0 = analogRead(0);

int s1 = analogRead(1);

int s2 = analogRead(2);

int s3 = analogRead(3);

////////////////////////////////////////////////////////

OLED.clearDisplay();

OLED.setTextColor(WHITE, BLACK); //สีอักษรเป็นสีขาว ,พื้นหลังดำ

OLED.setCursor(0, 0); // เซตตำแหน่ง 0,0

OLED.setTextSize(1); // เซตขนาดอักษรมีขนาดเป็น 1

OLED.print(" S0 = "); OLED.println(s0); // แสดงค่าเซนเซอร์ S0

OLED.print(" S1 = "); OLED.println(s1); // แสดงค่าเซนเซอร์ S1

OLED.print(" S2 = "); OLED.println(s2); // แสดงค่าเซนเซอร์ S2

OLED.print(" S3 = "); OLED.println(s3); // แสดงค่าเซนเซอร์ S3

OLED.display();

delay(100); // เปลี่ยนค่าเซนเซอร์ทุก 0.1 วินาที

}

ตัวอย่างการใช้งานโค้ดวัดแสง 4 ช่องผ่านไลบรารี่ LotusNanoBot.h

Arduino IDE Code Library LotusNanoBot.h

#include <LotusNanoBot.h>

void setup() {

oledset(); // เซตค่าจอ OLED

}

void loop() {

oleddel(); // ลบการแสดงบนหน้าจอ

oledp(0,0,1," S0 = ");oledlnp(inA(0)); // แสดงค่าอนาล็อกที่พอร์ต A0

oledp(" S1 = ");oledlnp(inA(1)); // แสดงค่าอนาล็อกที่พอร์ต A1

oledp(" S2 = ");oledlnp(inA(2)); // แสดงค่าอนาล็อกที่พอร์ต A2

oledp(" S3 = ");oledlnp(inA(3)); // แสดงค่าอนาล็อกที่พอร์ต A3

oledplay();

delay(100); // เปลี่ยนค่าเซนเซอร์ทุก 0.1 วินาที

}

ตัวอย่างวีดีโอการทำงาน