CN107329470A - A kind of control method for the robot that paddles, device and the robot that paddles - Google Patents

A kind of control method for the robot that paddles, device and the robot that paddles Download PDF

Info

Publication number
CN107329470A
CN107329470A CN201710423940.5A CN201710423940A CN107329470A CN 107329470 A CN107329470 A CN 107329470A CN 201710423940 A CN201710423940 A CN 201710423940A CN 107329470 A CN107329470 A CN 107329470A
Authority
CN
China
Prior art keywords
luminaire
movement locus
robot
determined
paddles
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201710423940.5A
Other languages
Chinese (zh)
Other versions
CN107329470B (en
Inventor
不公告发明人
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing PowerVision Technology Co Ltd
Original Assignee
Beijing PowerVision Technology Co Ltd
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 Beijing PowerVision Technology Co Ltd filed Critical Beijing PowerVision Technology Co Ltd
Priority to CN201710423940.5A priority Critical patent/CN107329470B/en
Publication of CN107329470A publication Critical patent/CN107329470A/en
Application granted granted Critical
Publication of CN107329470B publication Critical patent/CN107329470B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0253Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0285Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Manipulator (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

The invention discloses a kind of control method for the robot that paddles, device and the robot that paddles, methods described includes:The multiple image for being located at the luminaire that measurand under water is carried is obtained in preset time;And according to the multiple image, determine the movement locus of the luminaire;According to the movement locus, the movement locus type and the direction of motion of the luminaire are determined;And the corresponding relation of the movement locus type, the direction of motion and operational order according to storage, determine the corresponding operational order of movement locus type, the direction of motion of the luminaire;And according to the operational order determined, perform corresponding action.The method provided using the present invention, is not only realized the direct communication of scuba diver and the robot that paddles, so that the robot that paddles is able to carry out the various instructions that scuba diver sends, greatly meets the enjoyment of people's sub-aqua sport.

Description

A kind of control method for the robot that paddles, device and the robot that paddles
Technical field
The present invention relates to technical field of robot control in water, more particularly to a kind of control method for the robot that paddles, dress Put and paddle robot.
Background technology
Utilization is continually developed with the raising and marine resources of people's level of consumption, to dive under water as the fortune under water of representative The dynamic leisure as more and more people, temper selection, and gradually grow up robot sub-aqua sport of paddling, take pictures, The functions such as shooting, are capable of the enjoyment of significant increase people's sub-aqua sport.
Communicated in order to achieve the above object, it is necessary to paddle and can be realized between robot and scuba diver, and in the prior art It is to be connected using wire cable with control cabinet on the water surface with the method for robot communication of paddling generally to realize people, passes through wire cable The communication between control cabinet is realized, so as to realize the indirect communication of people and the robot that paddles, but the logical of wire cable is used Letter method, it is adaptable to which people carries out indirect communication with the robot that paddles under water, if being applied to scuba diver and machine of paddling The communication of people, then scuba diver need to carry with wire cable, this mode requires that wire cable is moved with scuba diver, so not Only it is unfavorable for scuba diver and does various actions of taking pictures, be less useful for scuba diver and move about, substantially reduces scuba diver's experience;In addition, wired Cable is connected by water joint with the robot that paddles, with the passage of time, because water joint infiltration to wire cable with relating to Communication between water robot threatens, and the communication in turn resulting in people between the robot that paddles is not smooth.
Therefore, in the case where not using wire cable, how by controlling the robot that paddles so that robot energy of paddling Enough real-time tracing users simultaneously perform the various action commands that diving user sends, and greatly meeting the enjoyment of people's sub-aqua sport is One of technical problem urgently to be resolved hurrily.
The content of the invention
The embodiment of the present invention provides a kind of control method for the robot that paddles, device and the robot that paddles, not adopt In the case of wire cable, the various action commands that diving user sends are performed, the pleasure of people's sub-aqua sport is greatly met Interest.
The embodiment of the present invention provides a kind of control method for the robot that paddles, including:
The multiple image for being located at the luminaire that measurand under water is carried is obtained in preset time;And
According to the multiple image, the movement locus of the luminaire is determined;
According to the movement locus, the movement locus type and the direction of motion of the luminaire are determined;And
According to the corresponding relation of the movement locus type, the direction of motion and operational order of storage, the luminaire is determined Movement locus type, the corresponding operational order of the direction of motion;And
According to the operational order determined, corresponding action is performed.
The embodiment of the present invention provides a kind of control device for the robot that paddles, including:
Collecting unit, the multiframe figure for the luminaire that measurand under water is carried is located at for being obtained in preset time Picture;
First determining unit, for according to the multiple image, determining the movement locus of the luminaire;
Second determining unit, for according to the movement locus, determining the movement locus type and fortune of the luminaire Dynamic direction;
3rd determining unit, for the corresponding relation of the movement locus type according to storage, the direction of motion and operational order, Determine the corresponding operational order of movement locus type, the direction of motion of the luminaire;
Execution unit, for according to the operational order determined, performing corresponding action.
The embodiment of the present invention provides a kind of nonvolatile computer storage media, and be stored with computer executable instructions, institute State computer executable instructions and be used to performing the application any of the above-described and paddle the control method of robot.
The embodiment of the present invention provides one kind and paddled robot, including:At least one processor;And
The memory being connected with least one described processor communication;Wherein, the memory storage have can by it is described extremely The instruction of a few computing device, the instruction is by least one described computing device, so that at least one described processing Device is able to carry out the application any of the above-described and paddled the control method of robot.
The embodiment of the present invention provides a kind of computer program product, and the computer program product is non-transient including being stored in Computer program on computer-readable recording medium, the computer program includes programmed instruction, wherein, when described program refers to Order is when being computer-executed, and the computer is performed the application any of the above-described and paddles the control method of robot.
Beneficial effects of the present invention:
Control method, device and the robot that paddles of the robot provided in an embodiment of the present invention that paddles, in preset time Obtain and be located at after the multiple image for the luminaire that measurand under water is carried, according to the multiple image, determine the hair The movement locus of light device;Then according to the movement locus, movement locus type and the motion side of the luminaire are determined To;And the corresponding relation of the movement locus type, the direction of motion and operational order according to storage, determine the luminaire The corresponding operational order of movement locus type, the direction of motion;And according to the operational order determined, perform corresponding action.By This is realized under conditions of without using wire cable, the direct communication of people and the robot that paddles, and by the robot that paddles Control so that the movement locus that the robot that paddles can be drawn out according to measurand using the luminaire, perform phase The action answered, not only meets the enjoyment of people's sub-aqua sport, and the robot that paddles can also be commanded to perform some detection operations, expands The use scope for the robot that paddles is opened up.
Other features and advantages of the present invention will be illustrated in the following description, also, partly becomes from specification Obtain it is clear that or being understood by implementing the present invention.The purpose of the present invention and other advantages can be by the explanations write Specifically noted structure is realized and obtained in book, claims and accompanying drawing.
Brief description of the drawings
Accompanying drawing described herein is used for providing a further understanding of the present invention, constitutes the part of the present invention, this hair Bright schematic description and description is used to explain the present invention, does not constitute inappropriate limitation of the present invention.In the accompanying drawings:
Fig. 1 a are the schematic flow sheet of the control method for the robot that paddles that the embodiment of the present invention one is provided;
Fig. 1 b be the embodiment of the present invention one in determine the luminaire movement locus method schematic flow sheet;
The signal of default movement locus in the control method for the robot that paddles that Fig. 2 provides for the embodiment of the present invention one Figure;
Equipment is carried out to measurand in the control method for the robot that paddles that Fig. 3 a provide for the embodiment of the present invention two The schematic flow sheet of method;
Fig. 3 b are the schematic diagram of determination glow frequency in the method that the embodiment of the present invention two is provided;
The schematic flow sheet being tracked in the method that Fig. 4 provides for the embodiment of the present invention two to measurand;
Fig. 5 is the structural representation of the control device for the robot that paddles that the embodiment of the present invention three is provided;
Fig. 6 is the hardware architecture diagram for the robot that paddles that the embodiment of the present invention five is provided.
Embodiment
Control method, device and the robot that paddles of the robot provided in an embodiment of the present invention that paddles, not use In the case of wire cable, the various action commands that diving user sends are performed, the enjoyment of people's sub-aqua sport is greatly met.
It should be noted that the control method of the robot provided in an embodiment of the present invention that paddles can apply to the user that dives under water Paddled the scene that robot taken pictures by control, substantially process is:A luminaire is carried under diving user before water, such as Signal lamp or reflex reflector, if the luminaire is signal lamp, diving user open signal lamp, and will be described under water Signal lamp is moved according to the corresponding track of photographing instruction, and the corresponding movement locus of such as photographing instruction is U-shaped track, then dives Water user drives the signal lamp to be moved along U-shaped track.Then paddle robot multi collect and obtain be located under water Diving user carry signal lamp multiple image, then according to multi collect and obtain multiple image, determine the letter The movement locus (U-shaped movement locus) of signal lamp;Further according to the movement locus, and the movement locus prestored refers to operation The corresponding relation of order, determines the corresponding operational order of movement locus (action of taking pictures) of the luminaire;And according to determining Operational order (action of taking pictures), corresponding action (being taken pictures to diving user) is performed, it is possible thereby to pass through signal lamp control Make the robot that paddles so that the robot that paddles takes pictures to diving user, improves the experience of diving user.
In addition, the executive agent of the control method of the robot provided in an embodiment of the present invention that paddles can be machine of paddling People, and the robot that paddles is provided with camera device, the measurand being located under water by camera device multi collect and acquisition is carried Luminaire multiple image;After multiple image is obtained, multiple image is entered by the image processor in the robot that paddles Row processing, and the movement locus of the luminaire is determined with reference to the master controller for the robot that paddles, then further according to the fortune Dynamic rail mark, and the movement locus and the corresponding relation of operational order prestored, determine the movement locus of the luminaire Corresponding operational order;The operational order determined is sent to corresponding execution mould by master controller after operational order is determined Block, performs the corresponding action of the operational order.
The preferred embodiments of the present invention are illustrated below in conjunction with Figure of description, it will be appreciated that described herein Preferred embodiment is merely to illustrate and explain the present invention, and is not intended to limit the present invention, and in the case where not conflicting, this hair The feature in embodiment and embodiment in bright can be mutually combined.
Embodiment one
As shown in Figure 1a, be the embodiment of the present invention one provide the robot that paddles control method schematic flow sheet, can To comprise the following steps:
S11, the multiple image that the luminaire for being located at measurand carrying under water is obtained in preset time.
When it is implemented, can be according to the image for gathering the luminaire in preset time with fixed frequency, such as pre- If it is luminous that the measurand being located under water using the camera multi collect and acquisition for robot built-in of paddling in the time is carried The multiple image of equipment, such as preset time are 1 second, and every collection in 0.02 second once, then can be gathered 50 times in 1 second, and point 50 two field pictures of the luminaire are not obtained.
Specifically, shape is opened, it is necessary to be in positioned at the luminaire that measurand under water is carried when performing the present invention State, then measurand perform corresponding motion using the luminaire, based on this, could realize that the control robot that paddles is held The purpose of row corresponding actions.
It is preferred that the luminaire can be, but not limited to include signal lamp and light deflection device;If the luminaire For signal lamp, then need to carry the measurand manual turning-on signal lamp of the signal lamp;If the luminaire is light deflection device When, then before multi collect and acquisition are located at the multiple image for the luminaire that measurand under water is carried, in addition to:
Detecting lamp is opened in advance, wherein the detecting lamp is used for when being pointed to measurand under water and being detected, it is tactile The light deflection device for sending out measurand described lights.
When it is implemented, the light deflection device can be the equipment with reflectorized material, when detecting lamp is irradiated to reflective set Standby upper, reflectorized material thereon can produce the light of high brightness under the irradiation of detecting lamp.So that robot collection of paddling is described anti- The multiple image of light device.
It is preferred that paddling robot before step S11 is performed, it is necessary to begin look for working as by the camera device of its own Whether front position has diving user, if it is not, can be rotated according to predetermined angle since current location, waits to rotate After predetermined angle, searched again, until finding diving user;Or looked into while can also be using rotation Look for, this process searched in rotation is relatively accurate, can also search diving user using other method certainly.Looking into Find after diving user, then perform the control method for the robot that paddles that the present invention is provided.
S12, according to the multiple image, determine the movement locus of the luminaire.
When it is implemented, after multiple image is obtained, for each two field picture, recording the position of luminaire, then will The position of luminaire is connected in multiple image, determines the movement locus of the luminaire.
It is preferred that the movement locus of the luminaire can be determined according to the method shown in Fig. 1 b, it can include following Step:
S121, according to the multiple image, using the coordinate system pre-established, determine described in each two field picture light set Standby coordinate value.
When it is implemented, the rectangular coordinate system UOV on pixel, image can be set up using the image upper left corner as round dot The transverse and longitudinal coordinate of middle any point represents the pixel value of the point, it is possible thereby to for each two field picture, obtain the luminaire Pixel value (u, v), the coordinate value of as described luminaire.It should be noted that the luminaire can not be one again Spot light, so the luminaire in the every two field picture collected is likely to be a circle, now we can obtain every frame The pixel value of the home position of the circle of this in image, is used as the coordinate value of the luminaire.
S122, the luminaire according to each two field picture determined coordinate value, determine the luminaire Movement locus.
When it is implemented, determining described in each two field picture after the coordinate value of luminaire, map that to same In coordinate system, and the movement locus of the luminaire is drawn out in the coordinate system.
S13, according to the movement locus, determine the movement locus type and the direction of motion of the luminaire.
When it is implemented, after the movement locus that step S12 determines the luminaire, you can true according to movement locus The movement locus type and the direction of motion of the luminaire are made, the luminaire can be determined from multiple image Original position, several centre positions and final position, thus will obtain the movement locus of the luminaire, so after its line The direction of motion and movement locus type of the luminaire are determined according to the movement locus of acquisition afterwards.
It is preferred that what movement locus type provided in an embodiment of the present invention represented is the corresponding figure of movement locus, such as institute The movement locus for stating luminaire is a circle, then movement locus type is circle.The direction of motion is expressed as from start bit It is fortune to put the direction that starting position coordinates point to final position coordinate in the direction of final position, such as step S121~S122 Dynamic direction.
It is preferred that the corresponding movement locus of movement locus a in Fig. 2 in the movement locus schematic diagram with reference to shown in Fig. 2, Fig. 2 Type is straight line, the direction of motion be level to the right;The corresponding movement locus types of movement locus b are straight line, the direction of motion in Fig. 2 For level to the left;Movement locus type corresponding movement locus c is straight line, and the direction of motion is vertically upward;D pairs of movement locus The movement locus type answered is straight line, and the direction of motion is vertically downward;Movement locus type corresponding movement locus e is circle Shape, the direction of motion is counterclockwise;Movement locus type corresponding movement locus f is circle, and the direction of motion is clockwise;Need Illustrate, the embodiment of the present invention can also increase movement locus newly, such as U-shaped movement locus, triangular motion track, the present invention To this without limiting.
S14, the corresponding relation according to the movement locus type, the direction of motion and operational order of storage, are determined described luminous The corresponding operational order of movement locus type, the direction of motion of equipment.
After the movement locus type and the direction of motion of the luminaire are determined according to step S13, you can according to pre- The corresponding relation of the movement locus type, the direction of motion and the operational order that first store, determines the motion rail of the luminaire The corresponding operational order of mark type, the direction of motion, wherein the movement locus type, the direction of motion and the operational order that prestore Shown in corresponding relation reference table 1:
Table 1
Movement locus type The direction of motion Operational order
Straight line Level is to the right Advancement commands
Straight line Level is to the left Retreat instruction
Straight line Vertically upward Turn left to instruct
Straight line Vertically downward Turn right and instruct
It is circular Counterclockwise Float and instruct
It is circular Clockwise Dive is instructed
It is U-shaped Upward opening Photographing instruction
…… …… ……
When it is implemented, if the movement locus types determined of step S13 are straight line, and the direction of motion be level to The right side, then can determine and expect robot advance pre-determined distance of paddling positioned at measurand under water;If it is determined that the hair The movement locus type of light device is circle, and the direction of motion is clockwise, then can determine the measurand positioned under water Expect robot dive instruction etc. of paddling.
It should be noted that the movement locus type, the direction of motion and the operational order that are stored in the embodiment of the present invention one Corresponding relation is made an appointment, for example, staff presets movement locus type, the direction of motion and operational order Corresponding relation, is then enter into the robot that paddles.In addition, staff also needs to inform measurand movement locus class The corresponding relation of type, the direction of motion and operational order, thus measurand can control to paddle robot according to the corresponding relation Perform the work that measurand needs.
It should be noted that movement locus of embodiment of the present invention type, the direction of motion can also correspond to other operational orders, The present invention to this without limit, in addition, the U-shaped track such as set, the corresponding operational order of upward opening is photographing instructions.
When it is implemented, advance provided in an embodiment of the present invention or retreat, float or the operational order such as dive, its advance or The distance of retrogressing, floating or dive is pre-set, i.e., advance according to the distance set or retreat or float or dive Deng.Equally, it is provided in an embodiment of the present invention left-hand rotation or turn right angle be also what is pre-set, i.e., often move once, it is necessary to Turned left or turned right according to angle set in advance.Wherein, the angle or the size of distance pre-set can be according to reality Situation determines that the present invention is to this without limiting.
If it is preferred that the luminaire without moving, that is, it is a point to shoot obtained movement locus, that is, is moved Type of gesture be a little, without motion direction, then can represent keep current operation or position it is constant.
It is preferred that in order to improve determine operational order precision, positioned at measurand under water drive luminaire by When being moved according to desired guiding trajectory, it can repeat twice.
The operational order that S15, basis are determined, performs corresponding action.
When it is implemented, if the operational order determined in step S14 is advancement commands, the robot that paddles is according to pre- If apart from forward movement.The luminaire carried by measurand, realizes the communication of measurand and the robot that paddles, and in fact Now to the control for the robot that paddles so that the robot that paddles performs corresponding action.
It is preferred that can be performed by the image processor in the robot that paddles and master controller in the embodiment of the present invention one Step S11~S15 process, described image processor can be DSP (at Digital Signal Process, data signal Manage device), the master controller can be ARM microprocessor, such as STM32F427.
The control method for the robot that paddles that the embodiment of the present invention one is provided, multi collect and position is obtained in preset time In after the multiple image for the luminaire that measurand under water is carried, the coordinate pre-established is utilized according to the multiple image System, determines the coordinate value of luminaire described in each two field picture;The luminaire according to each two field picture determined Coordinate value, determine the movement locus of the luminaire.After the movement locus of the luminaire is determined, according to described Movement locus, determines the movement locus type and the direction of motion of the luminaire;And according to the movement locus prestored The corresponding relation of type, the direction of motion and operational order, determines movement locus type, the reversing of motion correspondence of the luminaire Operational order;And according to the operational order determined, perform corresponding action.Thus achieve without using wire cable Under the conditions of, the direct communication of people and the robot that paddles, and pass through the control to the robot that paddles so that the robot that paddles being capable of root The movement locus drawn out according to measurand using the luminaire, is performed corresponding action, not only meets people under water The enjoyment of motion, can also command the robot that paddles to perform some detection operations, extend the use scope for the robot that paddles.
Embodiment two
For a better understanding of the present invention, the embodiment of the present invention two is performing step S13's on the basis of embodiment one Before, the flow shown in Fig. 3 a is can also carry out, be may comprise steps of:
S31, according to the multiple image, determine the characteristic information of the luminaire.
It is preferred that the characteristic information between the luminaire includes following at least one:Glow frequency, the color of light and institute State the shape of luminaire light-emitting window.
Specifically, the glow color can be red, green or yellow etc., but typically be compared when selecting using penetration power Long light is used, i.e., used from the long luminaire of the wavelength of the light sent.The shape of the light sent can for it is circular, Square or triangle etc..The present invention is to this without limiting.
When it is implemented, due to positioned at measurand more than one under water, therefore, in order to at least one measurand Make a distinction, can be with glow frequency in method provided in an embodiment of the present invention, the shape of glow color and the light sent, or Any combinations of these three features of person distinguishes luminaire.For example, two luminaires have different glow frequencies, or With different glow colors, or shape with different light etc..In order to further improve the accurate of identification luminaire Property, it can require that luminaire has fixed glow frequency and glow color the two features.When being identified, only this Two signature verifications could be identified the identification to measurand and be passed through by rear.
It is preferred that the robot that paddles when determining the characteristic information of the luminaire, lights according to the multiple image Color and the shape of light sent can easier be confirmed to come, but it is determined that during glow frequency, it is possible to use Nai Kuisi Special sampling thheorem is determined, when being more than 2 times of highest frequency using frequency, and sampled signal can retain all of original signal Information.Image frame per second as sample frequency, is carried out coding judgement, as shown in Figure 3 b, Rule of judgment is by the present invention to signal lamp: Chang Liang duration is more than TLFor long signal, 1 is encoded to;Duration is less than or equal to TLFor short message or, it is encoded to 0.Thus lead to Cross the glow frequency that different coding determines luminaire.
It is preferred that the luminaire that the embodiment of the present invention is used can also be breath light, its characteristic information is that breath light is bright The slope of angle value change.
The characteristic information that S32, basis are determined, the identity to measurand is identified.
When it is implemented, staff again by luminaire light measurand when, the identity of measurand can be recorded, such as The information such as ID card No., are illustrated by taking identification card number as an example, then staff can record ID card No. and luminaire Corresponding relation, and the characteristic information of the luminaire recorded in advance;In addition, exemplified by be easy to record, due to luminous Equipment has unit type, and the unit type of the luminaire can be directly recorded during record, or staff can be advance Unique number is carried out to all luminaires, luminaire can also be represented with this, ID card No. is thereby establish, lighting sets Corresponding relation between standby model (numbering) and the characteristic information three of luminaire.
Therefore, robot is paddled when measurand is identified, after the characteristic information of luminaire is determined, Can according to the corresponding relation between the characteristic information three of ID card No., luminaire model (numbering) and luminaire, The identity of measurand is determined, positioning is tracked to the measurand.
It is preferred that the embodiment of the present invention is provided when being tracked positioning to measurand, can be according to the side shown in Fig. 4 Method is implemented, and may comprise steps of:
S41, determine with positioned at the distance between measurand under water.
When it is implemented, the robot that paddles can utilize based on binocular vision system determine its with positioned at tested pair under water The relative position relation of elephant, the relative position relation includes left and right, up and down and distant relationships, and especially by paddling, robot is set The camera calibration put determines the inside and outside parameter of video camera, generally uses Zhang Zhengyou standardizations.Determining the figure of measurand As after coordinate value, the corresponding world coordinates of image coordinate is determined based on binocular vision system.
After relative position relation is determined, it is determined that with positioned at the distance between measurand under water.
Whether the distance that S42, judgement are determined is in the range of pre-determined distance, if it is not, then performing step S43;It is no Then, then step S44 is performed.
When it is implemented, the distance determined is judged whether in the range of pre-determined distance, if representing machine of paddling Device people can understand the image for the luminaire for collecting measurand and its carrying, then keep current location constant;If no In the range of pre-determined distance, in order to ensure the image clearly collected, it is necessary to be tracked to measurand, its movement side To should ensure that it is mobile after with the distance between measurand within a preset range.
It is preferred that in order to further track measurand, when detecting measurand along a direction advance certain distance, The robot that then paddles need to track measurand and accordingly advance certain distance.
S43, the measurand is tracked.
S44, holding current location are constant.
In order to be further understood that the tracking of the offer of the embodiment of the present invention two, methods described can be applied under water There are the application scenarios of multiple measurands, for example, there is 3 measurands under water, respectively A, B and C, then the robot that paddles can be with This 3 measurands are identified respectively for the method provided according to the embodiment of the present invention two, then determine and this 3 quilts respectively The relative position of object is surveyed, when this 3 measurand movements, then the distance with measurand is redefined, to realize to quilt Survey the track and localization of object.
The control method for the robot that paddles that the embodiment of the present invention two is provided, on the basis of embodiment one, utilizes collection The multiple image arrived, determines the characteristic information of the luminaire;And according to the characteristic information determined, to tested pair The identity of elephant is identified, and thus achieves the identification to measurand;Further, it is also possible to determine with being located at tested pair under water The distance between as;If it is determined that the distance is not in the range of pre-determined distance, then the measurand is tracked, it is real Now to the track and localization of measurand, the use scope for the robot that paddles is extended.
Embodiment three
Based on same inventive concept, a kind of control device for the robot that paddles is additionally provided in the embodiment of the present invention, due to The principle that said apparatus solves problem is similar to the control method for the robot that paddles, therefore the implementation side of may refer to of said apparatus The implementation of method, repeats part and repeats no more.
As shown in figure 5, the structural representation of the control device of the robot that paddles provided for the embodiment of the present invention three, bag Include:Obtaining unit 51, the first determining unit 52, the second determining unit 53, the 3rd determining unit 54 and execution unit 55, wherein:
Obtaining unit 51, the multiframe for the luminaire that measurand under water is carried is located at for being obtained in preset time Image;
First determining unit 52, for according to the multiple image, determining the movement locus of the luminaire;
Second determining unit 53, for according to the movement locus, determine the luminaire movement locus type and The direction of motion;
3rd determining unit 54, for the movement locus type according to storage, direction of motion pass corresponding with operational order System, determines the corresponding operational order of movement locus type, the direction of motion of the luminaire;
Execution unit 55, for according to the operational order determined, performing corresponding action.
When it is implemented, described device, in addition to:4th determining unit and recognition unit, wherein:
4th determining unit, in the 3rd determining unit 54 according to the movement locus type of storage, motion Direction and the corresponding relation of operational order, determine that the corresponding operation of movement locus type, the direction of motion of the luminaire refers to Before order, according to the multiple image, the characteristic information of the luminaire is determined;
The recognition unit, for the characteristic information determined according to the 4th determining unit, to the body of measurand Part is identified.
It is preferred that the characteristic information includes following at least one:Glow frequency, the color of light and the luminaire go out The shape of optical port.
When it is implemented, first determining unit 52, is specifically included:First determination subelement and second determines that son is single Member, wherein:
First determination subelement, for according to the multiple image, using the coordinate system pre-established, is determined each The coordinate value of luminaire described in two field picture;
Second determination subelement, for the coordinate value of the luminaire according to each two field picture determined, Determine the movement locus of the luminaire.
It is preferred that described device, in addition to the 5th determining unit and tracking cell, wherein:
5th determining unit, for determining and positioned at the distance between measurand under water;
The tracking cell, for if it is determined that the distance is not in the range of pre-determined distance, then to described tested pair As being tracked.
Preferably, the luminaire at least includes following one kind:Signal lamp and light deflection device;And described device, also Including:
Opening unit, if be light deflection device for the luminaire, in the multi collect of obtaining unit 51 And obtain before being located at the multiple image for the luminaire that measurand under water is carried, detecting lamp is opened in advance, wherein described The light deflection device that detecting lamp is used to trigger the measurand when being pointed to measurand under water and being detected is luminous.
For convenience of description, above each several part is divided by function describes respectively for each module (or unit).Certainly, exist Implement the function of each module (or unit) can be realized in same or multiple softwares or hardware during the present invention.For example, this The control device for the robot that paddles that inventive embodiments three are provided can be arranged in the robot that paddles, and by paddling, robot is completed The IMAQ of the luminaire carried to measurand and the corresponding action of execution.
Example IV
The embodiment of the present application four provides a kind of nonvolatile computer storage media, the computer-readable storage medium storage There are computer executable instructions, the computer executable instructions can perform the robot that paddles in above-mentioned any means embodiment Control method.
Embodiment five
Fig. 6 be the embodiment of the present application five provide implementation paddle robot control method the robot that paddles hardware knot Structure schematic diagram, as shown in fig. 6, this is paddled, robot includes:
In one or more processors 610 and memory 620, Fig. 6 by taking a processor 610 as an example.
Performing the robot that paddles of the control method for the robot that paddles can also include:Input unit 630 and output device 640。
Processor 610, memory 620, input unit 630 and output device 640 can pass through bus or other modes In connection, Fig. 6 exemplified by being connected by bus.
Memory 620 is as a kind of non-volatile computer readable storage medium storing program for executing, available for storage non-volatile software journey The control method pair of the robot that paddles in sequence, non-volatile computer executable program and module, such as the embodiment of the present application Programmed instruction/module/the unit answered is (for example, obtaining unit 51, the first determining unit 52, the second determining unit shown in accompanying drawing 5 53rd, the 3rd determining unit 54 and execution unit 55).Processor 610 is stored in non-volatile soft in memory 620 by operation Part program, instruction and module/unit, so that at execute server or the various function application and data of intelligent terminal Reason, that is, realize that above method embodiment is paddled the control method of robot.
Memory 620 can include storing program area and storage data field, wherein, storing program area can store operation system Application program required for system, at least one function;Storage data field can be stored to be made according to the control device for the robot that paddles With data created etc..In addition, memory 620 can include high-speed random access memory, it can also include non-volatile Memory, for example, at least one disk memory, flush memory device or other non-volatile solid state memory parts.In some realities Apply in example, memory 620 is optional including the memory remotely located relative to processor 610, and these remote memories can lead to Network connection is crossed to the control device for the robot that paddles.The example of above-mentioned network include but is not limited to internet, intranet, LAN, mobile radio communication and combinations thereof.
Input unit 630 can receive the numeral or character information of input, and produce the control device with the robot that paddles User set and function control it is relevant key signals input.Output device 640 may include the display devices such as display screen.
One or more of modules are stored in the memory 620, when by one or more of processors During 610 execution, the control method of the robot that paddles in above-mentioned any means embodiment is performed.
The said goods can perform the method that the embodiment of the present application is provided, and possesses the corresponding functional module of execution method and has Beneficial effect.Not ins and outs of detailed description in the present embodiment, reference can be made to the method that the embodiment of the present application is provided.
The electronic equipment of the embodiment of the present application exists in a variety of forms, includes but is not limited to:
(1) mobile communication equipment:The characteristics of this kind equipment is that possess mobile communication function, and to provide speech, data Communicate as main target.This Terminal Type includes:Smart mobile phone (such as iPhone), multimedia handset, feature mobile phone, and it is low Hold mobile phone etc..
(2) super mobile personal computer equipment:This kind equipment belongs to the category of personal computer, there is calculating and processing work( Can, typically also possess mobile Internet access characteristic.This Terminal Type includes:PDA, MID and UMPC equipment etc., such as iPad.
(3) portable entertainment device:This kind equipment can show and play content of multimedia.The kind equipment includes:Audio, Video player (such as iPod), handheld device, e-book, and intelligent toy and portable car-mounted navigation equipment.
(4) server:The equipment for providing the service of calculating, the composition of server is total including processor, hard disk, internal memory, system Line etc., server is similar with general computer architecture, but is due to need to provide highly reliable service, therefore in processing energy Require higher in terms of power, stability, reliability, security, scalability, manageability.
(5) other electronic installations with data interaction function.
Embodiment six
The embodiment of the present application six provides a kind of computer program product, wherein, the computer program product includes depositing The computer program on non-transient computer readable storage medium storing program for executing is stored up, the computer program includes programmed instruction, wherein, when When described program instruction is computer-executed, the computer is set to perform any one of the application above method embodiment machine of paddling The control method of device people.
It should be understood by those skilled in the art that, embodiments of the invention can be provided as method, system or computer program Product.Therefore, the present invention can be using the reality in terms of complete hardware embodiment, complete software embodiment or combination software and hardware Apply the form of example.Moreover, the present invention can be used in one or more computers for wherein including computer usable program code The computer program production that usable storage medium is implemented on (including but is not limited to magnetic disk storage, CD-ROM, optical memory etc.) The form of product.
The present invention is the flow with reference to method according to embodiments of the present invention, equipment (system) and computer program product Figure and/or block diagram are described.It should be understood that can be by every first-class in computer program instructions implementation process figure and/or block diagram Journey and/or the flow in square frame and flow chart and/or block diagram and/or the combination of square frame.These computer programs can be provided The processor of all-purpose computer, special-purpose computer, Embedded Processor or other programmable data processing devices is instructed to produce A raw machine so that produced by the instruction of computer or the computing device of other programmable data processing devices for real The device for the function of being specified in present one flow of flow chart or one square frame of multiple flows and/or block diagram or multiple square frames.
These computer program instructions, which may be alternatively stored in, can guide computer or other programmable data processing devices with spy Determine in the computer-readable memory that mode works so that the instruction being stored in the computer-readable memory, which is produced, to be included referring to Make the manufacture of device, the command device realize in one flow of flow chart or multiple flows and/or one square frame of block diagram or The function of being specified in multiple square frames.
These computer program instructions can be also loaded into computer or other programmable data processing devices so that in meter Series of operation steps is performed on calculation machine or other programmable devices to produce computer implemented processing, thus in computer or The instruction performed on other programmable devices is provided for realizing in one flow of flow chart or multiple flows and/or block diagram one The step of function of being specified in individual square frame or multiple square frames.
, but those skilled in the art once know basic creation although preferred embodiments of the present invention have been described Property concept, then can make other change and modification to these embodiments.So, appended claims are intended to be construed to include excellent Select embodiment and fall into having altered and changing for the scope of the invention.
Obviously, those skilled in the art can carry out the essence of various changes and modification without departing from the present invention to the present invention God and scope.So, if these modifications and variations of the present invention belong to the scope of the claims in the present invention and its equivalent technologies Within, then the present invention is also intended to comprising including these changes and modification.

Claims (10)

1. a kind of control method for the robot that paddles, it is characterised in that including:
The multiple image for being located at the luminaire that measurand under water is carried is obtained in preset time;And
According to the multiple image, the movement locus of the luminaire is determined;
According to the movement locus, the movement locus type and the direction of motion of the luminaire are determined;And
According to the corresponding relation of the movement locus type, the direction of motion and operational order of storage, the fortune of the luminaire is determined Dynamic type of gesture, the corresponding operational order of the direction of motion;And
According to the operational order determined, corresponding action is performed.
2. the method as described in claim 1, it is characterised in that in movement locus type, the direction of motion and the behaviour according to storage Make before the corresponding relation instructed, the corresponding operational order of movement locus type, the direction of motion for determining the luminaire, go back Including:
According to the multiple image, the characteristic information of the luminaire is determined;And
According to the characteristic information determined, the identity to measurand is identified.
3. method as claimed in claim 2, it is characterised in that the characteristic information includes following at least one:Glow frequency, The shape of the color of light and the luminaire light-emitting window.
4. the method as described in claim 1, it is characterised in that according to the multiple image, determine the fortune of the luminaire Dynamic rail mark, is specifically included:
According to the multiple image, using the coordinate system pre-established, the coordinate of luminaire described in each two field picture is determined Value;
The coordinate value of luminaire, determines the movement locus of the luminaire according to each two field picture determined.
5. the method as described in Claims 1 to 4 any claim, it is characterised in that also include:
It is determined that with positioned at the distance between measurand under water;
If it is determined that the distance is not in the range of pre-determined distance, then the measurand is tracked.
6. the method as described in Claims 1 to 4 any claim, it is characterised in that the luminaire at least include with Lower one kind:Signal lamp and light deflection device;And if when the luminaire is light deflection device, then in multi collect and obtain position Before the multiple image for the luminaire that measurand under water is carried, in addition to:
Detecting lamp is opened in advance, wherein the detecting lamp is used for when being pointed to measurand under water and being detected, triggering institute The light deflection device for stating measurand lights.
7. a kind of control device for the robot that paddles, it is characterised in that including:
Obtaining unit, the multiple image for the luminaire that measurand under water is carried is located at for being obtained in preset time;
First determining unit, for according to the multiple image, determining the movement locus of the luminaire;
Second determining unit, for according to the movement locus, determining movement locus type and the motion side of the luminaire To;
3rd determining unit, for the corresponding relation of the movement locus type according to storage, the direction of motion and operational order, it is determined that The corresponding operational order of movement locus type, the direction of motion of the luminaire;
Execution unit, for according to the operational order determined, performing corresponding action.
8. a kind of nonvolatile computer storage media, be stored with computer executable instructions, it is characterised in that the computer Executable instruction is used to perform the method as described in claim 1 to 6 any claim.
The robot 9. one kind is paddled, including:
At least one processor;And
The memory being connected with least one described processor communication;Characterized in that,
The memory storage has can be by the instruction of at least one computing device, and the instruction is by described at least one Manage device to perform, so that at least one described processor is able to carry out the method as described in claim 1 to 6 any claim.
10. a kind of computer program product, it is characterised in that the computer program product includes being stored in non-transient computer Computer program on readable storage medium storing program for executing, the computer program includes programmed instruction, wherein, when described program instruction is counted When calculation machine is performed, the computer is set to perform the method as described in claim 1 to 6 any claim.
CN201710423940.5A 2017-06-07 2017-06-07 Control method and device of wading robot and wading robot Expired - Fee Related CN107329470B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710423940.5A CN107329470B (en) 2017-06-07 2017-06-07 Control method and device of wading robot and wading robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710423940.5A CN107329470B (en) 2017-06-07 2017-06-07 Control method and device of wading robot and wading robot

Publications (2)

Publication Number Publication Date
CN107329470A true CN107329470A (en) 2017-11-07
CN107329470B CN107329470B (en) 2021-06-29

Family

ID=60194547

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710423940.5A Expired - Fee Related CN107329470B (en) 2017-06-07 2017-06-07 Control method and device of wading robot and wading robot

Country Status (1)

Country Link
CN (1) CN107329470B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108062091A (en) * 2017-11-14 2018-05-22 北京臻迪科技股份有限公司 Snorkel power compensation method, apparatus and the floating mobile body of floating mobile body
CN113285765A (en) * 2021-07-20 2021-08-20 深之蓝海洋科技股份有限公司 Underwater robot communication method, electronic equipment and underwater robot

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN202765273U (en) * 2012-09-14 2013-03-06 董昊 Remote operated vehicle (ROV) for underwater photography
US20140078050A1 (en) * 2011-11-28 2014-03-20 Tencent Technology (Shenzhen) Company Limited Method and system for triggering and controlling human-computer interaction operating instructions
CN103777746A (en) * 2012-10-23 2014-05-07 腾讯科技(深圳)有限公司 Human-machine interactive method, terminal and system
CN104002942A (en) * 2014-06-09 2014-08-27 北京理工大学 Micro autonomous submersible
CN104267643A (en) * 2014-09-27 2015-01-07 江苏华宏实业集团有限公司 Target positioning recognition system of underwater robot
CN104317302A (en) * 2014-09-28 2015-01-28 江苏华宏实业集团有限公司 Intellectualized underwater robot system
CN106314733A (en) * 2016-10-26 2017-01-11 朱苏学 Unmanned underwater photographing robot
CN106774355A (en) * 2016-12-14 2017-05-31 上海理工大学 Unmanned remotely controlled submersible vehicle system based on moving camera

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140078050A1 (en) * 2011-11-28 2014-03-20 Tencent Technology (Shenzhen) Company Limited Method and system for triggering and controlling human-computer interaction operating instructions
CN202765273U (en) * 2012-09-14 2013-03-06 董昊 Remote operated vehicle (ROV) for underwater photography
CN103777746A (en) * 2012-10-23 2014-05-07 腾讯科技(深圳)有限公司 Human-machine interactive method, terminal and system
CN104002942A (en) * 2014-06-09 2014-08-27 北京理工大学 Micro autonomous submersible
CN104267643A (en) * 2014-09-27 2015-01-07 江苏华宏实业集团有限公司 Target positioning recognition system of underwater robot
CN104317302A (en) * 2014-09-28 2015-01-28 江苏华宏实业集团有限公司 Intellectualized underwater robot system
CN106314733A (en) * 2016-10-26 2017-01-11 朱苏学 Unmanned underwater photographing robot
CN106774355A (en) * 2016-12-14 2017-05-31 上海理工大学 Unmanned remotely controlled submersible vehicle system based on moving camera

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108062091A (en) * 2017-11-14 2018-05-22 北京臻迪科技股份有限公司 Snorkel power compensation method, apparatus and the floating mobile body of floating mobile body
CN113285765A (en) * 2021-07-20 2021-08-20 深之蓝海洋科技股份有限公司 Underwater robot communication method, electronic equipment and underwater robot

Also Published As

Publication number Publication date
CN107329470B (en) 2021-06-29

Similar Documents

Publication Publication Date Title
CN107045844B (en) A kind of landscape guide method based on augmented reality
CN110132274A (en) A kind of indoor orientation method, device, computer equipment and storage medium
CN104335152B (en) Navigation instruction is provided when equipment is in locking mode
JP7168694B2 (en) 3D special effect generation method, device and electronic device with human face
CN109682392A (en) Vision navigation method and system based on deeply study
CN110262730A (en) Edit methods, device, equipment and the storage medium of game virtual resource
CN110163976A (en) A kind of method, apparatus, terminal device and the storage medium of virtual scene conversion
CN108702448A (en) Unmanned plane image-pickup method and unmanned plane
CN107615310A (en) Message processing device
CN105979133A (en) Tracking shooting method, mobile terminal and system
CN103279187B (en) A kind of method and intelligent terminal for being used to build more scene virtual panoramic spaces
CN105210117A (en) Augmented reality (AR) capture & play
CN109947886A (en) Image processing method, device, electronic equipment and storage medium
CN105549725A (en) Three-dimensional scene interaction display device and method
CN110202573A (en) Full-automatic hand and eye calibrating, working face scaling method and device
US20160117811A1 (en) Method for generating a target trajectory of a camera embarked on a drone and corresponding system
CN107329470A (en) A kind of control method for the robot that paddles, device and the robot that paddles
WO2018025511A1 (en) Information processing device, method, and computer program
CN110926334A (en) Measuring method, measuring device, electronic device and storage medium
CN109754421A (en) A kind of vision calibration method, device and robot controller
CN107656991A (en) A kind of remote guide method, apparatus and system
CN110140100B (en) Three-dimensional augmented reality object user interface functionality
CN106267843A (en) A kind of Educational toy external member and ocean mould recognition methods thereof
CN104184941A (en) Monitoring system
CN107562200A (en) A kind of VR menu control methods and system based on outdoor scene stage property

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20210629