单驱动自主遥控网络拳击模型机器人系统及该机器人系统的控制方法_5

文档序号:9254651阅读:来源:国知局
振动传感器发来的数据,根据该数据判断是否有振动,如果判断结果为是,则设置相应的“标志”,否则结束身体振动传感子过程;
[0275]驱动与显示子过程调用步骤:调用驱动与显示子过程,并在该过程结束之后执行无线通信子过程调用步骤;
[0276]无线通信子过程调用步骤:调用无线通信子过程,并在该步骤结束之后执行停止判断步骤;
[0277]停止判断步骤:判断是否接收到停止信号,并在判断结果为是时结束该自主对抗方法,在判断结果为否时执行目标识别和路径规划子过程调用步骤;
[0278]所述目标识别和路径规划子过程包括以下步骤:
[0279]路径提取步骤:提取设置的路径数组作为当前轨迹数据,并设置相应的“标志”,并在该步骤结束之后执行头部摆动步骤;
[0280]头部摆动步骤:按预置的头部摆角控制头部I左右摆动,并设置相应的“标志”,并在该步骤结束之后执行目标判断步骤;
[0281]目标判断步骤:提取图像传感器所摄录的传感图像,对该传感图像进行预处理,然后进行特征提取,将提取的特征与目标特征库中的特征相吻合,如果判断结果为是,则认为发现目标,并执行头部调整步骤,否则,结束目标识别和路径规划子过程;
[0282]头部调整步骤:调整头部I的转角,使面部朝向目标,并在该步骤结束之后执行目标距离测定子过程;
[0283]目标距离测定子过程:测量机器人与目标的距离,并在该步骤结束之后执行目标接近步骤;
[0284]目标接近步骤:按照“接近目标路径数组”控制机器人接近目标,并设置相应“标志”,并在该步骤结束之后执行距离判断步骤;
[0285]距离判断步骤:判断机器人与目标的距离是否小于或等于可击打距离,如果判断结果为是,则执行击打步骤,否则,执行躲避判断步骤;
[0286]击打步骤:设定机器人自身高度与朝向,并设置相应“标志”,然后控制机器人发出击打动作,并在该步骤结束之后执行躲避判断步骤;
[0287]躲避判断步骤:根据对方朝向及被击打振动情况是否需要躲避,如果判断结果为是,则执行躲避控制步骤,否则,结束目标识别和路径规划子过程;
[0288]躲避控制步骤:根据躲避路径数组控制机器人发出躲避动作,并设置相应的“标志”,并在该步骤结束之后结束目标识别和路径规划子过程;
[0289]所述的目标距离测定子过程包括以下步骤:
[0290]红外光图像发射步骤:根据红外照射光数组,控制红外发射部件发射预定的红外光图像,同时,接收红外接收阵列接收到的红外光图像,并在该步骤结束之后执行目标图像重构及特征提取步骤;
[0291]目标图像重构及特征提取步骤:将发射的红外光图像和接收的红外光图像进行编码比较并重构目标图像,然后对该目标图像进行特征提取,并在该步骤结束之后执行目标特征判断步骤;
[0292]目标特征判断步骤:提取的特征与目标特征进行比较,判断二者是否相吻合,如果判断结果为是,则执行距离计算步骤,否则,返回执行红外光图像发射步骤;
[0293]距离计算步骤:计算机器人与目标的距离,并在该步骤结束之后返回执行红外光图像发射步骤;
[0294]所述驱动与显示子过程包括以下步骤:
[0295]初始化步骤:初始化电动机驱动端口,并在该步骤结束之后执行“标志”数据读取步骤;
[0296]“标志”数据读取步骤:读取“标志”数据,并在该步骤结束之后执行动作事件判断步骤;
[0297]动作事件判断步骤:根据“标志”数据判断是否有动作事件发生,如果判断结果为是,则执行标志位置位及驱动步骤,否则,执行显示判断步骤;
[0298]所述动作事件包括后退、前进、前右转/右行、前左转/左行、凸轮前转升高、凸轮后转升高、击打、头部左转及头部右转;
[0299]标志位置位及驱动步骤:把动作标志寄存器相应的动作标志位置位,并通过电动机驱动电路驱动机器人发出相应动作,并在该步骤结束之后执行显示判断步骤;
[0300]显示判断步骤:判断是否有需要显示的“标志”,如果判断结果为是,则将显示标志寄存器的相应标志位置位,并将显示内容发送至数据寄存器,以控制声光显示装置显示相应的信息,然后结束驱动与显示子过程,否则,结束驱动与显示子过程;
[0301]所述无线通信子过程包括以下步骤:
[0302]初始化通信模块的步骤;
[0303]将机器人的“标志”发送给无线遥控器和网络服务器的步骤;
[0304]清除已发送的“标志”的步骤;
[0305]接收无线遥控器和网络服务器发来的控制命令、并设置相应的“标志”的步骤;
[0306]在无线遥控器的控制下与网络服务器交互进行注册、登录、积分、及交友信息通信的步骤;
[0307]所述管理方法包括以下步骤:
[0308]用于接收机器人发来的“标志”的步骤;
[0309]与机器人交互进行注册、登录、积分及交友的信息通信的步骤。
【主权项】
1.单驱动自主遥控网络拳击模型机器人系统,其特征在于:它包括机器人、无线控制器和网络服务器,所述机器人能够与无线控制器和网络服务器进行通信; 所述机器人包括头部(I)、颈部(2)、身体(3)、左出拳机构(4)、右出拳机构(5)、前行走机构(6)、后行走机构(7)和中间升高凸轮⑶; 头部(I)设置有头部被击打区域、红外发射与接收测距单元和声光显示装置和外部目标传感器,该外部目标传感器包括图像传感器和解码器; 身体(3)的内部设置有旋转凸轮,该旋转凸轮位于左出拳机构(4)和右出拳机构(5)之间,用于带动左出拳机构(4)和右出拳机构(5)动作, 身体(3)内还设置有分别用于驱动头部(I)、颈部(2)、旋转凸轮、前行走机构(6)、后行走机构(7)和中间升高凸轮⑶的电动机以驱动各电动机的电动机驱动电路, 身体(3)的内部还设置有无线通信模块、声光驱动电路、一号微处理器和身体振动传感器, 身体(3)的胸部设置有被击打区域(9),其中被击打区域由能够感受压力的压力传感器或压力传感器阵列构成; 所述中间升高凸轮(8)位于身体(3)底部的中间; 所述的无线控制器包括二号微处理器、无线通信模块、按键模块和显示模块,按键模块的信号输出端连接二号微处理器的控制信号输入端,二号微处理器的显示信号输出端连接显示模块的信号输入端,二号微处理器通过无线通信模块与机器人进行信号传输; 所述的无线控制器能够直接接入网络,与其他单驱动自主遥控网络拳击模型机器人系统的无线控制器组成网络化系统; 所述二号微处理器内嵌入有软件实现的无线控制模块,该无线控制模块包括以下单元: 键输入判断单元:判断是否有键输入,并在判断结果为是时启动参数键输入判断单元,在判断结果为否时返回启动键输入判断单元; 参数键输入判断单元:判断是否有参数键输入,并在判断结果为是时启动速度值存储单元,在判断结果为否时启动动作键输入判断单元; 速度值存储单元:记录速度值并将该速度值放入参数寄存器; 动作键输入判断单元:判断是否有动作键输入,并在判断结果为是时启动动作标志寄存器置位单元,在判断结果为否时启动显示键输入判断单元; 动作标志寄存器置位单元:将动作标志寄存器的标志位置位; 显示键输入判断单元:判断是否有显示键输入,并在判断结果为是时启动显示标志寄存器置位单元,在判断结果为否时启动动作与速度数据发送单元; 显示标志寄存器置位单元:将显示标志寄存器的标志位置位; 动作与速度数据发送单元:根据动作寄存器标志将对应的动作要求和参数寄存器中存储的速度值发送至数据寄存器; 显示数据发送单元:根据显示寄存器标志将该对应的显示数据寄存内容发送至显示缓存区; 数据寄存器无线发送单元:通过无线通信模块发送发射数据寄存器内存储的数据; 机器人数据接收单元:接收机器人发来的数据并将该数据存入显示数据寄存器; 显示缓存区数据发送单元:将显示缓存区存储的数据发送至声光显示装置; 停止信号判断单元:判断是否有停止信号输入,并在判断结果为是时结束无线控制模块,在判断结果为否时启动键输入判断单元; 所述的动作键包括前进键、后退键、前左转/左横移键、前右转/右横移键、后左转键、后右转键、升高键和击打键; 所述的速度值包括动作速度、击打速度和升高速度; 所述动作速度包括前进速度、后退速度、前左转/左横移速度、前右转/右横移速度、后左转速度和后右转速度; 所述的动作标志寄存器的标志位包括前进标志位、后退标志位、前左转/左横移标志位、前右转/右横移标志位、后左转标志位、后右转标志位、升高标志位或击打标志位; 所述的显示键包括显示总比分键、显示状态键和显示当前比分键; 所述的显示标志寄存器的标志位包括显示总比分标志位、显示状态标志位和显示当前比分标志位; 所述的一号微处理器内嵌入有软件实现的自主对抗模块,所述自主对抗模块包括以下单元: 设置单元:设置头部摆角、路径数组和初始值、目标特征库、测距特征库及红外照射光数组,所述路径数组包括接近目标路径数组和躲避路径数组,目标特征库包括各朝向的特征; 目标识别和路径规划子模块调用单元:调用目标识别和路径规划子模块; 被击打传感处理子模块调用单元:调用被击打传感处理子模块; 所述被击打传感处理子模块为:初始化被击打传感器,读取被击打传感器发来的数据,根据该数据判断头部(I)或身体(3)是否被击打,如果判断结果为是,则设置头部被击打标志或身体被击打标志,否则,结束被击打传感处理子模块; 身体振动传感子模块调用单元:调用身体振动传感子模块; 所述身体振动传感子模块为:初始化振动传感器,读取振动传感器发来的数据,根据该数据判断是否有振动,如果判断结果为是,则设置相应的“标志”,否则结束身体振动传感子模块; 驱动与显示子模块调用单元:调用驱动与显示子模块; 无线通信子模块调用单元:调用无线通信子模块; 停止判断单元:判断是否接收到停止信号,并在判断结果为是时结束该自主对抗模块,在判断结果为否时执行目标识别和路径规划子模块调用单元; 所述目标识别和路径规划子模块包括以下单元: 路径提取单元:提取设置的路径数组作为当前轨迹数据,并设置相应的“标志”; 头部摆动单元:按预置的头部摆角控制头部(I)左右摆动,并设置相应的“标志”;目标判断单元:提取图像传感器所摄录的传感图像,对该传感图像进行预处理,然后进行特征提取,将提取的特征与目标特征库中的特征相吻合,如果判断结果为是,则认为发现目标,并执行头部调整单元,否则,结束目标识别和路径规划子模块; 头部调整单元:调整头部(I)的转角,使面部朝向目标; 目标距离测定子模块:测量机器人与目标的距离; 目标接近单元:按照“接近目标路径数组”控制机器人接近目标,并设置相应“标志”;距离判断单元:判断机器人与目标的距离是否小于或等于可击打距离,如果判断结果为是,则执行击打单元,否则,执行躲避判断单元; 击打单元:设定机器人自身高度与朝向,并设置相应“标志”,然后控制机器人发出击打动作; 躲避判断单元:根据对方朝向及被击打振动情况是否需要躲避,如果判断结果为是,则执行躲避控制单元,否则,结束目标识别和路径规划子模块; 躲避控制单元:根据躲避路径数组控制机器人发出躲避动作,并设置相应的“标志”; 所述的目标距离测定子模块包括以下单元: 红外光图像发射单元:根据红外照射光数组,控制红外发射部件发射预定的红外光图像,同时,接收红外接收阵列接收到的红外光图像; 目标图像重构及特征提取单元:将发射的红外光图像和接收的红外光图像进行编码比较并重构目标图像,然后对该目标图像进行特征提取; 目标特征
当前第5页1 2 3 4 5 6 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1