Advertisement
timor2542

[4 DOF Robot Arm Keyestudio][Lab 06][i-Duino UNO R3B] Test Joystick Value on Serial Monitor

Aug 2nd, 2021
1,332
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. const int left_X = A3; // กำหนดขาสัญญาณ Joystick ด้านซ้ายแกน X คือขา A3
  2. const int left_Y = A4;  // กำหนดขาสัญญาณ Joystick ด้านซ้ายแกน X คือขา A4
  3. const int left_key = 8; // กำหนดขาสัญญาณ Joystick ด้านซ้ายแกน Z (ปุ่มกดลง) คือขา 8
  4.  
  5. const int right_X = A2; // กำหนดขาสัญญาณ Joystick ด้านขวาแกน X คือขา A2
  6. const int right_Y = A5; // กำหนดขาสัญญาณ Joystick ด้านขวาแกน Y คือขา A5
  7. const int right_key = 7; // กำหนดขาสัญญาณ Joystick ด้านขวาแกน Z (ปุ่มกดลง) คือขา 7
  8.  
  9. void setup()
  10. {
  11.   pinMode(left_key, INPUT);  //กำหนดขาสัญญาณ Joystick ด้านซ้ายแกน Z (ปุ่มกดลง) เป็นอินพุตดิจิตอล
  12.   pinMode(right_key, INPUT); //กำหนดขาสัญญาณ Joystick ด้านขวาแกน Z (ปุ่มกดลง) เป็นอินพุตดิจิตอล
  13.   Serial.begin(9600); // เปิดการสื่อสารอนุกรมระหว่างคอมพิวเตอร์กับบอร์ด i-Duino R3B อัตราบิตการรับส่งข้อมูล 9600 baud
  14. }
  15.  
  16. void loop()
  17. {
  18.   int x1,y1,z1;  // กำหนดตัวแปร เพื่อใช้เก็บค่าจากการอ่านค่าสัญญาณของ Joystick
  19.   int x2,y2,z2;
  20.  
  21.   x1 = analogRead(left_X); // อ่านค่าสัญญาณแอนาล็อกจากแกน X ของ Joystick ด้านซ้าย
  22.   y1 = analogRead(left_Y); // อ่านค่าสัญญาณแอนาล็อกจากแกน Y ของ Joystick ด้านซ้าย
  23.   z1 = digitalRead(left_key); // อ่านค่าสัญญาณแอนาล็อกจากแกน Z ของ Joystick ด้านซ้าย
  24.  
  25.   x2 = analogRead(right_X); // อ่านค่าสัญญาณแอนาล็อกจากแกน X ของ Joystick ด้านขวา
  26.   y2 = analogRead(right_Y); // อ่านค่าสัญญาณแอนาล็อกจากแกน Y ของ Joystick ด้านขวา
  27.   z2 = digitalRead(right_key);  // อ่านค่าสัญญาณดิจิตอลจากแกน X ของ Joystick ด้านขวา
  28.  
  29.   // แสดงผลจากการอ่านค่าสัญญาณของ Joystick 2 ตัว
  30.   // Joystick ด้านซ้าย
  31.   Serial.println();
  32.   Serial.println("*********Left***********");
  33.   Serial.print("L_X = ");
  34.   Serial.print(x1 ,DEC); // แสดงค่าสัญญาณแอนาล็อกจากแกน X ของ Joystick ด้านซ้าย เป็นตัวเลขฐานสิบ
  35.   Serial.print(" L_Y = ");
  36.   Serial.print(y1 ,DEC); // แสดงค่าสัญญาณแอนาล็อกจากแกน Y ของ Joystick ด้านซ้าย เป็นตัวเลขฐานสิบ
  37.   Serial.print(" L_Z(Key) = ");
  38.   Serial.println(z1 ,DEC); // แสดงค่าสัญญาณดิจิตอลจากแกน Z ของ Joystick ด้านซ้าย เป็นตัวเลขฐานสิบแล้วขึ้นบรรทัดใหม่
  39.   // Joystick ด้านขวา
  40.   Serial.println("**********Right**********");
  41.   Serial.print("R_X = ");
  42.   Serial.print(x2 ,DEC); // แสดงค่าสัญญาณแอนาล็อกจากแกน X ของ Joystick ด้านขวา เป็นตัวเลขฐานสิบ
  43.   Serial.print(" R_Y = ");
  44.   Serial.print(y2 ,DEC); // แสดงค่าสัญญาณแอนาล็อกจากแกน X ของ Joystick ด้านขวา เป็นตัวเลขฐานสิบ
  45.   Serial.print(" R_Z(Key) = ");
  46.   Serial.println(z2 ,DEC); // แสดงค่าสัญญาณดิจิตอลจากแกน Z ของ Joystick ด้านขวา เป็นตัวเลขฐานสิบแล้วขึ้นบรรทัดใหม่
  47.   Serial.println();
  48.  
  49.   delay(500); // หน่วงเวลา 0.5 วินาที
  50. }
  51.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement