CN109773796A - A kind of working method of mechanical arm - Google Patents

A kind of working method of mechanical arm Download PDF

Info

Publication number
CN109773796A
CN109773796A CN201910216576.4A CN201910216576A CN109773796A CN 109773796 A CN109773796 A CN 109773796A CN 201910216576 A CN201910216576 A CN 201910216576A CN 109773796 A CN109773796 A CN 109773796A
Authority
CN
China
Prior art keywords
mechanical arm
fpga
data
working method
host computer
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.)
Pending
Application number
CN201910216576.4A
Other languages
Chinese (zh)
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.)
Changzhou Campus of Hohai University
Original Assignee
Changzhou Campus of Hohai University
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 Changzhou Campus of Hohai University filed Critical Changzhou Campus of Hohai University
Priority to CN201910216576.4A priority Critical patent/CN109773796A/en
Publication of CN109773796A publication Critical patent/CN109773796A/en
Pending legal-status Critical Current

Links

Landscapes

  • Toys (AREA)

Abstract

The invention discloses a kind of working methods of mechanical arm, belong to robot device's application field.It the described method comprises the following steps: initialization mechanical arm;Establish the communication connection between FPGA and host computer;Data are write in the host computer creation, and data are sent FPGA;The FPGA receives data and is handled, and FPGA controls mechanical arm and completes to write.The invention can more accurate simulation action of writing, restore details, cope with complicated writing surface and normal work, wireless remote manipulation, and automatic Verification data correctness may be implemented.

Description

