三軸手機測試系統包含幾個重點項目
1. android系統程式的撰寫2. 三軸馬達的控制
3. CDD 影像擷取
4. 上位機程式撰寫
首先 系統硬體包含三軸馬達, CCD

延伸閱讀
- 影像測試系統-手機篇(2023/01)
- c# Emgu WebCAM 影像應用(一)-影像物體顏色追蹤(2022/12)
- 影像測試系統-WebCAM篇(2023/01)
- 物體角度影像判別(2023/01)
- c# Emgu WebCAM 影像應用(二)-影像標的物旋轉定位(2022/12)
三軸手機測試系統包含幾個重點項目
1. android系統程式的撰寫
利用BCB所寫的測試GUI去控制AP(Audio Precision)做聲音的量測
利用儀器Keithley2306 Battery/Charger Simulator去驗證充電IC的主要功能
利用儀器 Aglient

將手上的感測器結合ESP32連成WIFI MESH網路, 利用改裝的XBOX搖桿, 控制servo 馬達. 中控的ESP32結合控制的GUI, 可以接收各個sensor的資料.
node 編號和 function 名稱,中控 GUI 解開 JSON 後就知道是誰、做什麼。以下整理自本系列各篇文章的記錄:| node | function | 模組 | 出處 |
|---|---|---|---|
| 4 | 3Axis | 三軸感測模組(本文圖五) | 中控介面篇 |
| 5 | DS18B20 | 溫度感測,回傳 Temperature | DS18B20 篇 |
| 7 | PIR | 人體感應,回傳 Detect | 中控介面篇 |
| 8 | WS2812 | RGB 燈,接收 mode 與顏色 | WS2812 篇 |
| 10 | (按鍵名稱) | 改裝 XBOX 搖桿(2023/11 版) | Wifi mesh Control another ESP32 |
| 11 | Relay | 4 路繼電器 | 4 port Relay 篇 |
startHere: Received from 2085224085 msg={"node":5,"function":"DS18B20","Temperature":23.19}
startHere: Received from 2085146325 msg={"node":11,"function":"Relay"}
#include "painlessMesh.h"
#include <Arduino_JSON.h>
#define MESH_PREFIX "yourMeshName" // 全部節點要一樣
#define MESH_PASSWORD "yourMeshPassword"
#define MESH_PORT 5555
Scheduler userScheduler;
painlessMesh mesh;
int nodeNumber = 5;
void sendMessage();
Task taskSendMessage(TASK_SECOND * 1, TASK_FOREVER, &sendMessage);
void sendMessage() {
JSONVar doc;
doc["node"] = nodeNumber;
doc["function"] = "DS18B20";
doc["Temperature"] = readTemperature(); // 換成自己的感測器
mesh.sendBroadcast(JSON.stringify(doc));
taskSendMessage.setInterval(random(TASK_SECOND * 1, TASK_SECOND * 2));
}
void receivedCallback(uint32_t from, String &msg) {
JSONVar obj = JSON.parse(msg);
if (obj.hasOwnProperty("node")) {
Serial.printf("from %u node=%d\n", from, (int)obj["node"]);
}
}
void setup() {
Serial.begin(115200);
mesh.setDebugMsgTypes(ERROR | STARTUP);
mesh.init(MESH_PREFIX, MESH_PASSWORD, &userScheduler, MESH_PORT);
mesh.onReceive(&receivedCallback);
userScheduler.addTask(taskSendMessage);
taskSendMessage.enable();
}
void loop() {
mesh.update(); // 不能被 delay() 卡住
}
兩個重點:送資料的間隔用 random 打散,避免所有節點同一瞬間廣播;loop() 裡要一直呼叫 mesh.update(),用 delay() 擋住會讓節點掉線。| 模組 | 介面 | 重點 |
|---|---|---|
| 圖一 感測 LED 燈 | 數位輸入+輸出 | 左上角的白色半球是 PIR 人體感應,有人經過輸出 HIGH;常見的 PIR 模組上電後要暖機約一分鐘才穩定 |
| 圖二 伺服馬達 | PWM | 50 Hz、脈寬約 0.5~2.5 ms 對應角度;ESP32 沒有 AVR 的 Servo 函式庫,常用 ESP32Servo(底層是 LEDC);馬達啟動電流大,電源要夠、和 ESP32 共地 |
| 圖三、四 XBOX 搖桿 | ADC+數位輸入 | 兩支類比搖桿(各 X、Y 兩軸可變電阻)+A/B/X/Y 四顆按鍵,用三用電表找出接點後焊到排針 |
| 圖五 三軸模組 | I2C | 文章寫 ITG3205;照片板子絲印是 ITG/MPU6050(GY-521 型),MPU-6050 是三軸陀螺儀+三軸加速度,位址 0x68(AD0 接高為 0x69) |
| 圖六 氣壓感測 | I2C | 文章寫 BMP085;照片板子絲印是 BMP180,兩顆暫存器相容,Adafruit BMP085 函式庫可直接讀;位址 0x77,量測範圍 300~1100 hPa,附溫度 |
int x = analogRead(VRX_PIN_L); // 0~4095 if (x > 2200) cmd |= COMMAND_LEFT_L; else if (x < 900) cmd |= COMMAND_RIGHT_L; // 900~2200 之間視為回中,不送指令
{"node":4,"function":"3Axis","ax":...};中控 GUI 只要多認一種 function 就能顯示。| 現象 | 先檢查 |
|---|---|
| 新節點一直加不進網路 | MESH_PREFIX、密碼、PORT 三個是不是完全一樣;頻道是否一致 |
| 節點一陣子就掉線(GUI 變紅) | loop() 裡有沒有 delay() 或長時間的迴圈;電池電壓是否太低 |
| 搖桿讀值永遠是 0 或 4095 | 是不是接到 ADC2 腳位;VCC 是否接 3.3V |
| 伺服一轉 ESP32 就重開機 | 馬達電源不足,拉低了 ESP32 的電壓 |
| I2C 掃不到感測器 | SDA/SCL 是否接反;跑 I2C Scanner 確認位址 |
| Mesh 要同時連家裡 WiFi 上網 | 函式庫 bridge 範例:stationManual() 連路由器,mesh 的頻道要和路由器相同 |


