程序更新！STM32+OV7670+IL9325找球（黑底紅球）帶2路PWM（PID）程序

ID:225718 · 發表于 2017-8-12 14:54

本帖最后由 zhangpro666 于 2017-8-13 11:13 編輯

呃...看到大家都在電賽，自己暑假無聊玩一下，如果大家覺得有用就拿去吧。用的是啟光電子的STM32，OV7670，ILI9325，理論上核心板通過跳線都可以實現。

QQ圖片20170812145131.jpg

原理圖：

stm32主程序：

/*
OV7670模塊 STM32函數
選用STM32F103RBT6芯片
TFT驅動IC為 R61505V
程序中用到的TFT 為我們店的 2.4寸TFT 驅動芯片為 R61505V
TFT用到的GPIO PB為數據口 PC.6 CS PC.7 RS PC.8 WR PC.9 RD PC.10 RES
此函數用寄存器方式配置GPIO 在TFT的數據命令腳配置上用的是寄存器這樣能大幅度提高輸出速度
攝像頭方面
攝像頭數據口為PA口 AO-A7
SCL PC11
SDA PC12
OE PC3 //片選信號(OE)
WRST PC4 //寫指針復位
RRST PC2 //讀指針復位
RCLK PC1 //讀數據時鐘
WEN PC5 //寫入FIFO使能
VSY PD2 //同步信號檢測IO
整個程序流程介紹
初始化TFT
初始化ov7670 ov7670是通過SCCB 初始化的即 SCL 和SDA就可以初始化OV7670 SDA SCL類似于I2C效果
所以在調模塊前一定要確定OV7670是否已經初始化
開啟中斷判斷幀數據是否接收
死循環讀取并顯示攝像數據
*/
#include "stm32f10x.h"
#include "delay.h"
#include "led.h"
#include "tft.h"
#include "led.h"
#include "ov7670.h"
#include "gui.h"
#include "usart.h"
#include "PID.h"
#define KEY0 GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_9)
#define KEY1 GPIO_ReadInputDataBit(GPIOA,GPIO_Pin_10)
void coordinate_output(void);
extern u8 ov_sta; //幀次數置位標志位
struct{
u8 photo;
u8 pub_buf[14401];//120*120
char buf[200];
}CAM;
//更新LCD顯示
void camera_refresh(void)
{
u32 j;
u16 color,n565Color;
u8 cRed=0,cBlue=0,cGreen=0;
TFT_SCAN(5); //設置TFT掃描方向為從下到上從右到左
Address_set(60,0,179,119,0,0); //設置顯示范圍
if(ov_sta==2) //判斷緩存區是否存好攝像數據
{
OV7670_RRST_0; //開始復位讀指針
OV7670_RCK_0;
OV7670_RCK_1;
OV7670_RCK_0;
OV7670_RRST_1; //復位讀指針結束
OV7670_RCK_1;
TFT_RS_1; //寫數據線拉高為提高寫入速度
//此用法是將下面寫數據的步驟完全拆開主要是為了提高顯示速度（下面注釋部分為參考部分）
for(j=0;j<14400;j++) //分辨率為240x320 每個顏色點要兩個字節所以 240x320x2=76800 ?
{
OV7670_RCK_0; //每一次時鐘跳變讀一次數據
color=GPIOC->IDR&0XFF; //讀數據讀取顏色高字節數據
OV7670_RCK_1;
color<<=8; //左移8位將高字節移到高8位為接收低8位字節做準備
OV7670_RCK_0;
color|=GPIOC->IDR&0XFF; //讀數據讀取顏色低字節數據并轉化為16位 565 顏色數據
OV7670_RCK_1;
cRed = ((color & 0xf800)>>11);
CAM.pub_buf[j]=cRed;
n565Color = (cRed << 11) + (cGreen << 5) + (cBlue << 0);
GPIOB->ODR=n565Color; //對TFT并口快速寫數據
TFT_WR_0; //開始寫入
TFT_WR_1;
}
coordinate_output();
EXTI_ClearITPendingBit(EXTI_Line2); //清除LINE8上的中斷標志位
ov_sta=0; //開始下一次采集
}
}
u16 blight=15;//亮度判斷更改這里
void coordinate_output(void)
{
u16 i,j,k;
xmax=ymax=0;
xmin=ymin=119;
for(i=0;i<120;i++)
{
for(j=0;j<120;j++)
{
if(CAM.pub_buf[(i*120)+j]>=blight)
{
if(i>1&&i<119&&j<119&&j>1)//如果i值大于8且小于136（限制小球在8~136行），同理，限制小球在16~160列
{
if(j>xmax) {xmax=j;} //不斷更新邊緣，直到找到小球的直徑
if(j<xmin) {xmin=j;}//不斷更新邊緣，直到找到小球的直徑
if(i>ymax) {ymax=i;}//不斷更新邊緣，直到找到小球的直徑
if(i<ymin) {ymin=i;}//不斷更新邊緣，直到找到小球的直徑
}
}
}
}
for(k=0;k<14400;k++)
{
CAM.pub_buf[k]=0x00;
}
x=(xmax+xmin)/2;
y=(ymax+ymin)/2;
if(x<1){x=1;}
if(x>119){x=119;}
if(y<1){y=1;}
if(y>119){y=119;}
if(x!=0&&y!=0)
{
// GUI_sprintf_hzstr16x(20,200," ",Red,White);
sprintf(CAM.buf,"X:%d ",x);
GUI_sprintf_hzstr16x(20,200,CAM.buf,Red,White);
sprintf(CAM.buf,"Y:%d ",y);
GUI_sprintf_hzstr16x(80,200,CAM.buf,Red,White);
printf("X:%d",x);
printf("Y:%d",y);
printf("\r\n");
}
}
void disp_picture(void)
{
u16 i,j=0;
u16 COLOR;
u8 aRed=0,aBlue=0,aGreen=0;
coordinate_output();
TFT_SCAN(5);
Address_set(60,0,179,119,0,0);
TFT_RS_1;
for(i=0;i<14400;i++)
{
aRed=CAM.pub_buf[i];
printf("%d ",aRed);
j++;
if(j>=120){printf("\r\n");j=0;}
COLOR = (aRed << 11) + (aGreen << 5) + (aBlue << 0);
GPIOB->ODR=COLOR; //對TFT并口快速寫數據
TFT_WR_0; //開始寫入
TFT_WR_1;
}
EXTI_ClearITPendingBit(EXTI_Line2);
}
int main(void)
{
u8 lightmode=2,saturation=3,brightness=2,contrast=2;
u8 effect=0,flag=0;
delay_init(); //延時函數初始化
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
Lcd_Init(); //LCD 初始化
LED_Init();
uart_init(115200);
TIM2_Int_Init(1,1799);
TFT_CS(0); //打開LCD片選使能
GUI_Clear(White); //清屏
while(OV7670_Init())//初始化OV7670
{
GUI_sprintf_hzstr16x(20,150,"OV7670 Error!! ",Blue,White);
delay_ms(200);
printf("OV7670 ERROR!!!!!\r\n");
}
GUI_Clear(White); //清屏初始化成功后紅色清屏
CAM.photo=0;
// delay_ms(1500);
//攝像頭參數設置屏蔽后為默認效果
OV7670_Light_Mode(lightmode);
OV7670_Color_Saturation(saturation);
OV7670_Brightness(brightness);
OV7670_Contrast(contrast);
OV7670_Special_Effects(effect);
EXTI2_Init(); //初始化中斷線
OV7670_Window_Set(10,174,120,120);
OV7670_CS=0;
while(1) //死循環顯示攝像數據
{
camera_refresh();
// test_motor();
}
}