A kind of working method of mechanical arm
Technical field
The invention belongs to robot device's application field, specially a kind of working method of mechanical arm.
Background technique
It is generally write by printer printing character substitution in life, but printer can not realize that signature etc. being capable of body The function of existing individual's specific style, therefore can choose the mechanical arm substitution by high-freedom degree.Existing various machinery on the market Arm is only capable of completing the upper inferior simple operations in front and back, cannot achieve multiple steering engine combined operations, can not be according to oneself style book It writes.
Summary of the invention
In view of the deficiencies of the prior art, the purpose of the present invention is to provide a kind of working methods of mechanical arm, existing to solve There is mechanical arm present in technology to be only capable of completing the upper inferior simple operations in front and back, cannot achieve multiple steering engine combined operations, less The problem of capable of being write according to the style of oneself.
To solve prior art problem, the technical scheme adopted by the invention is as follows:
A kind of working method of mechanical arm, the described method comprises the following steps:
Initialize mechanical arm;
Establish the communication connection between FPGA and host computer;
Communication connection between the FPGA and host computer can independently be selected by operator, default FPGA and host computer it Between pass through bluetooth connection;
Data are write in the host computer creation, and data are sent FPGA;
The FPGA receives data and is handled, and FPGA controls mechanical arm and completes to write.
Further, the mechanical arm initial method includes: that the mechanical arm is accessed FPGA general-purpose interface, is established Communication connection between FPGA and mechanical arm;
Initialization key is pressed, the FPGA judges whether the freedom degree number of mechanical arm meets writing and require;Work as freedom It spends number and meets writing requirement, i.e., when freedom degree number is more than or equal to four, corresponding initialization process is selected according to freedom degree;It is logical The initialization for crossing initialization process completion mechanical arm initializes failure if freedom degree number is unsatisfactory for requiring, and lights yellow and refers to Show lamp alarm.
After the FPGA determines freedom degree number, mechanical arm enters specific initialization process, and FPGA con current control is each A steering engine makes each steering engine pinch and reaches intermediate value, FPGA is slow by internal setting initial velocity later by exporting specific square wave Slow falling head, while inside is started counting until pen tip touches paper, mechanical arm stopping at this time acting and generates feedback signal, Feedback signal is captured inside FPGA and calculates falling head, is entered after the writing height of the suitable current environment of automatic adjustment ready State.
For the difference of freedom degree number, the process initialized respectively to mechanical arm is stored in FPGA, due to certainly By spending and the difference of coordinate system selection, pinch also can be variant for the steering engine of each point in corresponding space, therefore needs according to different The each corner of the inverse kinematics derivation of equation, according to this situation, storing multiple sets calculation in FPGA, with mechanical with suitable different type Arm and different coordinate systems, FPGA default choice polar coordinate system, four-degree-of-freedom manipulator model can reach each on plane domain A coordinate points can uniformly touch each point on writing surface, since pen tip is vertical with writing surface always in writing process, It is lower to simulate the fine degree write, compared to five degree-of-freedom manipulator, increases freedom degree in nib, turning for pen can be controlled It is dynamic, the weight variation of every bit can be embodied, similarly, freedom degree more fine degree is higher, but complexity is also higher, inverse fortune The dynamic calculating for learning formula, belongs to existing knowledge, this will not be repeated here.
Further, the mechanical arm initial method specifically includes: FPGA electrification reset;Detection general-purpose interface judges machine Whether the freedom degree number of tool arm meets the requirements;Select suitable initialization scheme;FPGA receives feedback and post-processes and export just Beginning signal carries out initialization procedure to mechanical arm.
Further, the freedom degree number is more than or equal to 4.
Further, the writing data creation method includes:
Character is inputted in the host computer;
The host computer is according to character stroke acquisition order pixel;
Obtain the polar coordinates information and specific information symbol of each pixel;
The data packet of the character is generated according to polar coordinates information and specific information symbol;
The specific information symbol includes the pause of character stroke and empties position;
Further, the information in the data packet includes: the sequencing of total length of data, coordinate information, special letter Cease the position of symbol.
Further, the data processing method is as follows;
The FPGA, which identifies data characteristics and completes parsing in inside, obtains the polar coordinates of series of pixel point;
Judge polar reasonability;
Polar coordinates are converted to the square-wave signal of control mechanical arm.
Further, the host computer includes mobile phone and PC;The mechanical arm includes Cartesian robot arm, circular cylindrical coordinate Mechanical arm and polar coordinates mechanical arm.
Further, the end of the mechanical arm is fixed with writing pen.
It operates mouse and writes character in the input window of host computer, host computer is according to stroke writing sequence automatic collection pixel Point, to calculate the polar coordinates of each pixel, when pausing and emptying occur in person's handwriting, host computer automatically generates special letter Breath symbol automatically generates the data packet of the character, data packet includes total length of data, coordinate after completing to write inside host computer The sequencing of information, the position etc. of specific information symbol are automatically selected as single frames according to length or multiframe are transmitted, and according to number Corresponding data packet is sent according to transport protocol.
Host computer is clicked send after, data packet by Bluetooth transmission to FPGA, FPGA according to transport protocol received data packet, It identifies data packet feature, completes parsing in inside, obtain the polar coordinates of series of pixel point, examine each polar coordinates, judge Unreasonable coordinate simultaneously filters out, if filtering out quantity more than threshold value, is judged as error of transmission, issues red light alarm, if filtering is sat Number is marked within error, then it represents that font is reasonable, then handles by internal calculation, and polar coordinates are converted to control steering engine Square-wave signal successively moves to control mechanical arm according to the coordinate of pixel, to complete to write.
Compared with prior art, the present invention is with following the utility model has the advantages that FPGA concurrent processing characteristic larger can be promoted Data processing speed and working efficiency, multifreedom controlling can more accurate simulation action of writing, restore details, reply is multiple Wireless remote manipulation, and automatic Verification data correctness may be implemented in miscellaneous writing surface and normal work.
Detailed description of the invention
Fig. 1 is a kind of flow chart of the working method specific embodiment of mechanical arm of the present invention;
Fig. 2 is mechanical arm auto-initiation flow chart in a kind of working method specific embodiment of mechanical arm of the present invention;
Fig. 3 is to establish bluetooth connection flow chart in a kind of working method specific embodiment of mechanical arm of the present invention;
Fig. 4 is to write the flow chart that Data Concurrent is sent in a kind of working method specific embodiment of mechanical arm of the present invention;
Fig. 5 is to receive data in a kind of working method specific embodiment of mechanical arm of the present invention and be converted to output signal process Figure.
Specific embodiment
Following will be combined with the drawings in the embodiments of the present invention, and technical solution in the embodiment of the present invention carries out clear, complete Site preparation description, it is clear that described embodiments are only a part of the embodiments of the present invention, instead of all the embodiments.It is based on Embodiment in the present invention, those of ordinary skill in the art without making creative work it is obtained it is all its His embodiment, shall fall within the protection scope of the present invention.
As shown in figure 1, figure 2, figure 3, figure 4 and figure 5, a kind of working method of mechanical arm, the described method comprises the following steps:
S10, initialization mechanical arm;
Establish the communication connection between FPGA and mechanical arm;
The FPGA judges whether the freedom degree number of mechanical arm meets writing and require, and corresponding according to freedom degree selection Initialization process;
The initialization of mechanical arm is completed by initialization process.
S10 specifically includes the following steps:
S101, FPGA electrification reset;
S102, detection general-purpose interface;
S103, judge whether the freedom degree number of mechanical arm meets the requirements, S104 step is entered if meeting the requirements, it is no Then enter S105 step;
S104, the suitable initialization scheme of selection;
S105, yellow indicator lamp alarm is issued;
S106, FPGA receive feedback and post-process and export initial signal, keep mechanical arm ready in suitable position.
For the mechanical arm of different freedom degrees, FPGA driving method differs greatly, and per more ones degree of freedom, inverse kinematics is public The complexity of formula increases accordingly, so corresponding to the mechanical arm of different freedom degrees, it is public all to prepare a set of corresponding calculating inside FPGA Formula is write as plane, and the type of mechanical arm has Cartesian robot arm, circular cylindrical coordinate machinery arm and polar coordinates mechanical arm three classes, According to the complexity of writing, operator can independently select the coordinate domain write, and be defaulted as the highest polar coordinates mould of complexity Formula, writing pen needs fixed in mechanical arm tail end, generally allow to have 1~2mm error, can allow pen tip from a coordinate motion to It will not be interfered by too big frictional resistance when next coordinate, meanwhile, in order to avoid occurring causing due to subtle arithmetic eror The problem of steering engine stall, it is proposed that write with the nib of soft contact, prevent steering engine because long-time stall reduces accuracy and makes Use the service life.
S20, the Bluetooth communication established between FPGA and host computer connect;
S20 specifically includes the following steps:
S201, bluetooth initialization;
S202, detection connection;
S203, whether bluetooth is connected;
Whether S204, bluetooth respond;
S205, connection is established.
The no excessive demand of the selection of bluetooth can establish connection with host computer.
S30, host computer creation write data, and send the data to FPGA;
S30 specifically includes the following steps:
S301, host computer reset;
S302, control mouse write character stroke;
S303, judge whether the location of pixels of character stroke standardizes;
S304, give up current stroke automatically;
S305, parsing pixel, packaged data;
The configuration such as S306, host computer completing port, baud rate, check bit;
S307, data packet is sent;
It is S308, ready;
S309, whether require to retransmit.
Wherein writing the operators such as character stroke and configuration sending port can voluntarily control, and send an engineering, on Position chance enters ready state, and the request until receiving the retransmission of the end FPGA, host computer will retransmit a data packet, on The programming no special language requirement of position machine, but need to meet can the functions such as selection port, baud rate and parity check bit, tool There is an input window and any character in input window can be converted to polar data, the character that mouse writes is big It is small must host computer provide window in, if writing on outside window, current stroke will be judged as in vain, and host computer will be in window Picture element signal be converted to coordinate signal, when stroke is more than one, specific information symbol can be generated, specific information symbol can allow machinery Arm makes start writing Deng corresponding operatings, and final all data can be packaged into data packet, and host computer selects automatically according to data package size Transmission mode is selected, is transferred to FPGA by radio connections such as data line or bluetooths.
S40, the FPGA receive data and are handled, FPGA control mechanical arm completion writing.
S40 specifically includes the following steps:
S401, FPGA received data packet;
S402, it parses data packet and extracts coordinate;
S403, judge whether data standardize;
S404, cast out data lack of standardization;
S405, it is loaded into coordinate information table;
S406, judge whether that missing is serious;
S407, request host computer retransmit;
S408, coordinate is converted into driving signal;
S409, driving signal drive mechanical arm.
Then the Bluetooth transmission protocol received data packet that FPGA is selected according to operator parses number according to Data Transport Protocol According to packet, each pixel coordinate is obtained, coordinate is then successively examined, nonstandard data are cast out, judges that coordinate is believed after having parsed Cease it is whether complete, if missing will seriously send request to host computer, if lack coordinate is converted within threshold value it is corresponding Driving signal, driving mechanical arm work, the PWM drive cycle of general steering engine is 20ms, and controlled range is usually 0.5-2.5ms, Middle position is all 1.5ms, selects a coordinate as origin, assigns the specific numerical value of steering engine, on polar coordinate plane, successively It calculates the corresponding steering engine of relative coordinate to pinch, and this is exported in a manner of square-wave signal, to drive steering engine.
FPGA according to the data pack protocol parsing data packet of oneself setting and is mentioned according to Data Transport Protocol received data packet Coordinate signal is taken, with inverse kinematics formula, mechanical arm principal arm and auxiliary length is substituted into, polar coordinates signal can be converted to machine The angle-data of tool arm steering engine corner, while the square-wave signal that the FPGA output period is 20ms drives steering engine to go to specified angle, According to calculating, pen tip will just fall in the point at this time.
The coordinate signal received is buffered in RAM by FPGA needs, is then successively read coordinate signal in order, is guaranteed Each coordinate can be read.Coordinate signal needs to use inverse kinematics Formula Parsing, is ultimately converted to the corner of steering engine, FPGA It just can be with output signal to drive steering engine to rotate after the angle for knowing corner.Inverse kinematics formula is existing knowledge, here not It repeats.
Specifically, mechanical arm is using existing four-degree-of-freedom mechanical arm, operator independently select the type of pen simultaneously on the market It is fixed in the end of mechanical arm, it is desirable that position is reasonable.Due to installing individually, the fixation position of pen might have subtle Difference causes height of the pen tip apart from paper (or other faces of writing) different, influences effect of writing, and initialization can adapt to automatically Such situation.
Host computer can be mobile phone terminal or the end PC, can also connect other by setting transport protocol at the end FPGA and answer With, data are sent using the end PC herein, the character being intended by (or pattern) is write in host computer input frame by mouse, Mechanical arm can write out corresponding character (or pattern) in paper or other writing surfaces.Mechanical arm can by development board or FPGA is controlled, and receives the signal and control manipulator motion that host computer generates using FPGA in the present embodiment.
The above-mentioned a certain application that the invention is only illustrated with example, aspect reader understands, but does not represent purposes of the present invention It is only limitted to this, for the non-technical personnel of this field, it is possible to understand that in the case of without departing from the principles of the present invention, Ke Yi Make extension or recreation on the basis of this, the scope of the present invention is subject to claims.

