This application claims the priority benefit of Taiwan application no. 108141203, filed on Nov. 13, 2019. The entirety of the above-mentioned patent application is hereby incorporated by reference herein and made a part of this specification.
The disclosure relates to a control method, and more particularly, to an interactive control method of robot equipment and elevator equipment.
Recently, more and more robot equipment has been applied to various occasions such as factories, stores, or homes to provide the corresponding automatic control functions. However, the current robot equipment can only be operated to work in areas on the same plane to provide specific functions. As specific requirements increase, if the robot equipment is required to work in areas on different floor planes, such requirement cannot be satisfied because the current robot equipment cannot automatically move between different floor planes. In view of the above, solutions of several embodiments will be presented below.
The invention provides an interactive control method of robot equipment and elevator equipment, which can enable the robot equipment to realize the function of automatically moving into and out of the elevator equipment.
An interactive control method of robot equipment and elevator equipment of the invention includes the following steps. When the robot equipment is located outside the elevator equipment, the robot equipment is connected to a first control module disposed outside the elevator equipment to call, by the first control module, an elevator car of the elevator equipment. The first control module determines whether the elevator car arrives at a current floor to return an arrival signal to the robot equipment. The robot equipment is connected to a second control module disposed inside the elevator car according to the arrival signal to control, by the second control module, an elevator door of the elevator car to open. An image detection device of the robot equipment determines whether the elevator door of the elevator car is fully opened to drive the robot equipment to move into the elevator car. When the robot equipment is located within a working range of the elevator car, the second control module stops controlling the elevator door of the elevator car to open.
Based on the above, in the interactive control method of the robot equipment and the elevator equipment of the invention, the robot equipment can automatically call the elevator car of the elevator equipment, and the elevator door of the elevator car is operated to open or close to allow the robot equipment to move into or out of the elevator car.
To make the aforementioned more comprehensible, several embodiments accompanied with drawings are described in detail as follows.
To make the content of the invention more comprehensible, embodiments are provided below as examples for the invention to be implemented accordingly. In addition, wherever possible, the same elements, components, and steps labeled with the same numerals in the drawings and embodiments represent the same or similar components.
In the present embodiment, the processor 110 may be, for example, a central processing unit (CPU), or another programmable general-purpose or specific-purpose microprocessor, digital signal processor (DSP), programmable controller, application specific integrated circuit (ASIC), programmable logic device (PLD), another similar processing device, or a combination of the above devices. In the present embodiment, the processor 110 may include one or more processing circuits to perform, for example, automatic control commands, image processing operations, etc. and may be further coupled to a memory. The memory may store data such as control commands, programs, or images for the processor 110 to read and execute. In the present embodiment, the image detection device 140 may be configured to obtain an image in front of the robot equipment 100, so that the processor 110 can perform relevant image determination operations. The image detection device 140 may be, for example, a camera. In addition, in an embodiment, the robot equipment 100 may further include other devices such as a driving module, a battery module, etc., which are configured to realize the automatic movement function, or other devices such as a voice device, a display device, etc., which are configured to provide voice and display functions.
Referring to
For example, the first control module 210 may be coupled to a signal line and a light emitting element of the direction button of the elevator equipment 220. The first control module 210 may enable the signal line of the direction button to call the elevator car, and the first control module 210 may determine whether the elevator car arrives according to the lighting state of the light emitting element of the direction button.
Furthermore, it is noted that the first wireless communication device 120 and the wireless communication device 212 of the present embodiment may adopt the communication protocol of WiFi, Bluetooth, or ZigBee to perform wireless communication operations. Also, in an exemplary embodiment, the first wireless communication device 120 and the wireless communication device 212 adopt the communication protocol of ZigBee to perform wireless communication operations. In addition, the first control module 210 of the present embodiment is disposed outside the elevator equipment 220 and is electrically connected to relevant elevator control buttons of the elevator equipment 220 in a plug-in manner. The invention does not specifically limit the specific configuration location of the first control module 210 outside the elevator equipment 220.
In the present embodiment, when the robot equipment 100 moves into the elevator car 320, the robot equipment 100 communicates with the wireless communication device 312 of the second control module 310 through the second wireless communication device 130 to provide relevant control commands to the controller 311 of the second control module 310, so that the controller 311 correspondingly operates the opening/closing button module 321 and the floor button module 322 of the elevator car 320. It is noted that if the opening/closing button module 321 includes the opening button and the closing button of the elevator, the controller 311 may enable the opening button or the closing button through the relay 313, the boost and voltage regulator circuit 314, and the cable module 315 to keep an elevator door 326 of the elevator car 320 open or closed. Moreover, if the floor button module 322 includes a plurality of floor buttons, the controller 311 may enable one of the plurality of floor buttons corresponding to a target floor through the relay 313, the boost and voltage regulator circuit 314, and the cable module 315, so that the elevator car 320 can move toward the target floor after the elevator door 326 is closed.
For example, the second control module 310 may be coupled to the signal line of the door opening button inside the elevator car 320, and the second control module 310 may enable the signal line of the door opening button to control the elevator door 326 of the elevator car 320 to open. Moreover, the second control module 310 may be coupled to the signal line and the light emitting element of the floor button inside the elevator car 320. The second control module 310 may enable the signal line of the floor button to control the elevator car 320 to move toward the target floor. Moreover, the second control module 310 may determine whether the elevator car 320 arrives at the target floor according to the lighting state of the light emitting element of the floor button.
Furthermore, it is noted that the second wireless communication device 130 and the wireless communication device 312 of the present embodiment may adopt a communication protocol of WiFi, Bluetooth, or ZigBee to perform wireless communication operations. Moreover, in an exemplary embodiment, the second wireless communication device 130 and the wireless communication device 312 adopt the communication protocol of Bluetooth to perform wireless communication operations. In another embodiment, the first wireless communication device 120 and the second wireless communication device 130 may also adopt the same or different wireless communication protocols, or the first wireless communication device 120 and the second wireless communication device 130 may even be the same wireless communication unit. In addition, the second control module 310 of the present embodiment is disposed inside the elevator car 320 and is electrically connected to relevant elevator control buttons of the elevator car 320 in a plug-in manner. The invention does not specifically limit the specific configuration location of the second control module 310 inside the elevator car 320.
In step S406, the robot equipment 100 outputs a control command to the second control module 310 to control the elevator door 326 of the elevator car 320 to open through the second control module 310. In step S407, the robot equipment 100 obtains a current elevator door image of the elevator car 320 through the image detection device 140 to determine whether the elevator door 326 of the elevator car 320 is fully opened. If not, the robot equipment 100 performs step S407 again to continue the determination. If yes, the robot equipment 100 performs step S408 to obtain a current in-car image of the elevator car 320 through the image detection device 140, and further determine whether an obstacle is present within a working range 327 in the elevator car 320, and the obstacle may be, for example, a person or an object. If yes, the robot equipment 100 performs step S409 and step S412 to wait for the next arrival of the elevator car 320. In other words, if there is no space in the elevator car 320, the robot equipment 100 can wait for the next elevator. If not, the robot equipment 100 performs step S410 to drive the robot equipment 100 to move into the elevator car 320.
In step S411, the robot equipment 100 detects the AR label 323 inside the elevator car 320 through the image detection device 140, so that the processor 110 can establish a corresponding spatial model inside the elevator car 320 and correspondingly drive and adjust the position or angle of the robot equipment 100. Specifically, according to the AR label 323, the robot equipment 100 may calculate the corresponding posture information and position information of the AR label 323 in the image taken by the image detection device 140. Next, according to the posture information and the position information, the robot equipment 100 estimates the coordinate data of the working range 327 in the image obtained by the image detection device 140. Finally, the robot equipment 100 may determine the working range 327 inside the elevator car 320 according to the coordinate data. It is noted that the AR label 323 is configured to allow the robot equipment 100 to obtain the position and size of the working range 327. Based on the pixel size, position, and posture of the AR label 323 (of which the actual size is known) shown in the image, the posture information and position information of the AR label 323 in the real world relative to the robot equipment 100 is calculated according to the camera imaging principle, and at the same time, the coordinate data of the working range 327 in the image is estimated, so that the robot equipment 100 can obtain the actual position and actual size of the working range 327 inside the elevator car 320 according to the above data.
In step S412, when the robot equipment 100 finishes step S411, the robot equipment 100 may first enable the floor button module 322 through the second control module 310, and then stop enabling the opening/closing button module 321 of the elevator car 320 to stop controlling the elevator door 326 of the elevator car 320 to open, so that the elevator car 320 can move toward the target floor according to the selection result of the floor button module 322. Therefore, the interactive control method of the present embodiment may enable the robot equipment 100 to realize the function of automatically taking the elevator.
In step S605, the robot equipment 100 determines whether an obstacle is present within the working range 327 through the previous object recognition. If not, the robot equipment 100 performs step S609 to cause the processor 110 to issue an elevator entry command. If yes, the robot equipment 100 performs step S606 to further detect whether there is still space inside the elevator car 320 through the image detection device 140. If not, the robot equipment 100 performs step S610 to wait for the next arrival of the elevator car 320. If yes, the robot equipment 100 performs step S607. In step S607, the processor 110 of the robot equipment 100 determines whether a voice message has been played. If not, the robot equipment 100 performs step S608 to play the voice message through a voice device and then performs step S601 again. If yes, the robot equipment 100 performs step S610 to wait for the next arrival of the elevator car 320.
In other words, the robot equipment 100 of the present embodiment may emit a one-time voice prompt to prompt the obstacle within the working range 327. If the obstacle is a person, the person may make room for the robot equipment 100 according to the voice prompt. On the other hand, when the obstacle is an object, or the person does not want to make room for the robot equipment 100, after issuing the one-time voice prompt, if the robot equipment 100 determines that the space of the working range 327 is still occupied, the robot equipment 100 will wait for the next elevator car 320. Therefore, the process of the present embodiment may effectively ensure that the robot equipment 100 can properly enter the elevator car 320.
In step S704, the robot equipment 100 remotely controls the second control module 310 to enable the floor button module through the second wireless communication device 130 to control the elevator car 320 to move toward the target floor. In step S705, the robot equipment 100 captures an image of the floor display panel 325 through the image detection device 140 to obtain a current image of the floor display panel 325. In step S706, the processor 110 of the robot equipment 100 analyzes the image to recognize the elevator floor number displayed by the floor display panel 325. In step S707, the processor 110 of the robot equipment 100 determines whether the elevator car 320 arrives at the target floor. If not, the robot equipment 100 performs step S705 again to continue the determination. If yes, the robot equipment 100 performs step S708.
In step S708, the robot equipment 100 turns to the elevator door. In step S709, the robot equipment 100 obtains a current elevator door image of the elevator car 320 through the image detection device 140 to determine whether the elevator door 326 of the elevator car 320 is fully opened. If not, the robot equipment 100 performs step S709 again to continue the determination. If yes, the robot equipment 100 performs step S710 to control the elevator door 326 of the elevator car 320 to remain opened through the second control module 310. It is noted that the process of
In summary of the above, in the interactive control method of the robot equipment and the elevator equipment of the invention, the robot equipment may automatically call the elevator car of the elevator equipment, correspondingly control the elevator door of the elevator car to open or close, and drive the robot equipment to properly move into and out of the elevator car based on image detection. Moreover, the interactive control method of the robot equipment and the elevator equipment of the invention can further effectively determine whether an obstacle is present in the elevator car and emit a voice prompt, which enhances the chance and efficiency for the robot equipment to properly move into and out of the elevator car.
It will be apparent to those skilled in the art that various modifications and variations can be made to the disclosed embodiments without departing from the scope or spirit of the disclosure. In view of the foregoing, it is intended that the disclosure covers modifications and variations provided that they fall within the scope of the following claims and their equivalents.
Number | Date | Country | Kind |
---|---|---|---|
108141203 | Nov 2019 | TW | national |