CN203204442U - Automatic walking robot - Google Patents

The utility model relates to an automatic walking robot. The automatic walking robot comprises a structure portion and a control portion. The structure portion comprises: a base which is installed with rollers for walking; a supporting rod; a first movable shaft; a first movable arm, wherein one end of the first movable arm is connected to the first movable shaft; a second movable shaft; a second movable arm; a third movable shaft; and a holding hand. The control portion comprises: a Hall sensor array which is arranged on the base; an amplifier unit which is used for amplifying signals outputted by Hall sensors in the Hall sensor array respectively; an analog-to-digital conversion unit which is used for converting the analog quantity outputted by the amplifier unit into a digital signal; and a processing unit which is used for processing the signal outputted by the analog-to-digital conversion unit and controlling the action of the structure portion. The Hall sensor array comprises a first sensor row of at least three Hall sensors which are distributed along a straight line and a second sensor row of at least two Hall sensors which are distributed along a straight line, wherein the first sensor row is vertical to the second sensor row.

A kind of automatic walking robot

Technical field

The utility model relates to a kind of automatic walking robot.

Background technology

Finishing book needs great amount of manpower in the library.How to reduce manpower and use, adopted robot at present in a large number.In the library, robot follows fixed line walking, for example the route of bookshelf composition.How to allow robot walk automatically according to setting path, magnetic tracks is a kind of lower-cost solution route.To this, more employing Hall element.

Hall element is a kind of magnetic field sensor of making according to Hall effect, and according to Hall effect, the element that people make with semiconductor material is Hall element.It has to magnetic-field-sensitive, simple in structure, volume is little, frequency response is wide, output voltage changes greatly and advantage such as long service life, therefore, be widely used in fields such as measurement, robotization, computing machine and infotecies.And, the type Hall element have a linear characteristic of output voltage and externally-applied magnetic field intensity, therefore on certain direction, when on certain orientation different 2 place two Hall elements, can obtain according to the output voltage of sensor two sensors respectively with the ratio of the displacement of magnetisable material.

But Hall element when for example a plurality of magnetic stripes superpose, can't further be judged concrete direction when judging direction.So in the application of comparatively complicated route, for example the crossroad of magnetic tracks composition can't determine concrete direction.

The utility model content

Technical problem to be solved in the utility model is, a kind of automatic walking robot that can travel along comparatively complicated magnetic tracks is provided.

The utility model provides a kind of automatic walking robot, comprising:

Structural portion comprises:

Pedestal is equipped with the roller for walking;

Pole serves as that axle rotates with its axial rotating shaft, and this axial rotating shaft vertical fixing is on described pedestal;

First movable axis is fixed in described pole upper end, and it is axially vertical with described pole;

First lever arm, one end are connected in described first movable axis, can serve as that axle rotates on the plane vertical with described first movable axis with this first movable axis;

Second movable axis is fixed in the other end of described first lever arm, and it is axially vertical with described first lever arm;

Second lever arm, one end are connected in described second movable axis, can serve as that axle rotates on the plane vertical with described second movable axis with this second movable axis;

The 3rd movable axis is fixed in the other end of described second lever arm, and it is axially vertical with described second lever arm; With

The clamping hand is used for the clamping foreign object, and the one end is connected in described the 3rd movable axis, can serve as that axle rotates on the plane vertical with described the 3rd movable axis with the 3rd movable axis;

And control part comprises:

Hall sensor array is arranged on the described pedestal, comprising: it is capable and have second sensor row of at least 2 Hall elements that distribute along straight line to have a first sensor of at least 3 Hall elements that distribute along straight line; Described first sensor is capable and second sensor row is perpendicular;

Amplifier unit is used for amplifying respectively the signal that described Hall sensor array Hall element is exported;

AD conversion unit is used for the analog quantity of described amplifier unit output is converted to digital signal;

Processing unit is used for the signal of described AD conversion unit output is handled, and controls the action of described structural portion.

Compared with prior art, the advantage of technique scheme is:

Not only, Machinery Ministry can be good at adapting to multilayer framves such as bookshelf, and the article of differing heights are got flexibly or put.First lever arm and second lever arm cooperatively interact specifically, can realize getting flexibly or putting of differing heights with comparatively simply motion.

And on this basis, Hall sensor array can be good at realizing the direction determining such as the magnetic tracks of right-angled intersection, concrete follow-up accompanying drawings, and then can realize the automatic walking of travelling along comparatively complicated magnetic tracks.

Preferably, described control part also comprises:

The radio-frequency (RF) identification reading unit is connected with described processing unit, is used for reading outside RFID tag.

Adopt above-mentioned technological means, further can realize the judgement to particular location preferably.

Preferably, described first movable axis, second movable axis and the 3rd movable axis adopt the stepper motor by described processing unit to drive rotation respectively.

Description of drawings

