中电网移动|移动中电网
 
中电网移动|移动中电网|高清图滚动区

基于单片机六自由度自动寻迹机械人的设计

1 系统原理

1.1 自动寻迹模块的系统原理

本设计中自动寻迹模块主要由单片机及其外同电路、红外寻迹电路、直流电机控制电路等组成。正常工作时,单片机循环检测红外寻迹电路输出信号,据此产生直流电机控制信号,当系统检测到工作方式发生改变时,系统进入相应方式。其原理框图如图1、图2所示。


图1 自动寻迹模块原理框图


图2 自动寻迹模块原理框图

1.2 六自由度机械手模块的系统原理

系统的设计采用模块化的方法,将机械于划分为基座、手臂、手腕、手部4部分。控制器以MSP430单片机为主控制器,具体控制部分框图见图3。


图3 六自由度模块的原理框图

2 系统设计

2.1 自动寻迹模块硬件设计

1)基本单片机系统

寻迹机器人系统的控制核心,一般情况下以MSP430单片机片内的基本硬件资源为主,有必要时再扩展部分外部器件。在本设计中需要完成的控制比较简单,以单片机片内的基本硬件资源完全可以实现,因此不需扩展。

2)放大信号电路

采用LM324控制,LM324是四运放集成电路,它采用14脚双列直插塑料封装,内部包含四组形式完全相同的运算放大器,除电源共用外,四组运放相互独立。

3)电动机驱动电路

所选用的电动机为普通的直流电机,在MSP430单片机的控制下,可接一个电机驱动芯片或者通过其他的一些原件可使电机转动。本系统为了设计简单,采用其他方式代替了电路驱动芯片。

2.2 六自由度机械手模块硬件设计

六自由度机械手是由6个伺服电机驱动的机器手臂。除了构成手臂的4个关节、手腕1个关节外,再加上手部的夹持,实现了1个机械手的机械结构。

该控制模块采用5 V直流电源分别为单片机和机械手臂的电机供电,电路包括手动复位电路、晶振电路、矩阵键盘、用以控制单片机转角的控制的独立键盘、伺服电机接入口,并可通过显示屏显示被选电机标识号和该电机转动的角度。

3 软件设计

本系统的软件设计面向硬件,选用C语言编程。最主要部分是单片机控制电机转动(包括正转反转)、时间的延迟和PID算法,具体的设计流程图见图4和图5。


图4 自动寻迹模块控制流程图


图5 六自由度模块流程图

4 系统调试

1)程序编完后,对代码仔细逐行检查。检查代码的错误,建立自己的代码检查表,对经常易错的地方进行检查。检查代码是否符合编程规范。

2)调试程序看是否能仿真,如果运行正常再将在编译器中调试好的程序烧写至单片机。

3)在接上电源时,观察整体电路是否按照预计设计的运作,电机是否正转,电机是否反转等。可根据电路的运行情况推测出程序出错的部分,修改程序后再经过编译器调试后烧到单片机,反复检测直到能工作完全正常。

猜你喜欢
中电网移动|移动中电网|频道导航区