Claims (9)

1. a kind of working method of mechanical arm, which is characterized in that the described method comprises the following steps:
Initialize mechanical arm;
Establish the communication connection between FPGA and host computer;
Data are write in the host computer creation, and data are sent FPGA;
The FPGA receives data and is handled, and FPGA controls mechanical arm and completes to write.
2. a kind of working method of mechanical arm according to claim 1, which is characterized in that the mechanical arm initial method Include:
Establish the communication connection between FPGA and mechanical arm;
The FPGA judges whether the freedom degree number of mechanical arm meets writing and require, and corresponding initial according to freedom degree selection Change process;
The initialization of mechanical arm is completed by the initialization process.
3. a kind of working method of mechanical arm according to claim 2, which is characterized in that the freedom degree number be greater than etc. In 4.
4. a kind of working method of mechanical arm according to claim 2, which is characterized in that the mechanical arm initial method It specifically includes: FPGA electrification reset;Detection general-purpose interface judges whether the freedom degree number of mechanical arm meets the requirements;Selection is suitable Initialization scheme;FPGA receives feedback and post-processes and export initial signal, carries out initialization procedure to mechanical arm.
5. a kind of working method of mechanical arm according to claim 1, which is characterized in that the writing data creation method Include:
Character is inputted in the host computer;
The host computer is according to character stroke acquisition order pixel;
Obtain the polar coordinates information and specific information symbol of each pixel;
The data packet of the character is generated according to polar coordinates information and specific information symbol;
The specific information symbol includes the pause of character stroke and empties position.
6. a kind of working method of mechanical arm according to claim 5, which is characterized in that the packet in the data packet It includes: the position of total length of data, the sequencing of coordinate information and specific information symbol.
7. a kind of working method of mechanical arm according to claim 1, which is characterized in that the data processing method is such as Under;
The FPGA identifies data characteristics and completes parsing in inside, obtains the polar coordinates of series of pixel point;
Judge polar reasonability;
Polar coordinates are converted to the square-wave signal of control mechanical arm.
8. a kind of working method of mechanical arm according to claim 1, which is characterized in that
The host computer includes mobile phone and PC;The mechanical arm includes that Cartesian robot arm, circular cylindrical coordinate machinery arm and pole are sat Mark mechanical arm.
9. a kind of working method of mechanical arm according to claim 1, which is characterized in that the end of the mechanical arm is fixed There is writing pen.
CN201910216576.4A 2019-03-20 2019-03-20 A kind of working method of mechanical arm Pending CN109773796A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910216576.4A CN109773796A (en) 2019-03-20 2019-03-20 A kind of working method of mechanical arm

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910216576.4A CN109773796A (en) 2019-03-20 2019-03-20 A kind of working method of mechanical arm

