|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
摘要: 本设计是以STM32单片机为核心、采用视觉检测技术的的滚球控制系统,
5 I- A; l$ `# S/ g# m4 x实现对小球在平板滚动的精确控制功能。本设计基本模块包括mcu、摄像头、
& _ ~4 p: c* `0 y" }显示屏、机械平台、按键输入,其中MCU即STM32 F429开发板,摄像头采用5 I, N& a1 n# J9 c+ D. j
OV2640,显示屏选择7 寸TFT触摸屏。通过摄像头获得图像数据,分析小球位" N* i7 P `# d& N
置来控制平板倾斜,达到控制小球的目的。; X9 g& d2 O6 ^, F1 K; X
% Y6 h7 h8 y; A+ R+ L0 P题目要求我们在3cm直径的圆内稳定2cm左右的小球,精度很高。本实验
5 i2 P5 G- Q# w( L$ \! H首要问题就是要解决获取小球位置的难题。为此,我们采用摄像头采集数据,& @, G( O% S- _0 ?' f3 V6 e+ c
单片机分析小球位置,与目标位置相比获得控制输入量,控制平板机械结构运/ n; C6 k, c) J- H. M" e
动。
0 N& n' \$ {0 L" n5 E二系统方案设计9 o8 [: E* f: ?# L% `/ t
1 平板控制方案
2 t: }& H! M9 T$ R方案一:推杆电机上下推动,这种方案材料易得,平板稳定,但是无法控# w2 g l" a o5 z" I& n2 c& p
制行程,甚至需要mpu6050加入第二个控制环。
/ [: N/ \' z% B0 I1 Y- K0 }方案二:步进电机+丝杆,有现成器材,行程可控,速度可调,容易实现4 m$ ~* i; D. W/ V
PID。但机械结构难以组装。* y e0 e3 Z1 C% x
方案三:舵机,角度与占空比成线性关系,不存在失步,力矩大。6 {0 w' W W9 R% ^8 Y+ {
在可行性与精确度指标上比较过后,决定采用方案三。+ C. r' y1 P$ i* x/ j
2 位置采集方案/ ^; ~/ \# h7 Z6 S0 q
方案一:在木板X与Y边缘分布大量光电收发二极管,为了实现题目要求
, R, r" F1 }8 a5 H# D e9 V: m2 G3cm以内的定位,每侧需要60/3=20 个。难度低,但需要大量IO 口,精度也很
( b7 T, A' G! O X- Q不理想。8 f3 K" e1 T4 T* u- v* }
方案二:摄像头采集数据,精度高,大量DMA中断操作使得PWM很不精确,* P) `3 g) `6 n9 F
导致舵机不稳定。$ @6 F0 d; B' ^
经过讨论,我们决定使用方案二。
P) _( m+ S3 {, ~. v" Q, N' \3 小球材料方案, W7 k$ C6 Q5 U G$ F
方案一:木球,重量轻,有利于快速反应。但是不太圆
4 Z4 x- u' p# ]# \+ _; w! A5 G' E方案二:铁球,惯性大,加速度慢,有利于稳定。- d- d1 A5 D q$ L( t( \" r
方案三:选用RoboMaster 比赛的子弹。此圆球质量适中,漫反射材料有利
5 l: {, h! i5 a6 q0 {: o于小球像素提取。但是不容易获取。2 x' _5 W( ^5 O& f" a& N
多次实验并比较之后,我们采用方案二。5 W" Q# w7 ~& V' w( Y% |1 M
三理论分析与计算
/ k/ d, p" I) l2 a2 e$ V* j! y8 b7 L! `
1 小球位置的分析与计算
! O/ j! L5 O4 w! e" F4 b+ z6 vOV2640是高像素的cmos摄像头,但现有模块中没有FIFO,存取速度极大' z% o* ]3 W3 E9 u0 R
影响了主程序运行,因此采用DMA不经CPU传送数据,配合STM32F4系列特有* Q+ b! e: U2 r
的DCMI,节省运算资源。小球的质心有多种方法计算。由于板上只有一个小球,
, V6 v; ]& N1 i3 d: V: h采用霍夫圆变换消耗过多运算资源得不偿失;获取小球上下左右四顶点求平均+ V5 @. S+ M( m4 I% q' ?8 B" W+ M
方法很简单,精度足够;本设计中采用小球坐标相加求平均,即质心。对于图% }( Y- D% \+ J
像中的噪点,通过检测两个连续的像素点,来粗略判断是否是小球。
/ w0 s' B: y3 v+ M0 a% R* }3 z我们采用180 个像素点来显示Y轴坐标值,误差60cm/180=3.33mm。小球7 g3 @. l9 T/ k+ U2 P, O6 p7 g9 k
2cm,在圆心处距离圆边界有5mm,因此误差可满足精度要求,但对控制要求较
! d5 u' t: N% D4 H高。
0 B3 Z- W4 c5 I: y; \; O% F2 控制算法分析5 s a3 q0 V7 \' v- J/ C& g. Z
平板倾斜角与舵机转角成正比,而舵机转角与占空比成正比。即控制倾斜
4 z" x1 c2 p! F% C9 G* V角度仅需设定占空比。
9 y" E) u6 b9 H7 A4 a+ V$ n* q
8 \' g: R4 s+ Q3 y8 r5 q& d; G" m; m- a- @! G- z
3 S0 ~% c8 y# T1 d
, x; G3 y) u! f7 Q, b/ r' T+ |
|
|