演示

?

怎么運(yùn)行的

該項目由兩部分組成。Arduino 端處理所有伺服運(yùn)動并從激光雷達(dá)傳感器獲取測量讀數(shù)。Java 端將球形點轉(zhuǎn)換為笛卡爾點并將它們呈現(xiàn)為 3D。它們通過串行端口相互通信。用戶可以使用類似游戲的 fps 控件在場景中移動以獲得更好的體驗。

數(shù)學(xué)

項目中有兩個舵機(jī)。一個將用作平移 (Phi) 角，另一個用作傾斜 (Theta) 角。我們從激光雷達(dá)傳感器獲得的讀數(shù)將成為半徑。這意味著設(shè)備本身將位于點 (0,0,0)。從 Arduino 發(fā)送到 Java 程序的每個數(shù)據(jù)集都由這三個數(shù)字（半徑、phi、theta）組成，前導(dǎo)零以保持一致性。

?

從這里我們必須將這些球面點轉(zhuǎn)換為 Cartesian(x, y, z) 以便我們可以在我們的 Java 程序中正確地繪制它們。

?

我們可以使用這些公式實現(xiàn)這些轉(zhuǎn)換。

?

注意：如果您查看 Java 代碼并注意到 x、y 和 z 的某些值被交換，有時甚至設(shè)置為負(fù)數(shù)，那是因為計算機(jī)坐標(biāo)系也不同。例如，在計算機(jī)坐標(biāo)系中，x 是水平的，而不是 y。Y positive 下降，而不是上升。像這樣的東西。對公式所做的這些修改只是為了讓 Java 在正確的位置呈現(xiàn)點。

串口通訊

我用 Arduino Uno 開始了這個項目，但遇到了串行端口與伺服系統(tǒng)沖突的問題。他們不能同時工作。當(dāng)數(shù)據(jù)來回發(fā)送時，舵機(jī)會不斷抖動。從研究中我了解到這是使用 SoftwareSerial 的常見問題。我找到了一些解決這個問題的方法，但它們太麻煩了，甚至對我來說都沒有完全奏效。我決定改用 Arduino Mega，它解決了抖動問題。這是因為 Mega 有多個串口。

溝通的步驟

• Java開啟端口并監(jiān)聽數(shù)據(jù)

• Arduino 進(jìn)行第一次測量，將伺服系統(tǒng)移動到下一個位置并等待來自 Java 的“Okay”信號

• Arduino 以這種格式將數(shù)據(jù)發(fā)送到 Java 000,000,000

• Java等待所有的數(shù)據(jù)分片達(dá)到一定量就可以轉(zhuǎn)換

• Java 轉(zhuǎn)換這些數(shù)字，繪制點，并向 Arduino 發(fā)送一個字符作為“Okay”信號

• 一旦 Arduino 接收到信號，它就會在新的角度位置重復(fù)之前的操作

Java 必須等待的原因是因為即使您告訴 Arduino 發(fā)送 9 位數(shù)字和 2 個逗號，通過串行發(fā)送數(shù)據(jù)也不能那樣工作。只要有可能，它就會發(fā)送它想要的任何數(shù)據(jù)片段。所以我們希望 Java 直到接收到的所有數(shù)據(jù)看起來都像它可以識別的東西。

我使用 USB 電纜作為串行連接，但我相信如果需要無線，也可以使用藍(lán)牙模塊。

為項目提供動力

我用一塊 5v 的墻磚來運(yùn)行伺服系統(tǒng)，因為我只是討厭處理電池并盡可能避免使用它們。激光雷達(dá)傳感器通過 Arduino 5V 供電。當(dāng)然，Arduino 使用用作串行端口的相同 USB 電纜供電。

請隨時發(fā)表有關(guān)該項目的評論或問題。謝謝！