Publications (1)

Publication Number Publication Date
CN109773796A true CN109773796A (en) 2019-05-21

Family

ID=66490142

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910216576.4A Pending CN109773796A (en) 2019-03-20 2019-03-20 A kind of working method of mechanical arm

Country Status (1)

Country Link
CN (1) CN109773796A (en)

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61100386A (en) * 1984-10-23 1986-05-19 松下電器産業株式会社 Writing brush drawing method
CN101162389A (en) * 2007-08-07 2008-04-16 广西工学院 Universal small-sized programmable controller and control method thereof
CN101524677A (en) * 2009-01-09 2009-09-09 成都广泰实业有限公司 Eight-axis six-linkage spray coater control system
CN203031609U (en) * 2012-12-19 2013-07-03 西安理工大学 Robot capable of imitating writing of person
CN104050468A (en) * 2013-03-11 2014-09-17 日电(中国)有限公司 Handwriting identification method, device and system
CN104669277A (en) * 2015-03-11 2015-06-03 宿州学院 Double-arm writing robot and control method thereof
CN104875208A (en) * 2015-06-11 2015-09-02 赵楠 Calligraphy robot
CN106292543A (en) * 2015-05-14 2017-01-04 宁波舜宇光电信息有限公司 Multi-axis motion controller based on FPGA and application thereof
CN107088882A (en) * 2017-06-18 2017-08-25 闾天驰 Robot humanoid handwriting system and its control method
CN207127895U (en) * 2017-07-25 2018-03-23 杭州安脉盛智能技术有限公司 Industrial robot equipment data acquisition analyzing
CN108348945A (en) * 2015-10-15 2018-07-31 桑福德有限合伙人公司 The object mechanically reproduced is generated from numeral input
CN108460347A (en) * 2018-02-12 2018-08-28 中国民航大学 A kind of paper is united subsystem automatically
CN108500967A (en) * 2018-05-05 2018-09-07 深圳市越疆科技有限公司 Control method, modular articulated robot and storage medium
CN108818565A (en) * 2018-07-20 2018-11-16 深圳市幻尔科技有限公司 A kind of control method and system that the mechanical arm that writes writes

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61100386A (en) * 1984-10-23 1986-05-19 松下電器産業株式会社 Writing brush drawing method
CN101162389A (en) * 2007-08-07 2008-04-16 广西工学院 Universal small-sized programmable controller and control method thereof
CN101524677A (en) * 2009-01-09 2009-09-09 成都广泰实业有限公司 Eight-axis six-linkage spray coater control system
CN203031609U (en) * 2012-12-19 2013-07-03 西安理工大学 Robot capable of imitating writing of person
CN104050468A (en) * 2013-03-11 2014-09-17 日电(中国)有限公司 Handwriting identification method, device and system
CN104669277A (en) * 2015-03-11 2015-06-03 宿州学院 Double-arm writing robot and control method thereof
CN106292543A (en) * 2015-05-14 2017-01-04 宁波舜宇光电信息有限公司 Multi-axis motion controller based on FPGA and application thereof
CN104875208A (en) * 2015-06-11 2015-09-02 赵楠 Calligraphy robot
CN108348945A (en) * 2015-10-15 2018-07-31 桑福德有限合伙人公司 The object mechanically reproduced is generated from numeral input
CN107088882A (en) * 2017-06-18 2017-08-25 闾天驰 Robot humanoid handwriting system and its control method
CN207127895U (en) * 2017-07-25 2018-03-23 杭州安脉盛智能技术有限公司 Industrial robot equipment data acquisition analyzing
CN108460347A (en) * 2018-02-12 2018-08-28 中国民航大学 A kind of paper is united subsystem automatically
CN108500967A (en) * 2018-05-05 2018-09-07 深圳市越疆科技有限公司 Control method, modular articulated robot and storage medium
CN108818565A (en) * 2018-07-20 2018-11-16 深圳市幻尔科技有限公司 A kind of control method and system that the mechanical arm that writes writes

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
黄昕龙等: ""基于FPGA的开放式数控***硬件配置设计"", 《电气与自动化》 *

