[現學現賣Arduino實戰]二、頭追式車載探照燈

喜歡自駕游，走的地方多了就發現車燈的照射角度有限，特別是在山路大角度轉彎和大坑照射不到，所以有了用頭追的方式控制探照燈的想法

基本想法是用3D打印件支撐兩個55克的舵機，控制燈的水平和垂直轉動。燈為美國可瑞L2單顆大功率LED，用單片機控制它實現長亮、爆閃、短閃幾個擋位

我用arduino編寫的程序很初級很簡單，姿態控制用的是6050，實際應用時發現三個問題：
1、Arduino 進口UNO，上傳程序后控制基本正常，兩個舵機都有動作，但是一旦斷電再上電，兩個舵機只是通電瞬間動一下歸位然后就再也沒反應了，按復位按鈕復位也沒用。必須重新燒寫一次才有反映，但依然不能斷電。我用的是進口原裝UNO，不知是什么原因？
2、6050的問題：xy軸基本正常，但Z軸要么沒輸出，要么就亂跳，換了兩塊6050都是同樣的毛病。網上查了很多資料，6050的應用基本沒看到用z軸的。。。不知道有沒有熟悉6050的朋友？
3、UNO的pwm輸出很不穩定，比如模擬輸出200時，燈會象鬼火那樣忽悠忽悠的亂閃（沒有示波器看不到波形是怎么樣的），有沒有寫過LED控制的朋友？

代碼：
1、燈的控制：
void setup(){
  pinMode(5, INPUT);
  pinMode(4, INPUT);
  pinMode(10, OUTPUT);
  pinMode(3, INPUT);
}

void loop(){
  if (digitalRead(5) == LOW) {
    analogWrite(10,255);
    delay(50);
    analogWrite(10,0);
    delay(1000);

  } else {
    analogWrite(10,0);

  }
  if (digitalRead(4) == LOW) {
    digitalWrite(10,HIGH);

  } else {
    analogWrite(10,0);

  }
  if (digitalRead(3) == LOW) {
    analogWrite(10,255);
    delay(20);
    analogWrite(10,0);
    delay(50);

  } else {
    analogWrite(10,0);

  }

}



二、姿態控制：
#include<Servo.h>
Servo analogservo;
Servo analogservo2;

#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"

MPU6050 accelgyro;
int16_t ax, ay, az;
int16_t gx, gy, gz;

int16_t value
int16_t value2;

bool blinkState = false;
void setup() {

      analogservo.attach(10);
      analogservo2.attach(11);
}
void loop() {
      accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
      value2=90-az/350;
      value=90+ay/350;  

      analogservo2.write(value2);
      analogservo.write(value);
      blinkState = !blinkState;
      delay(30);
}




其他設計
[現學現賣Arduino實戰]一、盲人雷達
http://www.zg4o1577.cn/bbs/dpj-175950-1.html
(出處: 單片機論壇)

https://sourceforge.net/projects/arduinorclib/
舵機控制可以試試這個庫

indrydock 發表于 2019-12-19 17:54
https://sourceforge.net/projects/arduinorclib/
舵機控制可以試試這個庫

英文太爛。。。能不能幫忙傳一個上來

大貓8888 發表于 2019-12-19 23:34
英文太爛。。。能不能幫忙傳一個上來

ArduinoRCLib-0.3.zip (1.36 MB, 下載次數: 10)

2019-12-20 09:14 上傳

點擊文件名下載附件
下載積分: 黑幣 -5

這是個RC遙控器的庫，除了不僅是舵機控制，還可以做出完整的PPM遙控器

indrydock 發表于 2019-12-20 09:16
這是個RC遙控器的庫，除了不僅是舵機控制，還可以做出完整的PPM遙控器

非常感謝！

想加個搖桿，卻苦找了很久也沒有找到不會自動回中的，就做了個機械裝置來“止回”，搖桿可以停留在任何角度。
辛苦沒有白費，雖然手感沒有那么輕松順滑了，但作為在車上這種顛簸環境下還是適用的

大哥，我按照你的方法寫代碼測試，第一個問題我也遇到了，我更慘，只能運行一次，斷電再燒都不行了，傳感器沒數據回來了，不知道為什么啊，  請問你解決了嗎？如何解決的？

過兩天來試試，這么邪門？

樓主動手能力真強啊！ 有幾個問題：1。燈的控制和舵機都使用了10口，怎樣防止沖突呢？2。開燈的程序，并行3個if判斷，會不斷進入else關燈的，也就是不管按哪個開關都會燈都會閃爍啊？3。LED燈的驅動是什么啊，能否支持PWM?

喜歡自駕游，幾次夜路跑山道，發現彎急需要預判的地方燈光根本照不到！幾次歷險后萌發了這個跟蹤頭部動作引導燈光的想法。其實設計是去年做的，搞了個半截就去忙其他事情了，這兩天比較閑就又從箱底翻出來繼續做完。只可惜中間這一年多時間中多次做電腦系統，結果原始設計文檔全部丟失，明明記得網盤備份過的，結果也找不到，郁悶。

開始是用6050做頭追跟蹤，結果發現Z軸效果太差，要么沒反映，要么就發狂！現在換了DY-25發現效果不錯，下來要搞的是手動切換和燈光的多檔調光，希望在51假期前能掛到車上，跑跑山路，實際測試

喜歡自駕游，幾次夜路跑山道，發現彎急需要預判的地方燈光根本照不到！幾次歷險后萌發了這個跟蹤頭部動作引導燈光的想法。其實設計是去年做的，搞了個半截就去忙其他事情了，這兩天比較閑就又從箱底翻出來繼續做完。只可惜中間這一年多時間中多次做電腦系統，結果原始設計文檔全部丟失，明明記得網盤備份過的，結果也找不到，郁悶。

開始是用6050做頭追跟蹤，結果發現Z軸效果太差，要么沒反映，要么就發狂！現在換了DY-25發現效果不錯，下來要搞的是手動切換和燈光的多檔調光，希望在51假期前能掛到車上，跑跑山路，實際測試
https://www.bilibili.com/video/BV1H5411w7We?share_source=copy_web

omom 發表于 2020-2-15 11:00
大哥，我按照你的方法寫代碼測試，第一個問題我也遇到了，我更慘，只能運行一次，斷電再燒都不行了，傳感器 ...

換Larduino w/ LGT8F328D就好了

glinfei 發表于 2021-5-6 11:33
樓主動手能力真強啊！ 有幾個問題：1。燈的控制和舵機都使用了10口，怎樣防止沖突呢？2。開燈的程序，并行3 ...

哈哈，是兩片單片機。不知道在一片上怎么完成這兩部分。。。

不可以發b站的視頻鏈接嗎？
3D打印】【Arduino】猜猜這是什么？頭追。。。

b站上我發了最近又重新開始搞的視頻：
【3D打印】【Arduino】猜猜這是什么？頭追。。。
【3D打印】【Arduino】車載頭追探照燈，看哪照哪！
【3D打印】【Arduino】頭追探照燈停車場測試
喜歡的可以上b站按標題搜一下