接續c# Emgu WebCAM 影像應用(一)-影像物體顏色追蹤這篇文章配合旋轉台,將ROI中的影像顏色的標的物角度旋轉到90度的正向位置.
旋轉台是用RS232控制的架構
_Port[PortID] = new SerialPort(PortNumber, BaudRate, Parity.None, 8, StopBits.One);
MCvBox2D rect;
rect = currentContour.GetMinAreaRect();
這個函式GetMinAreaRect會包含角度的值 rect.angle
再依據angle的值去控制轉台旋轉到此角度達到所要需求.
編寫環境:
OS: Win 11
C#: VS2010
EMGU:2.4.10
構想: 利用滑鼠down->move->up在圖形上的事件, 抓取ROI區塊上的顏色, 進而去判斷整個影像中相對應的顏色物件並將其以最小矩形框出.
利用滑鼠的事件
private void imageBox1_MouseDown(object sender, MouseEventArgs e)
private void imageBox1_MouseMove(object sender, MouseEventArgs e)
private void imageBox1_MouseUp(object sender, MouseEventArgs e)
去抓取imageBox1中的ROI區塊的影像去做處理
利用到的函式
// bgr 轉 hsv
TEmgu._EmguPara.TouchRegionHsv = CommonData.ROIImageSource.Convert<Hsv, Byte>();
TEmgu._EmguPara.TouchRegionHsv.SmoothGaussian(5);
TEmgu._EmguPara.m_Lower = new Hsv(TEmgu._EmguPara.m_TargetColor.Hue - 30, TEmgu._EmguPara.m_TargetColor.Satuation - 30, TEmgu._EmguPara.m_TargetColor.Value - 30);
TEmgu._EmguPara.m_Higher = new Hsv(TEmgu._EmguPara.m_TargetColor.Hue + 30, TEmgu._EmguPara.m_TargetColor.Satuation + 30, TEmgu._EmguPara.m_TargetColor.Value + 30);
//搜尋的顏色範圍
TEmgu._EmguPara.InRageFrame = TEmgu._EmguPara.ImageHsv.InRange(TEmgu._EmguPara.m_Lower, TEmgu._EmguPara.m_Higher);
//抓取ROI顏色的最小矩形
using (MemStorage storage = new MemStorage())
{
for (Contour<Point> contours = TEmgu._EmguPara.InRageFrame.FindContours(Emgu.CV.CvEnum.CHAIN_APPROX_METHOD.CV_CHAIN_APPROX_NONE, Emgu.CV.CvEnum.RETR_TYPE.CV_RETR_EXTERNAL, storage); contours != null; contours = contours.HNext)
{
Contour<Point> currentContour = contours.ApproxPoly(contours.Perimeter * 0.010, storage);
if (currentContour.BoundingRectangle.Width < 10 || currentContour.BoundingRectangle.Height < 10) //对于太小的外接矩形,删除掉
{
continue;
}
if (currentContour.BoundingRectangle.Width > 50 && currentContour.BoundingRectangle.Height > 50)
{
TEmgu._EmguPara.ImageSource.Draw(currentContour.GetMinAreaRect(), new Bgr(0, 0, 255), 1);
MCvBox2D rect;
rect = currentContour.GetMinAreaRect();
CommonData.Angle = rect.angle;
cnti++;
}
}
}