功能介紹放開頭， 使用便捷無需愁

這是全網最詳細、性價比最高的STM32實戰項目入門教程，通過合理的硬件設計和詳細的視頻筆記介紹，硬件使用STM32F103主控資料多方便學習，通過3萬字筆記、12多個小時視頻、20多章節代碼手把手教會你如何開發和調試。讓你更快掌握嵌入式系統開發。

V3.3.0-STM32智能小車

視頻: https://www.bilibili.com/video/BV16x4y1M7EN/?spm_id_from=333.337.search-card.all.click

V3:HAL庫開發、功能：PID速度控制、PID循跡、PID跟隨、遙控、避障、PID角度控制、視覺控制、電磁循跡、RTOS等功能。

19.5-STM32接收數據-根據狀態控制電機

前面我們測試了openmv能夠正確識別，正確發送數據、STM32能夠正確接收、那么下面STM32單片機就要開始控制電機了。

這里控制電機其實和我們紅外循跡PID基本一致。

需要注意的 因為我們的攝像頭更加前瞻，距離車輪更遠，所以電機同樣的擺動幅度，攝像頭擺動更大。

先分析一下之前的代碼，然后明白我們要改什么了就

所以我們需要上面紅色減藍色 的部分

這里我們先定義一個結構體，這個是攝像頭PID循跡，仿造那個紅外對管的就可以。

tPid pidOpenmv_Tracking;//openmv攝像頭的PID結構體類型變量

pidOpenmv_Tracking.actual_val=0.0;
	pidOpenmv_Tracking.target_val=0.00;//攝像頭PID 的目標值為0
	pidOpenmv_Tracking.err=0.0;
	pidOpenmv_Tracking.err_last=0.0;
	pidOpenmv_Tracking.err_sum=0.0;
	pidOpenmv_Tracking.Kp=-0.4;//攝像頭循跡PID的K和d先調整的小一些
	pidOpenmv_Tracking.Ki=0;
	pidOpenmv_Tracking.Kd=0.10;

聲明一下

extern tPid pidOpenmv_Tracking;//攝像頭的PID

sprintf((char*)OledString, "lHW:%d  ", g_lHW_State);//視覺識別結果
		OLED_ShowString(0,0,OledString,12);//這個是oled驅動里面的，是顯示位置的一個函數，
		
		g_fHW_PID_Out = PID_realize(&pidOpenmv_Tracking,g_cThisState);//PID計算輸出目標速度 這個速度，會和基礎速度加減

		g_fHW_PID_Out1 = 0.5 + g_fHW_PID_Out;//電機1速度=基礎速度+循跡PID輸出速度
		g_fHW_PID_Out2 = 0.5 - g_fHW_PID_Out;//電機1速度=基礎速度-循跡PID輸出速度
		if(g_fHW_PID_Out1 >1.2) g_fHW_PID_Out1 =1.2;//進行限幅 限幅速度在0-1.2之間
		if(g_fHW_PID_Out1 < 0) g_fHW_PID_Out1 =0;
		if(g_fHW_PID_Out2 >1.2) g_fHW_PID_Out2 =1.2;//進行限幅 限幅速度在0-1.2之間
		if(g_fHW_PID_Out2 < 0) g_fHW_PID_Out2 =0;
		if(g_cThisState != g_cLastState)//如何這次狀態不等于上次狀態、就進行改變目標速度和控制電機、在定時器中依舊定時控制電機
		{
			motorPidSetSpeed(g_fHW_PID_Out1,g_fHW_PID_Out2);//通過計算的速度控制電機
		}
		
		g_cLastState = g_cThisState;//保存上次紅外對管狀態

注意攝像頭不能仰角太大

審核編輯 黃宇