復制代碼

全部資料下載地址：

STM32找球.rar (429.95 KB, 下載次數: 60)

ID:225718 · 發表于 2017-8-12 14:59

支持坐標1~119

ID:225718 · 發表于 2017-8-13 11:12

#include "pid.h"
#include "usart.h"
#include "led.h"int x,y,xmax,ymax,xmin,ymin;
struct{int setspeed;
int actspeed;
int err;
int err_last;
int err_next;
float Kp,Ki,Kd;
float integral;
int incrementSpeed;}pid;void PID_init(void)
{
pid.setspeed=0;
pid.actspeed=60;
pid.err=0;
pid.Kp=0.25; //這里調節P參數
pid.Ki=0.25; //這里調節I參數
pid.Kd=0.21; //這里調節D參數
}
int PID_adjustment(int speed,int act) //PID處理函數，輸入X、Y到目標的距離輸出應該移動的距離
{
pid.setspeed=speed;
pid.actspeed=act;
pid.err=pid.setspeed-pid.actspeed;
pid.incrementSpeed=pid.Kp*(pid.err-pid.err_next)+pid.Ki*pid.err+pid.Kd*(pid.err-2*pid.err_next+pid.err_last);
// pid.actspeed+=pid.incrementSpeed;
pid.err_last=pid.err_next;
pid.err_next=pid.err;
return pid.incrementSpeed;
}void DIST_TO_PWM(int dist,u8 zhou) //距離轉換輸入距離方向軸直接調整
{
if(zhou==0)//X軸
{
timer1=30+dist*0.2; //這里調整X軸，注意！如果X軸反了，把+改成-
// printf("PIDPWMX:%d",timer1);
// printf("\r\n");
}
if(zhou==1)//Y軸
{
timer2=30+dist*0.2; //這里調節Y軸，注意！如果Y軸反了，把+改成-
// printf("PIDPWMY:%d",timer2);
// printf("\r\n");
}
}
void zuobiao_process(u16 ux,u16 uy)//輸入目標的坐標
{
int xdist,ydist,dist;//x、y離坐標的距離
xdist=ux-x;
ydist=uy-y;
dist=PID_adjustment(0,xdist);
if(dist>50){dist=50;} //限制距離調節在50
// printf("PIDx:%d",dist);
if(dist<0){DIST_TO_PWM(dist,0);}//處理X軸
if(dist>0){DIST_TO_PWM(dist,0);}
if(dist==0){timer1=30;}
dist=PID_adjustment(0,ydist);
if(dist>50){dist=50;} //限制距離調節在50
// printf("PIDy:%d",dist);
// printf("\r\n");
if(dist!=0){DIST_TO_PWM(dist,1);}//處理Y軸
if(dist==0){timer2=30;}
}

復制代碼

程序更新！誰說STM32F103慢？黑底找球+兩路PWM舵機輸出（帶PID），可以在程序里面調節PID大小，實測輸出FPS:20左右！

ID:138247 · 發表于 2019-4-4 16:19

謝謝分享。。。。。。。。。

ID:138247 · 發表于 2019-4-4 16:23

謝謝分享。。。。

ID:110257 · 發表于 2019-4-5 06:51

謝謝分享！！！

帳號		自動登錄	找回密碼
密碼			立即注冊

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

程序更新！STM32+OV7670+IL9325找球（黑底紅球）帶2路PWM（PID）程序

評分