TW202125084A - Robot balance determination device and robot balance determination method - Google Patents

Robot balance determination device and robot balance determination method Download PDF

Info

Publication number
TW202125084A
TW202125084A TW108145924A TW108145924A TW202125084A TW 202125084 A TW202125084 A TW 202125084A TW 108145924 A TW108145924 A TW 108145924A TW 108145924 A TW108145924 A TW 108145924A TW 202125084 A TW202125084 A TW 202125084A
Authority
TW
Taiwan
Prior art keywords
image
robot
balance
coordinates
judgment
Prior art date
Application number
TW108145924A
Other languages
Chinese (zh)
Other versions
TWI715353B (en
Inventor
李宗益
Original Assignee
新煒科技有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 新煒科技有限公司 filed Critical 新煒科技有限公司
Priority to TW108145924A priority Critical patent/TWI715353B/en
Application granted granted Critical
Publication of TWI715353B publication Critical patent/TWI715353B/en
Publication of TW202125084A publication Critical patent/TW202125084A/en

Links

Images

Landscapes

  • Image Processing (AREA)

Abstract

A robot balance determination device includes a photographing device and a processor. The processor is coupled to the photographing device. The processor is configured to: receive a set of images from the photographing device; obtain the coordinates of each initial image; arrange and stitch a plurality of the initial images according to the coordinates to generate an image model; set a balance threshold of the image model; receive a determination image from the photographing device instantly; compare the determination image with the image model to obtain a difference value; determine whether the difference value exceeds the balance threshold to determine the balance state of the robot. The invention also provides a robot balance determination method.

Description

機器人平衡判定裝置及機器人平衡判定方法Robot balance judging device and robot balance judging method

本發明涉機器人領域,具體涉及一種機器人平衡判定裝置及機器人平衡判定方法。The invention relates to the field of robots, in particular to a robot balance determination device and a robot balance determination method.

機器人的運動過程中,由於從事多樣性的動作時,會造成機器人的重心有所改變,容易使機器人進入不平衡的狀態,如不能及時調整,易導致機器人跌倒而造成機器人損壞。During the movement of the robot, the center of gravity of the robot will change due to various actions, which will easily cause the robot to enter an unbalanced state. If it cannot be adjusted in time, it will easily cause the robot to fall and cause damage to the robot.

有鑑於此,本發明提出一種機器人平衡判定裝置及機器人平衡判定方法,以解決上述問題。In view of this, the present invention provides a robot balance determination device and a robot balance determination method to solve the above-mentioned problems.

本申請的第一方面提供一種機器人平衡判定裝置,包括拍照設備;處理器,與所述拍照設備耦接,用於:接收來自所述拍照設備的圖像集,所述圖像集包括機器人保持平衡時所述拍照設備拍攝的多個初始圖像;獲取每個所述初始圖像的座標;依據所述座標排列並拼接多個所述初始圖像,以生成圖像模型;設定所述圖像模型的平衡閾值;即時接收來自所述拍照設備的判定圖像;比對所述判定圖像與所述圖像模型,以獲取區別值;判斷所述區別值是否超出所述平衡閾值,以判定所述機器人的平衡狀態。The first aspect of the present application provides a robot balance determination device, including a photographing device; a processor, coupled to the photographing device, and configured to: receive an image set from the photographing device, the image set including the robot holding Multiple initial images taken by the photographing device during balance; acquiring the coordinates of each initial image; arranging and stitching multiple initial images according to the coordinates to generate an image model; setting the image The balance threshold of the image model; instantaneously receive the judgment image from the photographing device; compare the judgment image with the image model to obtain a difference value; determine whether the difference value exceeds the balance threshold, to Determine the balance state of the robot.

進一步地,其中所述處理器進一步用於: 若所述機器人保持平衡,依據所述判定圖像調整所述圖像模型。Further, wherein the processor is further used for: If the robot maintains a balance, adjust the image model according to the judgment image.

進一步地,其中所述區別值為: 所述判定圖像的座標與所述圖像模型中相同的圖像區域的座標之間的差值,或 所述判定圖像與所述圖像模型中相同座標區域圖像的差異度。Further, wherein the difference value is: The difference between the coordinates of the judgment image and the coordinates of the same image area in the image model, or The degree of difference between the judgment image and the image of the same coordinate region in the image model.

進一步地,其中所述處理器進一步用於: 依據所述圖像模型的模型特點確定判定座標; 所述拍照設備進一步地用於: 依據所述判定座標獲取所述判定圖像。Further, wherein the processor is further used for: Determining the judgment coordinates according to the model characteristics of the image model; The photographing device is further used for: The determination image is acquired based on the determination coordinates.

進一步地,機器人平衡判定裝置還包括第一感應單元與第二感應單元,所述第一感應器用於感應所述機器人的速度與位移,以形成第一感應資訊,所述第二感應器用於感應所述機器人的方位角度,以獲取第二感應資訊, 其中所述處理器進一步用於: 獲取所述第一感應資訊與第二感應資訊; 依據所述第一感應資訊與所述第二感應資訊形成狀態資訊; 依據所述狀態資訊調整所述圖像模型的重建週期。Further, the robot balance determination device further includes a first sensing unit and a second sensing unit, the first sensor is used for sensing the speed and displacement of the robot to form first sensing information, and the second sensor is used for sensing The azimuth angle of the robot to obtain the second sensing information, The processor is further used for: Acquiring the first sensing information and the second sensing information; Forming status information based on the first sensing information and the second sensing information; Adjust the reconstruction period of the image model according to the state information.

本發明第二方面提供一種機器人平衡判定方法,包括: 獲取圖像集,所述圖像集包括機器人保持平衡時獲取的多個初始圖像; 獲取每個所述初始圖像的座標; 依據所述座標排列並拼接多個所述初始圖像,以生成圖像模型; 設定所述圖像模型的平衡閾值; 即時獲取判定圖像; 比對所述判定圖像與所述圖像模型,以獲取區別值; 判斷所述區別值是否超出所述平衡閾值,以判定所述機器人的平衡狀態。The second aspect of the present invention provides a robot balance determination method, including: Acquiring an image set, the image set including a plurality of initial images acquired when the robot maintains a balance; Acquiring the coordinates of each of the initial images; Arranging and stitching a plurality of the initial images according to the coordinates to generate an image model; Setting the balance threshold of the image model; Obtain judgment images instantly; Comparing the judgment image with the image model to obtain a difference value; It is determined whether the difference value exceeds the balance threshold to determine the balance state of the robot.

進一步地,所述方法還包括步驟: 若所述機器人保持平衡,依據所述判定圖像調整所述圖像模型。Further, the method further includes the steps: If the robot maintains a balance, adjust the image model according to the judgment image.

進一步地,其中所述區別值為: 所述判定圖像的座標與所述圖像模型中相同的圖像區域的座標之間的差值,或 所述判定圖像與所述圖像模型中相同座標區域圖像的差異度。Further, wherein the difference value is: The difference between the coordinates of the judgment image and the coordinates of the same image area in the image model, or The degree of difference between the judgment image and the image of the same coordinate region in the image model.

進一步地,其中“即時接收來自所述拍照設備的判定圖像”具體包括步驟: 依據所述圖像模型的模型特點確定判定座標; 依據判定座標獲取所述判定圖像。Further, "receiving the determined image from the photographing device immediately" specifically includes the steps: Determining the judgment coordinates according to the model characteristics of the image model; The judgment image is obtained based on the judgment coordinates.

進一步地,所述方法還包括步驟: 獲取第一感應資訊與第二感應資訊,其中所述第一感應資訊包括所述機器人的速度與位移資訊,所述第二感應資訊包括所述機器人的方位角度資訊; 依據所述第一感應資訊與所述第二感應資訊形成狀態資訊; 依據所述狀態資訊調整所述圖像模型的重建週期。Further, the method further includes the steps: Acquiring first sensing information and second sensing information, wherein the first sensing information includes speed and displacement information of the robot, and the second sensing information includes azimuth angle information of the robot; Forming status information based on the first sensing information and the second sensing information; Adjust the reconstruction period of the image model according to the state information.

本發明通過建立機器人保持平衡時的圖像模型,設定圖像模型的平衡閾值,並即時比對判定圖像與圖像模型,以獲取區別值,依據區別值與平衡閾值判定機器人的平衡狀態,以便於控制機器人及時進行狀態調整。The present invention establishes an image model when the robot maintains balance, sets the balance threshold of the image model, and instantly compares the judgment image and the image model to obtain the difference value, and judges the balance state of the robot according to the difference value and the balance threshold. In order to control the robot to adjust the state in time.

為了能夠更清楚地理解本發明的上述目的、特徵與優點,下面結合附圖與具體實施方式對本發明進行詳細描述。需要說明的是,在不衝突的情況下,本申請的實施方式及實施方式中的特徵可以相互組合。In order to be able to understand the above objectives, features and advantages of the present invention more clearly, the present invention will be described in detail below with reference to the accompanying drawings and specific embodiments. It should be noted that, in the case of no conflict, the embodiments of the present application and the features in the embodiments can be combined with each other.

在下面的描述中闡述了很多具體細節以便於充分理解本發明,所描述的實施方式僅是本發明一部分實施方式,而不是全部的實施方式。基於本發明中的實施方式,本領域普通技術人員在沒有做出創造性勞動前提下所獲得的所有其它實施方式,都屬於本發明保護的範圍。In the following description, many specific details are set forth in order to fully understand the present invention. The described embodiments are only a part of the embodiments of the present invention, rather than all of them. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of the present invention.

除非另有定義,本文所使用的所有的技術與科學術語與屬於本發明的技術領域的技術人員通常理解的含義相同。本文中在本發明的說明書中所使用的術語只是為了描述具體的實施方式的目的,不是旨在限制本發明。Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by those skilled in the technical field of the present invention. The terminology used in the specification of the present invention herein is only for the purpose of describing specific embodiments, and is not intended to limit the present invention.

本文所使用的術語“及/或”包括一個或複數相關的所列項目的任意的與所有的組合。The term "and/or" as used herein includes any and all combinations of one or plural related listed items.

請參閱圖1,為本發明一實施中提供的機器人平衡判定裝置的示意圖。Please refer to FIG. 1, which is a schematic diagram of a robot balance determination device provided in an implementation of the present invention.

在本實施方式中,所述機器人平衡判定裝置100包括拍照設備10、處理器20、記憶體30、第一感應單元40、第二感應單元50及第三感應單元60。In this embodiment, the robot balance determination device 100 includes a photographing device 10, a processor 20, a memory 30, a first sensing unit 40, a second sensing unit 50, and a third sensing unit 60.

拍照設備10用於拍攝機器人周邊的圖像。The photographing device 10 is used to photograph images around the robot.

本實施例中,機器人保持平衡時,拍照設備10拍攝的機器人周邊的多張圖像,即為初始圖像,依據多張初始圖像形成圖像集。In this embodiment, when the robot is in balance, the multiple images around the robot taken by the photographing device 10 are the initial images, and an image set is formed based on the multiple initial images.

在一實施例中,通過一個或多個拍照設備10,依據機器人為軸心,依據不同的拍攝角度,依次拍攝多個初始圖像,可以通過多個初始圖像獲取保持平衡時的機器人周邊的環境狀況,例如是否包含標誌性物體,標誌性物體與機器人的相對位置。可以理解,可以依據環境狀況選擇拍攝圖片的數量。In one embodiment, through one or more photographing devices 10, based on the robot as the axis, and according to different shooting angles, multiple initial images can be taken in sequence. The multiple initial images can be used to obtain the surroundings of the robot while maintaining balance. Environmental conditions, such as whether it contains a landmark object, the relative position of the landmark object and the robot. It is understandable that the number of pictures taken can be selected according to the environmental conditions.

進一步地,各個初始圖像之間可以部分重合,從而保證依據多個初始圖像獲取的圖像模型的圖像連續性。Further, the initial images can be partially overlapped, so as to ensure the image continuity of the image model obtained from the multiple initial images.

進一步地,可以依據拍照設備10僅拍攝機器人正前方的多個初始圖像,以獲取機器人正前方環境狀況。Further, according to the photographing device 10, only a plurality of initial images directly in front of the robot can be captured to obtain the environmental conditions in front of the robot.

可以理解,機器人保持平衡時,機器人可以為靜止中或運動中。It can be understood that when the robot is in balance, the robot can be stationary or in motion.

在一實施例中,拍照設備10還用於依據判定座標,拍攝對應座標區域的圖像,以獲取判定圖像。In one embodiment, the photographing device 10 is also used to shoot an image corresponding to the coordinate area according to the judgment coordinates to obtain the judgment image.

在一實施例中,拍照設備10可以為CCD相機、雙目攝像機等。In an embodiment, the photographing device 10 may be a CCD camera, a binocular camera, or the like.

所述處理器20可以為中央處理器(CPU,Central Processing Unit),還可以包括其他通用處理器、數位訊號處理器(Digital Signal Processor,DSP)、專用積體電路(Application Specific Integrated Circuit,ASIC)、現成可程式設計閘陣列(Field-Programmable Gate Array,FPGA)或者其他可程式設計邏輯器件、分立門或者電晶體邏輯器件、分立硬體元件等。通用處理器可以是微處理器或者該處理器也可以是任何常規的處理器等,所述處理器20是機器人平衡判定裝置100的控制中心,利用各種介面與線路連接整個機器人平衡判定裝置100的各個部分。The processor 20 may be a central processing unit (CPU, Central Processing Unit), and may also include other general-purpose processors, digital signal processors (Digital Signal Processors, DSPs), and dedicated integrated circuits (Application Specific Integrated Circuits, ASICs). , Ready-made programmable gate array (Field-Programmable Gate Array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. The general-purpose processor can be a microprocessor or the processor can also be any conventional processor. The processor 20 is the control center of the robot balance determination device 100, which uses various interfaces and lines to connect the entire robot balance determination device 100. Various parts.

所述記憶體30用於存儲機器人平衡判定裝置100中的各類資料,例如圖像集、圖像模型等。在本實施方式中,所述記憶體30可以包括但不限於唯讀記憶體(Read-Only Memory,ROM)、隨機記憶體(Random Access Memory,RAM)、可程式設計唯讀記憶體(Programmable Read-Only Memory,PROM)、可擦除可程式設計唯讀記憶體(Erasable Programmable Read-Only Memory,EPROM)、一次可程式設計唯讀記憶體(One-time Programmable Read-Only Memory,OTPROM)、電子擦除式可複寫唯讀記憶體(Electrically-Erasable Programmable Read-Only Memory,EEPROM)、唯讀光碟(Compact Disc Read-Only Memory,CD-ROM)或其他光碟記憶體、磁碟記憶體、磁帶記憶體、或者能夠用於攜帶或存儲資料的電腦可讀的任何其他介質。The memory 30 is used to store various data in the robot balance determination device 100, such as image collections, image models, and so on. In this embodiment, the memory 30 may include, but is not limited to, read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), and programmable read-only memory (Programmable Read-Only Memory, RAM). -Only Memory, PROM, Erasable Programmable Read-Only Memory (EPROM), One-time Programmable Read-Only Memory (OTPROM), electronic Erasable-erasable Programmable Read-Only Memory (Electrically-Erasable Programmable Read-Only Memory, EEPROM), CD-ROM (Compact Disc Read-Only Memory, CD-ROM) or other optical disc memory, magnetic disk memory, tape memory Body, or any other computer-readable medium that can be used to carry or store data.

所述第一感應單元40用於感應機器人的速度與位移,以獲取第一感應資訊。The first sensing unit 40 is used for sensing the speed and displacement of the robot to obtain first sensing information.

本實施例中,所述第一感應單元40包括重力感應器,第一感應資訊為機器人的速度與位移的資訊。可以理解,第一感應單元40也可包括加速度感應器等,但不限於此。In this embodiment, the first sensing unit 40 includes a gravity sensor, and the first sensing information is information on the speed and displacement of the robot. It can be understood that the first sensing unit 40 may also include an acceleration sensor and the like, but is not limited thereto.

所述第二感應單元50用於感應機器人的方位角度,以獲取第二感應資訊。The second sensing unit 50 is used to sense the azimuth angle of the robot to obtain second sensing information.

本實施例中,所述第二感應單元50包括陀螺儀,第二感應資訊為機器人的方位角度的資訊。可以理解,第二感應單元50也可包括磁力計等,但不限於此。In this embodiment, the second sensing unit 50 includes a gyroscope, and the second sensing information is information about the azimuth angle of the robot. It can be understood that the second sensing unit 50 may also include a magnetometer, etc., but is not limited thereto.

在另一實施例中,第一感應單元40在機器人保持平衡時獲取第一感應資訊,並依據多個第一感應資訊形成第一資訊集;第二感應單元50在機器人保持平衡時獲取第二感應資訊,並依據多個第二感應資訊形成第二資訊集。In another embodiment, the first sensing unit 40 obtains the first sensing information when the robot is in balance, and forms a first information set according to a plurality of first sensing information; the second sensing unit 50 obtains the second information when the robot is in balance Sensing information, and forming a second information set based on a plurality of second sensing information.

第三感應單元60用於感應機器人與周圍物體之間的距離,以獲取第三感應資訊。The third sensing unit 60 is used for sensing the distance between the robot and surrounding objects to obtain third sensing information.

本實施例中,所述第三感應單元60包括超聲波感應器,第三感應資訊為機器人與周圍物體之間的距離資訊。可以理解,第三感應單元60也可包括紅外線感應器等,但不限於此。In this embodiment, the third sensing unit 60 includes an ultrasonic sensor, and the third sensing information is distance information between the robot and surrounding objects. It can be understood that the third sensing unit 60 may also include an infrared sensor and the like, but is not limited thereto.

請參閱圖2,為本發明一實施方式中機器人平衡判定系統200的功能模組示意圖。Please refer to FIG. 2, which is a schematic diagram of functional modules of the robot balance determination system 200 in an embodiment of the present invention.

在本實施方式中,機器人平衡判定系統200包括有一個或多個程式形式的電腦指令,所述一個或多個程式形式的電腦指令存儲於所述記憶體30中,並由所述處理器20執行,以實現本發明所提供的功能。In this embodiment, the robot balance determination system 200 includes one or more computer instructions in the form of a program, and the one or more computer instructions in the form of a program are stored in the memory 30 and executed by the processor 20. Execute to realize the functions provided by the present invention.

在本實施方式中,所述機器人平衡判定系統200可以被分割成接收模組201、判定模組202、控制模組203、獲取模組204、模型建立模組205、設定模組206比對模組207及更新模組208。各個功能模組的功能將在下面的實施例中進行詳述。In this embodiment, the robot balance determination system 200 can be divided into a receiving module 201, a determination module 202, a control module 203, an acquisition module 204, a model creation module 205, and a setting module 206. Group 207 and update module 208. The functions of each functional module will be described in detail in the following embodiments.

接收模組201用於接收拍照設備10發送的圖像集,其中圖像集包括拍照設備10拍攝保持平衡時的機器人的周邊,以獲得的多個初始圖像。The receiving module 201 is configured to receive an image set sent by the photographing device 10, where the image set includes a plurality of initial images obtained by the photographing device 10 while photographing the periphery of the robot while maintaining the balance.

本實施例中,接收模組201還用於接收拍照設備10發送的判定圖像。In this embodiment, the receiving module 201 is also used to receive the judgment image sent by the photographing device 10.

進一步地,接收模組201還用於接收第一感應單元40發送的第一感應資訊與第二感應單元50發送的第二感應資訊。Furthermore, the receiving module 201 is also used for receiving the first sensing information sent by the first sensing unit 40 and the second sensing information sent by the second sensing unit 50.

在另一實施例中,接收模組201還用於接收第一資訊集與第二資訊集,其中所述第一資訊集為第一感應單元40在機器人保持平衡時獲取的多個第一感應資訊的集合,所述第二資訊集為第二感應單元50在機器人保持平衡時獲取的多個第二感應資訊的集合。In another embodiment, the receiving module 201 is further configured to receive a first information set and a second information set, wherein the first information set is a plurality of first sensors acquired by the first sensor unit 40 when the robot is in balance. A collection of information, and the second information set is a collection of multiple second sensing information acquired by the second sensing unit 50 when the robot is in balance.

進一步地,接收模組201還用於接收第三感應單元60發送的第三感應資訊。Furthermore, the receiving module 201 is also used for receiving the third sensing information sent by the third sensing unit 60.

判定模組202用於判斷機器人的平衡狀態。The judging module 202 is used to judge the balance state of the robot.

在一實施例中,接收模組201接收第一感應單元40發送的第一感應資訊與第二感應單元50發送的第二感應資訊,判定模組202設定判定閾值,並依據第一感應資訊、第二感應資訊及平衡閾值,判斷機器人的平衡狀態,平衡狀態包括保持平衡與失去平衡。In one embodiment, the receiving module 201 receives the first sensing information sent by the first sensing unit 40 and the second sensing information sent by the second sensing unit 50, and the determining module 202 sets a determination threshold, and based on the first sensing information, The second sensing information and the balance threshold value determine the balance state of the robot. The balance state includes maintaining balance and losing balance.

判定模組202還用於依據圖像模型的模型特點確定判定區域,進而確定判定區域的判定座標。The judging module 202 is also used to determine the judging area according to the model characteristics of the image model, and then to determine the judging coordinates of the judging area.

其中模型特點包括圖像模型中各個區域圖像的相似度、連貫度、是否包含明顯特徵等。例如,圖像模型中的多個區域圖像相似度較高,如果將該區域作為判定區域,容易造成判定誤差;若圖像模型中相鄰區域圖像具有連續性及重複性,不易發現相鄰區域的區別點,則該區域不宜作為判定區域;若圖像模型中具有突出的特徵,例如一區域包含有明顯區別於周圍環境的動物圖案,則該區域可以作為判定區域。Among them, the characteristics of the model include the similarity, coherence, and whether it contains obvious features in each area of the image model. For example, the image similarity of multiple regions in the image model is relatively high. If the region is used as the judgment region, it is easy to cause judgment errors; if the images of adjacent regions in the image model have continuity and repetitiveness, it is difficult to find the similarity. If there is a distinguishing point in the neighboring area, this area should not be used as the judgment area; if the image model has prominent features, for example, an area contains animal patterns that are clearly different from the surrounding environment, then this area can be used as the judgment area.

判定模組202還用於判定區別值是否超出平衡閾值,以判斷機器人的平衡狀態。The judging module 202 is also used for judging whether the difference value exceeds the balance threshold, so as to judge the balance state of the robot.

在另一實施例中,判定模組202還用於分別比對第一感應資訊、第二感應資訊與所述輔助平衡閾值,以判定所述機器人的平衡狀態。In another embodiment, the determining module 202 is further configured to compare the first sensing information, the second sensing information, and the auxiliary balance threshold to determine the balance state of the robot.

控制模組203用於發送拍照指令,以使拍照設備10拍攝圖像。The control module 203 is configured to send a photographing instruction, so that the photographing device 10 takes an image.

進一步地,拍照指令包括第一拍照指令與第二拍照指令,控制模組203發送第一拍照指令,以使拍照設備10拍攝形成圖像集的多個初始圖像;控制模組203發送第二拍照指令,以使拍照設備10拍攝判定圖像。Further, the photographing instruction includes a first photographing instruction and a second photographing instruction. The control module 203 sends the first photographing instruction so that the photographing device 10 can photograph a plurality of initial images forming the image set; the control module 203 sends the second photographing instruction. The photographing instruction is used to make the photographing device 10 photograph the judgment image.

控制模組203還用於向機器人發送調整指令,以使機器人自我調整平衡。The control module 203 is also used to send an adjustment instruction to the robot to make the robot self-adjust and balance.

獲取模組204用於獲取圖像集中每個初始圖像的座標。The acquiring module 204 is used to acquire the coordinates of each initial image in the image set.

在一實施例中,獲取模組204建立的坐標系,並依據每個初始圖像與機器人的相對位置,設定相應的座標,其中坐標系可以為直角坐標系或三維坐標系。In one embodiment, the coordinate system established by the module 204 is acquired, and corresponding coordinates are set according to the relative position of each initial image and the robot, where the coordinate system may be a rectangular coordinate system or a three-dimensional coordinate system.

模型建立模組205用於依據座標排列並拼接圖像集中的多個初始圖像,以生成圖像模型。The model building module 205 is used for arranging and stitching a plurality of initial images in the image set according to the coordinates to generate an image model.

在一實施例中,圖像模型為依據座標排列並拼接而成的全景圖像。In one embodiment, the image model is a panoramic image that is arranged and stitched according to coordinates.

在另一實施例中,圖像模型如圖4所示,圖像模型由5*5矩陣排列的25個初始圖像排列拼接而成,每個初始圖像設有相應的座標,分別為1~25。可以理解,每個初始圖像的座標及排列拼接方式可以依據實際應用場景進行調整。In another embodiment, the image model is shown in Figure 4. The image model is composed of 25 initial images arranged in a 5*5 matrix, and each initial image has corresponding coordinates, which are 1 ~25. It can be understood that the coordinates and arrangement and splicing method of each initial image can be adjusted according to actual application scenarios.

在另一實施例中,模型建立模組205還用於依據第三資訊更新圖像模型中各個圖像區域的三維座標。In another embodiment, the model building module 205 is also used to update the three-dimensional coordinates of each image area in the image model according to the third information.

設定模組206用於設定圖像模型的平衡閾值。The setting module 206 is used to set the balance threshold of the image model.

在一實施例中,平衡閾值為圖像模型的特定圖像區域的差異度。例如,依據指定座標獲取的圖像與圖像模型中相同座標區域圖像的差異度。In an embodiment, the balance threshold is the degree of difference of a specific image region of the image model. For example, the degree of difference between the image acquired according to the specified coordinates and the image of the same coordinate region in the image model.

在另一實施例中,平衡閾值為座標偏移量,例如,依據指定座標獲取的圖像與圖像模型中相同圖像區域的座標的差值,即為座標偏移量。In another embodiment, the balance threshold is the coordinate offset. For example, the coordinate difference between the image acquired according to the specified coordinates and the coordinates of the same image area in the image model is the coordinate offset.

在另一實施例中,設定模組206還用於依據第一資訊集與第二資訊集設定所述輔助平衡閾值。其中輔助平衡閾值可以為角度或方位範圍。In another embodiment, the setting module 206 is further configured to set the auxiliary balance threshold according to the first information set and the second information set. The auxiliary balance threshold can be an angle or azimuth range.

比對模組207用於比對判定圖像與圖像模型,以獲取區別值。The comparison module 207 is used to compare the judgment image with the image model to obtain the difference value.

在一實施例中,比對模組207比對判定圖像與圖像模型中相同座標的圖像區域的差異度,差異度即為區別值。In one embodiment, the comparison module 207 compares and determines the degree of difference between the image and the image area of the same coordinate in the image model, and the degree of difference is the difference value.

在另一實施例中,比對模組207比對判定圖像的座標與圖像模型中相同圖像區域的座標,以獲取座標差值,座標差值即為區別值。In another embodiment, the comparison module 207 compares the coordinates of the determined image with the coordinates of the same image area in the image model to obtain the coordinate difference, which is the difference value.

更新模組208用於依據第一感應資訊與第二感應資訊,以形成狀態資訊,並依據狀態資訊調整所述圖像模型的重建週期。狀態資訊包括運動速度、加速度、方向變化、角度變化等。其中運動速度及加速度為機器人運動的速度變化情況,方向變化及角度變化為機器人運動過程中轉向,變更移動方向的頻率。例如,若機器人周圍環境變動加大,或是機器人移動速度較快,則需要縮短圖像模型的重建週期,以便於保證圖像模型的準確性。若機器人速度較慢且環境變動較小,則需要增大圖像模型的重建週期。The update module 208 is used for forming state information according to the first sensing information and the second sensing information, and adjusting the reconstruction period of the image model according to the state information. State information includes movement speed, acceleration, direction change, angle change, etc. The movement speed and acceleration are the speed change of the robot movement, and the direction change and angle change are the frequency of turning and changing the moving direction during the movement of the robot. For example, if the surrounding environment of the robot changes more or the robot moves faster, the reconstruction period of the image model needs to be shortened to ensure the accuracy of the image model. If the robot speed is slow and the environment changes less, the reconstruction period of the image model needs to be increased.

模型建立模組205還用於依據重建週期重新建立新的圖像模型,以替換舊的圖像模型。The model building module 205 is also used to rebuild a new image model according to the reconstruction period to replace the old image model.

其中重建週期為圖像模型重新建立的時長,以保證圖像模型與機器人周圍的環境保持一致性。The reconstruction period is the length of time the image model is re-established to ensure that the image model is consistent with the environment around the robot.

請參閱圖3,為本發明一個實施方式提供的機器人平衡判定的流程圖。根據不同的需求,該流程圖中步驟的順序可以改變,某些步驟可以省略。為了便於說明,僅示出了與本發明實施例相關的部分。Please refer to FIG. 3, which is a flowchart of robot balance determination provided by an embodiment of the present invention. According to different needs, the order of the steps in the flowchart can be changed, and some steps can be omitted. For ease of description, only the parts related to the embodiment of the present invention are shown.

如圖3所示,所述機器人平衡判定方法包括以下步驟。As shown in Figure 3, the robot balance determination method includes the following steps.

步驟S1:獲取圖像集。Step S1: Obtain an image set.

具體地,接收模組201接收拍照設備10發送的圖像集,其中圖像集包括拍照設備10拍攝保持平衡時的機器人的周邊,獲得的多個初始圖像。Specifically, the receiving module 201 receives an image set sent by the photographing device 10, where the image set includes a plurality of initial images obtained by the photographing device 10 while photographing the periphery of the robot while maintaining balance.

步驟S1具體包括步驟:Step S1 specifically includes steps:

判定機器人的平衡狀態;Determine the balance state of the robot;

若保持平衡,獲取多個初始圖像;If the balance is maintained, obtain multiple initial images;

依據多個初始圖像形成圖像集。An image set is formed based on a plurality of initial images.

若失去平衡,發送調整指令,以使機器人自我調整。If it loses balance, send an adjustment command to make the robot self-adjust.

具體地,判定模組202判斷機器人的平衡狀態;若保持平衡,控制模組203向拍照設備10發送拍照指令,以使拍照設備10拍攝多個初始圖像,並依據多個初始圖像形成圖像集。若失去平衡,控制模組203向機器人發送調整指令,以使機器人自我調整平衡。Specifically, the judging module 202 judges the balance state of the robot; if the balance is maintained, the control module 203 sends a photographing instruction to the photographing device 10 so that the photographing device 10 takes multiple initial images, and forms the image according to the multiple initial images. Like set. If the balance is lost, the control module 203 sends an adjustment instruction to the robot so that the robot can adjust its balance by itself.

步驟S2:獲取所述圖像集中每個初始圖像的座標。Step S2: Obtain the coordinates of each initial image in the image set.

具體地,獲取模組204獲取圖像集中每個初始圖像的座標。Specifically, the acquisition module 204 acquires the coordinates of each initial image in the image set.

在一實施例中,獲取模組204建立的坐標系,並依據每個初始圖像與機器人的相對位置,設定相應的座標,其中坐標系可以為直角坐標系或三維坐標系。In one embodiment, the coordinate system established by the module 204 is acquired, and corresponding coordinates are set according to the relative position of each initial image and the robot, where the coordinate system may be a rectangular coordinate system or a three-dimensional coordinate system.

步驟S3:依據所述座標排列並拼接多個所述初始圖像,以生成圖像模型。Step S3: Arranging and splicing a plurality of the initial images according to the coordinates to generate an image model.

具體地,模型建立模組205依據座標排列並拼接圖像集中的多個初始圖像,以生成圖像模型。Specifically, the model building module 205 arranges and stitches a plurality of initial images in the image set according to the coordinates to generate an image model.

在一實施例中,圖像模型為依據座標排列拼接而成的全景圖像。In one embodiment, the image model is a panoramic image stitched together according to the coordinate arrangement.

在另一實施例中,圖像模型如圖4所示,由5*5矩陣排列的25個初始圖像排列拼接而成,每個初始圖像設有相應的座標,分別為1~25。可以理解,每個初始圖像的座標及排列拼接方式可以依據實際應用場景進行調整。In another embodiment, the image model is shown in FIG. 4, which is composed of 25 initial images arranged in a 5*5 matrix, and each initial image is provided with corresponding coordinates, which are 1-25, respectively. It can be understood that the coordinates and arrangement and splicing method of each initial image can be adjusted according to actual application scenarios.

在另一實施例中,進一步地,步驟S3之後還包括步驟:In another embodiment, further, after step S3, the method further includes the following steps:

獲取第三感應資訊;Obtain third induction information;

依據所述第三感應資訊調整所述圖像模型。The image model is adjusted according to the third sensing information.

具體地,接收模組201接收第三感應單元60發送的第三感應資訊,第三感應資訊包括圖像模型中顯示的機器人周圍的事物的距離,模型建立模組205依據第三感應資訊更新圖像模型中各個圖像區域的三維座標。Specifically, the receiving module 201 receives the third sensing information sent by the third sensing unit 60, the third sensing information includes the distance of things around the robot displayed in the image model, and the model building module 205 updates the map according to the third sensing information. The three-dimensional coordinates of each image area in the image model.

步驟S4:設定所述圖像模型的平衡閾值。Step S4: Set the balance threshold of the image model.

具體地,設定模組206設定圖像模型的平衡閾值。Specifically, the setting module 206 sets the balance threshold of the image model.

在一實施例中,平衡閾值為圖像模型的特定圖像區域的差異度。例如,依據指定座標獲取的圖像與圖像模型中相同座標區域圖像的差異度。In an embodiment, the balance threshold is the degree of difference of a specific image region of the image model. For example, the degree of difference between the image acquired according to the specified coordinates and the image of the same coordinate region in the image model.

在另一實施例中,平衡閾值為座標偏移量,例如,依據指定座標獲取的圖像與圖像模型中相同圖像區域的座標的差值,即為座標偏移量。In another embodiment, the balance threshold is the coordinate offset. For example, the coordinate difference between the image acquired according to the specified coordinates and the coordinates of the same image area in the image model is the coordinate offset.

在一實施例中,平衡閾值的設定依據機器人的自我調整調整能力,例如,機器人移動過程中,由於自身晃動產生的傾斜可以依據自身重力進行調整,則該傾斜屬於正常範圍,為平衡閾值範圍內;機器人傾斜超過一定角度,依靠機器人自身的重力無法進行調整,機器人若不做狀態調整,則將導致機器人失衡,甚至摔倒,則該狀態超出平衡閾值範圍。In one embodiment, the balance threshold is set according to the robot's self-adjustment ability. For example, when the robot moves, the tilt caused by its own shaking can be adjusted according to its own gravity, then the tilt belongs to the normal range and is within the balance threshold range ; The robot tilts more than a certain angle and cannot be adjusted by the robot's own gravity. If the robot does not adjust the state, the robot will be unbalanced or even fall, and the state will exceed the balance threshold range.

步驟S5:即時獲取判定圖像。Step S5: Obtain the judgment image immediately.

具體地,接收模組201即時接收來自拍照設備10的判定圖像。Specifically, the receiving module 201 immediately receives the determined image from the photographing device 10.

在一實施例中,步驟S5具體包括步驟:In an embodiment, step S5 specifically includes the steps:

依據圖像模型的模型特點確定判定座標;Determine the judgment coordinates according to the model characteristics of the image model;

依據判定座標獲取判定圖像。Obtain the judgment image based on the judgment coordinates.

具體地,判定模組202依據圖像模型的模型特點確定判定區域,進而確定判定座標,拍照設備10依據判定座標拍攝該判定座標的判定圖像。Specifically, the determination module 202 determines the determination area according to the model characteristics of the image model, and then determines the determination coordinates, and the photographing device 10 captures the determination image of the determination coordinates according to the determination coordinates.

其中模型特點包括圖像模型中各個區域的相似度、連貫度、是否包含明顯特徵等。例如,圖像模型中的多個區域相似度較高,如果將該區域作為判定區域,容易造成判定誤差;若圖像模型中相鄰區域具有連續性及重複性,不易發現相鄰區域的區別點,則該區域不宜作為判定區域;若圖像模型中具有突出的特徵,例如一區域包含有明顯區別於周圍環境的動物圖案,則該區域可以作為判定區域。The characteristics of the model include the similarity, coherence, and whether there are obvious features in each region in the image model. For example, the similarity of multiple regions in the image model is relatively high. If the region is used as the judgment region, it is easy to cause judgment errors; if the adjacent regions in the image model have continuity and repetition, it is difficult to find the difference between the adjacent regions If the image model has prominent features, for example, an area contains animal patterns that are clearly different from the surrounding environment, then this area can be used as the judgment area.

步驟S6:比對所述判定圖像與所述圖像模型,以獲取區別值。Step S6: Compare the judgment image with the image model to obtain a difference value.

具體地,比對模組207比對判定圖像與圖像模型,以獲取區別值。Specifically, the comparison module 207 compares the determined image with the image model to obtain the difference value.

在一實施例中,比對模組207比對判定圖像與圖像模型中相同座標的圖像區域的差異度,差異度即為區別值。In one embodiment, the comparison module 207 compares and determines the degree of difference between the image and the image area of the same coordinate in the image model, and the degree of difference is the difference value.

在另一實施例中,比對模組207比對判定圖像的座標與圖像模型中相同圖像區域的座標,以獲取座標差值,座標差值即為區別值。In another embodiment, the comparison module 207 compares the coordinates of the determined image with the coordinates of the same image area in the image model to obtain the coordinate difference, which is the difference value.

步驟S7:判斷所述區別值是否超出所述平衡閾值,以判定機器人的平衡狀態。Step S7: Determine whether the difference value exceeds the balance threshold value to determine the balance state of the robot.

若為是,執行步驟S8:判定機器人失去平衡,控制機器人調整;If yes, perform step S8: determine that the robot is out of balance, and control the robot to adjust;

若為否,執行步驟S9:判定機器人保持平衡,並依據所述判定圖像調整所述圖像模型。If not, perform step S9: determine that the robot maintains a balance, and adjust the image model according to the determined image.

例如,如圖4所示,如果判定圖像的座標為8,但是座標為8的判定圖像位於圖像模型中的座標為24的圖像區域,超出平衡閾值範圍3、7、8、9及13,則判定機器人失去平衡。For example, as shown in Figure 4, if the coordinate of the judged image is 8, but the judged image with coordinate 8 is located in the image area of the image model with coordinate 24, which exceeds the balance threshold range 3, 7, 8, 9 And 13, it is determined that the robot is out of balance.

具體地,判定模組202判斷所述區別值是否超出所述平衡閾值,以判定機器人的平衡狀態。若機器人失去平衡,則控制模組203向機器人發送調整指令,以使機器人進行平衡調整,若機器人保持平衡,模型建立模組205依據判定圖像替換所述圖像模型中相應區域的圖案。Specifically, the determination module 202 determines whether the difference value exceeds the balance threshold value to determine the balance state of the robot. If the robot loses balance, the control module 203 sends an adjustment instruction to the robot to adjust the balance of the robot. If the robot maintains balance, the model building module 205 replaces the pattern of the corresponding area in the image model according to the determined image.

進一步地,所述方法還包括步驟:Further, the method further includes the steps:

即時獲取第一感應資訊與第二感應資訊;Obtain the first sensor information and the second sensor information in real time;

依據所述第一感應資訊與第一感應資訊,以形成狀態資訊;Forming status information based on the first sensing information and the first sensing information;

依據狀態資訊調整所述圖像模型的重建週期。Adjust the reconstruction period of the image model according to the status information.

其中狀態資訊包括運動速度、加速度、方向變化、角度變化等。其中運動速度及加速度為機器人運動的速度變化情況,方向變化及角度變化為機器人運動過程中轉向,變更移動方向的頻率。The status information includes movement speed, acceleration, direction change, angle change, etc. The movement speed and acceleration are the speed change of the robot movement, and the direction change and angle change are the frequency of turning and changing the moving direction during the movement of the robot.

具體地,接收模組201接收第一感應資訊與第二感應資訊;更新模組208依據第一感應資訊與第二感應資訊,以形成狀態資訊,並依據狀態資訊調整所述圖像模型的重建週期。例如,若機器人周圍環境變動加大,或是機器人移動速度較快,則需要縮短圖像模型的重建週期,以便於保證圖像模型的準確性。若機器人速度較慢且環境變動較小,則需要增大圖像模型的重建週期。Specifically, the receiving module 201 receives the first sensing information and the second sensing information; the updating module 208 forms state information according to the first sensing information and the second sensing information, and adjusts the reconstruction of the image model according to the state information cycle. For example, if the surrounding environment of the robot changes more or the robot moves faster, the reconstruction period of the image model needs to be shortened to ensure the accuracy of the image model. If the robot speed is slow and the environment changes less, the reconstruction period of the image model needs to be increased.

在一實施例中,依據重建週期,週期執行步驟S1至步驟S3,重新建立圖像模型,以替換舊的圖像模型。In one embodiment, according to the reconstruction period, step S1 to step S3 are periodically executed to rebuild the image model to replace the old image model.

在另一實施例中,所述方法還包括步驟:In another embodiment, the method further includes the steps:

獲取第一資訊集與第二資訊集,其中所述第一資訊集為第一感應單元40在機器人保持平衡時獲取的多個第一感應資訊的集合,所述第二資訊集為第二感應單元50在機器人保持平衡時獲取的多個第二感應資訊的集合;Acquire a first information set and a second information set, wherein the first information set is a set of a plurality of first sensing information acquired by the first sensing unit 40 when the robot is in balance, and the second information set is a second sensing A collection of multiple second sensing information acquired by the unit 50 when the robot is in balance;

依據第一資訊集與第二資訊集設定所述輔助平衡閾值;Setting the auxiliary balance threshold according to the first information set and the second information set;

即時獲取第一感應資訊與第二感應資訊;Obtain the first sensor information and the second sensor information in real time;

分別比對第一感應資訊、第二感應資訊與所述輔助平衡閾值,以判定所述機器人的平衡狀態。The first sensing information, the second sensing information and the auxiliary balance threshold are respectively compared to determine the balance state of the robot.

機器人保持平衡時,通過第一感應單元40、第二感應單元50及拍照設備10獲取圖像集、第一資訊集及第二資訊集,並設定平衡閾值與輔助平衡閾值,即時獲取判定圖像、第一感應資訊與第二感應資訊,依據平衡閾值、輔助平衡閾值、判定圖像、第一感應資訊與第二感應資訊判定機器人的平衡狀態。通過結合多種判定方式,以增強平衡判定準確性,增強平衡判定的適應性。When the robot maintains balance, it acquires the image set, the first information set and the second information set through the first sensing unit 40, the second sensing unit 50 and the photographing device 10, and sets the balance threshold and the auxiliary balance threshold to obtain the judgment image in real time , The first sensor information and the second sensor information determine the balance state of the robot according to the balance threshold, the auxiliary balance threshold, the judgment image, the first sensor information and the second sensor information. By combining multiple judgment methods, the accuracy of balance judgment and the adaptability of balance judgment can be enhanced.

上述機器人平衡判定方法通過建立機器人保持平衡時的圖像模型,設定圖像模型的平衡閾值,並即時比對判定圖像與圖像模型,以獲取區別值,依據區別值與平衡閾值判定機器人的平衡狀態,以便於控制機器人及時進行狀態調整。The above robot balance determination method establishes an image model when the robot maintains balance, sets the balance threshold of the image model, and instantly compares the image and the image model to obtain the difference value, and determines the robot’s performance based on the difference value and the balance threshold. Balance state, so as to control the robot to adjust the state in time.

上述機器人平衡判定方法依據狀態資訊週期重建圖像模型,以保證圖像模型的準確性,進而提升機器人的平衡狀態判定的準確率。The aforementioned robot balance determination method periodically reconstructs the image model according to the state information to ensure the accuracy of the image model, thereby improving the accuracy of the robot's balance state determination.

進一步地,上述機器人平衡判定方法可以結合其他的平衡判定方法,例如依據重力感應器與陀螺儀判定,以提升機器人平衡的判定的準確率,增強適應性。Further, the aforementioned robot balance determination method can be combined with other balance determination methods, such as determination based on a gravity sensor and a gyroscope, to improve the accuracy of robot balance determination and enhance adaptability.

對於本領域技術人員而言,顯然本發明不限於上述示範性實施例的細節,而且在不背離本發明的精神或基本特徵的情況下,能夠以其他的具體形式實現本發明。因此,無論從哪一點來看,均應將實施例看作是示範性的,而且是非限制性的,本發明的範圍由所附權利要求而不是上述說明限定,因此旨在將落在權利要求的等同要件的含義與範圍內的所有變化涵括在本發明內。不應將權利要求中的任何附圖標記視為限制所涉及的權利要求。此外,顯然“包括”一詞不排除其他器或步驟,單數不排除複數。For those skilled in the art, it is obvious that the present invention is not limited to the details of the above exemplary embodiments, and the present invention can be implemented in other specific forms without departing from the spirit or basic characteristics of the present invention. Therefore, from any point of view, the embodiments should be regarded as exemplary and non-limiting. The scope of the present invention is defined by the appended claims rather than the above description, and therefore it is intended to fall into the claims. All changes within the meaning and scope of the equivalent elements of are included in the present invention. Any reference signs in the claims should not be regarded as limiting the claims involved. In addition, it is obvious that the word "including" does not exclude other means or steps, and the singular does not exclude the plural.

以上所述,僅為本發明的較佳實施例,並非是對本發明作任何形式上的限定。另外,本領域技術人員還可在本發明精神內做其它變化,當然,這些依據本發明精神所做的變化,都應包含在本發明所要求保護的範圍之內。The above are only preferred embodiments of the present invention, and are not intended to limit the present invention in any form. In addition, those skilled in the art can also make other changes within the spirit of the present invention. Of course, these changes made according to the spirit of the present invention should all be included in the scope of protection claimed by the present invention.

100:機器人平衡判定裝置 10:拍照設備 20:處理器 30:記憶體 40:第一感應單元 50:第二感應單元 60:第三感應單元 200:機器人平衡判定系統 201:接收模組 202:判定模組 203:控制模組 204:獲取模組 205:模型建立模組 206:設定模組 207:比對模組 208:更新模組100: Robot balance determination device 10: Camera equipment 20: processor 30: memory 40: The first induction unit 50: second sensing unit 60: The third induction unit 200: Robot balance determination system 201: receiving module 202: Judgment Module 203: Control Module 204: Get Module 205: Model Creation Module 206: Setting Module 207: Comparison module 208: Update module

圖1為本發明一實施方式中的機器人平衡判定裝置的硬體架構示意圖。FIG. 1 is a schematic diagram of the hardware architecture of a robot balance determination device in an embodiment of the present invention.

圖2為本發明一實施方式中的機器人平衡判定系統的功能模組示意圖。2 is a schematic diagram of functional modules of the robot balance determination system in an embodiment of the present invention.

圖3為本發明一實施方式中的機器人平衡判定方法的方法流程圖。Fig. 3 is a method flowchart of a robot balance determination method in an embodiment of the present invention.

圖4為本發明一實施方式中的圖像模型的示意圖。Fig. 4 is a schematic diagram of an image model in an embodiment of the present invention.

none

Claims (10)

一種機器人平衡判定裝置,其改良在於,包括: 拍照設備; 處理器,與所述拍照設備耦接,用於: 接收來自所述拍照設備的圖像集,所述圖像集包括機器人保持平衡時所述拍照設備拍攝的多個初始圖像; 獲取每個所述初始圖像的座標; 依據所述座標排列並拼接多個所述初始圖像,以生成圖像模型; 設定所述圖像模型的平衡閾值; 即時接收來自所述拍照設備的判定圖像; 比對所述判定圖像與所述圖像模型,以獲取區別值; 判斷所述區別值是否超出所述平衡閾值,以判定所述機器人的平衡狀態。A robot balance determination device, which is improved in that it includes: Camera equipment The processor, coupled to the photographing device, is used for: Receiving an image set from the photographing device, the image set including a plurality of initial images taken by the photographing device when the robot is in balance; Acquiring the coordinates of each of the initial images; Arranging and stitching a plurality of the initial images according to the coordinates to generate an image model; Setting the balance threshold of the image model; Receive the judged image from the photographing device in real time; Comparing the judgment image with the image model to obtain a difference value; It is determined whether the difference value exceeds the balance threshold to determine the balance state of the robot. 如申請專利範圍第1項所述之機器人平衡判定裝置,其中所述處理器進一步用於: 若所述機器人保持平衡,依據所述判定圖像調整所述圖像模型。According to the robot balance determination device described in item 1 of the scope of patent application, the processor is further used for: If the robot maintains a balance, adjust the image model according to the judgment image. 如申請專利範圍第1項所述之機器人平衡判定裝置,其中所述區別值為: 所述判定圖像的座標與所述圖像模型中相同的圖像區域的座標之間的差值,或 所述判定圖像與所述圖像模型中相同座標區域圖像的差異度。The robot balance judging device described in item 1 of the scope of patent application, wherein the difference value is: The difference between the coordinates of the judgment image and the coordinates of the same image area in the image model, or The degree of difference between the judgment image and the image of the same coordinate region in the image model. 如申請專利範圍第1項所述之機器人平衡判定裝置,其中所述處理器進一步用於: 依據所述圖像模型的模型特點確定判定座標; 所述拍照設備進一步地用於: 依據所述判定座標獲取所述判定圖像。According to the robot balance determination device described in item 1 of the scope of patent application, the processor is further used for: Determining the judgment coordinates according to the model characteristics of the image model; The photographing device is further used for: The determination image is acquired based on the determination coordinates. 如申請專利範圍第1項所述之機器人平衡判定裝置,其中所述機器人平衡判定裝置還包括第一感應單元與第二感應單元,所述第一感應器用於感應所述機器人的速度與位移,以形成第一感應資訊,所述第二感應器用於感應所述機器人的方位角度,以形成第二感應資訊, 其中所述處理器進一步用於: 獲取所述第一感應資訊與第二感應資訊; 依據所述第一感應資訊與所述第二感應資訊形成狀態資訊; 依據所述狀態資訊調整所述圖像模型的重建週期。The robot balance judging device described in the first item of the scope of patent application, wherein the robot balance judging device further includes a first sensing unit and a second sensing unit, and the first sensor is used to sense the speed and displacement of the robot, To form first sensing information, and the second sensor is used to sense the azimuth angle of the robot to form second sensing information, The processor is further used for: Acquiring the first sensing information and the second sensing information; Forming status information based on the first sensing information and the second sensing information; Adjust the reconstruction period of the image model according to the state information. 一種機器人平衡判定方法,其改良在於,包括: 獲取圖像集,所述圖像集包括機器人保持平衡時獲取的多個初始圖像; 獲取每個所述初始圖像的座標; 依據所述座標排列並拼接多個所述初始圖像,以生成圖像模型; 設定所述圖像模型的平衡閾值; 即時獲取判定圖像; 比對所述判定圖像與所述圖像模型,以獲取區別值; 判斷所述區別值是否超出所述平衡閾值,以判定所述機器人的平衡狀態。A method for determining the balance of a robot, which is improved in that it includes: Acquiring an image set, the image set including a plurality of initial images acquired when the robot maintains a balance; Acquiring the coordinates of each of the initial images; Arranging and stitching a plurality of the initial images according to the coordinates to generate an image model; Setting the balance threshold of the image model; Obtain judgment images instantly; Comparing the judgment image with the image model to obtain a difference value; It is determined whether the difference value exceeds the balance threshold to determine the balance state of the robot. 如申請專利範圍第6項所述之機器人平衡判定方法,其中所述方法還包括步驟: 若所述機器人保持平衡,依據所述判定圖像調整所述圖像模型。The robot balance determination method described in item 6 of the scope of patent application, wherein the method further includes the steps: If the robot maintains a balance, adjust the image model according to the judgment image. 如申請專利範圍第6項所述之機器人平衡判定方法,其中所述區別值為: 所述判定圖像的座標與所述圖像模型中相同的圖像區域的座標之間的差值,或 所述判定圖像與所述圖像模型中相同座標區域圖像的差異度。The robot balance determination method described in item 6 of the scope of patent application, wherein the difference value is: The difference between the coordinates of the judgment image and the coordinates of the same image area in the image model, or The degree of difference between the judgment image and the image of the same coordinate region in the image model. 如申請專利範圍第6項所述之機器人平衡判定方法,其中“即時獲取判定圖像”具體包括步驟: 依據所述圖像模型的模型特點確定判定座標; 依據所述判定座標獲取所述判定圖像。For the robot balance determination method described in item 6 of the scope of the patent application, the "real-time acquisition of the determination image" specifically includes the following steps: Determining the judgment coordinates according to the model characteristics of the image model; The determination image is acquired based on the determination coordinates. 如申請專利範圍第6項所述之機器人平衡判定方法,其中所述方法還包括步驟: 獲取第一感應資訊與第二感應資訊,其中所述第一感應資訊包括所述機器人的速度與位移資訊,所述第二感應資訊包括所述機器人的方位角度資訊; 依據所述第一感應資訊與所述第二感應資訊形成狀態資訊; 依據所述狀態資訊調整所述圖像模型的重建週期。The robot balance determination method described in item 6 of the scope of patent application, wherein the method further includes the steps: Acquiring first sensing information and second sensing information, wherein the first sensing information includes speed and displacement information of the robot, and the second sensing information includes azimuth angle information of the robot; Forming status information based on the first sensing information and the second sensing information; Adjust the reconstruction period of the image model according to the state information.
TW108145924A 2019-12-16 2019-12-16 Robot balance determination device and robot balance determination method TWI715353B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW108145924A TWI715353B (en) 2019-12-16 2019-12-16 Robot balance determination device and robot balance determination method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW108145924A TWI715353B (en) 2019-12-16 2019-12-16 Robot balance determination device and robot balance determination method

Publications (2)

Publication Number Publication Date
TWI715353B TWI715353B (en) 2021-01-01
TW202125084A true TW202125084A (en) 2021-07-01

Family

ID=75237330

Family Applications (1)

Application Number Title Priority Date Filing Date
TW108145924A TWI715353B (en) 2019-12-16 2019-12-16 Robot balance determination device and robot balance determination method

Country Status (1)

Country Link
TW (1) TWI715353B (en)

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4998506B2 (en) * 2009-04-22 2012-08-15 トヨタ自動車株式会社 Robot control device, robot control method, and legged robot
CN103699136B (en) * 2014-01-14 2016-08-31 河海大学常州校区 Intelligent home service robot system based on the algorithm that leapfrogs and method of servicing
CN106525049B (en) * 2016-11-08 2019-06-28 山东大学 A kind of quadruped robot ontology posture tracking method based on computer vision
CN110546459A (en) * 2017-02-08 2019-12-06 马凯特大学 Robot tracking navigation with data fusion
CN107943065B (en) * 2017-12-08 2018-10-19 西安科技大学 Robot self-balancing experimental system for simulating and method
CN110032191A (en) * 2019-04-28 2019-07-19 中北大学 A kind of human emulated robot is quickly walked tracking avoidance implementation method

Also Published As

Publication number Publication date
TWI715353B (en) 2021-01-01

Similar Documents

Publication Publication Date Title
TWI782332B (en) An augmented reality data presentation method, device and storage medium
Carrera et al. SLAM-based automatic extrinsic calibration of a multi-camera rig
KR102347239B1 (en) Method and system for improving depth information of feature points using camera and lidar
TWI642903B (en) Locating method, locator, and locating system for head-mounted display
JP2017112602A (en) Image calibrating, stitching and depth rebuilding method of panoramic fish-eye camera and system thereof
US10841570B2 (en) Calibration device and method of operating the same
JP6615545B2 (en) Image processing apparatus, image processing method, and image processing program
JP2008506953A5 (en)
TW201101812A (en) Derivation of 3D information from single camera and movement sensors
CN105993041A (en) Local location computation device and local location computation method
US11670056B2 (en) 6-DoF tracking using visual cues
CN114722913A (en) Attitude detection method and apparatus, electronic device, and computer-readable storage medium
CN112991255B (en) Robot balance determination device and robot balance determination method
CN113194263A (en) Gun and ball linkage control method and device, computer equipment and storage medium
CN113240615A (en) Image processing method, image processing device, electronic equipment and computer readable storage medium
JP5369873B2 (en) Judgment program and calibration device
WO2021026748A1 (en) Photography detection method and apparaus, and gimbal, system and storage medium
TWI715353B (en) Robot balance determination device and robot balance determination method
WO2020014941A1 (en) Map establishment method, positioning method and apparatus, terminal and storage medium
TWI726536B (en) Image capturing method and image capturing apparatus
JP2017529709A (en) How to build an optical flow field
JP2022516466A (en) Information processing equipment, information processing methods, and programs
JP7379785B2 (en) 3D tour comparison display system and method
CN109389645B (en) Camera self-calibration method and system, camera, robot and cloud server
WO2022036512A1 (en) Data processing method and device, terminal, and storage medium

Legal Events

Date Code Title Description
MM4A Annulment or lapse of patent due to non-payment of fees