A kind of photoelectric positioning apparatus of construction mechanical arm
Technical field
The present invention relates to a kind of photoelectric positioning apparatus, particularly relate to and a kind of workpiece that construction mechanical arm gripped is realized the straight line positioning means for positioning.
Background technology
Construction mechanical arm is the novel mechanical equipment of large-scale underground pipe network modernization construction as large-scale underground buried pipeline construction mechanical arm, can improve the efficient of pipeline construction, reduces or avoids casualty accident.Existing several countries have carried out the research of machine for pipe hand, and as the research and the test of second generation large-sized concrete underground pipeline laying mechanical arm, but this mechanical arm does not solve problems such as tube coupling (workpiece) straight line detection and localization.Up to the present, the research of China's construction mechanical arm has some achievements, but for utilizing optical target straight line Position Research achievement still to belong to blank.
Summary of the invention
The object of the present invention is to provide a kind of locating device to the workpiece that construction mechanical arm gripped, the photodiode of this device or photoelectricity band are arranged along the target disc radial direction, constitute photosensitive utmost point footpath.Its locating device can utilize single target location, two target location or the realization of the three targets location location to the straight line of workpiece.This optical target is simple and reliable, helps construction mechanical arm and realizes automated construction.
The objective of the invention is to be achieved through the following technical solutions:
A kind of photoelectric positioning apparatus of construction mechanical arm, this device includes hardware components and software section, and its hardware components comprises: mechanical target disc, target disc rotating shaft, drive motor, electronic devices and components and photodiode; The outside surface of machinery target disc is equipped with photodiode or photoelectricity band, and inside surface is equipped with drive motor, target disc rotating shaft and electronic devices and components, and mechanical target disc is by the drive motor driven in rotation that is installed in inside surface; Electronic devices and components include: laser pick-off circuit, coding circuit, be installed in angular displacement sensor, AD converter, single-chip microcomputer and wireless communication module in the target disc rotating shaft, wherein, AD converter, coding circuit and wireless communication module all link to each other with single-chip microcomputer, and being subjected to Single-chip Controlling, the connecting circuit between the control program of single-chip microcomputer and each module is a software section; This photoelectric positioning apparatus is mainly gathered two data: a laser beam that is angular displacement sensor records is beaten the polar angle of laser spot on mechanical target disc; A distance that is laser spot apart from mechanical target disc center; Photodiode or photoelectricity band are arranged along mechanical target disc radial direction, constitute photosensitive utmost point footpath, and angular displacement sensor is surveyed polar angle; When laser beam is beaten on the mechanical target disc of rotation, the photosensitive utmost point directly touches laser spot, data acquisition system (DAS) will directly be worth the utmost point of laser spot on mechanical target disc with polar angle and collects, and passes to data receiving system by wireless transmitting system, for control system provides information.
The photoelectric positioning apparatus of aforesaid a kind of construction mechanical arm, its single described photoelectric positioning apparatus can be measured the location of 2 degree of freedom, two described photoelectric positioning apparatus can be measured 4 degree of freedom or be less than the location of 4 degree of freedom, and three described photoelectric positioning apparatus can be measured 6 degree of freedom or be less than the location of 6 degree of freedom.
Advantage of the present invention and effect are:
Locating device of the present invention can be realized single target location, two target location or three targets location to the workpiece that construction mechanical arm gripped according to concrete operating position; The optical target of this device is simple and reliable, helps construction mechanical arm and realizes automated construction.
Description of drawings
Fig. 1 is the front view of photoelectric positioning apparatus of the present invention;
Fig. 2 is the left view of photoelectric positioning apparatus of the present invention;
Fig. 3 concerns synoptic diagram for photoelectric positioning apparatus internal control of the present invention;
Fig. 4 is the structural representation of photoelectric positioning system of the present invention;
Fig. 5 is the principle of work synoptic diagram of photoelectric positioning apparatus of the present invention.
Embodiment
The present invention is described in detail with reference to the accompanying drawings.
As shown in the figure, this photoelectric positioning apparatus includes hardware components and software section.Its hardware components comprises: mechanical target disc 1, target disc rotating shaft 2, drive motor 3, electronic devices and components 4 and photodiode 5.The outside surface of machinery target disc 1 is equipped with photodiode 5 or photoelectricity band, and inside surface is equipped with drive motor 3, target disc rotating shaft 2 and electronic devices and components 4; The machinery target disc is by the drive motor driven in rotation that is installed in inside surface, electronic devices and components 4 include: laser pick-off circuit, coding circuit, be installed in angular displacement sensor, AD converter, single-chip microcomputer and wireless communication module in the target disc rotating shaft, and by Ni-MH battery as its power supply.Wherein, AD converter, coding circuit and wireless communication module all link to each other with single-chip microcomputer, and are subjected to Single-chip Controlling, and the connecting circuit between the control program of single-chip microcomputer and each module is a software section.This photoelectric positioning apparatus is mainly gathered two data: a laser beam that is angular transducer records is beaten the polar angle of laser spot on target disc; A distance that is laser spot apart from the target disc center.
Principle of work of the present invention is: photodiode or photoelectricity band are arranged along the target disc radial direction, constitute photosensitive utmost point footpath, and angular displacement sensor is surveyed polar angle.When laser beam is beaten on the receiving target of the photoelectricity location of rotation, the photosensitive utmost point directly touches laser spots, data acquisition system (DAS) will directly be worth the utmost point of laser spots on target disc with polar angle and collects, and passes to data receiving system by wireless transmitting system, for control system provides information.
Utilize photoelectric positioning apparatus of the present invention, promptly this optical target can use single target positioning system, two target positioning system or the realization of the three target positioning systems location to construction mechanical arm according to concrete operating position.This optical target is simple and reliable, helps construction mechanical arm and realizes automated construction.
In use, optical target is installed on the certain position of mechanical arm, and laser instrument is fixed on the working-yard, mechanical arm reached ideal position when the adjustment laser beam made it through target center.Can select with 1 optical target, 2 optical targets or 3 optical targets according to the needs of mechanical arm measuring position state.Disposing under the proper situation, 1 optical target can be measured 2 degree of freedom, and 2 optical targets can be measured 4 degree of freedom, and 3 optical targets can record 6 degree of freedom of mechanical arm in certain spatial domain.
When work, when laser beam is got on the photoelectricity, after the photosensitive utmost point of rotation directly touches laser beam, will trigger circuit, make optical target collect the extreme value and the polar angle of laser beam position on optical target, and a data wireless that collects is transferred to data receiving system.The data computation that the position computation module basis of data receiving system receives goes out the position of laser spots, and location parameter is passed to control system.