CN104049633A - Servo control method, servo device and servo system - Google Patents
Servo control method, servo device and servo system Download PDFInfo
- Publication number
- CN104049633A CN104049633A CN201410265679.7A CN201410265679A CN104049633A CN 104049633 A CN104049633 A CN 104049633A CN 201410265679 A CN201410265679 A CN 201410265679A CN 104049633 A CN104049633 A CN 104049633A
- Authority
- CN
- China
- Prior art keywords
- signal
- primary controller
- distance
- hunting gear
- wireless control
- 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
Links
Landscapes
- Toys (AREA)
- Selective Calling Equipment (AREA)
Abstract
The invention relates to a servo control method, a servo device and a servo system. The method includes the following steps that A, wireless control signals from a master controller are received; B, according to the wireless control signals, the distance between the servo device and the master controller is judged; C, the direction of the master controller is judged, the servo device is driven to move in the direction of the master controller so that the distance between the servo device and the master controller is smaller than a preset value and servo motion can be achieved, wherein the wireless control signals carry ID code information of the master controller and/or the servo device and the step A includes the parts that ID codes contained in the ID code information are compared with ID codes, stored in the servo device in advance, of the master controller and/or the servo device, when the ID codes are matched, the following step B and the step C are executed. When the distance between the servo device and the master controller exceeds the preset value, the direction of the master controller can be judged, the servo device is driven to move in the direction of the master controller, the distance between the servo device and the master controller is maintained, and therefore servo motion is achieved.
Description
Technical field
The present invention relates to radio tracking technical field, more particularly, relate to a kind of follow-up control method, hunting gear and servomechanism.
Background technology
People, in daily life or work, for example, when going window-shopping, do shopping, travel or going on business, bring shopping cart or luggage case conventionally, need in tow shopping cart or luggage case to make it follow oneself and move together, be very inconvenience when owner moves one's steps.Another the most original random movement method is found someone exactly and is followed with oneself, and this people is retinue, pushes away, draws shopping cart or luggage case by him.Modern society's human cost is high, and finding someone at any time, it is unrealistic to follow with oneself.If realize servo-actuatedly by technology, hi-tech should design a retinue of robot exactly, and it can carry luggage and follow owner, and wherein servo technology scheme is exactly the key that solves the problem of following.
Therefore, need a kind of following control technical and hunting gear, for realizing servo-actuated providing safeguard.
Summary of the invention
The technical problem to be solved in the present invention is, can not follow voluntarily for shopping cart or the luggage case etc. of prior art existence the problem that owner moves, and a kind of follow-up control method, hunting gear and servomechanism are provided.
The technical solution adopted for the present invention to solve the technical problems is: a kind of follow-up control method is provided, comprises the steps:
A, receive from the wireless control signal of primary controller, described wireless control signal comprises at least one in radio signal, field signal, ultrasonic signal, infrared signal;
B, judge the distance of hunting gear and primary controller according to described wireless control signal;
C, in the time that the distance of hunting gear and primary controller exceedes predetermined value, judge primary controller place direction, or real-time judge primary controller place direction; And drive hunting gear to move to primary controller direction, so that the distance of hunting gear and primary controller is less than described predetermined value, realize servo-actuated;
Wherein, described wireless control signal carries the ID code information of primary controller and/or hunting gear, and steps A comprises:
A1, the ID code comprising in described ID code information is compared with being pre-stored in primary controller in hunting gear and/or the ID code of hunting gear, and in the time that both mate, carry out follow-up step B and step C.
In follow-up control method of the present invention, described wireless control signal is radio signal, and step B comprises:
B1, according to the RSSI information of described radio signal, by tabling look-up or experimental formula calculates corresponding distance.
In follow-up control method of the present invention, described wireless control signal is field signal, and the magnetic field that described ID code information is changed by predetermined rule is defined, and step B comprises:
The intensity in B2, the magnetic field that changes according to described predetermined rule, by tabling look-up or experimental formula calculates corresponding distance.
In follow-up control method of the present invention, described wireless control signal is ultrasonic signal, and step B comprises:
B3, according to described ultrasonic signal from being transmitted into the time of reception, table look-up or experimental formula calculates distance corresponding to ultrasonic transmission/reception time.
In follow-up control method of the present invention, described wireless control signal is infrared signal, and step B comprises:
B4, by being arranged on the infrared lights of at least two groups on the infrared positioning shooting head sensing primary controller on hunting gear or two infrared LED transmittings, the distance of the infrared light by least two groups described in calculating or two infrared LED transmittings, tables look-up or experimental formula calculates the distance between described distance corresponding primary controller and hunting gear.
In follow-up control method of the present invention,
In step C, judge that primary controller place direction comprises:
Drive described hunting gear self rotation and/or all around move, antenna rotation and/or all around move, and/or antenna stands in, and disk border does circle by disc rotary drive or elliptical orbit moves, the Strength Changes of wireless control signal described in sensing simultaneously, to determine primary controller place direction.
In follow-up control method of the present invention, described ID code is exclusive ID code and/or public ID code.
The technical solution adopted for the present invention to solve the technical problems is: construct a kind of hunting gear, its bottom is provided with the wheel for driving described hunting gear to move, and described hunting gear comprises:
Wireless control signal receiver, for receiving the wireless control signal from primary controller, described wireless control signal comprises at least one in radio signal, field signal, ultrasonic signal, infrared signal;
Signal deteching circuit, for detection of described wireless control signal;
Controller, comprises Distance Judgment module, direction judge module, follows instruction generation module, wherein:
Distance Judgment module is for judging the distance of hunting gear and primary controller according to described wireless control signal;
Direction judge module, in the time that the distance of hunting gear and primary controller exceedes predetermined value, judges primary controller place direction, or for real-time judge primary controller place direction;
Follow instruction generation module for generation of drive hunting gear to move and/or turn to follow instruction;
And
The first driving circuit, for following wheel turns described in order-driven described in basis, to drive hunting gear to move towards primary controller; And
The ID code information that described wireless control signal comprises primary controller and/or hunting gear, described controller also comprises ID code authentication module, compare with being pre-stored in primary controller in hunting gear and/or the ID code of hunting gear for ID code that described ID code information is comprised, and when both mate, start described Distance Judgment module and carry out Distance Judgment and operate.
In hunting gear of the present invention,
Described wireless control signal is radio signal;
Described signal deteching circuit is radio signal testing circuit; And
Described Distance Judgment module is for according to the RSSI information of described radio signal, by tabling look-up or experimental formula calculates corresponding distance.
In hunting gear of the present invention,
Described wireless control signal is field signal, and the magnetic field that described ID code information is changed by predetermined rule is defined;
Described signal deteching circuit is magnetic field detection circuit; And
Described Distance Judgment module is for the intensity in the magnetic field that changes according to described rule, by tabling look-up or experimental formula calculates corresponding distance.
In hunting gear of the present invention,
Described wireless control signal is ultrasonic signal, and described primary controller is provided with ultrasonic generator;
Described signal deteching circuit is ultrasonic signal testing circuit; And
Described Distance Judgment module for according to described ultrasonic signal from being transmitted into the time of reception, table look-up or experimental formula calculates distance corresponding to ultrasonic transmission/reception time.
In hunting gear of the present invention,
Described wireless control signal is infrared signal, and described hunting gear is provided with infrared positioning shooting head, for the infrared lights of at least two groups on sensing primary controller or two infrared LED transmittings;
Described signal deteching circuit comprises described infrared positioning shooting head and connected image-signal processor; And
Described Distance Judgment module is for the distance of the infrared light by least two groups described in calculating or two infrared LED transmittings, tables look-up or experimental formula calculates the distance between described distance corresponding primary controller and hunting gear.
In hunting gear of the present invention,
Described direction judge module, by detecting instruction to described the first driving circuit sending direction, is controlled described the first driving circuit and is driven described hunting gear self rotation and/or all around move; Accept the information from the Strength Changes of the wireless control signal of signal deteching circuit simultaneously, and determine primary controller place direction according to the information of described Strength Changes; Or
Described wireless control signal receiver is connected with antenna, described antenna is connected with the second driving circuit, described direction judge module is by detecting instruction to described the second driving circuit sending direction, control described the second driving circuit and drive described antenna rotation and/or all around move, and/or antenna stands in, and disk border does circle by disc rotary drive or elliptical orbit moves; Accept the information from the Strength Changes of the wireless control signal of signal deteching circuit simultaneously, and determine primary controller place direction according to the information of described Strength Changes.
The technical solution adopted for the present invention to solve the technical problems is: construct a kind of servomechanism, it comprises the primary controller that is provided with wireless control signal transmitter, and hunting gear as above.
Implement the present invention, there is following beneficial effect: hunting gear can judge the distance between itself and primary controller, when the distance that can work as hunting gear and primary controller exceedes predetermined value or real time discriminating primary controller place direction drive hunting gear to move to primary controller direction, the distance of maintenance and primary controller, servo-actuated to realize.
It is low that technical scheme of the present invention has cost, the advantage that control accuracy is high.
Brief description of the drawings
Below in conjunction with drawings and Examples, the invention will be further described, in accompanying drawing:
Fig. 1 is the schematic block diagram of servomechanism according to an embodiment of the invention;
Fig. 2 is the schematic block diagram of hunting gear according to an embodiment of the invention;
Fig. 3 is the process flow diagram of follow-up control method of the present invention.
Embodiment
As shown in Figure 1, in one embodiment of this invention, servomechanism comprises primary controller 1 and the hunting gear 2 being connected with its radio communication.
Particularly, in primary controller 1, be provided with wireless control signal transmitter 10, for launching wireless control signal.
Hunting gear 2 comprises controller 20, the wireless control signal receiver 21, signal deteching circuit 22 and the first driving circuit 23 that communicate to connect with controller 20, and the wheel 31 for driving hunting gear to move being connected with the first driving circuit 23, for example, wheel can be arranged on hunting gear bottom.Further, controller 20 comprises Distance Judgment module 201, direction judge module 203, follows instruction generation module 205.
In the course of work of servomechanism, wireless control signal receiver 21 receives the wireless control signal from primary controller 1.Afterwards, signal deteching circuit 22 detects the wireless control signal receiving, and testing result is sent to controller 20.
Then, the Distance Judgment module 201 in controller 20 judges the distance of hunting gear and primary controller according to wireless control signal; In the time that the distance of hunting gear and primary controller exceedes predetermined value, direction judge module 203 judges primary controller place direction, or direction module 203 at any time (in real time) judge and follow the tracks of the direction at primary controller place; Follow instruction generation module 205 for generation of drive hunting gear to move and/or turn to follow instruction; The first driving circuit 23 is according to following order-driven wheel turns, to drive hunting gear to move towards primary controller.
In each embodiment of the present invention, wireless control signal comprises at least one in radio signal, field signal, ultrasonic signal, infrared signal.
Fig. 2 is the schematic block diagram of the hunting gear 2 ' of another embodiment of the present invention.As shown in Figure 2, compared with hunting gear 2 in Fig. 1, difference is, hunting gear 2 ' also comprises the second driving circuit 24, the storer 25 that communicate to connect with controller 2, and the antenna 32 that is connected (not shown) with wireless control signal receiver 21 and is connected with the second driving circuit 24.In addition, controller 20 also comprises ID code authentication module 207.
In the present embodiment, in wireless control signal, carry the ID code information of primary controller 1 and/or hunting gear 2 ', ID code authentication module 207 in controller 20 comprises ID code in ID code information for the wireless control signal that wireless control signal receiver 21 is received and compares with being pre-stored in primary controller in the storer 25 of hunting gear and/or the ID code of hunting gear, and when both mate, starts Distance Judgment module 201 and carry out Distance Judgment and operate.It should be noted that, ID code can be exclusive ID code and/or public ID code.Exclusive ID is convenient one to one, the public one-to-many that facilitates.For example, for the hunting gear such as luggage case, shopping cart, need primary controller and hunting gear to have relation one to one, ID code is exclusive ID code.Again for example, for without occasion one to one, the toy of for example playing in family servo-actuated, ID code can be public ID code.
In certain embodiments, for example, when wireless control signal is in the situation of radio signal, field signal and/or ultrasonic signal, in the time that the distance of hunting gear and primary controller exceedes predetermined value, the second driving circuit can detect instruction to the direction of its transmission according to direction judge module, and driven antenna 32 is rotated; Accept the information from the Strength Changes of the wireless control signal of signal deteching circuit simultaneously, and determine primary controller 20 place directions according to the information of Strength Changes.
In further embodiments, for example, when wireless control signal is in the situation of radio signal, field signal and/or ultrasonic signal, in the time that the distance of hunting gear and primary controller exceedes predetermined value, direction judge module 203 judges that primary controller place direction comprises: direction judge module, by detecting instruction to the first driving circuit sending direction, is controlled the first driving circuit and driven hunting gear self rotation and/or all around move; Accept the information from the Strength Changes of the wireless control signal of signal deteching circuit simultaneously, and determine primary controller place direction according to the information of described Strength Changes.
In certain embodiments, also can real-time judge and follow the tracks of the direction at primary controller place.
Storer 25 is for storing the primary controller that mates with hunting gear and/or the ID code of hunting gear, and for obtain the needed data of distance or the program of hunting gear and primary controller according to wireless control signal, for example, signal intensity and the corresponding table of distance and/or algorithm routine etc.
In one embodiment, wireless control signal is radio signal; Signal deteching circuit is radio signal testing circuit; And Distance Judgment module is for according to the RSSI strength information of radio signal, by tabling look-up or experimental formula calculates corresponding distance.
In another embodiment, wireless control signal is field signal, and the magnetic field that ID code information is changed by predetermined rule is defined; Signal deteching circuit is magnetic field detection circuit; The intensity in magnetic field of Distance Judgment module for changing according to rule, by tabling look-up or experimental formula calculates corresponding distance.
In another embodiment, wireless control signal is ultrasonic signal, and primary controller is provided with ultrasonic transmitter, hunting gear is provided with ultrasonic receiver; Signal deteching circuit detects the ultrasonic signal from primary controller; And Distance Judgment module for according to ultrasonic signal from being transmitted into the time of reception, table look-up or experimental formula calculates distance corresponding to ultrasonic transmission/reception time.
In another embodiment, wireless control signal is infrared signal, and hunting gear is provided with infrared positioning shooting head, for the infrared lights of at least two groups on sensing primary controller or two infrared LED transmittings; Signal deteching circuit comprises described infrared positioning shooting head and connected image-signal processor; And Distance Judgment module is for the distance between the infrared light by calculating this at least two group or the transmitting of two infrared LEDs, table look-up or experimental formula calculates the corresponding primary controller of distance between the infrared light of this at least two group or two infrared LED transmittings and the distance between hunting gear.
In other embodiments, wireless control signal is two or more the combination in radio signal, field signal, ultrasonic signal, infrared signal.Correspondingly, on hunting gear, be provided with two or more the combination in radio signal testing circuit, magnetic field detection circuit, ultrasonic signal testing circuit, infrared positioning shooting head.
As shown in Figure 3, follow-up control method of the present invention comprises the steps:
After starting step, enter in steps A, receive the wireless control signal from primary controller.Then, carry out step B.In step B, judge the distance of hunting gear and primary controller according to wireless control signal.Whether the distance that subsequently, judges hunting gear and primary controller exceedes predetermined value.
In the time that the distance of hunting gear and primary controller exceedes predetermined value, execution step C.In step C, judge primary controller place direction, and drive hunting gear to move to primary controller direction, so that the distance of hunting gear and primary controller is less than described predetermined value, realize servo-actuated.For example, in step C, judge that primary controller place direction comprises: drive described hunting gear self rotation and/or all around move, antenna rotation and/or all around move, and/or antenna stands in, and disk border does circle by disc rotary drive or elliptical orbit moves, to obtain signal judgement, the Strength Changes of wireless control signal described in sensing simultaneously, to determine primary controller place direction.
After step C, follow-up control method is proceeded, and for example, returns to steps A and proceeds servo-actuated control.
In the time that the distance of hunting gear and primary controller does not exceed predetermined value, return to steps A, continue to receive wireless control signal to carry out servo-actuated control.
In some other embodiment, step C can carry out at any time, real-time judge primary controller place direction, and drive hunting gear to move to primary controller direction, so that the distance of hunting gear and primary controller is less than predetermined value, realize servo-actuated.
Wireless control signal carries the ID code information of primary controller and/or hunting gear in one embodiment of this invention, and steps A comprises: steps A 1 (not shown): the ID code comprising in described ID code information is compared with being pre-stored in primary controller in hunting gear and/or the ID code of hunting gear, and in the time that both mate, carry out follow-up step B and step C.
In each embodiment, wireless control signal comprises at least one in radio signal, field signal, ultrasonic signal, infrared signal.
In one embodiment, wireless control signal is radio signal, and step B comprises: step B1: according to the RSSI information of radio signal, by tabling look-up or experimental formula calculates corresponding distance.
In another embodiment, wireless control signal is field signal, the magnetic field that ID code information is changed by predetermined rule is defined, and step B comprises: step B2: the intensity in the magnetic field changing according to this predetermined rule, and by tabling look-up or experimental formula calculates corresponding distance.
In another embodiment, wireless control signal is ultrasonic signal, and step B comprises: step B3:, table look-up or experimental formula calculates distance corresponding to ultrasonic transmission/reception time from being transmitted into the time of reception according to ultrasonic signal.
In another embodiment, wireless control signal is infrared signal, step B comprises: step B4: at least two groups or two infrared LEDs and infrared positioning shooting head are respectively at primary controller or hunting gear, by being arranged at least two groups or two infrared lights that infrared LED is launched on the infrared positioning shooting head sensing primary controller on hunting gear, by the distance between the infrared light of at least two groups described in calculating or two infrared LED transmittings, table look-up or experimental formula calculates the distance between described distance corresponding primary controller and hunting gear.
In other embodiments, wireless control signal is two or more the combination in radio signal, field signal, ultrasonic signal, infrared signal.Correspondingly, follow-up control method also comprises that step B1 is to two kinds of steps in step B4 or the more combination of multi-step.
In actual applications, hunting gear of the present invention can be designed as: compliant platform; Servo-actuated shopping cart, servo-actuated leather trunk, servo-actuated school bag, servo-actuated perambulator; Servo-actuated toy animals car; And servo-actuated toy airplane.All hunting gears all have Power Drive Unit, ensure hunting gear energy autokinetic movement.Primary controller can be attached to any position of health of human body, such as positions such as arm, leg, waists, or is arranged on knapsack, footwear, clothes.
The present invention conceives a kind of follow-up control method, comprise: by keep constant radio strength, field strength values, ultrasonic intensity value between primary controller and hunting gear, and infrared photography detect in one or more modes keep distance between the two; One or more modes such as the track detection of the detection of cooperation multiple spot, multi-direction detection or cooperation inertial sensor judge direction of motion, again by hunting gear according to the position of the position of primary controller and self, control displacement, to realize with primary controller servo-actuated in certain distance scope.
Between primary controller and hunting gear, adopt the field strength values of default wireless RSSI signal strength values, regular variation, the ultrasound wave that rule changes to keep distance between the two, and one or more in testing to keep at a distance of infrared signal.For example, by hunting gear carry out within the specific limits self rotation, antenna rotation or all around one or more in move mode carry out the variation of the wireless RSSI intensity of sensing, judge peak signal direction, drive hunting gear close to primary controller, due to nearer with the transmitting terminal of primary controller, signal intensity RSSI is stronger, in the time that RSSI intensity level reaches preset value or distance value, and hunting gear stop motion; Also need before this first to set up the decay correspondence database that RSSI wireless signal strength increases with distance, facilitate direct setpoint distance to determine RSSI intensity level.As selection, also can calculate corresponding distance by experimental formula.Be below several embodiments of the present invention.
Embodiment mono-, utilizes the judgement of radio signal strength RSSI to determine distance and direction.
Between primary controller and hunting gear by the radio signal communication of receiving and sending messages, and the ID code comprising according to the information of receiving determines whether it is the signal that the primary controller that matches sends, if coupling judges signal intensity RSSI again, and in database, find corresponding range data according to RSSI signal intensity, the respective value of RSSI signal intensity and distance determines in advance and preserves in test before.Or calculate corresponding distance by experimental formula.
In the present embodiment, primary controller and hunting gear have wireless receiving and dispatching module separately, the signal by transmission with ID code carries out communication, receive the signal of the ID code with coupling, detect RSSI signal intensity now, relatively intensity level, whether in scope, illustrates that in scope servo-actuated distance is moderate.
When intensity or apart from exceeding preset value, owing to cannot determining direction, servo-actuatedly antenna can be rotated to the orientation that identification signal is the strongest, or drive hunting gear self to rotate, or turn a circle that diameter is non-vanishing, or all around move, sense the strongest sense, judge primary controller direction.
The advantage of this method is, not only carry out communication with radio, the characteristic of simultaneously also utilizing the RSSI intensity of radio signal to decay along with the increasing of receiving end and transmitting terminal distance is carried out measuring distance, has reduced components and parts, under the prerequisite that realizes said function, has reduced cost.
Embodiment bis-, utilizes the magnetic field of rule variation and the relation of distance to come judging distance and direction.
Between primary controller and hunting gear, comprise magnetic field R-T unit, magnetic field, by circuit control, has certain rhythm and pace of moving things, facilitates receiving end to differentiate, and determines both sides' distance by detecting the corresponding relation of magnetic field intensity and distance.
RSSI with embodiment mono-is similar, and just RSSI changes magnetic field into.Primary controller is with the magnetic field that can produce rule variation, as sent digital signal: 1110000,1110000 ... continuous like this variation magnetic field data, at hunting gear end for example, with magnetic field detection circuit (Magnetic Sensor, magnetometer), variation magnetic field that can this rule of identification, because the increase of the intensity distance in this magnetic field decays, can test the relation that obtains magnetic field intensity and distance, utilize field strength value to ensure the distance between primary controller and hunting gear.
When intensity or apart from exceeding preset value, owing to cannot determining direction, hunting gear can rotate the orientation that identification signal is the strongest by antenna, or drive hunting gear self to rotate, or turn a circle that diameter is non-vanishing, or all around move, sense the strongest sense, judge primary controller direction.
The advantage of this method is, disturbs under larger environment and still can normally work at aerogram, unaffected.
Embodiment tri-, primary controller and hunting gear utilize the combination of infrared LED and camera.
Between primary controller and hunting gear, include at least 2 infrared LEDs and at least one camera, distance and direction between the size of the distance between the infrared light sending by two groups of opposite ends of detection infrared LED group and orientation judge.
Primary controller is with at least two infrared LEDs, and point has certain distance.On hunting gear with at least one CMOS alignment sensor, for example, utilize a circle infrared LED around primary controller, what facilitate that camera sees from any angle is all the bright wisp of the same length, such as the both feet band infrared LED ring of light, or on neck, be with a ring of light, on the camera of installing on hunting gear, see that the length of infrared LED striation length is converted into distance, and direction is provided, certainly also can have set up before the corresponding relation database of bright wisp length and distance.Or calculate corresponding distance by experimental formula.
The benefit of this method is not to be subject to outside electromagnetic interference completely.
Embodiment tetra-, utilizes ultrasonic ranging.
Between primary controller and hunting gear, comprise ultrasonic receiving device, guarantee both sides' distance (primary controller transmission loop-shaped ultrasound) by ultrasonic ranging.
On primary controller, with ultrasonic transmitter, on hunting gear, with ultrasonic receiver, transmitter is launched in the form of a ring, and receiver received ultrasonic signal carrys out judging distance.Such as in ultrasonic signal with launch time, primary controller and hunting gear are put together and powered on, now receive the ultrasonic signal that primary controller sends, difference between time and the system time of hunting gear oneself comprising in solution read output signal is as the reference value of both sides' zero distance, recycle manually or automatically mode or laboratory test mode primary controller and hunting gear are pulled open to certain distance, and this using in the signal of receiving with time and the difference of the system time of hunting gear inside as suitable servo-actuated distance, an and then definite deviate, as long as both mistimings are within the scope of deviate, just can judge that both are appropriate apart from keeping.Certainly also can set up before the poor corresponding relation database with distance of ultrasonic signal transmitting time of reception.Or calculate corresponding distance by experimental formula.
When the mistiming or apart from exceeding preset value, owing to cannot determining direction, servo-actuatedly antenna can be rotated to the orientation that identification signal is the strongest, or drive hunting gear self rotation, or turn a circle that diameter is non-vanishing, or all around move, or antenna stands in, and disk border does circle by disc rotary drive or elliptical orbit moves, to obtain signal judgement, sense the strongest sense, judge primary controller direction.
Hunting gear (telecar, telecontrolled aircraft, electric trunk etc.) starts power and advances by the direction of pointing to primary controller, in the time that distance arrives the distance of setting, stops.
The benefit of this method is not to be subject to the interference of external electromagnetic and sunshine.
Embodiment five arranges respectively the sensing module being made up of acceleration transducer, gyroscope and/or geomagnetic sensor on primary controller and hunting gear; The place that powers on that primary controller and hunting gear are put together is as motion reference point, by sensing motion separately, and three dimensional space coordinate separately will be obtained after sense data computing, further obtain again movement locus and direction, taking primary controller position as reference point, primary controller and hunting gear sensor sense movement track union operation are separately obtained distance and direction by hunting gear.
It should be noted that, the present invention can also adopt complex method to realize servo-actuated control, can form complex method by the one or more servo-actuated method in above embodiment mono-to five, to carry out complementation and optimization that is:.
In addition, on the basis of above technology, the present invention can also utilize in primary controller and hunting gear end inside with acceleration transducer, gyroscope and geomagnetic sensor, for sensing displacement, and send data by wireless mode, primary controller will obtain sending with respect to the last time relative coordinate of position when data after the exercise data computing of self, it is the coordinate of self that hunting gear sensing displacement obtains receiving primary controller coordinate with respect to the last time, two comprehensive computings of coordinate, obtain the coordinate of this relative primary controller, thereby obtain from the direction of coordinate points primary controller, the distance obtaining in previous methods and direction are carried out to comprehensive computing and obtain more high-precision distance and direction, guarantee that hunting gear and primary controller keep the servo-actuated of certain distance.
Above embodiment is only explanation technical conceive of the present invention and feature, and its object is to allow person skilled in the art can understand content of the present invention and implement accordingly, can not limit the scope of the invention.All equalizations of doing with the claims in the present invention scope change and modify, and all should belong to the covering scope of the claims in the present invention.
Claims (14)
1. a follow-up control method, is characterized in that, comprises the steps:
A, receive from the wireless control signal of primary controller, described wireless control signal comprises at least one in radio signal, field signal, ultrasonic signal, infrared signal;
B, judge the distance of hunting gear and primary controller according to described wireless control signal;
C, in the time that the distance of hunting gear and primary controller exceedes predetermined value, judge primary controller place direction; Or real-time judge primary controller place direction; And drive hunting gear to move to primary controller direction, so that the distance of hunting gear and primary controller is less than described predetermined value, realize servo-actuated;
Wherein, described wireless control signal carries the ID code information of primary controller and/or hunting gear, and steps A comprises:
A1, the ID code comprising in described ID code information is compared with being pre-stored in primary controller in hunting gear and/or the ID code of hunting gear, and in the time that both mate, carry out follow-up step B and step C.
2. follow-up control method according to claim 1, is characterized in that, described wireless control signal is radio signal, and step B comprises:
B1, according to the RSSI information of described radio signal, by tabling look-up or experimental formula calculates corresponding distance.
3. follow-up control method according to claim 1, is characterized in that, described wireless control signal is field signal, and the magnetic field that described ID code information is changed by predetermined rule is defined, and step B comprises:
The intensity in B2, the magnetic field that changes according to described predetermined rule, by tabling look-up or experimental formula calculates corresponding distance.
4. follow-up control method according to claim 1, is characterized in that, described wireless control signal is ultrasonic signal, and step B comprises:
B3, according to described ultrasonic signal from being transmitted into the time of reception, table look-up or experimental formula calculates distance corresponding to ultrasonic transmission/reception time.
5. follow-up control method according to claim 1, is characterized in that, described wireless control signal is infrared signal, and step B comprises:
B4, by being arranged on the infrared lights of at least two groups on the infrared positioning shooting head sensing primary controller on hunting gear or two infrared LED transmittings, the distance of the infrared light by least two groups described in calculating or two infrared LED transmittings, tables look-up or experimental formula calculates the distance between described distance corresponding primary controller and hunting gear.
6. according to the follow-up control method described in any one in claim 2 to 4, it is characterized in that,
In step C, judge that primary controller place direction comprises:
Drive described hunting gear self rotation and/or all around move, antenna rotation and/or all around move, and/or antenna stands in, and disk border does circle by disc rotary drive or elliptical orbit moves, the Strength Changes of wireless control signal described in sensing simultaneously, to determine primary controller place direction.
7. follow-up control method according to claim 1, is characterized in that, described ID code is exclusive ID code and/or public ID code.
8. a hunting gear, its bottom is provided with the wheel for driving described hunting gear to move, and it is characterized in that, and described hunting gear comprises:
Wireless control signal receiver, for receiving the wireless control signal from primary controller, described wireless control signal comprises at least one in radio signal, field signal, ultrasonic signal, infrared signal;
Signal deteching circuit, for detection of described wireless control signal;
Controller, comprises Distance Judgment module, direction judge module, follows instruction generation module, wherein:
Distance Judgment module is for judging the distance of hunting gear and primary controller according to described wireless control signal;
Direction judge module, in the time that the distance of hunting gear and primary controller exceedes predetermined value, judges primary controller place direction, or for real-time judge primary controller place direction;
Follow instruction generation module for generation of drive hunting gear to move and/or turn to follow instruction;
And
The first driving circuit, for following wheel turns described in order-driven described in basis, to drive hunting gear to move towards primary controller; And
The ID code information that described wireless control signal comprises primary controller and/or hunting gear, described controller also comprises ID code authentication module, compare with being pre-stored in primary controller in hunting gear and/or the ID code of hunting gear for ID code that described ID code information is comprised, and when both mate, start described Distance Judgment module and carry out Distance Judgment and operate.
9. hunting gear according to claim 8, is characterized in that,
Described wireless control signal is radio signal;
Described signal deteching circuit is radio signal testing circuit; And
Described Distance Judgment module is for according to the RSSI information of described radio signal, by tabling look-up or experimental formula calculates corresponding distance.
10. hunting gear according to claim 8, is characterized in that,
Described wireless control signal is field signal, and the magnetic field that described ID code information is changed by predetermined rule is defined;
Described signal deteching circuit is magnetic field detection circuit; And
Described Distance Judgment module is for the intensity in the magnetic field that changes according to described rule, by tabling look-up or experimental formula calculates corresponding distance.
11. hunting gears according to claim 8, is characterized in that,
Described wireless control signal is ultrasonic signal, and described primary controller is provided with ultrasonic generator;
Described signal deteching circuit is ultrasonic signal testing circuit; And
Described Distance Judgment module for according to described ultrasonic signal from being transmitted into the time of reception, table look-up or experimental formula calculates distance corresponding to ultrasonic transmission/reception time.
12. hunting gears according to claim 8, is characterized in that,
Described wireless control signal is infrared signal, and described hunting gear is provided with infrared positioning shooting head, for the infrared lights of at least two groups on sensing primary controller or two infrared LED transmittings;
Described signal deteching circuit comprises described infrared positioning shooting head and connected image-signal processor; And
Described Distance Judgment module is for the distance of the infrared light by least two groups described in calculating or two infrared LED transmittings, tables look-up or experimental formula calculates the distance between described distance corresponding primary controller and hunting gear.
13. according to the hunting gear described in any one in claim 9 to 11, it is characterized in that,
Described direction judge module, by detecting instruction to described the first driving circuit sending direction, is controlled described the first driving circuit and is driven described hunting gear self rotation and/or all around move; Accept the information from the Strength Changes of the wireless control signal of signal deteching circuit simultaneously, and determine primary controller place direction according to the information of described Strength Changes; Or
Described wireless control signal receiver is connected with antenna, described antenna is connected with the second driving circuit, described direction judge module is by detecting instruction to described the second driving circuit sending direction, control described the second driving circuit and drive described antenna rotation and/or all around move, and/or antenna stands in, and disk border does circle by disc rotary drive or elliptical orbit moves; Accept the information from the Strength Changes of the wireless control signal of signal deteching circuit simultaneously, and determine primary controller place direction according to the information of described Strength Changes.
14. 1 kinds of servomechanisms, is characterized in that, comprise the primary controller that is provided with wireless control signal transmitter, and hunting gear as described in any one in claim 8 to 13.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410265679.7A CN104049633B (en) | 2014-06-13 | 2014-06-13 | Servo control method, servo device and servo system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410265679.7A CN104049633B (en) | 2014-06-13 | 2014-06-13 | Servo control method, servo device and servo system |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104049633A true CN104049633A (en) | 2014-09-17 |
CN104049633B CN104049633B (en) | 2017-05-10 |
Family
ID=51502629
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410265679.7A Active CN104049633B (en) | 2014-06-13 | 2014-06-13 | Servo control method, servo device and servo system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104049633B (en) |
Cited By (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104281160A (en) * | 2014-09-24 | 2015-01-14 | 任钢 | Close-range automatic following system |
CN104469158A (en) * | 2014-12-15 | 2015-03-25 | 安徽华米信息科技有限公司 | Moving shooting and shooting controlling method and device |
CN105783918A (en) * | 2016-03-09 | 2016-07-20 | 欧永达 | Positioning following method based on geomagnetic field and signal strength |
CN105807790A (en) * | 2016-04-25 | 2016-07-27 | 安徽大学 | Intelligent following system based on indoor hybrid location and following method of system |
CN105843231A (en) * | 2016-06-18 | 2016-08-10 | 陈明敬 | Moving carrier capable of automatically walking along with signal terminal |
CN105892656A (en) * | 2016-03-30 | 2016-08-24 | 联想(北京)有限公司 | Data processing method and electronic devices |
CN106227206A (en) * | 2016-07-27 | 2016-12-14 | 广州艾想电子科技有限公司 | A kind of equipment follow-up control method and device and system for tracking |
CN106297083A (en) * | 2016-07-29 | 2017-01-04 | 广州市沃希信息科技有限公司 | A kind of market shopping method, shopping server and shopping robot |
CN106483959A (en) * | 2016-11-10 | 2017-03-08 | 江苏大学 | A kind of set a distance under image space is with car control method |
WO2017039546A1 (en) * | 2015-09-01 | 2017-03-09 | Cyclect Electrical Engineering Pte Ltd | System, method and apparatus for navigating one or more vehicles |
CN106527425A (en) * | 2016-09-30 | 2017-03-22 | 张家港长安大学汽车工程研究院 | Omnibearing intelligent following trolley and controlling method thereof |
CN106681359A (en) * | 2016-07-18 | 2017-05-17 | 歌尔股份有限公司 | Method for controlling intelligent baby pram, intelligent baby pram and control system |
CN106680802A (en) * | 2017-03-16 | 2017-05-17 | 武汉理工大学 | Automatic wheelchair following method based on radio signal intensity and system |
WO2017219751A1 (en) * | 2016-06-21 | 2017-12-28 | 安徽酷哇机器人有限公司 | Mobile suitcase having automatic following and obstacle avoidance functions, and using method therefor |
WO2018014275A1 (en) * | 2016-07-21 | 2018-01-25 | 深圳前海达闼云端智能科技有限公司 | Target tracking device and system, and robot |
CN107976995A (en) * | 2016-10-24 | 2018-05-01 | 苏州宝时得电动工具有限公司 | Intelligent mobile system, intelligent mobile device and its moving method |
CN108363390A (en) * | 2018-01-23 | 2018-08-03 | 安徽酷哇机器人有限公司 | Auto-manual luggage case system for tracking, method and handle and luggage case |
CN108733043A (en) * | 2017-09-01 | 2018-11-02 | 北京猎户星空科技有限公司 | robot movement control method and device |
CN108803610A (en) * | 2018-06-13 | 2018-11-13 | 陈忠 | A kind of automatic intelligent positioning trolley case system and its control method for following function |
WO2018228462A1 (en) * | 2017-06-15 | 2018-12-20 | Zhejiang Geely Holding Group Co., Ltd. | Mobile power for outdoor power supply |
CN109240308A (en) * | 2018-11-12 | 2019-01-18 | 辽东学院 | Automatically track shopping cart |
CN109541525A (en) * | 2018-11-22 | 2019-03-29 | 东南大学 | A kind of direction finding distance measuring method and system based on infrared signal |
CN109597408A (en) * | 2018-11-22 | 2019-04-09 | 东南大学 | A kind of control method and system of automatic Following Car |
CN109634273A (en) * | 2018-11-30 | 2019-04-16 | 深圳大学 | The follow-up control method and device of movable equipment |
WO2019095594A1 (en) * | 2017-11-14 | 2019-05-23 | Powervision Tech Inc. | Following mobile device, following system, and method therefor |
WO2020029166A1 (en) * | 2018-08-09 | 2020-02-13 | Lingdong Technology (Beijing) Co. Ltd | Luggage delivery system |
CN111026202A (en) * | 2019-09-30 | 2020-04-17 | 陕西雷神智能装备有限公司 | Motion equipment drive-by-wire signal generation device and drive-by-wire motion equipment |
CN113525553A (en) * | 2021-06-03 | 2021-10-22 | 韦淑庄 | Intelligent following vehicle and control method thereof |
CN114063656A (en) * | 2021-11-17 | 2022-02-18 | 重庆庄周科技有限责任公司 | Self-following method and automatic following device |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63111509A (en) * | 1986-10-29 | 1988-05-16 | Komatsu Ltd | Inspection instrument for dust-proof filter of clean room |
EP1742124A1 (en) * | 2005-06-27 | 2007-01-10 | Toyota Jidosha Kabushiki Kaisha | Servo controller comprising two integrators for reducing phase delay |
CN101669866A (en) * | 2009-09-22 | 2010-03-17 | 罗富强 | Baby wireless monitoring method, device and system thereof |
CN102625077A (en) * | 2011-01-27 | 2012-08-01 | 深圳市合智创盈电子有限公司 | Conference recording method, conference photographing device, client and system |
US20120316680A1 (en) * | 2011-06-13 | 2012-12-13 | Microsoft Corporation | Tracking and following of moving objects by a mobile robot |
CN103135589A (en) * | 2013-01-14 | 2013-06-05 | 深圳市宇恒互动科技开发有限公司 | Reflector lamp capable of randomly changing projection areas, following projection system and implementation method of following projection system |
CN103439127A (en) * | 2013-07-18 | 2013-12-11 | 深圳市宇恒互动科技开发有限公司 | Inertia inputting device motion mass measuring method, terminal and system |
-
2014
- 2014-06-13 CN CN201410265679.7A patent/CN104049633B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63111509A (en) * | 1986-10-29 | 1988-05-16 | Komatsu Ltd | Inspection instrument for dust-proof filter of clean room |
EP1742124A1 (en) * | 2005-06-27 | 2007-01-10 | Toyota Jidosha Kabushiki Kaisha | Servo controller comprising two integrators for reducing phase delay |
CN101669866A (en) * | 2009-09-22 | 2010-03-17 | 罗富强 | Baby wireless monitoring method, device and system thereof |
CN102625077A (en) * | 2011-01-27 | 2012-08-01 | 深圳市合智创盈电子有限公司 | Conference recording method, conference photographing device, client and system |
US20120316680A1 (en) * | 2011-06-13 | 2012-12-13 | Microsoft Corporation | Tracking and following of moving objects by a mobile robot |
CN103135589A (en) * | 2013-01-14 | 2013-06-05 | 深圳市宇恒互动科技开发有限公司 | Reflector lamp capable of randomly changing projection areas, following projection system and implementation method of following projection system |
CN103439127A (en) * | 2013-07-18 | 2013-12-11 | 深圳市宇恒互动科技开发有限公司 | Inertia inputting device motion mass measuring method, terminal and system |
Cited By (38)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104281160A (en) * | 2014-09-24 | 2015-01-14 | 任钢 | Close-range automatic following system |
CN104469158A (en) * | 2014-12-15 | 2015-03-25 | 安徽华米信息科技有限公司 | Moving shooting and shooting controlling method and device |
WO2017039546A1 (en) * | 2015-09-01 | 2017-03-09 | Cyclect Electrical Engineering Pte Ltd | System, method and apparatus for navigating one or more vehicles |
CN105783918A (en) * | 2016-03-09 | 2016-07-20 | 欧永达 | Positioning following method based on geomagnetic field and signal strength |
CN105892656A (en) * | 2016-03-30 | 2016-08-24 | 联想(北京)有限公司 | Data processing method and electronic devices |
CN105807790B (en) * | 2016-04-25 | 2018-08-28 | 安徽大学 | A kind of intelligent system for tracking and its follower method based on indoor mixed positioning |
CN105807790A (en) * | 2016-04-25 | 2016-07-27 | 安徽大学 | Intelligent following system based on indoor hybrid location and following method of system |
CN105843231A (en) * | 2016-06-18 | 2016-08-10 | 陈明敬 | Moving carrier capable of automatically walking along with signal terminal |
WO2017219751A1 (en) * | 2016-06-21 | 2017-12-28 | 安徽酷哇机器人有限公司 | Mobile suitcase having automatic following and obstacle avoidance functions, and using method therefor |
CN106681359A (en) * | 2016-07-18 | 2017-05-17 | 歌尔股份有限公司 | Method for controlling intelligent baby pram, intelligent baby pram and control system |
CN106681359B (en) * | 2016-07-18 | 2020-10-27 | 歌尔股份有限公司 | Control method of intelligent baby carriage, intelligent baby carriage and control system |
WO2018014275A1 (en) * | 2016-07-21 | 2018-01-25 | 深圳前海达闼云端智能科技有限公司 | Target tracking device and system, and robot |
CN106227206B (en) * | 2016-07-27 | 2019-05-17 | 广州艾想电子科技有限公司 | A kind of equipment follow-up control method and device and system for tracking |
CN106227206A (en) * | 2016-07-27 | 2016-12-14 | 广州艾想电子科技有限公司 | A kind of equipment follow-up control method and device and system for tracking |
CN106297083A (en) * | 2016-07-29 | 2017-01-04 | 广州市沃希信息科技有限公司 | A kind of market shopping method, shopping server and shopping robot |
WO2018018839A1 (en) * | 2016-07-29 | 2018-02-01 | 曾昭兴 | Method for shopping in shopping mall, shopping server and shopping robot |
CN106527425A (en) * | 2016-09-30 | 2017-03-22 | 张家港长安大学汽车工程研究院 | Omnibearing intelligent following trolley and controlling method thereof |
CN107976995A (en) * | 2016-10-24 | 2018-05-01 | 苏州宝时得电动工具有限公司 | Intelligent mobile system, intelligent mobile device and its moving method |
CN106483959A (en) * | 2016-11-10 | 2017-03-08 | 江苏大学 | A kind of set a distance under image space is with car control method |
CN106680802A (en) * | 2017-03-16 | 2017-05-17 | 武汉理工大学 | Automatic wheelchair following method based on radio signal intensity and system |
CN106680802B (en) * | 2017-03-16 | 2019-05-24 | 武汉理工大学 | The automatic follower method of wheelchair and system based on radio signal strength |
WO2018228462A1 (en) * | 2017-06-15 | 2018-12-20 | Zhejiang Geely Holding Group Co., Ltd. | Mobile power for outdoor power supply |
CN108733043A (en) * | 2017-09-01 | 2018-11-02 | 北京猎户星空科技有限公司 | robot movement control method and device |
CN108733043B (en) * | 2017-09-01 | 2021-12-14 | 北京猎户星空科技有限公司 | Robot movement control method and device |
WO2019095594A1 (en) * | 2017-11-14 | 2019-05-23 | Powervision Tech Inc. | Following mobile device, following system, and method therefor |
CN108363390A (en) * | 2018-01-23 | 2018-08-03 | 安徽酷哇机器人有限公司 | Auto-manual luggage case system for tracking, method and handle and luggage case |
CN108803610A (en) * | 2018-06-13 | 2018-11-13 | 陈忠 | A kind of automatic intelligent positioning trolley case system and its control method for following function |
WO2020029166A1 (en) * | 2018-08-09 | 2020-02-13 | Lingdong Technology (Beijing) Co. Ltd | Luggage delivery system |
US11200765B2 (en) | 2018-08-09 | 2021-12-14 | Lingdong Technology (Beijing) Co. Ltd | Luggage delivery system |
CN109240308A (en) * | 2018-11-12 | 2019-01-18 | 辽东学院 | Automatically track shopping cart |
CN109597408A (en) * | 2018-11-22 | 2019-04-09 | 东南大学 | A kind of control method and system of automatic Following Car |
CN109541525A (en) * | 2018-11-22 | 2019-03-29 | 东南大学 | A kind of direction finding distance measuring method and system based on infrared signal |
CN109597408B (en) * | 2018-11-22 | 2022-01-28 | 东南大学 | Control method and system for automatically following vehicle |
CN109634273A (en) * | 2018-11-30 | 2019-04-16 | 深圳大学 | The follow-up control method and device of movable equipment |
CN109634273B (en) * | 2018-11-30 | 2021-11-19 | 深圳大学 | Following control method and device for movable equipment |
CN111026202A (en) * | 2019-09-30 | 2020-04-17 | 陕西雷神智能装备有限公司 | Motion equipment drive-by-wire signal generation device and drive-by-wire motion equipment |
CN113525553A (en) * | 2021-06-03 | 2021-10-22 | 韦淑庄 | Intelligent following vehicle and control method thereof |
CN114063656A (en) * | 2021-11-17 | 2022-02-18 | 重庆庄周科技有限责任公司 | Self-following method and automatic following device |
Also Published As
Publication number | Publication date |
---|---|
CN104049633B (en) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104049633A (en) | Servo control method, servo device and servo system | |
CN104515992B (en) | A kind of method and device that spacescan positioning is carried out using ultrasonic wave | |
CN106127117B (en) | Automatic following luggage case based on binocular vision rapid high-robustness recognition and positioning | |
US11160340B2 (en) | Autonomous robot system | |
US10180683B1 (en) | Robotic platform configured to identify obstacles and follow a user device | |
US10921820B2 (en) | Movable object and control method thereof | |
CN208323397U (en) | A kind of educational robot and its control system | |
CN108536145A (en) | A kind of robot system intelligently followed using machine vision and operation method | |
CN108125349A (en) | A kind of Intelligent luggage carrier | |
CN206684574U (en) | A kind of mobile robot recharges control system | |
CN105517664A (en) | Systems and methods for uav docking | |
CN106444843A (en) | Unmanned aerial vehicle relative azimuth control method and device | |
CN204883391U (en) | A personally experience sth. part of body and feel remote controller for controlling cloud platform | |
CN111201497A (en) | Autonomous robot system | |
KR20180089667A (en) | Robot for providing coding education | |
CN106647815A (en) | Intelligent following robot based on multi-sensor information fusion and control method thereof | |
CN205707061U (en) | Automatically trailing type electrodynamic balance car | |
KR102088989B1 (en) | Method and apparatus for landing guidance of unmanned aerial vehicle | |
CN106707834A (en) | Remote control equipment based on computer vision technology | |
CN105807790B (en) | A kind of intelligent system for tracking and its follower method based on indoor mixed positioning | |
CN106647788B (en) | UAV Flight Control method and device | |
CN106292710A (en) | Four rotor wing unmanned aerial vehicle control methods based on Kinect sensor | |
CN109857121A (en) | Indoor inspection mobile robot | |
Krejsa et al. | Odometry-free mobile robot localization using bearing only beacons | |
CN205131675U (en) | Intelligence unmanned aerial vehicle system based on long -range target of listening of infrared ray |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230913 Address after: Room 202L, Building 2, No.1 Cangxing Road, Cangqian Street, Yuhang District, Hangzhou City, Zhejiang Province, 310000 Patentee after: Shiwen (Hangzhou) Artificial Intelligence Technology Co.,Ltd. Address before: 518049, Guangdong, Shenzhen Futian District Meilin Road, No. three, blue sky green homes on the third floor of the annex Patentee before: SHENZHEN YUHENG INTERACTIVE TECHNOLOGY DEVELOPMENT Co.,Ltd. |