CN104759103A - Multi-drive remote control boxing model robot system and control method of the robot system - Google Patents
Multi-drive remote control boxing model robot system and control method of the robot system Download PDFInfo
- Publication number
- CN104759103A CN104759103A CN201510160944.XA CN201510160944A CN104759103A CN 104759103 A CN104759103 A CN 104759103A CN 201510160944 A CN201510160944 A CN 201510160944A CN 104759103 A CN104759103 A CN 104759103A
- Authority
- CN
- China
- Prior art keywords
- register
- action
- data
- display
- key
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000009471 action Effects 0.000 claims abstract description 95
- 230000007246 mechanism Effects 0.000 claims abstract description 47
- 238000004891 communication Methods 0.000 claims description 49
- 230000000875 corresponding effect Effects 0.000 claims description 23
- 230000033001 locomotion Effects 0.000 claims description 10
- 230000005540 biological transmission Effects 0.000 claims description 8
- 230000001276 controlling effect Effects 0.000 claims description 4
- 230000000630 rising effect Effects 0.000 claims description 3
- 230000008054 signal transmission Effects 0.000 claims description 3
- 230000004043 responsiveness Effects 0.000 claims 1
- 125000006850 spacer group Chemical group 0.000 claims 1
- 238000004080 punching Methods 0.000 abstract description 22
- 238000005516 engineering process Methods 0.000 abstract description 2
- 230000000007 visual effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 6
- 238000001514 detection method Methods 0.000 description 3
- 210000000245 forearm Anatomy 0.000 description 3
- 238000010009 beating Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000002452 interceptive effect Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000007667 floating Methods 0.000 description 1
- 210000004744 fore-foot Anatomy 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 229910000679 solder Inorganic materials 0.000 description 1
- 229910001220 stainless steel Inorganic materials 0.000 description 1
- 239000010935 stainless steel Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Landscapes
- Manipulator (AREA)
- Toys (AREA)
Abstract
Description
技术领域technical field
本发明涉及拳击模型机器人的控制技术。The invention relates to the control technology of a boxing model robot.
背景技术Background technique
拳击是一项惊险刺激的体育运动,所以常被用来作为新装置的主题。这些装置可以分成几类,第一类是与拳击功能相关的装置,如模拟拳击动作的装置,供人作为击打对象之用,采用类似原理的还有电子系统虚拟显示拳击动作的装置;第二类是可以对拳击动作进行辅助的装置;第三类,将拳击用作娱乐玩具,还有可以人在其中操作的机械拳击装置,有两人可以分别操作的仿拳击小机构,或单体仿拳击动作小机构作为观赏之用,但目前这类产品结构复杂、动作不灵活,且难以实现对左右臂分别控制。Boxing is such a thrilling sport that it is often used as the subject of new installations. These devices can be divided into several categories. The first category is devices related to boxing functions, such as devices that simulate boxing actions for people to use as hitting objects. Devices that use similar principles also use electronic systems to virtually display boxing actions; The second category is a device that can assist boxing actions; the third category uses boxing as an entertainment toy, and there are also mechanical boxing devices that can be operated by people. There are small imitation boxing mechanisms that two people can operate separately, or single Small mechanisms imitating boxing actions are used for viewing, but at present, such products have complex structures, inflexible movements, and it is difficult to control the left and right arms separately.
发明内容Contents of the invention
本发明的目的是为了解决现有的拳击模型机器人结构复杂、动作不灵活,且难以实现对左右臂分别控制的问题,提供一种多驱动遥控拳击模型机器人系统及该机器人系统的控制方法。The object of the present invention is to provide a multi-drive remote control boxing model robot system and a control method for the robot system in order to solve the problems of the existing boxing model robot with complex structure, inflexible movements, and difficulty in separately controlling the left and right arms.
本发明所述的多驱动遥控拳击模型机器人系统包括机器人、无线控制器和声光显示装置,无线控制器用于控制机器人动作以及接受机器人发出的信息;The multi-drive remote control boxing model robot system of the present invention includes a robot, a wireless controller and an acousto-optic display device, and the wireless controller is used to control the action of the robot and receive information from the robot;
所述机器人包括头部1、颈部2、身体3、左出拳机构4、右出拳机构5、前行走机构6、后行走机构7、中间升高凸轮8;The robot includes a head 1, a neck 2, a body 3, a left punching mechanism 4, a right punching mechanism 5, a front traveling mechanism 6, a rear traveling mechanism 7, and a middle raising cam 8;
所述身体3内设置有分别用于驱动头部1、颈部2、左出拳机构4、右出拳机构5、前行走机构6、后行走机构7和中间升高凸轮8的电动机以驱动各电动机的电动机驱动电路,身体3内还设置有无线通信模块、声光驱动电路和微处理器,身体的胸部设置有被击打区域9,所述被击打区域9由能够感受压力的压力传感器或压力传感器阵列构成;The body 3 is provided with motors for driving the head 1, the neck 2, the left punching mechanism 4, the right punching mechanism 5, the front traveling mechanism 6, the rear traveling mechanism 7 and the middle raising cam 8 to drive The motor drive circuit of each motor, the body 3 is also provided with a wireless communication module, an acousto-optic drive circuit and a microprocessor, and the chest of the body is provided with a hit area 9, and the hit area 9 is formed by a pressure that can feel pressure. sensor or pressure sensor array;
所述中间升高凸轮8位于身体3底部的中间;The middle lifting cam 8 is located in the middle of the bottom of the body 3;
所述的无线控制器包括单片机、无线通信模块、按键模块和显示模块,按键模块的信号输出端连接单片机的控制信号输入端,单片机的显示信号输出端连接显示模块的信号输入端,单片机通过无线通信模块与机器人进行信号传输;The wireless controller includes a single-chip microcomputer, a wireless communication module, a key module and a display module, the signal output end of the key module is connected to the control signal input end of the single-chip microcomputer, and the display signal output end of the single-chip microcomputer is connected to the signal input end of the display module. The communication module communicates with the robot for signal transmission;
所述的无线控制器接入网络,与其他多驱动遥控拳击模型机器人系统的无线控制器组成网络化系统;The wireless controller is connected to the network, and forms a networked system with wireless controllers of other multi-drive remote control boxing model robot systems;
所述单片机内嵌入有软件实现的无线控制模块,该无线控制模块包括以下单元:A wireless control module implemented by software is embedded in the single-chip microcomputer, and the wireless control module includes the following units:
键输入判断单元:判断是否有键输入,并在判断结果为是时启动参数键输入判断单元,在判断结果为否时返回启动键输入判断单元;Key input judging unit: judging whether there is a key input, and starting the parameter key input judging unit when the judging result is yes, and returning to start the key input judging unit when the judging result is no;
启动参数键输入判断单元:判断是否有参数键输入,并在判断结果为是时启动速度值存储单元,在判断结果为否时启动动作键输入判断单元;Start the parameter key input judgment unit: judge whether there is parameter key input, and start the speed value storage unit when the judgment result is yes, and start the action key input judgment unit when the judgment result is no;
速度值存储单元:记录速度值并将该速度值放入参数寄存器;Speed value storage unit: record the speed value and put the speed value into the parameter register;
动作键输入判断单元:判断是否有动作键输入,并在判断结果为是时启动动作标志寄存器置位单元,在判断结果为否时启动显示键输入判断单元;Action key input judgment unit: judge whether there is an action key input, and start the action flag register setting unit when the judgment result is yes, and start the display key input judgment unit when the judgment result is no;
动作标志寄存器置位单元:将动作标志寄存器的标志位置位;Action flag register setting unit: set the flag position of the action flag register;
显示键输入判断单元:判断是否有显示键输入,并在判断结果为是时启动显示标志寄存器置位单元,在判断结果为否时启动动作与速度数据发送单元;Display key input judging unit: judging whether there is display key input, and starting the display flag register setting unit when the judgment result is yes, and starting the action and speed data sending unit when the judgment result is no;
显示标志寄存器置位单元:将显示标志寄存器的标志位置位;Display flag register setting unit: set the flag position of the display flag register;
动作与速度数据发送单元:根据动作寄存器标志将对应的动作要求和参数寄存器中存储的速度值发送至数据寄存器;Action and speed data sending unit: send the corresponding action request and the speed value stored in the parameter register to the data register according to the action register flag;
显示数据发送单元:根据显示寄存器标志将该对应的显示数据寄存内容发送至显示缓存区;Display data sending unit: send the corresponding display data register content to the display buffer area according to the display register flag;
数据寄存器无线发送单元:通过无线通信模块发送发射数据寄存器内存储的数据;Data register wireless sending unit: send the data stored in the transmitting data register through the wireless communication module;
机器人数据接收单元:接收机器人发来的数据并将该数据存入显示数据寄存器;Robot data receiving unit: receive the data sent by the robot and store the data in the display data register;
显示缓存区数据发送单元:将显示缓存区存储的数据发送至声光显示装置;Display buffer area data sending unit: send the data stored in the display buffer area to the acousto-optic display device;
停止信号判断单元:判断是否有停止信号输入,并在判断结果为是时结束控制模块,在判断结果为否时启动键输入判断单元;Stop signal judging unit: judging whether there is a stop signal input, and ending the control module when the judging result is yes, and starting the key input judging unit when the judging result is no;
所述的速度值包括动作速度、击打速度和升高速度;The speed value includes action speed, hitting speed and raising speed;
所述的动作键包括前进键、后退键、前左转/左横移键、前右转/右横移键、后左转键、后右转键、升高键和击打键;The action keys include a forward key, a backward key, a front left turn/left traverse key, a front right turn/right traverse key, a rear left turn key, a rear right turn key, a raise key and a hit key;
所述的动作标志寄存器的标志位包括前进标志位、后退标志位、前左转/左横移标志位、前右转/右横移标志位、后左转标志位、后右转标志位、升高标志位或击打标志位;The flag bits of the action flag register include a forward flag, a backward flag, a front left turn/left traverse flag, a front right turn/right traverse flag, a rear left turn flag, a rear right turn flag, Raise the flag or hit the flag;
所述的显示键包括显示总比分键、显示状态键和示当前比分键;The display keys include a key for displaying the total score, a key for displaying status and a key for displaying the current score;
所述的显示标志寄存器的标志位包括显示总比分标志位、显示状态标志位和示当前比分标志位;The flag bit of the display flag register includes a flag bit for displaying the total score, a flag bit for display status and a flag bit for showing the current score;
所述的微处理器内嵌入有软件实现的机器人控制模块,该机器人控制模块包括以下单元:A robot control module implemented by software is embedded in the microprocessor, and the robot control module includes the following units:
信息接收单元:不断接收由无线通信模块发来的信息;Information receiving unit: continuously receive information sent by the wireless communication module;
动作和速度控制单元:根据无线通信模块发来的数据寄存器的数据,驱动相应的电动机;Action and speed control unit: drive the corresponding motor according to the data of the data register sent by the wireless communication module;
击打状况采集单元:采集被击打区域9发来的信息,判断机器人是否被击打,并在判断结果为是时启动声光报警控制信号发送步骤,在判断结果为否时重新启动击打状况采集单元;Striking status acquisition unit: collect the information sent by the stricken area 9, judge whether the robot is slapped, and start the sound and light alarm control signal sending step when the judging result is yes, and restart hitting when the judging result is no Status collection unit;
声光报警控制信号发送单元:向声光显示装置发送控制信号。Sound and light alarm control signal sending unit: send control signals to the sound and light display device.
本发明所述的多驱动遥控拳击模型机器人系统的控制方法,该控制方法包括无线控制方法和机器人控制方法;The control method of the multi-drive remote control boxing model robot system according to the present invention, the control method includes a wireless control method and a robot control method;
所述无线控制方法包括以下步骤:The wireless control method includes the following steps:
键输入判断步骤:判断是否有键输入,并在判断结果为是时执行参数键输入判断步骤,在判断结果为否时返回执行键输入判断步骤;Key input judging step: judging whether there is a key input, and executing the parameter key input judging step when the judging result is yes, and returning to executing the key input judging step when the judging result is no;
参数键输入判断步骤:判断是否有参数键输入,并在判断结果为是时执行速度值存储步骤,在判断结果为否时执行动作键输入判断步骤;Parameter key input judging step: judging whether there is parameter key input, and executing the speed value storage step when the judging result is yes, and executing the action key input judging step when the judging result is no;
速度值存储步骤:记录速度值并将该速度值放入参数寄存器,并在该步骤结束之后执行动作键输入判断步骤;Speed value storage step: record the speed value and put the speed value into the parameter register, and execute the action key input judgment step after this step ends;
动作键输入判断步骤:判断是否有动作键输入,并在判断结果为是时执行动作标志寄存器置位步骤,在判断结果为否时执行显示键输入判断步骤;Action key input judging step: judging whether there is an action key input, and executing the action flag register setting step when the judgment result is yes, and executing the display key input judgment step when the judgment result is no;
动作标志寄存器置位步骤:将动作标志寄存器的标志位置位,并在该步骤结束之后执行显示键输入判断步骤;Action flag register setting step: set the flag position of the action flag register, and execute the display key input judgment step after this step ends;
显示键输入判断步骤:判断是否有显示键输入,并在判断结果为是时执行显示标志寄存器置位步骤,在判断结果为否时执行动作与速度数据发送步骤;Display key input judging step: judging whether there is a display key input, and performing the step of setting the display flag register when the judgment result is yes, and executing the action and speed data sending step when the judgment result is no;
显示标志寄存器置位步骤:将显示标志寄存器的标志位置位,并在该步骤结束之后执行动作与速度数据发送步骤;Display flag register setting step: set the flag position of the display flag register, and execute the action and speed data sending step after the step ends;
动作与速度数据发送步骤:根据动作寄存器标志将对应的动作要求和参数寄存器中存储的速度值发送至数据寄存器,并在该步骤结束之后执行显示数据发送步骤;Action and speed data sending step: send the corresponding action request and the speed value stored in the parameter register to the data register according to the action register flag, and execute the display data sending step after the step ends;
显示数据发送步骤:根据显示寄存器标志将该对应的显示数据寄存内容发送至显示缓存区,并在该步骤结束之后执行数据寄存器无线发送步骤;Display data sending step: send the corresponding display data register content to the display buffer area according to the display register flag, and perform the data register wireless sending step after the step ends;
数据寄存器无线发送步骤:通过无线通信模块发送发射数据寄存器内存储的数据,并在该步骤结束之后执行机器人数据接收步骤;Data register wireless sending step: send the data stored in the transmitting data register through the wireless communication module, and execute the robot data receiving step after the step ends;
机器人数据接收步骤:接收机器人发来的数据并将该数据存入显示数据寄存器,并在该步骤结束之后执行显示缓存区数据发送步骤;Robot data receiving step: receive the data sent by the robot and store the data in the display data register, and execute the display buffer data sending step after this step;
显示缓存区数据发送步骤:将显示缓存区存储的数据发送至声光显示装置,并在该步骤结束之后执行停止信号判断步骤;The step of sending data in the display buffer area: sending the data stored in the display buffer area to the acousto-optic display device, and executing the stop signal judging step after the step;
停止信号判断步骤:判断是否有停止信号输入,并在判断结果为是时结束控制方法,在判断结果为否时执行键输入判断步骤;Stop signal judging step: judging whether there is a stop signal input, and ending the control method when the judging result is yes, and executing the key input judging step when the judging result is no;
所述机器人控制方法包括以下步骤:The robot control method includes the following steps:
信息接收步骤:不断接收由无线通信模块发来的信息,并在该步骤结束之后执行动作和速度控制步骤;Information receiving step: continuously receive the information sent by the wireless communication module, and execute the action and speed control steps after the step ends;
动作和速度控制步骤:根据无线通信模块发来的数据寄存器的数据,驱动相应的电动机;Action and speed control steps: drive the corresponding motor according to the data of the data register sent by the wireless communication module;
击打状况采集步骤:采集被击打区域9发来的信息,判断机器人是否被击打,并在判断结果为是时执行声光报警控制信号发送步骤,在判断结果为否时返回执行击打状况采集步骤;Beating status collection step: collect the information sent from the hit area 9, judge whether the robot has been hit, and execute the sound and light alarm control signal sending step when the judgment result is yes, and return to execute the hit when the judgment result is no Status collection steps;
声光报警控制信号发送步骤:向声光显示装置发送控制信号,并在该步骤结束之后返回执行击打状况采集步骤。The step of sending the sound and light alarm control signal: sending the control signal to the sound and light display device, and returning to the step of collecting the striking situation after the step is completed.
本发明的优点:1、主要动作直观,零件简单,动作灵活;2、左、右臂分别控制,互不干涉。Advantages of the present invention: 1. The main action is intuitive, the parts are simple, and the action is flexible; 2. The left and right arms are controlled separately without interfering with each other.
附图说明Description of drawings
图1为实施方式一所述的多驱动遥控拳击模型机器人系统的结构示意图的主视图;Fig. 1 is the front view of the structural schematic diagram of the multi-drive remote control boxing model robot system described in Embodiment 1;
图2为图1的右视图;Fig. 2 is the right view of Fig. 1;
图3为实施方式一所述的多驱动遥控拳击模型机器人系统的原理框图;Fig. 3 is the functional block diagram of the multi-drive remote control boxing model robot system described in Embodiment 1;
图4为实施方式一中的左出拳机构4和右出拳机构5的原理示意图;Fig. 4 is a schematic diagram of the principle of the left punching mechanism 4 and the right punching mechanism 5 in Embodiment 1;
图5为实施方式三中电动机驱动电路的结构图;5 is a structural diagram of a motor drive circuit in Embodiment 3;
图6为实施方式三中电动机驱动电路的一种具体的电路结构;FIG. 6 is a specific circuit structure of the motor drive circuit in Embodiment 3;
图7为实施方式六中压力传感器与微处理器的连接关系示意图;Fig. 7 is a schematic diagram of the connection relationship between the pressure sensor and the microprocessor in Embodiment 6;
图8为实施方式八中的机器人的结构示意图;Fig. 8 is a schematic structural diagram of the robot in Embodiment 8;
图9为实施方式八中的机器人出拳的原理示意图;Fig. 9 is a schematic diagram of the principle of the robot punching in the eighth embodiment;
图10为实施方式九所述的多驱动遥控拳击模型机器人系统的控制方法的流程图。Fig. 10 is a flow chart of the control method of the multi-drive remote control boxing model robot system described in the ninth embodiment.
具体实施方式Detailed ways
具体实施方式一:结合图1至图4、图10说明本实施方式,本实施方式所述的多驱动遥控拳击模型机器人系统包括机器人、无线控制器和声光显示装置,无线控制器用于控制机器人动作以及接受机器人发出的信息;Specific Embodiment 1: This embodiment is described in conjunction with Fig. 1 to Fig. 4 and Fig. 10. The multi-drive remote control boxing model robot system described in this embodiment includes a robot, a wireless controller and an acousto-optic display device, and the wireless controller is used to control the robot. actions and receiving messages from the robot;
所述机器人包括头部1、颈部2、身体3、左出拳机构4、右出拳机构5、前行走机构6、后行走机构7、中间升高凸轮8;The robot includes a head 1, a neck 2, a body 3, a left punching mechanism 4, a right punching mechanism 5, a front traveling mechanism 6, a rear traveling mechanism 7, and a middle raising cam 8;
所述身体3内设置有分别用于驱动头部1、颈部2、左出拳机构4、右出拳机构5、前行走机构6、后行走机构7和中间升高凸轮8的电动机以驱动各电动机的电动机驱动电路,身体3内还设置有无线通信模块、声光驱动电路和微处理器,身体的胸部设置有被击打区域9,所述被击打区域9由能够感受压力的压力传感器或压力传感器阵列构成;The body 3 is provided with motors for driving the head 1, the neck 2, the left punching mechanism 4, the right punching mechanism 5, the front traveling mechanism 6, the rear traveling mechanism 7 and the middle raising cam 8 to drive The motor drive circuit of each motor, the body 3 is also provided with a wireless communication module, an acousto-optic drive circuit and a microprocessor, and the chest of the body is provided with a hit area 9, and the hit area 9 is formed by a pressure that can feel pressure. sensor or pressure sensor array;
所述中间升高凸轮8位于身体3底部的中间;The middle lifting cam 8 is located in the middle of the bottom of the body 3;
所述的无线控制器包括单片机、无线通信模块、按键模块和显示模块,按键模块的信号输出端连接单片机的控制信号输入端,单片机的显示信号输出端连接显示模块的信号输入端,单片机通过无线通信模块与机器人进行信号传输;The wireless controller includes a single-chip microcomputer, a wireless communication module, a key module and a display module, the signal output end of the key module is connected to the control signal input end of the single-chip microcomputer, and the display signal output end of the single-chip microcomputer is connected to the signal input end of the display module. The communication module communicates with the robot for signal transmission;
所述的无线控制器接入网络,与其他多驱动遥控拳击模型机器人系统的无线控制器组成网络化系统;The wireless controller is connected to the network, and forms a networked system with wireless controllers of other multi-drive remote control boxing model robot systems;
所述单片机内嵌入有软件实现的无线控制模块,该无线控制模块包括以下单元:A wireless control module implemented by software is embedded in the single-chip microcomputer, and the wireless control module includes the following units:
键输入判断单元:判断是否有键输入,并在判断结果为是时启动参数键输入判断单元,在判断结果为否时返回启动键输入判断单元;Key input judging unit: judging whether there is a key input, and starting the parameter key input judging unit when the judging result is yes, and returning to start the key input judging unit when the judging result is no;
启动参数键输入判断单元:判断是否有参数键输入,并在判断结果为是时启动速度值存储单元,在判断结果为否时启动动作键输入判断单元;Start the parameter key input judgment unit: judge whether there is parameter key input, and start the speed value storage unit when the judgment result is yes, and start the action key input judgment unit when the judgment result is no;
速度值存储单元:记录速度值并将该速度值放入参数寄存器;Speed value storage unit: record the speed value and put the speed value into the parameter register;
动作键输入判断单元:判断是否有动作键输入,并在判断结果为是时启动动作标志寄存器置位单元,在判断结果为否时启动显示键输入判断单元;Action key input judgment unit: judge whether there is an action key input, and start the action flag register setting unit when the judgment result is yes, and start the display key input judgment unit when the judgment result is no;
动作标志寄存器置位单元:将动作标志寄存器的标志位置位;Action flag register setting unit: set the flag position of the action flag register;
显示键输入判断单元:判断是否有显示键输入,并在判断结果为是时启动显示标志寄存器置位单元,在判断结果为否时启动动作与速度数据发送单元;Display key input judging unit: judging whether there is display key input, and starting the display flag register setting unit when the judgment result is yes, and starting the action and speed data sending unit when the judgment result is no;
显示标志寄存器置位单元:将显示标志寄存器的标志位置位;Display flag register setting unit: set the flag position of the display flag register;
动作与速度数据发送单元:根据动作寄存器标志将对应的动作要求和参数寄存器中存储的速度值发送至数据寄存器;Action and speed data sending unit: send the corresponding action request and the speed value stored in the parameter register to the data register according to the action register flag;
显示数据发送单元:根据显示寄存器标志将该对应的显示数据寄存内容发送至显示缓存区;Display data sending unit: send the corresponding display data register content to the display buffer area according to the display register flag;
数据寄存器无线发送单元:通过无线通信模块发送发射数据寄存器内存储的数据;Data register wireless sending unit: send the data stored in the transmitting data register through the wireless communication module;
机器人数据接收单元:接收机器人发来的数据并将该数据存入显示数据寄存器;Robot data receiving unit: receive the data sent by the robot and store the data in the display data register;
显示缓存区数据发送单元:将显示缓存区存储的数据发送至声光显示装置;Display buffer area data sending unit: send the data stored in the display buffer area to the acousto-optic display device;
停止信号判断单元:判断是否有停止信号输入,并在判断结果为是时结束控制模块,在判断结果为否时启动键输入判断单元;Stop signal judging unit: judging whether there is a stop signal input, and ending the control module when the judging result is yes, and starting the key input judging unit when the judging result is no;
所述的速度值包括动作速度、击打速度和升高速度;The speed value includes action speed, hitting speed and raising speed;
所述的动作键包括前进键、后退键、前左转/左横移键、前右转/右横移键、后左转键、后右转键、升高键和击打键;The action keys include a forward key, a backward key, a front left turn/left traverse key, a front right turn/right traverse key, a rear left turn key, a rear right turn key, a raise key and a hit key;
所述的动作标志寄存器的标志位包括前进标志位、后退标志位、前左转/左横移标志位、前右转/右横移标志位、后左转标志位、后右转标志位、升高标志位或击打标志位;The flag bits of the action flag register include a forward flag, a backward flag, a front left turn/left traverse flag, a front right turn/right traverse flag, a rear left turn flag, a rear right turn flag, Raise the flag or hit the flag;
所述的显示键包括显示总比分键、显示状态键和示当前比分键;The display keys include a key for displaying the total score, a key for displaying status and a key for displaying the current score;
所述的显示标志寄存器的标志位包括显示总比分标志位、显示状态标志位和示当前比分标志位;The flag bit of the display flag register includes a flag bit for displaying the total score, a flag bit for display status and a flag bit for showing the current score;
所述的微处理器内嵌入有软件实现的机器人控制模块,该机器人控制模块包括以下单元:A robot control module implemented by software is embedded in the microprocessor, and the robot control module includes the following units:
信息接收单元:不断接收由无线通信模块发来的信息;Information receiving unit: continuously receive information sent by the wireless communication module;
动作和速度控制单元:根据无线通信模块发来的数据寄存器的数据,驱动相应的电动机;Action and speed control unit: drive the corresponding motor according to the data of the data register sent by the wireless communication module;
击打状况采集单元:采集被击打区域9发来的信息,判断机器人是否被击打,并在判断结果为是时启动声光报警控制信号发送步骤,在判断结果为否时重新启动击打状况采集单元;Striking status acquisition unit: collect the information sent by the stricken area 9, judge whether the robot is slapped, and start the sound and light alarm control signal sending step when the judging result is yes, and restart hitting when the judging result is no Status collection unit;
声光报警控制信号发送单元:向声光显示装置发送控制信号。Sound and light alarm control signal sending unit: send control signals to the sound and light display device.
本实施方式中,左出拳机构4和右出拳机构5相当于机器人的左臂和右臂,且左出拳机构4和右出拳机构5的结构相同。前行走机构6和后行走机构7相当于机器人的腿,中间升高凸轮8用于带动机器人的身体上升或下降。图3中的左拳击电动机和右拳击电动机分别用于控制左出拳机构4和右出拳机构5,中间升高凸轮8包括左升高凸轮和右升高凸轮,左升高电动机和右升高电动机分别用于控制所述左升高凸轮和右升高凸轮,前行走机构6使用不加驱动控制的滚动轮实现,左行走电动机和右行走电动机用于控制后行走机构7。In this embodiment, the left punching mechanism 4 and the right punching mechanism 5 are equivalent to the left arm and the right arm of the robot, and the structures of the left punching mechanism 4 and the right punching mechanism 5 are the same. Front traveling mechanism 6 and rear traveling mechanism 7 are equivalent to the legs of robot, and middle raising cam 8 is used to drive the body of robot to rise or fall. The left boxing motor and the right boxing motor in Fig. 3 are respectively used to control the left punching mechanism 4 and the right punching mechanism 5, and the middle raising cam 8 includes a left raising cam and a right raising cam, a left raising motor and a right raising cam. High motor is used to control described left raising cam and right raising cam respectively, and front traveling mechanism 6 uses the rolling wheel that does not add driving control to realize, and left traveling motor and right traveling motor are used for controlling rear traveling mechanism 7.
左出拳机构4和右出拳机构5结构相同,均包括前臂4-1、后臂4-2、前连杆4-3、曲柄4-4和后连杆4-8,参见图4所示,其中G表示固定轴,F表示浮动轴。The left punching mechanism 4 and the right punching mechanism 5 have the same structure, and both include a forearm 4-1, a rear arm 4-2, a front connecting rod 4-3, a crank 4-4 and a rear connecting rod 4-8, as shown in Fig. 4 , where G represents a fixed axis and F represents a floating axis.
当电动机按标定方向旋转(或正转和反转交替选转时)曲柄4-4带动后连杆4-8使后臂4-2的前端做上下摆动,使前臂4-1的“拳头”做出拳动作。图4中A为未出击时“拳头”的位置,B为出击时“拳头”的位置。When the motor rotates in the calibrated direction (or forward rotation and reverse rotation are alternately selected), the crank 4-4 drives the rear connecting rod 4-8 to make the front end of the rear arm 4-2 swing up and down, so that the "fist" of the forearm 4-1 Make a punching motion. In Fig. 4, A is the position of the "fist" when not attacking, and B is the position of the "fist" when attacking.
使用无线控制器控制机器人的前进、后退、升高、左转、右转、拳击等动作,并接收机器人发出的信息,机器人的指定区域受到击打后,会通过声光显示装置进行提示,并向无线控制器发送信息。无线控制器的无线通信模块与机器人的控制器的无线通信模块是一样的,都可以双向传送信息。Use the wireless controller to control the robot's forward, backward, elevation, left turn, right turn, boxing and other actions, and receive the information sent by the robot. After the designated area of the robot is hit, it will be prompted through the sound and light display device, and Send information to the wireless controller. The wireless communication module of the wireless controller is the same as that of the robot controller, both of which can transmit information in both directions.
当使用无线控制器设定速度时,其内部的单片机判断是动作速度、击打速度还是升高速度,判断完成后将相应的速度值进行存储;进行动作设定时,单片机判断是否为后退、前左转(或左移)、前右转(或右移)、后左转、后右转、升高或击打,判断完成后,将动作标志器中相应的标志位进行置位;进行显示设定时,单片机判断是否为总比分显示、状态显示或者当前比分显示,判断完成后,将显示寄存器中相应的标志位进行置位;最后,将用户设定的动作以及与该动作对应的速度值发送至发射数据寄存器,再通过无线通信模块将发射数据寄存器内存储的信息发送至机器人;将显示寄存器内各标志位对应的信息通过显示缓存区发送至声光显示装置以进行显示。控制过程中,如果有停止信号输入,则控制过程随时停止。When using the wireless controller to set the speed, the internal single-chip microcomputer judges whether it is the action speed, hitting speed or rising speed, and stores the corresponding speed value after the judgment is completed; when setting the action, the single-chip microcomputer judges whether it is backward, Turn left (or move left), turn right (or move right), turn left, turn right, raise or hit, after the judgment is completed, set the corresponding flag in the action marker; When setting the display, the MCU judges whether it is the total score display, the status display or the current score display. After the judgment is completed, the corresponding flag in the display register is set; finally, the action set by the user and the action corresponding to the action are set. The speed value is sent to the launch data register, and then the information stored in the launch data register is sent to the robot through the wireless communication module; the information corresponding to each flag in the display register is sent to the acousto-optic display device for display through the display buffer. During the control process, if there is a stop signal input, the control process will stop at any time.
机器人身体内的微控制器通过无线通信模块,接收无线控制器发来的控制信息,然后根据这些信息控制相应的电动机驱动电路,以控制各电动机工作,实现对机器人各种动作的控制;并采集被击打区域9所安放的传感器或传感器阵列的信息,判断是不是被击打,在被击打时发出声光报警控制信号,并上传给无线控制器;与无线控制器进行必要的其它信息交互通信。The microcontroller in the robot body receives the control information sent by the wireless controller through the wireless communication module, and then controls the corresponding motor drive circuit according to the information to control the operation of each motor and realize the control of various actions of the robot; and collect The information of the sensor or sensor array placed in the hit area 9 determines whether it is hit, and sends out an audible and visual alarm control signal when being hit, and uploads it to the wireless controller; communicates with the wireless controller for other necessary information interactive communication.
无线控制器还可以接入网络,与其它无线控制器组成网络化系统,每个无线控制器的数据都可以通过网络上传,网络化系统具有很多功能,例如会员管理,以及对每个无线控制器的操作情况进行评分等。The wireless controller can also be connected to the network to form a networked system with other wireless controllers. The data of each wireless controller can be uploaded through the network. The networked system has many functions, such as member management, and the performance ratings, etc.
具体实施方式二:本实施方式是对实施方式一所述的多驱动遥控拳击模型机器人系统的进一步限定,本实施方式中,所述的电动机为刷直流电动机或永磁同步电动机。Embodiment 2: This embodiment is a further limitation of the multi-drive remote control boxing model robot system described in Embodiment 1. In this embodiment, the motor is a brushed DC motor or a permanent magnet synchronous motor.
具体实施方式三:结合图5和图6说明本实施方式,本实施方式是对实施方式二所述的多驱动遥控拳击模型机器人系统的进一步限定,本实施方式中,所述的电动机驱动电路包括微处理器及运动控制器、三相桥式电路前级驱动器和三相桥式电路,微处理器及运动控制器的控制信号输出端连接三相桥式电路前级驱动器的控制信号输入端,三相桥式电路前级驱动器的驱动信号输出端连接三相桥式电路的驱动信号输入端,三相桥式电路的驱动信号输出端用于连接电动机的驱动信号输入端,微处理器及运动控制器的反馈信号输入端用于连接电动机的反馈信号输出端。Specific Embodiment Three: This embodiment is described in conjunction with Fig. 5 and Fig. 6. This embodiment is a further limitation of the multi-drive remote control boxing model robot system described in Embodiment 2. In this embodiment, the motor drive circuit includes The microprocessor and the motion controller, the pre-driver of the three-phase bridge circuit and the three-phase bridge circuit, the control signal output terminals of the microprocessor and the motion controller are connected to the control signal input terminals of the pre-driver of the three-phase bridge circuit, The drive signal output terminal of the pre-driver of the three-phase bridge circuit is connected to the drive signal input terminal of the three-phase bridge circuit, and the drive signal output terminal of the three-phase bridge circuit is used to connect the drive signal input terminal of the motor, the microprocessor and the motion The feedback signal input terminal of the controller is used to connect the feedback signal output terminal of the motor.
图6所示为一种具体的电动机驱动电路的结构。Figure 6 shows the structure of a specific motor drive circuit.
具体实施方式四:本实施方式是对实施方式一所述的多驱动遥控拳击模型机器人系统的进一步限定,本实施方式中,无线通信模块采用WiFi通信。Embodiment 4: This embodiment is a further limitation of the multi-drive remote control boxing model robot system described in Embodiment 1. In this embodiment, the wireless communication module uses WiFi communication.
具体实施方式五:本实施方式是对实施方式四所述的多驱动遥控拳击模型机器人系统的进一步限定,本实施方式中,无线通信模块采用USR-WIFI232-T型通信模块或LSD5WF-3017型通信模块。Embodiment 5: This embodiment is a further limitation of the multi-drive remote control boxing model robot system described in Embodiment 4. In this embodiment, the wireless communication module adopts a USR-WIFI232-T communication module or a LSD5WF-3017 communication module. module.
USR-WIFI232-T是一款集成了所有Wi-Fi功能的小巧模块,尺寸仅22mm x 13.5mm x6mm。针对照明和插座等应用领域,采用了1x10管脚2mm插针连接器,易于焊装在客户的产品的硬件单板电路上。模块配备有特制的焊盘或外置天线连接器,适用于各种外置天线的应用。USR-WIFI232-T is a compact module that integrates all Wi-Fi functions, with a size of only 22mm x 13.5mm x6mm. For applications such as lighting and sockets, a 1x10-pin 2mm pin connector is used, which is easy to solder and install on the hardware single-board circuit of the customer's product. The modules are equipped with special pads or external antenna connectors for various external antenna applications.
超低功耗嵌入式Wi-Fi模组提供了一种将用户的物理设备连接到Wi-Fi无线网络上,并提供UART串口等接口传输数据的解决方案。该模块硬件上集成了MAC,基频芯片,射频收发单元,以及功率放大器;嵌入式的固件则支持Wi-Fi协议及配置,以及组网的TCP/IP协议栈。USR-WIFI232-T是一款一体化的802.11b/g/n Wi-Fi的低功耗解决方案,通过USR-WIFI232-T模组,传统的低端串口设备或MCU控制的设备均可以很方便的接入Wi-Fi无线网络,从而实现物联网络控制与管理。The ultra-low power embedded Wi-Fi module provides a solution to connect the user's physical equipment to the Wi-Fi wireless network and provide interfaces such as UART serial ports to transmit data. The module hardware integrates MAC, baseband chip, RF transceiver unit, and power amplifier; the embedded firmware supports Wi-Fi protocol and configuration, as well as the TCP/IP protocol stack for networking. USR-WIFI232-T is an integrated 802.11b/g/n Wi-Fi low-power solution. Through the USR-WIFI232-T module, traditional low-end serial devices or MCU-controlled devices can be easily Convenient access to Wi-Fi wireless network, so as to realize the control and management of the Internet of Things network.
LSD5WF-3017是专门为实现嵌入式系统的无线局域网通信应用而设计的一款高性能、低成本IEEE 802.11b/g/n的USB接口无线模块,使用该模块能够使用户通过嵌入式硬件USB Host接口高效快捷的扩展出无线局域网通信功能。模块核心为一个高度集成的MIMO(多输入、多输出)、MAC、2T2R基带和2.4G射频芯片,支持PHY速率高达300Mbps,完全符合IEEE 802.11b/g/n标准规范,优化的射频架构和基带算法提供了卓越性能与低功耗。LSD5WF-3017模块设计基于安全的标准特性范围,将为客户提供高质量并符合国际标准一种简单、低成本、可靠的拥有无线网络功能产品的设计方案。LSD5WF-3017 is a high-performance, low-cost IEEE 802.11b/g/n USB interface wireless module specially designed for wireless LAN communication applications in embedded systems. The interface efficiently and quickly expands the wireless LAN communication function. The core of the module is a highly integrated MIMO (multiple input, multiple output), MAC, 2T2R baseband and 2.4G radio frequency chip, supporting PHY rate up to 300Mbps, fully compliant with IEEE 802.11b/g/n standard specifications, optimized radio frequency architecture and baseband algorithm provides excellent performance and low power consumption. The LSD5WF-3017 module design is based on a safe standard feature range, and will provide customers with a simple, low-cost, and reliable design solution for products with wireless network functions that meet international standards.
NRF905单片无线收发器是挪威Nordic公司推出的单片射频发射器芯片,工作电压为1.9-3.6V,32引脚QFN封装。其特性如下:NRF905 single-chip wireless transceiver is a single-chip radio frequency transmitter chip launched by Nordic company in Norway. The working voltage is 1.9-3.6V and it is packaged in 32-pin QFN. Its characteristics are as follows:
(1)433Mhz开放ISM频段免许可使用。(1) 433Mhz open ISM frequency band for license-free use.
(2)最高工作频率50kbps,高效GFSK调制,抗干扰能力强,提别适合工业控制场合。(2) The maximum working frequency is 50kbps, high-efficiency GFSK modulation, strong anti-interference ability, especially suitable for industrial control occasions.
(3)125频道,满足多点通信和跳频通信需要。(3) 125 channels to meet the needs of multipoint communication and frequency hopping communication.
(4)内置硬件CRC检错和点对多点通信地址控制。(4) Built-in hardware CRC error detection and point-to-multipoint communication address control.
(5)低功耗1.9V-3.6V工作,待机模式下状态仅为2.5uA(5) Low power consumption 1.9V-3.6V work, only 2.5uA in standby mode
(6)收发模式切换时间<650us(6) Transceiver mode switching time <650us
(7)模块可软件设地址,只有收到本机地址时才会输出数据,可直接接各种单片机使用,软件编程非常方便。(7) The address of the module can be set by software, and the data will be output only when the address of the local machine is received. It can be directly connected to various single-chip microcomputers, and the software programming is very convenient.
(8)TX Mode:在+10dBm情况下,电流为30mA;RX Mode:12.2mA。(8) TX Mode: In the case of +10dBm, the current is 30mA; RX Mode: 12.2mA.
(9)标准DIP间距接口,便于嵌入式应用。(9) Standard DIP spacing interface, convenient for embedded applications.
(10)RFModule-Quick-DEV快速开发系统,含开发板。(10) RFModule-Quick-DEV rapid development system, including development board.
NRF905无线通信模块引脚功能如下表1所示:The pin functions of the NRF905 wireless communication module are shown in Table 1 below:
表1 NRF905无线通信模块的引脚功能Table 1 Pin functions of NRF905 wireless communication module
发送接收流程如下。The sending and receiving process is as follows.
ShockBurst TX发送流程:当微控制器有数据要发送时,通过SPI接口,按时序接收机的地址和要发送的数据送传给模块,SPI接口速率在通信协议和器件配置时确定。微控制器置高TRX_CE和TX_EN,激发模块的ShockBurstTM发送模式。模块自动发送,过程包括:(1)射频寄存器自动开启;(2)数据打包;(3)发送数据包;(4)当数据发送完成,数据准备好引脚被置高。如果AUTO_RETRAN被置高,模块会不断重发,直到TRX_CE被置低。当TRX_CE被置低,模块发送过程完成,自动进入空闲模式。ShockBurst TX sending process: When the microcontroller has data to send, through the SPI interface, the address of the receiver and the data to be sent are sent to the module according to the timing. The SPI interface rate is determined during the communication protocol and device configuration. The microcontroller sets TRX_CE and TX_EN high to stimulate the ShockBurstTM transmission mode of the module. The module automatically sends, and the process includes: (1) The radio frequency register is automatically turned on; (2) Data packaging; (3) Sending data packets; (4) When the data transmission is completed, the data ready pin is set high. If AUTO_RETRAN is set high, the module will keep retransmitting until TRX_CE is set low. When TRX_CE is set low, the module transmission process is completed and automatically enters idle mode.
ShockBurst RX接收流程:当TRX_CE为高、TX_EN为低时,模块进入ShockBurst TM接收模式。650us后,模块不断检测,等待接收数据。当模块检测到同一频段的载波时,载波检测引脚被置高。当接收到一个相匹配的地址,AM引脚被置高。当一个正确的数据包接收完毕,模块自动移去字头、地址和CRC校验位,然后把DR引脚置高。微控制器把TRX_CE置低,模块进入空闲模式。微控制器通过PSI口,以一定的速率把数据移动到微控制器内。当所有的数据接收完毕,模块把DR引脚和AM引脚置低。模块此时进入接收模式、发送模式或关机模式。ShockBurst RX receiving process: When TRX_CE is high and TX_EN is low, the module enters ShockBurst TM receiving mode. After 650us, the module continues to detect, waiting to receive data. When the module detects the carrier of the same frequency band, the carrier detection pin is set high. When a matching address is received, the AM pin is asserted high. When a correct data packet is received, the module automatically removes the header, address and CRC check bit, and then sets the DR pin high. The microcontroller sets TRX_CE low and the module enters idle mode. The microcontroller moves data into the microcontroller at a certain rate through the PSI port. When all the data has been received, the module sets the DR pin and AM pin low. The module enters receive mode, transmit mode or shutdown mode at this time.
具体实施方式六:结合图7说明本实施方式,本实施方式是对实施方式一所述的多驱动遥控拳击模型机器人系统的进一步限定,本实施方式中,所述的压力传感器阵列由多个FB09微型单压力传感器构成。Embodiment 6: This embodiment is described in conjunction with FIG. 7. This embodiment is a further limitation of the multi-drive remote control boxing model robot system described in Embodiment 1. In this embodiment, the pressure sensor array is composed of a plurality of FB09 A miniature single pressure sensor constitutes.
本实施方式中,每个FB09微型单压力传感器均连接微处理器中的A/D转换器,如图7所示,图中圆圈表示压力传感器。使用在被击打区域矩阵式排列的压力传感器监测被击打情况。一旦发生被击打情况,压力传感器输出相应的电信号,送到信号处理电路进行处理,再进行声光显示和向遥控器发送信息。In this embodiment, each FB09 miniature single pressure sensor is connected to the A/D converter in the microprocessor, as shown in FIG. 7 , the circles in the figure represent pressure sensors. Strikes are monitored using pressure sensors arranged in a matrix in the stricken area. Once being hit, the pressure sensor outputs a corresponding electrical signal, which is sent to the signal processing circuit for processing, and then performs acousto-optic display and sends information to the remote control.
FB09微型单压力传感器采用不锈钢制作而成,体积小,输出信号大,广泛的应用于空间狭小领域,如开关压力检测等电子行业测力装置。FB09微型单压力传感器参数如表2所示,量程如表3所示。FB09 miniature single pressure sensor is made of stainless steel, with small size and large output signal, it is widely used in small space fields, such as switch pressure detection and other electronic industry force measuring devices. The parameters of the FB09 miniature single pressure sensor are shown in Table 2, and the range is shown in Table 3.
表2 FB09微型单压力传感器参数Table 2 FB09 miniature single pressure sensor parameters
表3 FB09微型单压力传感器的量程Table 3 Range of FB09 miniature single pressure sensor
具体实施方式七:本实施方式是对实施方式一所述的多驱动遥控拳击模型机器人系统的进一步限定,本实施方式中,所述的压力传感器由压力微动开关构成。Embodiment 7: This embodiment is a further limitation of the multi-drive remote control boxing model robot system described in Embodiment 1. In this embodiment, the pressure sensor is composed of a pressure micro switch.
当被击打区域9由能够感受压力的压力传感器构成时,所述压力传感器采用压力微动开关实现。When the struck area 9 is composed of a pressure sensor capable of feeling pressure, the pressure sensor is realized by a pressure micro switch.
具体实施方式八:本实施方式是对实施方式一所述的多驱动遥控拳击模型机器人系统的进一步限定,本实施方式中,所述的声光显示装置包括声光显示装置和发光二极管。Embodiment 8: This embodiment is a further limitation of the multi-drive remote control boxing model robot system described in Embodiment 1. In this embodiment, the acousto-optic display device includes an acousto-optic display device and a light-emitting diode.
用微处理器的定时器产生脉冲并经输出口输出,放大后可以加到蜂鸣器上,产生声音报警。可以用数字输出口的高低电平控制开关电路,让开关电路控制发光二极管实现光报警。The pulse is generated by the timer of the microprocessor and output through the output port, and can be added to the buzzer after being amplified to generate a sound alarm. The high and low level of the digital output port can be used to control the switch circuit, so that the switch circuit controls the light-emitting diode to realize the light alarm.
具体实施方式九:结合图8和图9说明本实施方式,本实施方式是实施方式一所述的多驱动遥控拳击模型机器人系统的一种具体结构,本实施方式中,所述的机器人包括前臂4-1、后臂4-2、前连杆4-3、曲柄4-4、前进轮4-6、直流减速电动机4-7、后连杆4-8和击中指示灯4-9。参见图9和和图10。本实施方式中,前足用点接触,不需要前轮。Ninth specific embodiment: This embodiment is described in conjunction with Fig. 8 and Fig. 9. This embodiment is a specific structure of the multi-drive remote control boxing model robot system described in Embodiment 1. In this embodiment, the robot includes a forearm 4-1, trailing arm 4-2, front connecting rod 4-3, crank 4-4, forward wheel 4-6, DC reduction motor 4-7, rear connecting rod 4-8 and hit indicator light 4-9. See Figure 9 and Figure 10. In this embodiment, the forefoot uses point contact, and the front wheel is not required.
具体实施方式十:结合图10说明本实施方式,本实施方式是实施方式一所述的多驱动遥控拳击模型机器人系统的控制方法,该控制方法包括无线控制方法和机器人控制方法;Embodiment 10: This embodiment is described in conjunction with FIG. 10 . This embodiment is a control method for the multi-drive remote control boxing model robot system described in Embodiment 1. The control method includes a wireless control method and a robot control method;
所述无线控制方法包括以下步骤:The wireless control method includes the following steps:
键输入判断步骤:判断是否有键输入,并在判断结果为是时执行参数键输入判断步骤,在判断结果为否时返回执行键输入判断步骤;Key input judging step: judging whether there is a key input, and executing the parameter key input judging step when the judging result is yes, and returning to executing the key input judging step when the judging result is no;
参数键输入判断步骤:判断是否有参数键输入,并在判断结果为是时执行速度值存储步骤,在判断结果为否时执行动作键输入判断步骤;Parameter key input judging step: judging whether there is parameter key input, and executing the speed value storage step when the judging result is yes, and executing the action key input judging step when the judging result is no;
速度值存储步骤:记录速度值并将该速度值放入参数寄存器,并在该步骤结束之后执行动作键输入判断步骤;Speed value storage step: record the speed value and put the speed value into the parameter register, and execute the action key input judgment step after this step ends;
动作键输入判断步骤:判断是否有动作键输入,并在判断结果为是时执行动作标志寄存器置位步骤,在判断结果为否时执行显示键输入判断步骤;Action key input judging step: judging whether there is an action key input, and executing the action flag register setting step when the judgment result is yes, and executing the display key input judgment step when the judgment result is no;
动作标志寄存器置位步骤:将动作标志寄存器的标志位置位,并在该步骤结束之后执行显示键输入判断步骤;Action flag register setting step: set the flag position of the action flag register, and execute the display key input judgment step after this step ends;
显示键输入判断步骤:判断是否有显示键输入,并在判断结果为是时执行显示标志寄存器置位步骤,在判断结果为否时执行动作与速度数据发送步骤;Display key input judging step: judging whether there is a display key input, and performing the step of setting the display flag register when the judgment result is yes, and executing the action and speed data sending step when the judgment result is no;
显示标志寄存器置位步骤:将显示标志寄存器的标志位置位,并在该步骤结束之后执行动作与速度数据发送步骤;Display flag register setting step: set the flag position of the display flag register, and execute the action and speed data sending step after the step ends;
动作与速度数据发送步骤:根据动作寄存器标志将对应的动作要求和参数寄存器中存储的速度值发送至数据寄存器,并在该步骤结束之后执行显示数据发送步骤;Action and speed data sending step: send the corresponding action request and the speed value stored in the parameter register to the data register according to the action register flag, and execute the display data sending step after the step ends;
显示数据发送步骤:根据显示寄存器标志将该对应的显示数据寄存内容发送至显示缓存区,并在该步骤结束之后执行数据寄存器无线发送步骤;Display data sending step: send the corresponding display data register content to the display buffer area according to the display register flag, and perform the data register wireless sending step after the step ends;
数据寄存器无线发送步骤:通过无线通信模块发送发射数据寄存器内存储的数据,并在该步骤结束之后执行机器人数据接收步骤;Data register wireless sending step: send the data stored in the transmitting data register through the wireless communication module, and execute the robot data receiving step after the step ends;
机器人数据接收步骤:接收机器人发来的数据并将该数据存入显示数据寄存器,并在该步骤结束之后执行显示缓存区数据发送步骤;Robot data receiving step: receive the data sent by the robot and store the data in the display data register, and execute the display buffer data sending step after this step;
显示缓存区数据发送步骤:将显示缓存区存储的数据发送至声光显示装置,并在该步骤结束之后执行停止信号判断步骤;The step of sending data in the display buffer area: sending the data stored in the display buffer area to the acousto-optic display device, and executing the stop signal judging step after the step;
停止信号判断步骤:判断是否有停止信号输入,并在判断结果为是时结束控制方法,在判断结果为否时执行键输入判断步骤;Stop signal judging step: judging whether there is a stop signal input, and ending the control method when the judging result is yes, and executing the key input judging step when the judging result is no;
所述机器人控制方法包括以下步骤:The robot control method includes the following steps:
信息接收步骤:不断接收由无线通信模块发来的信息,并在该步骤结束之后执行动作和速度控制步骤;Information receiving step: continuously receive the information sent by the wireless communication module, and execute the action and speed control steps after the step ends;
动作和速度控制步骤:根据无线通信模块发来的数据寄存器的数据,驱动相应的电动机;Action and speed control steps: drive the corresponding motor according to the data of the data register sent by the wireless communication module;
击打状况采集步骤:采集被击打区域9发来的信息,判断机器人是否被击打,并在判断结果为是时执行声光报警控制信号发送步骤,在判断结果为否时返回执行击打状况采集步骤;Beating status collection step: collect the information sent from the hit area 9, judge whether the robot has been hit, and execute the sound and light alarm control signal sending step when the judgment result is yes, and return to execute the hit when the judgment result is no Status collection steps;
声光报警控制信号发送步骤:向声光显示装置发送控制信号,并在该步骤结束之后返回执行击打状况采集步骤。The step of sending the sound and light alarm control signal: sending the control signal to the sound and light display device, and returning to the step of collecting the striking situation after the step is completed.
声光报警控制信号发送步骤中,向声光显示装置发送控制信号的同时,还可以将击打信号其他必要信息上传给无线控制器。In the step of sending the sound and light alarm control signal, while sending the control signal to the sound and light display device, other necessary information of the hitting signal can also be uploaded to the wireless controller.
具体实施方式十一:本实施方式中,前行走机构6和后行走机构7采用全向轮实现。采用全向轮时,图3中行走电动机和驱动需要增加驱动路数,软件也要做相应的改动,实现更灵活的移动。Specific Embodiment Eleven: In this embodiment, the front traveling mechanism 6 and the rear traveling mechanism 7 are realized by using omnidirectional wheels. When omni-directional wheels are used, the number of driving paths of the traveling motor and drive in Figure 3 needs to be increased, and the software should be modified accordingly to achieve more flexible movement.
具体实施方式十二:本实施方式中,无线控制器可以接入网络,与其它无线控制器组成系统。Embodiment 12: In this embodiment, the wireless controller can access the network and form a system with other wireless controllers.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510160944.XA CN104759103A (en) | 2015-04-07 | 2015-04-07 | Multi-drive remote control boxing model robot system and control method of the robot system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510160944.XA CN104759103A (en) | 2015-04-07 | 2015-04-07 | Multi-drive remote control boxing model robot system and control method of the robot system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104759103A true CN104759103A (en) | 2015-07-08 |
Family
ID=53641395
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510160944.XA Pending CN104759103A (en) | 2015-04-07 | 2015-04-07 | Multi-drive remote control boxing model robot system and control method of the robot system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104759103A (en) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104932508A (en) * | 2015-07-23 | 2015-09-23 | 合肥扬帆通信元器件有限公司 | Upright balance robot |
CN104971502A (en) * | 2015-07-22 | 2015-10-14 | 黑龙江大学 | Multi-driving autonomous networked boxing model robot system and control method thereof |
CN104971503A (en) * | 2015-07-22 | 2015-10-14 | 黑龙江大学 | Single-driving autonomous remote control network boxing robot system and control method thereof |
CN104971501A (en) * | 2015-07-22 | 2015-10-14 | 黑龙江大学 | Multi-drive autonomous boxing model robot system and control method thereof |
CN105005303A (en) * | 2015-06-01 | 2015-10-28 | 安徽禄讯电子科技有限公司 | Vertical and balanced robot |
CN105013186A (en) * | 2015-07-22 | 2015-11-04 | 黑龙江大学 | Multi-drive autonomous remote control networked boxing model robot system and its control method |
CN105013185A (en) * | 2015-07-22 | 2015-11-04 | 黑龙江大学 | Single-driven automatic networked boxing model robot system and control method thereof |
CN105031933A (en) * | 2015-07-22 | 2015-11-11 | 黑龙江大学 | Single-driving remote-control boxing model robot system and control method of robot system |
CN106094831A (en) * | 2016-07-13 | 2016-11-09 | 安徽禄讯电子科技有限公司 | Vertical balanced robot |
CN109927051A (en) * | 2019-04-25 | 2019-06-25 | 鲁亮 | A kind of intelligent robot of fight class training |
CN111037570A (en) * | 2019-12-31 | 2020-04-21 | 深圳市工匠社科技有限公司 | Robot display method and related device |
CN115338846A (en) * | 2022-09-21 | 2022-11-15 | 中煤科工集团重庆研究院有限公司 | Multi-drive omnidirectional running device |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2066345U (en) * | 1990-02-17 | 1990-11-28 | 郑昌祁 | Robet for boxing |
US5290185A (en) * | 1992-09-03 | 1994-03-01 | Kabushiki Kaisha Bandai | Hook throwing boxing remote control toy robot |
JP2003053050A (en) * | 2001-08-20 | 2003-02-25 | Toybox:Kk | Steering toy and its steering machine |
CN1785461A (en) * | 2004-12-10 | 2006-06-14 | 米利恒 | Learning system of boxing amusement |
CN201437046U (en) * | 2009-07-01 | 2010-04-14 | 广东骅威玩具工艺股份有限公司 | Electric boxing toy robot |
CN102553250A (en) * | 2010-12-15 | 2012-07-11 | 西安天动数字科技有限公司 | Intelligent toy robot with action imitation function |
CN302489880S (en) * | 2012-12-31 | 2013-07-03 | 汕头市创高玩具有限公司 | Toy remote control boxing robot (w101) |
CN203552589U (en) * | 2013-11-28 | 2014-04-16 | 袁晓曦 | Intelligent multi-freedom humanoid dance teaching robot |
-
2015
- 2015-04-07 CN CN201510160944.XA patent/CN104759103A/en active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2066345U (en) * | 1990-02-17 | 1990-11-28 | 郑昌祁 | Robet for boxing |
US5290185A (en) * | 1992-09-03 | 1994-03-01 | Kabushiki Kaisha Bandai | Hook throwing boxing remote control toy robot |
JP2003053050A (en) * | 2001-08-20 | 2003-02-25 | Toybox:Kk | Steering toy and its steering machine |
CN1785461A (en) * | 2004-12-10 | 2006-06-14 | 米利恒 | Learning system of boxing amusement |
CN201437046U (en) * | 2009-07-01 | 2010-04-14 | 广东骅威玩具工艺股份有限公司 | Electric boxing toy robot |
CN102553250A (en) * | 2010-12-15 | 2012-07-11 | 西安天动数字科技有限公司 | Intelligent toy robot with action imitation function |
CN302489880S (en) * | 2012-12-31 | 2013-07-03 | 汕头市创高玩具有限公司 | Toy remote control boxing robot (w101) |
CN302552388S (en) * | 2013-04-22 | 2013-08-28 | 郑森彪 | Remote control toy (boxing robot) |
CN203552589U (en) * | 2013-11-28 | 2014-04-16 | 袁晓曦 | Intelligent multi-freedom humanoid dance teaching robot |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105005303A (en) * | 2015-06-01 | 2015-10-28 | 安徽禄讯电子科技有限公司 | Vertical and balanced robot |
CN105013185A (en) * | 2015-07-22 | 2015-11-04 | 黑龙江大学 | Single-driven automatic networked boxing model robot system and control method thereof |
CN104971503A (en) * | 2015-07-22 | 2015-10-14 | 黑龙江大学 | Single-driving autonomous remote control network boxing robot system and control method thereof |
CN104971501A (en) * | 2015-07-22 | 2015-10-14 | 黑龙江大学 | Multi-drive autonomous boxing model robot system and control method thereof |
CN104971502A (en) * | 2015-07-22 | 2015-10-14 | 黑龙江大学 | Multi-driving autonomous networked boxing model robot system and control method thereof |
CN105013186A (en) * | 2015-07-22 | 2015-11-04 | 黑龙江大学 | Multi-drive autonomous remote control networked boxing model robot system and its control method |
CN105031933A (en) * | 2015-07-22 | 2015-11-11 | 黑龙江大学 | Single-driving remote-control boxing model robot system and control method of robot system |
CN104932508A (en) * | 2015-07-23 | 2015-09-23 | 合肥扬帆通信元器件有限公司 | Upright balance robot |
CN106094831A (en) * | 2016-07-13 | 2016-11-09 | 安徽禄讯电子科技有限公司 | Vertical balanced robot |
CN109927051A (en) * | 2019-04-25 | 2019-06-25 | 鲁亮 | A kind of intelligent robot of fight class training |
CN109927051B (en) * | 2019-04-25 | 2024-06-04 | 鲁亮 | Intelligent robot for fight training |
CN111037570A (en) * | 2019-12-31 | 2020-04-21 | 深圳市工匠社科技有限公司 | Robot display method and related device |
CN111037570B (en) * | 2019-12-31 | 2022-01-14 | 深圳市工匠社科技有限公司 | Robot display method and related device |
CN115338846A (en) * | 2022-09-21 | 2022-11-15 | 中煤科工集团重庆研究院有限公司 | Multi-drive omnidirectional running device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104759103A (en) | Multi-drive remote control boxing model robot system and control method of the robot system | |
CN104971501A (en) | Multi-drive autonomous boxing model robot system and control method thereof | |
CN104971502A (en) | Multi-driving autonomous networked boxing model robot system and control method thereof | |
CN110154030A (en) | A robot control method, robot and control terminal | |
CN204932734U (en) | Intelligence power roller | |
WO2017140020A1 (en) | Changeable intelligent fitness handle and intelligent fitness equipment set comprising same | |
CN102289981A (en) | Programmable learning type robot | |
CN105031933A (en) | Single-driving remote-control boxing model robot system and control method of robot system | |
US9043031B1 (en) | Low-cost, high-reliability controller for remotely operated robots | |
CN202771500U (en) | Electronic timing device for racing game | |
CN105641946B (en) | Wireless electron building blocks | |
CN103529787A (en) | Remote control device based on gesture control and gesture control method thereof | |
CN104971503A (en) | Single-driving autonomous remote control network boxing robot system and control method thereof | |
CN203235258U (en) | Remote control model wireless control system based on gesture recognition | |
CN102279705B (en) | Method for wirelessly switching slides and terminal thereof | |
CN103028257A (en) | Remote interactive tumblers | |
CN204143634U (en) | A kind of remote control device | |
CN201329167Y (en) | Wireless scoring device of synchronized mutual hitting recreational activity with apparatus held | |
CN105013186A (en) | Multi-drive autonomous remote control networked boxing model robot system and its control method | |
CN105137850A (en) | Laser shooting vehicle, countermeasure system and countermeasure method based on the vehicle | |
CN205460476U (en) | Device of human -computer interaction function with recreation and massage | |
CN201389322Y (en) | A ball-serving machine and a multi-machine ball-serving system composed of the same | |
CN108525325A (en) | A kind of building block system instruction module, host apparatus and modular system | |
CN207503442U (en) | A kind of intelligent robot remote controler | |
CN208799769U (en) | A kind of building block system instruction module, host apparatus and modular system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20150708 |