Fig. 1 is the structural representation of structural portion among a kind of embodiment of the automatic walking robot of the utility model;

Fig. 2 is the structural representation of control part among a kind of embodiment of the automatic walking robot of the utility model;

Fig. 3 is the structural representation of Hall sensor array among a kind of embodiment of the automatic walking robot of the utility model;

Fig. 4 is Hall element principle of work synoptic diagram.

Embodiment

Below in conjunction with accompanying drawing embodiment of the present utility model is described further.

As depicted in figs. 1 and 2, a kind of automatic walking robot comprises:

Structural portion comprises:

Pedestal is equipped with the roller for walking;

Pole serves as that axle rotates with its axial rotating shaft, and this axial rotating shaft vertical fixing is on described pedestal;

First movable axis is fixed in described pole upper end, and it is axially vertical with described pole;

First lever arm, one end are connected in described first movable axis, can serve as that axle rotates on the plane vertical with described first movable axis with this first movable axis;

Second movable axis is fixed in the other end of described first lever arm, and it is axially vertical with described first lever arm;

Second lever arm, one end are connected in described second movable axis, can serve as that axle rotates on the plane vertical with described second movable axis with this second movable axis;

The 3rd movable axis is fixed in the other end of described second lever arm, and it is axially vertical with described second lever arm; With

The clamping hand is used for the clamping foreign object, and the one end is connected in described the 3rd movable axis, can serve as that axle rotates on the plane vertical with described the 3rd movable axis with the 3rd movable axis;

And control part comprises:

Hall sensor array is arranged on the described pedestal, comprising: it is capable and have second sensor row of at least 2 Hall elements that distribute along straight line to have a first sensor of at least 3 Hall elements that distribute along straight line; Described first sensor is capable and second sensor row is perpendicular;

Amplifier unit is used for amplifying respectively the signal that described Hall sensor array Hall element is exported;

AD conversion unit is used for the analog quantity of described amplifier unit output is converted to digital signal;

Processing unit is used for the signal of described AD conversion unit output is handled, and controls the action of described structural portion.

Wherein, described control part also comprises:

The radio-frequency (RF) identification reading unit is connected with described processing unit, is used for reading outside RFID tag.

Described first movable axis, second movable axis and the 3rd movable axis adopt the stepper motor by described processing unit to drive rotation respectively.

As shown in Figure 3, magnetic stripe 1 and magnetic stripe 2 are orthogonal two magnetic stripes,

Hall sensor array comprises the first linear rows Hall element and the second linear rows Hall element of two mutual vertical distribution.Wherein, the first linear rows Hall element comprises 8 Hall elements that distribute point-blank, and the second linear rows Hall element comprises 2 Hall elements that distribute point-blank.

Because the intensity of Hall element institute detection signal and Distribution of Magnetic Field have linear relation, when being distributed in straight line between a plurality of Hall elements, are convenient to more signal is handled.

Say to have only a plurality of Hall elements of a linear distribution how to work in conjunction with Fig. 4.

As shown in Figure 4, can be because of the different differences that have Hall voltage with the position of magnetic stripe at Hall element, because of the cost that strong magnetic is required higher, so a little less than adopting magnetic in an embodiment, the magnetic stripe that cost is low, therefore to detect the change in voltage that obtains be very faint to Hall element, must amplify processing through operational amplifier, and the signal after the amplification is defeated by single-chip microcomputer through AD conversion oral instructions and is handled.Its principle of work can be referring to shown in Figure 2.Like this, be based on above principle, the magnetic stripe of laying along ground with the automatic guided robot of realizing the magnetic stripe navigate mode travels and is basic purpose, though there is the low defective of sensitivity in some position range in the data of stable output, is enough to satisfy the purpose of finishing tracking.

In the tracking process, utilize above principle can realize the tracking of camber line, straight line etc., but because Hall element upwards has certain defective the detection side, in the time of in the middle of through the right-angled intersection formed by magnetic stripe 1 and magnetic stripe 2 as shown in Figure 3 the time, the Hall element that distributes on the single straight line can't stable detection arrive magnetic stripe 2, and therefore need increase respectively in the left and right sides with original sensor orientation angle is two Hall elements of 90 degree.

And through experimental check, increase and to detect track and right-angled intersection accurately after the left and right sides increases by two Hall elements, the directivity defective of Hall element not only can not influence tracking for general tracking, can also reduce some unnecessary interference.Can be by in advance information being input to selection paths such as single-chip microcomputer or radio-frequency (RF) identification to realize full automatic independent navigation when selecting the path through right-angled intersection.

Above content is in conjunction with specific embodiments to further describing that the utility model is done, and can not assert that concrete enforcement of the present utility model is confined to these explanations.For the utility model person of an ordinary skill in the technical field, under the prerequisite that does not break away from the utility model design, can also make some simple deduction or replace, all should be considered as belonging to protection domain of the present utility model.