TWI715353B - 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
TWI715353B
TWI715353B TW108145924A TW108145924A TWI715353B TW I715353 B TWI715353 B TW I715353B TW 108145924 A TW108145924 A TW 108145924A TW 108145924 A TW108145924 A TW 108145924A TW I715353 B TWI715353 B TW I715353B
Authority
TW
Taiwan
Prior art keywords
image
robot
balance
determination
coordinates
Prior art date
Application number
TW108145924A
Other languages
Chinese (zh)
Other versions
TW202125084A (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

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 determination device and robot balance determination 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 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, the processor is further configured to: 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 difference between the coordinates of the judgment image and the image model The degree of difference between images in the same coordinate area.

進一步地,其中所述處理器進一步用於:依據所述圖像模型的模型特點確定判定座標;所述拍照設備進一步地用於:依據所述判定座標獲取所述判定圖像。 Further, the processor is further configured to: determine the judgment coordinates according to the model characteristics of the image model; the photographing device is further configured to: obtain the judgment image according to the judgment 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 second sensing information, wherein the processor is further configured to: obtain the first sensing information and the second sensing information; according to the first sensing information and the second sensing information Forming status information; adjusting the reconstruction period of the image model according to the status information.

本發明第二方面提供一種機器人平衡判定方法,包括:獲取圖像集,所述圖像集包括機器人保持平衡時獲取的多個初始圖像;獲取每個所述初始圖像的座標;依據所述座標排列並拼接多個所述初始圖像,以生成圖像模型;設定所述圖像模型的平衡閾值;即時獲取判定圖像;比對所述判定圖像與所述圖像模型,以獲取區別值; 判斷所述區別值是否超出所述平衡閾值,以判定所述機器人的平衡狀態。 A 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 is in balance; acquiring the coordinates of each of the initial images; Arranging the coordinates and splicing a plurality of the initial images to generate an image model; setting the balance threshold of the image model; obtaining the judgment image immediately; comparing the judgment image with the image model to Get the 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 step of: if the robot maintains a balance, adjusting 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 difference between the coordinates of the judgment image and the image model The degree of difference between images in the same coordinate area.

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

進一步地,所述方法還包括步驟:獲取第一感應資訊與第二感應資訊,其中所述第一感應資訊包括所述機器人的速度與位移資訊,所述第二感應資訊包括所述機器人的方位角度資訊;依據所述第一感應資訊與所述第二感應資訊形成狀態資訊;依據所述狀態資訊調整所述圖像模型的重建週期。 Further, the method further includes the step of 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 the orientation of the robot Angle information; forming state information based on the first sensing information and the second sensing information; adjusting the reconstruction period of the image model based on 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.

100:機器人平衡判定裝置 100: Robot balance determination device

10:拍照設備 10: Camera equipment

20:處理器 20: processor

30:記憶體 30: memory

40:第一感應單元 40: The first induction unit

50:第二感應單元 50: second sensing unit

60:第三感應單元 60: The third induction unit

200:機器人平衡判定系統 200: Robot balance determination system

201:接收模組 201: receiving module

202:判定模組 202: Judgment Module

203:控制模組 203: Control Module

204:獲取模組 204: Get Module

205:模型建立模組 205: Model Creation Module

206:設定模組 206: Setting Module

207:比對模組 207: Comparison module

208:更新模組 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 Figure.

圖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.

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

在下面的描述中闡述了很多具體細節以便於充分理解本發明,所描述的實施方式僅是本發明一部分實施方式,而不是全部的實施方式。基於本發明中的實施方式,本領域普通技術人員在沒有做出創造性勞動前提下所獲得的所有其它實施方式,都屬於本發明保護的範圍。 In the following description, many specific details are explained 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, one or more photographing devices 10 are used to sequentially photograph multiple initial images according to the axis of the robot and according to different shooting angles. 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 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 an 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 Programmable Read-Only Memory (OTPROM) Memory (Electrically-Erasable Programmable Read-Only Memory, EEPROM), CD-ROM (Compact Disc Read-Only Memory, CD-ROM) or other optical disk memory, magnetic disk memory, tape memory, or can be used to carry Or any other computer-readable medium for storing 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 for sensing 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 based on 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 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 also used 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, 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 the determination threshold value according to According to the first sensing information, the second sensing information, and the balance threshold, the robot's balance state is determined. The balance state includes maintaining balance and losing balance.

判定模組202還用於依據圖像模型的模型特點確定判定區域,進而確定判定區域的判定座標。 The determination module 202 is also used to determine the determination area according to the model characteristics of the image model, and then determine the determination coordinates of the determination 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 adjacent region images in the image model are continuous and repetitive, it is difficult to find the similarity. The distinguishing point of the neighboring area is not suitable for 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, the area can be used as the judgment area.

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

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

控制模組203用於發送拍照指令,以使拍照設備10拍攝圖像。 The control module 203 is configured to send a photographing instruction to enable the photographing device 10 to photograph 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 to enable the photographing device 10 to photograph multiple 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 the corresponding coordinates are set according to the relative position of each initial image and the robot. 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 coordinates to generate an image model.

在一實施例中,圖像模型為依據座標排列並拼接而成的全景圖像。 In an 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 is provided with corresponding coordinates, which are 1 ~25. It can be understood that the coordinates and arrangement of each initial image can be adjusted according to actual application scenarios.

在另一實施例中,模型建立模組205還用於依據第三資訊更新圖像模型中各個圖像區域的三維座標。 In another embodiment, the model building module 205 is further 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 in 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 judged 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. Among them, the movement speed and acceleration are the speed of the robot movement Changes, direction changes and angle changes are the frequency of turning and changing the direction of movement of the robot during movement. 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 rebuilt 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 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 the steps of: determining the balance state of the robot; if the balance is maintained, acquiring multiple initial images; forming an image set based on the multiple initial images.

若失去平衡,發送調整指令,以使機器人自我調整。 If you lose 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.

步驟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 the corresponding coordinates are set according to the relative position of each initial image and the robot. 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 coordinates to generate an image model.

在一實施例中,圖像模型為依據座標排列拼接而成的全景圖像。 In an embodiment, the image model is a panoramic image stitched together according to 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 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 steps of: acquiring third sensing information; and adjusting the image model 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 in 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 one embodiment, step S5 specifically includes the steps of: determining the judgment coordinates according to the model characteristics of the image model; and obtaining the judgment image according to 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 it contains obvious features 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 are continuous and repetitive, it is difficult to find the difference between adjacent regions If the image model has a prominent feature, for example, an area contains animal patterns that are clearly different from the surrounding environment, then this area can be used as a 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 judged 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 to determine the balance state of the robot.

若為是,執行步驟S8:判定機器人失去平衡,控制機器人調整;若為否,執行步驟S9:判定機器人保持平衡,並依據所述判定圖像調整所述圖像模型。 If yes, perform step S8: determine that the robot is out of balance and control the robot to adjust; if not, perform step S9: determine that the robot is in 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 the coordinate of 8 is located in the image area with the coordinate of 24 in the image model, it 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 of: acquiring first sensing information and second sensing information in real time; forming state information based on the first sensing information and first sensing information; adjusting the image model based on the state information Rebuild cycle.

其中狀態資訊包括運動速度、加速度、方向變化、角度變化等。其中運動速度及加速度為機器人運動的速度變化情況,方向變化及角度變化為機器人運動過程中轉向,變更移動方向的頻率。 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 update 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 environment around the robot changes more, or the robot If the moving speed is 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.

在另一實施例中,所述方法還包括步驟:獲取第一資訊集與第二資訊集,其中所述第一資訊集為第一感應單元40在機器人保持平衡時獲取的多個第一感應資訊的集合,所述第二資訊集為第二感應單元50在機器人保持平衡時獲取的多個第二感應資訊的集合;依據第一資訊集與第二資訊集設定所述輔助平衡閾值;即時獲取第一感應資訊與第二感應資訊;分別比對第一感應資訊、第二感應資訊與所述輔助平衡閾值,以判定所述機器人的平衡狀態。 In another embodiment, the method further includes the step of: obtaining 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, the second information set is a collection of a plurality of second sensing information acquired by the second sensing unit 50 when the robot is in balance; the auxiliary balance threshold is set according to the first information set and the second information set; Obtain the first sensor information and the second sensor information; compare the first sensor information, the second sensor information and the auxiliary balance threshold respectively 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 are 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 robot balance determination method described above 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 the robot balance determination and enhance the 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, no matter from which 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 within 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 request shall not be regarded as the request item involved in the restriction. In addition, it is obvious that the word "include" 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 of the present invention.

Claims (10)

一種機器人平衡判定裝置,其改良在於,包括:拍照設備;處理器,與所述拍照設備耦接,用於:接收來自所述拍照設備的圖像集,所述圖像集包括機器人保持平衡時所述拍照設備拍攝的多個初始圖像;獲取每個所述初始圖像的座標;依據所述座標排列並拼接多個所述初始圖像,以生成圖像模型;設定所述圖像模型的平衡閾值;即時接收來自所述拍照設備的判定圖像;比對所述判定圖像與所述圖像模型,以獲取區別值;判斷所述區別值是否超出所述平衡閾值,以判定所述機器人的平衡狀態。 A robot balance determination device, which is improved in that it includes: 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 time when the robot is in balance Multiple initial images taken by the photographing device; acquiring the coordinates of each of the initial images; arranging and stitching multiple initial images according to the coordinates to generate an image model; setting the image model The balance threshold; receive the judgment image from the photographing device immediately; compare the judgment image with the image model to obtain the difference value; determine whether the difference value exceeds the balance threshold to determine the State the equilibrium state of the robot. 如請求項1所述之機器人平衡判定裝置,其中所述處理器進一步用於:若所述機器人保持平衡,依據所述判定圖像調整所述圖像模型。 The robot balance determination device according to claim 1, wherein the processor is further configured to: if the robot maintains balance, adjust the image model according to the determination image. 如請求項1所述之機器人平衡判定裝置,其中所述區別值為:所述判定圖像的座標與所述圖像模型中相同的圖像區域的座標之間的差值,或所述判定圖像與所述圖像模型中相同座標區域圖像的差異度。 The robot balance determination device according to claim 1, wherein the difference value is: the difference between the coordinates of the determination image and the coordinates of the same image area in the image model, or the determination The degree of difference between the image and the image in the same coordinate region in the image model. 如請求項1所述之機器人平衡判定裝置,其中所述處理器進一步用於:依據所述圖像模型的模型特點確定判定座標;所述拍照設備進一步地用於:依據所述判定座標獲取所述判定圖像。 The robot balance determination device according to claim 1, wherein the processor is further configured to: determine the determination coordinates according to the model characteristics of the image model; the photographing device is further configured to: obtain the determination coordinates according to the determination coordinates The judgment image. 如請求項1所述之機器人平衡判定裝置,其中所述機器人平衡判定裝置還包括第一感應單元與第二感應單元,所述第一感應單元用於感應所述機器人的速度與位移,以形成第一感應資訊,所述第二感應單元用於感應所述機器人的方位角度,以形成第二感應資訊,其中所述處理器進一步用於:獲取所述第一感應資訊與第二感應資訊;依據所述第一感應資訊與所述第二感應資訊形成狀態資訊;依據所述狀態資訊調整所述圖像模型的重建週期。 The robot balance determination device according to claim 1, wherein the robot balance determination device further includes a first sensing unit and a second sensing unit, and the first sensing unit is used to sense the speed and displacement of the robot to form The first sensing information, the second sensing unit is used for sensing the azimuth angle of the robot to form second sensing information, wherein the processor is further used for: acquiring the first sensing information and the second sensing information; Forming state information according to the first sensing information and the second sensing information; adjusting the reconstruction period of the image model based on 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 is in balance; acquiring the coordinates of each of the initial images; and according to the coordinates Arrange and stitch a plurality of the initial images to generate an image model; set the balance threshold of the image model; obtain the judgment image instantly; compare the judgment image with the image model to obtain the difference Value; determine whether the difference value exceeds the balance threshold to determine the balance state of the robot. 如請求項6所述之機器人平衡判定方法,其中所述方法還包括步驟:若所述機器人保持平衡,依據所述判定圖像調整所述圖像模型。 The robot balance determination method according to claim 6, wherein the method further includes the step of: if the robot maintains a balance, adjusting the image model according to the determination image. 如請求項6所述之機器人平衡判定方法,其中所述區別值為:所述判定圖像的座標與所述圖像模型中相同的圖像區域的座標之間的差值,或所述判定圖像與所述圖像模型中相同座標區域圖像的差異度。 The robot balance determination method according to claim 6, wherein the difference value is: the difference between the coordinates of the determination image and the coordinates of the same image area in the image model, or the determination The degree of difference between the image and the image in the same coordinate region in the image model. 如請求項6所述之機器人平衡判定方法,其中“即時獲取判定 圖像”具體包括步驟:依據所述圖像模型的模型特點確定判定座標;依據所述判定座標獲取所述判定圖像。 The robot balance determination method described in claim 6, in which "getting the determination immediately The "image" specifically includes the steps of: determining the judgment coordinates according to the model characteristics of the image model; acquiring the judgment image according to the judgment coordinates. 如請求項6所述之機器人平衡判定方法,其中所述方法還包括步驟:獲取第一感應資訊與第二感應資訊,其中所述第一感應資訊包括所述機器人的速度與位移資訊,所述第二感應資訊包括所述機器人的方位角度資訊;依據所述第一感應資訊與所述第二感應資訊形成狀態資訊;依據所述狀態資訊調整所述圖像模型的重建週期。 The robot balance determination method according to claim 6, wherein the method further includes the step of: 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 the azimuth angle information of the robot; the state information is formed according to the first sensing information and the second sensing information; the reconstruction period of the image model is adjusted 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 true TWI715353B (en) 2021-01-01
TW202125084A 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)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010122705A1 (en) * 2009-04-22 2010-10-28 トヨタ自動車株式会社 Robot control device, robot control method, and robot with legs
CN103699136A (en) * 2014-01-14 2014-04-02 河海大学常州校区 Intelligent household service robot system and service method based on leapfrogging algorithm
CN106525049A (en) * 2016-11-08 2017-03-22 山东大学 Quadruped robot body posture tracking method based on computer vision
CN107943065A (en) * 2017-12-08 2018-04-20 西安科技大学 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
US20190361460A1 (en) * 2017-02-08 2019-11-28 Marquette University Robotic tracking navigation with data fusion

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010122705A1 (en) * 2009-04-22 2010-10-28 トヨタ自動車株式会社 Robot control device, robot control method, and robot with legs
CN103699136A (en) * 2014-01-14 2014-04-02 河海大学常州校区 Intelligent household service robot system and service method based on leapfrogging algorithm
CN106525049A (en) * 2016-11-08 2017-03-22 山东大学 Quadruped robot body posture tracking method based on computer vision
US20190361460A1 (en) * 2017-02-08 2019-11-28 Marquette University Robotic tracking navigation with data fusion
CN107943065A (en) * 2017-12-08 2018-04-20 西安科技大学 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
TW202125084A (en) 2021-07-01

Similar Documents

Publication Publication Date Title
TWI782332B (en) An augmented reality data presentation method, device and storage medium
US20200388051A1 (en) Camera attitude tracking method and apparatus, device, and system
Carrera et al. SLAM-based automatic extrinsic calibration of a multi-camera rig
JP4931218B2 (en) Imaging apparatus, object detection method, and attitude parameter calculation method
KR102347239B1 (en) Method and system for improving depth information of feature points using camera and lidar
US7856172B2 (en) Jiggle measuring system and jiggle measuring method
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
WO2019205868A1 (en) Method, device and apparatus for repositioning in camera orientation tracking process, and storage medium
JP6615545B2 (en) Image processing apparatus, image processing method, and image processing program
JP2008506953A5 (en)
JP2007072537A (en) 360-degree image photographing device
CN105993041A (en) Local location computation device and local location computation method
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
CN113240615A (en) Image processing method, image processing device, electronic equipment and computer readable storage medium
US10916062B1 (en) 6-DoF tracking using visual cues
JP2017151026A (en) Three-dimensional information acquiring device, three-dimensional information acquiring method, and program
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
JP2005241323A (en) Imaging system and calibration method
WO2019100216A1 (en) 3d modeling method, electronic device, storage medium and program product

Legal Events

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