基于飞思卡尔单片机的智能车控制系统设计 - 百度文库

ѧػʵУҵƣģ 12ҳ

ͼ2.6ֱ

ת󣬳ʱֵܳǰŴ⵽ʱתת 90䡢180䡣ǰõϢתСǶȣڴʱȡٶֲǰհásʱֱĵڶʶʽʲ١

(2)ֱʶ𣬳ȷ

Снᷢ񵴣ʹʱһ5Ϊֱʶɹʣӵڶֱб𷽷ͬʱãһֺ󾭹15msȷֱ

ѭִУǵijִƵ2KHzöʱж(15ms)ķʽǰм3(Ϊ345)ʹ3ֱÿִгһ⵽ߣӦļ1㣬15msֵܼΪ31趨ֵ15msڴﵽҪļֵΪֱлֱ򲢽㣻15msûдﵽҪļֵ㣬¼СΪ2m/sٶȣСн3cmֻҪж2~2.5cmΪֱɡֵΪ20~25Ϊֱ

ȻҲԲøϸķжϣֻʱжϵʱͼֵɡڽֱ㣬ΪһֱбʽIJ䣬ֱ֤ȶɿʶ[7]

ѧػʵУҵƣģ 13ҳ

2.2.4 ֱȶƲ

СڶķӦܳᷢ񵴣ܴﵽȶΪ˾С񵴣·ʽСĶ

ñ־λֱ߳ʶ־λԿƶתĹʽȡáʽΪq=K1q1+K2q2qΪ͸Ŀq1ΪǰŹ紫ķתֵq2ΪźⷵתֵK1K2ֱΪǰŴļȨֵͨK1K2Ϊֵ1Ҫʱı丳ֵ

Сֱɹʶֱ󣬼СK1ֵںŴСǰ(ת)ܽСƫʱںŴλòܴλ(ǰŴ)Сֱ϶ĴͻԼ٣ֱߵȶԻáͬʱǰŲͬϣͬתDz(ڳбķʽ)һֱߵȶ 2.2.5 Ʋ

PID㷨ֱЧܺãƼ򵥣ܼʱǰȫٵһٶֵڼPIDڣγһڷֶεĿƣɽϿشﵽ涨ٶȡ

ʵ֤˫ŹʱPID㷨ܳڴSϻֶͳ٣ܳͨʱĴӳΪˣ5ֽ

1ӳڣܳķӳȽͣڴSϻֶĴȱӳڣԳʱļӳԵڳֱٺת䷴ӦʱΪ˲ֻнֱٶȣӰܳٶԡ

2ıPIDıPIDԼСתʱƵPWMźţóתССڴSϳֶķȣȱǸıPIDСڴSϳֶķȵͬʱҲСܳڳֱٺתʱתȣʹͬٶ£תתĴ䣬»ֱӳ

ѧػʵУҵƣģ 14ҳ

ҲӰܳıܡ

3־λСS䣬S䣬90䣬180䣬ݲɼɱ־λ˺ܳʱϼ¼ɼ5ݣԿơʵ֪ȱΪ־λʶ׳󣬿ԲߣҪΪ˫Ź紫ǰհ㣨28cmɼϢҲͷ࣬׼ȷʶ

4ٶȴصʵٶֵ־λPIDзֶοƣһϵٶֵܳٶԷֶΣڵSΪ٣еֵٲߣСĿڿԶʱɺܺõĵڳ壬ȶ䣻ҪСS䣩Сһ̶ʵSֱܣʡʱ䣬ڴS֮Բܣ˫ŹǰհСͲɼϢԵʣڸֻͨڳֱٺٶֵɴﵽ򣩣󣬷ֹʱת90䣬180䲻ʱܵʵУЧܺãֵṹֱIJͬϣδȫʱٶνӴʧأֱֱӽӴSS䣬ٶδڸ󣬲ڴSϵȷƣڶ2-3κ󷽿нʱڳڶͣϵ׼ȷ

5ڣ4Ļƣ3ı־λʵ鷨ȷֵҪDzͬ¸ıĿqСKpֵСڼ䣬ٶϸ֣ԭȵĵ͡СθĽΪ5Ρ7Ρ9ΣпƣʵϸֶӣԼټνӴijڶȫ⣬㷨ִʱܵһӰ졣̶־λʵ鷨ȷֵܳɳַ˫ſʶǰƣʶٽٶȷֶοƣʹϵĿƵõ˱֤ЧȽ⡣ 2.2.6 ʵ

ͼΪʹ㷨ǰСнʵʹ켣

ѧػʵУҵƣģ 15ҳ

ͼ2.7 㷨Снʵʹ켣Ա

ͼ2.7 ʹʵ鷨ȷֵǰСϵʵʹ켣,еĺʻ켣

עͼĻƷģͨڰֵٶͨߴڷλȻͨڼ㻭СʵʵĹ켣ƫʵdzơ

ԷdzԵĿʹʵ鷨ȷֵ֮СȻҲƫڣDZ Kp 㶨㷨ͺöˡҪΪ Kp ԵʡKp ʱһ⵽ƫϵͳܸĻָƽλáӱпԿСƫķʵʼСˣСߵʵʾҲСˣȻʱҲСˡ 2.3 ģ

˴αѡõģ1/10 ķ泵ģеṹֻʹþṩģĵּ̲ת֡Ʋǰת򣬺峵ģ£

ϵͷ779662525#qq.com(#滻Ϊ@) ICP20003344-4