Similar Documents

Publication Publication Date Title
CN104385787B (en) A kind of control method of laser marking machine and laser marking machine
CN108234614A (en) A kind of exchange method based on custom protocol and Netty frames
CN102075389B (en) Debugging method and equipment
CN102945088B (en) Realize the method for terminal simulation mouse action equipment, device and mobile terminal
CN103324348A (en) Windows desktop control method based on intelligent mobile terminals
US11850747B2 (en) Action imitation method and robot and computer readable medium using the same
CN203945816U (en) The print scanned brush of portable hand-held
CN100409200C (en) Method for implementing real-time monitoring performance information of embedded operating system
CN104142876A (en) Function verification method and verification environmental platform for USB (universal serial bus) equipment controller modules
CN107199566A (en) A kind of remote control system of the space-oriented station robot based on virtual arm
CN109514555A (en) Command interaction method, robot demonstrator, robot controller and storage medium
WO2019184057A1 (en) Student terminal and interactive classroom question answering system
CN105487403A (en) Establishment of motion control system based on CAN and simulation modeling method
CN106533621B (en) The means of communication of permanent magnet synchronous motor real time monitoring based on simplified MODBUS agreement
CN109773796A (en) A kind of working method of mechanical arm
CN106452679B (en) Robot development system and communication method thereof
CN103149909A (en) Field programmable gate array (FPGA)-based controller area network (CAN) simulation node system
CN106648614A (en) Modular platform-based robot development system architecture and main control unit thereof
CN107102729A (en) A kind of PPT Demonstration Control Systems based on CSI gesture identifications
CN110053046A (en) Robot control method and its system based on customized event
CN202075605U (en) Local area network type intelligent automatic step control device of CAN (controller area network) field bus structure
CN206021633U (en) classroom interaction networking control system based on wireless technology
CN111245686B (en) Command vehicle system node monomer detection and diagnosis equipment
CN102455969B (en) Method for recording Linux serial communication log
CN104516547B (en) A kind of control method and electronic equipment

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20190521

RJ01 Rejection of invention patent application after publication