CN106338994A - Greenhouse logistics plant protection robot control system and method - Google Patents

Greenhouse logistics plant protection robot control system and method Download PDF

Info

Publication number
CN106338994A
CN106338994A CN201610887534.XA CN201610887534A CN106338994A CN 106338994 A CN106338994 A CN 106338994A CN 201610887534 A CN201610887534 A CN 201610887534A CN 106338994 A CN106338994 A CN 106338994A
Authority
CN
China
Prior art keywords
robot
unit
parameter
chip microcomputer
greenhouse
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201610887534.XA
Other languages
Chinese (zh)
Other versions
CN106338994B (en
Inventor
刘雪美
陈宝林
李扬
苑进
张晓辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shandong Agricultural University
Original Assignee
Shandong Agricultural 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 Shandong Agricultural University filed Critical Shandong Agricultural University
Priority to CN201610887534.XA priority Critical patent/CN106338994B/en
Publication of CN106338994A publication Critical patent/CN106338994A/en
Application granted granted Critical
Publication of CN106338994B publication Critical patent/CN106338994B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01GHORTICULTURE; CULTIVATION OF VEGETABLES, FLOWERS, RICE, FRUIT, VINES, HOPS OR SEAWEED; FORESTRY; WATERING
    • A01G25/00Watering gardens, fields, sports grounds or the like
    • A01G25/02Watering arrangements located above the soil which make use of perforated pipe-lines or pipe-lines with dispensing fittings, e.g. for drip irrigation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/04Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/042Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Water Supply & Treatment (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Environmental Sciences (AREA)
  • Soil Sciences (AREA)
  • Catching Or Destruction (AREA)

Abstract

The invention discloses a greenhouse logistics plant protection robot control system. The technical scheme employed by the system is that the greenhouse logistics plant protection robot control system comprises an operation parameter configuration system, a detection system and a control system. The operation parameter configuration system generates logistics plant protection robot operation parameter sets suitable for different growth periods in different crop plantation modes at a server end; the detection system feeds detection data back to a single-chip microcomputer through sensors so as to form a closed-loop control system; and the control system mainly processes data information sent by the sensors and mobile phones and completes spray operation or logistics transportation through control of the single-chip microcomputer. The invention provides a greenhouse logistics plant protection robot control method. Remote configuration of operation parameters corresponding to a spray mode or a logistics mode is realized, a greenhouse logistics plant protection robot is controlled to complete the spray operation or the logistics transportation, and position information and a current working condition of the greenhouse logistics plant protection robot are displayed in real time through an electronic map interface in control software of mobile phone client.

Description

A kind of greenhouse logistics plant protection robot control system and method
Technical field
The invention belongs to agricultural mechanical field is and in particular to a kind of greenhouse logistics plant protection robot control system and method, Complete to transport based on pinpoint spraying operation and material in heliogreenhouse, realize intelligent, lighting and Automated condtrol.
Background technology
China is industrialized agriculture big producing country, and area and yield are sure to occupy first place in the world, and green house sets as China Apply the main body of agricultural industry, become most effective industry in agricultural planting in recent years.Plant growing has been broken in its appearance Region and space-time boundary, be vegetable dull season supply, energy saving, promote agricultural sector structure adjustment etc. to be made that historic tribute Offer.With the fast development of heliogreenhouse, the equipment for plant protection of vegetable in greenhouse, transport vehicle have become as the focus of development.
On the one hand, the preventing and treating of current facilities vegetable pest and disease damage is mainly completed by spraying medicine, traditional spraying in greenhouse Mode, such as knapsack sprayer, power driven mist blower whole process need manpower to participate in, and efficiency is low, wastes time and energy, simultaneously greenhouse spraying operation Big to human body infringement.Because in greenhouse, long-term cropping species is various, and the density degree of different growing stages crop is different, therefore will The essence realizing spraying operation quantifies to need the work pattern of spraying is control effectively with precision dispenser.
On the other hand, the logistics carriage development in greenhouse is relatively slower, and existing logistics trolley exists and cannot accurately determine The problems such as position and automatic running, mostly need to manually control direction, speed and the stop position that it is advanced, lavish labor on, material Transport has become one of laborious production link of work consuming in greenhouse.
Therefore, not high for the mechanization of greenhouse spraying and logistics transportation equipment presence, automaticity, by topographic space Limit, the problems such as effect difference, in the urgent need to inventing a kind of greenhouse logistics plant protection robot control system and method, to complete daylight It is based on pinpoint spraying operation in greenhouse and material transports, realize intellectuality, lighting, essence quantization and Automated condtrol.
Content of the invention
In order to solve problem present in the spraying of sunlight indoor crops and material transportation, the invention provides a kind of greenhouse Logistics plant protection robot control system and method, realize Remote configuration spray pattern or the corresponding job parameter of logistic pattern, control Greenhouse logistics plant protection robot processed completes spraying operation or logistics transportation, and by the electronics in the control software of cell-phone customer terminal Map interface shows positional information and the present behavior of greenhouse logistics plant protection robot in real time.
The technical scheme that a kind of logistics plant protection robot control system in greenhouse of the present invention is adopted: include job parameter configuration System, detecting system and control system.Described job parameter configuration system, generates Different Crop cropping pattern in server end In the suitable logistics plant protection robot job parameter collection of different growing stages;Described detecting system, will detect number by sensor According to feeding back to single-chip microcomputer, constitute the control system of a closed loop;Described control system, main process sensor and mobile phone are sent out The data message sent, and spraying operation or logistics transportation are completed by the control of single-chip microcomputer.
Described job parameter configuration system includes spray pattern parameter configuration and logistic pattern parameter configuration.Described spray Mist mode parameter configures: the related chamber operation parameter of exploitation calculates pc machine software, and operator input in greenhouse on pc machine The parameter directly perceived obtaining, calculates, by pc machine software, the parameter that single-chip microcomputer can identify automatically.Obtain in its medium temperature chamber is straight See the height degree that parameter includes plant type, density degree, the size of blade, plant strain growth;Needed for logistics plant protection robot Job parameter collection include: robot gait of march, mist flow, blower fan wind rotating speed, luffing angle, luffing speed, angle of revolution Degree, speed of gyration.In greenhouse, plant type is divided into dense planting green vegetable and two kinds from wall type fruit and vegerable Planting Patterns, thus spraying square Formula is divided into dense planting green vegetable plantation spray pattern and plants spray pattern from wall type fruit and vegerable.
Dense planting green vegetable plantation spray pattern under, scalable robot gait of march, uninterrupted, wind-force size, Luffing angle, luffing speed, angle of revolution, speed of gyration, realize planting class to dense planting green vegetable while robot advances Type completes spraying operation, shows the current location information of robot in real time by mobile phone electronic map, and by electronic chart The color of spraying row becomes red display spraying performance by green.Operator are on the pc machine being provided with parameter software for calculation After |input paramete, pc machine application program exports the discernible parameter of single-chip microcomputer automatically by following computing formula.
vrobot=∫ 1/dxdx (10 > x > 0)
In above formula, vrobotFor the gait of march of robot, unit is m/s;D is the density degree of leaf it is recommended that value 3~8; X is robot forward acceleration constant, and unit is m/s2.
θh=((θ_r_l)/2π+l/r)×kh
In above formula, θhFor the angle of robotic spray apparatus revolution, unit is rad;θ_rFor line and advance side of robot To angle, wherein line is the line of the point of point and two row centre position near-ends of the right row distalmost end, and unit is to spend;θ_lFor Line and the angle of robot direction of advance, wherein line are the point of left line distalmost end and the point of two row centre position near-ends Line, unit is degree;L is row length, and unit is m;R is the distance of robot to row near-end, and unit is m;khFor corrected parameter, push away Recommend 1.1~1.3.
θv=((θ_up_down)/2π+h/r)×kv
In above formula, θvFor the angle of robotic spray apparatus pitching, unit is rad;θ_upFor the angle of line and ground, Wherein line is the line with robot barycenter for the point of plant canopy of plant row most proximal end, and unit is degree;θ_downFor line with The angle on ground, wherein line are the line with robot barycenter for the point of plant root of plant row distalmost end, and unit is degree;h For robot barycenter height from the ground, unit is m;R is the distance of robot to row near-end, and unit is m;kvFor revising ginseng Number is it is recommended that 0.8~1.2.
vh-rotation=d × θh/t
In above formula, vh-rotationFor speed of gyration, unit is rad/s;The density degree of d leaf is it is recommended that value 2~8;θhFor The angle of robotic spray apparatus revolution, unit is rad;T is time constant, and unit is s it is recommended that 40~60.
vv-rotation=d × θv/t
In above formula, vv-rotationFor luffing speed, unit is rad/s;The density degree of d leaf is it is recommended that value 2~8;θvFor The angle of robotic spray apparatus pitching, unit is rad;T is time constant, and unit is s it is recommended that 40~60.
Q=s × v ∫ 1/ (t+1) dt × s
In above formula, q is the size of flow, and unit is l/min;S is the sectional area of pipeline, and unit is dm2;V is flow velocity, single Position is m/s, and t is the coefficient of flow, and t starts to increase from 0.5;S is the size of blade, and unit is dm2It is recommended that 0.3~1.5.
vwindow-scale=d × (2- θh×θv)/t2+kw
In above formula, vwind-scaleFor the size of wind-force, unit is m/s;The density degree of d leaf is it is recommended that value 2~8;θhFor The angle of robotic spray apparatus revolution, unit is rad;θvFor the angle of robotic spray apparatus pitching, unit is rad;T is Time constant, unit is s it is recommended that 40~60;kwFor corrected parameter it is recommended that 2~4.
Under wall type fruit and vegerable plantation spray pattern, control machine People's Bank of China to enter to reach specified location, control uninterrupted, wind Power size, luffing angle, luffing speed, angle of revolution, speed of gyration, realize reaching and specify spraying row to complete from wall type fruit and vegerable kind Plant the accurate spraying operation of type, show the current location information of robot by mobile phone electronic map in real time, and pass through electronics Capable color of spraying on map becomes red display spraying performance by green.Carrying out practically parametric mathematical model is as follows:
vrobot={ 0, v, 0, v... }
In above formula, vrobotFor the gait of march of robot, unit is m/s;Due to needing from wall type fruit and vegerable Planting Patterns In the ranks pinpointed spraying, speed adopts discrete type mathematical model, wherein v is constant, scope 0~2.
The calculating of other specification is similar with calculating under dense planting green vegetable plantation spray pattern, is not repeating.
The parameter configuration of logistic pattern: the related chamber operation parameter of exploitation calculates pc machine software, and operator are in pc machine The parameter directly perceived obtaining in upper input greenhouse, calculates, by pc machine software, the parameter that single-chip microcomputer can identify automatically, wherein temperature The parameter directly perceived of indoor acquisition includes the weight of material to be carried, carrying position;The parameter that single-chip microcomputer can identify includes: machine The speed of people's traveling, robot stop position.The stop position of greenhouse logistics plant protection robot is exactly the carrying position of parameter input Put, directly transmission range in pc machine software.
vrobot=200/m+ldis/t
In above formula, vrobotFor the gait of march of robot, unit is m/s;M is the weight of carrying material, and unit is kg; ldisFor the distance of carrying, unit is m;T is to estimate handling time, and unit is s it is recommended that 30~240.
Described detecting system includes: position and speed detector, flow detection, wind detection device, luffing angle Detection means, residual drug detection means with the detection means, angle of revolution and speed of speed.Described position and speed inspection Survey device and adopt existing technology for example: radar fix, gps positioning, laser ranging positioning, encoder are tested the speed, agv intelligent carriage Positioning mode etc., corresponding module cooperation single-chip microcomputer is installed using these technology and uses, realize in robot in greenhouse Positioning;Described flow detection, installs effusion meter on robot liquor piping, will be monitored by way of 485 buses Flow information is sent to single-chip microcomputer;Described wind detection device is installation speed measuring coder in the rotary shaft of blower fan, coding The pulse information detecting is sent to single-chip microcomputer by way of Differential Input by device, can be obtained according to the change of blower fan axle speed size Change to wind-force;The detection means of described luffing angle and speed installs Hall angular transducer on pitch axis, and leads to Cross gpio mouth to be connected with single-chip microcomputer, the information detecting is delivered to single-chip microcomputer by gpio oral instructions;Described angle of revolution and The detection means of speed installs Hall angular transducer on gyroaxis, and is connected with single-chip microcomputer by gpio mouth, will detect To information deliver to single-chip microcomputer by gpio oral instructions;Described residual drug detection means installs a pressure in the lower section of medicinal liquor barrel Force transducer, pressure transducer detects the change of dose, detection information is inputted to a/d modular converter, a/d module will be changed The digital signal completing is sent to single-chip microcomputer.
Described control system include pc machine parameter software for calculation, mobile phone control software, single-chip microcomputer, power supply and other outside Enclose controller.Described pc machine parameter software for calculation, is calculated thus being obtained the discernible ginseng of single-chip microcomputer to the parameter of input The parameter converting is sent to the Internet according to certain data form packing by number simultaneously;Described mobile phone control software Receive the packet that pc machine is sent to the Internet, and packet is sent to by single-chip microcomputer by router, furthermore list can be received The data that piece machine feeds back, electric map module in mobile phone control software for the data of feedback is processed, thus real When show the current position of robot and handling situations, wherein, the formation basic theory of greenhouse electronic chart be will greenhouse ground condition (temperature Room size, plantation row distribution) parameter is written as one and can change txt text, and corresponding text parameter is set according to current greenhouse, leads Enter cell phone software thus forming the electronic chart in current greenhouse;Described single-chip microcomputer selects high-performance stm32 of arm3 series mono- Piece machine;Preferentially the power supply from 24v, 5v direct current is powered described power supply to single-chip microcomputer, other peripheral controllers etc.;Described Other peripheral controllers include motor driver, wireless communication module, pump controller, fan driver etc., wherein wireless telecommunications Module has wireless router and wifi to turn serial ports submodule for the data transfer between single-chip microcomputer and mobile phone.
Present invention also offers a kind of control method of greenhouse logistics plant protection robot controller, comprise the steps:
1) operator obtain intuitively parameter in pc generator terminal input greenhouse, the corresponding computed in software developed by pc machine Afterwards, computed information is sent to network.
2) open mobile phone control software, receive pc machine and be sent to the data on network;Start greenhouse logistics plant protection robot, By way of wireless wifi transmission signal, complete the connection of mobile phone and single-chip microcomputer.
3) it is currently needed for according to greenhouse, logistic pattern or spray pattern are selected on mobile phone, the packet obtaining is sent To single-chip microcomputer.
4) single-chip microcomputer receives the information that mobile phone control software sends, and proceeds by the spraying operation in greenhouse or thing Stream operation, all the sensors are in running order simultaneously, and by the feedback of the information detecting to single-chip microcomputer, single-chip microcomputer is according to feedback letter Breath carries out the adjustment of attitude automatically, forms the control system of closed loop, realizes automatically controlling;Robot location is believed by single-chip microcomputer simultaneously Breath and working condition sent to mobile phone by router, and on mobile phone in the way of electronic chart Dynamic Announce.
5) after fulfiling assignment, operator's operating handset software, control robot to move to home position by operating position, Closing machine people's power supply.
Beneficial effects of the present invention:
1) present invention adopts mobile phone control, high degree of automation, saves a large amount of labour forces.
2) present invention, using self-propelled, need not manually directly participate in spraying, it is to avoid people's medicine can not isolate the life wound causing Evil.
3) present invention can on cell phone map the position of Real-time Feedback current robot, work state information, positioning precision Height, conveniently controls it.
4) enter the automatic calculating of line parameter using pc machine, parameter modification is convenient, simple, improves computational efficiency.
5) present configuration is simple, and easy to operate, high working efficiency is suitable for being sprayed and hauling operation in greenhouse.
Brief description
Fig. 1 is job parameter configuration systematic schematic diagram;
Fig. 2 is detecting system schematic diagram;
Fig. 3 is control system schematic diagram;
Fig. 4 is main interface and the locating and displaying surface chart of cell phone software;
Fig. 5 is that spray operations are illustrated;
Fig. 6 is the workflow diagram of greenhouse logistics plant protection robot;
Specific embodiment:
Below in conjunction with the accompanying drawings patent of the present invention is described further.A kind of greenhouse logistics plant protection machine of the present invention People's control system and method, control device includes: includes job parameter configuration system, detecting system and control system.As Fig. 1 institute Show, described job parameter configures the parameter configuration that system includes spray pattern and logistic pattern.Spray pattern parameter configuration: open Send out related chamber operation parameter and calculate pc machine software, operator input the parameter directly perceived obtaining in greenhouse on pc machine, lead to Cross pc machine software and automatically calculate the parameter that single-chip microcomputer can identify.The parameter directly perceived obtaining in its medium temperature chamber includes plant class Type, density degree, the size of blade, the height degree of plant strain growth;The parameter that single-chip microcomputer can identify includes: robot advances Speed, uninterrupted, wind-force size, luffing angle, luffing speed, angle of revolution, speed of gyration.In greenhouse, plant type is divided into Dense planting green vegetable and two kinds from wall type fruit and vegerable Planting Patterns, thus spray pattern is divided into dense planting green vegetable plantation spray pattern Plant spray pattern with from wall type fruit and vegerable.Under dense planting green vegetable plantation spray pattern, scalable robot gait of march, stream Amount size, wind-force size, luffing angle, luffing speed, angle of revolution, speed of gyration, realize while robot advances to close Plant green vegetable Planting Patterns and complete spraying operation, show the current location information of robot by mobile phone electronic map in real time, And red display spraying performance is become by green by capable color of spraying on electronic chart.Operator are being provided with parameter After |input paramete on the pc machine of software for calculation, pc machine application program is discernible automatically by following computing formula output single-chip microcomputer Parameter.vrobotIn=∫ 1/dxdx (10 > x > 0) formula, vrobotFor the gait of march of robot, unit is m/s;D is dredging of leaf Close degree is it is recommended that value 3~8;X is robot forward acceleration constant, and unit is m/s2.
θh=((θ_r_l)/2π+l/r)×khIn formula, θhFor the angle of robotic spray apparatus revolution, unit is rad; θ_rFor the angle of line and robot direction of advance, wherein line is point and the two row centre position near-ends of the right row distalmost end The line of point, unit is degree;θ_lFor the angle of line and robot direction of advance, wherein line be left line distalmost end point with The line of the point of two row centre position near-ends, unit is degree;L is row length, and unit is m;R is the distance of robot to row near-end, Unit is m;khFor corrected parameter it is recommended that 1.1~1.3.
θv=((θ_up_down)/2π+h/r)×kvIn formula, θvFor the angle of robotic spray apparatus pitching, unit is rad;θ_upFor the angle of line and ground, wherein line is the point of plant canopy and the robot barycenter of plant row most proximal end Line, unit is degree;θ_downFor the angle of line and ground, wherein line is the point of plant root and the machine of plant row distalmost end The line of device people's barycenter, unit is degree;H is robot barycenter height from the ground, and unit is m;R is for robot to row near-end Distance, unit is m;kvFor corrected parameter it is recommended that 0.8~1.2.
vh-rotation=d × θhIn/t formula, vh-rotationFor speed of gyration, unit is rad/s;The density degree of d leaf, Recommendation 2~8;θhFor the angle of robotic spray apparatus revolution, unit is rad;T is time constant, and unit is s it is recommended that 40 ~60.vv-rotation=d × θvIn/t formula, vv-rotationFor luffing speed, unit is rad/s;The density degree of d leaf it is recommended that Value 2~8;θvFor the angle of robotic spray apparatus pitching, unit is rad;T is time constant, and unit is s it is recommended that 40~60. In q=s × v ∫ 1/ (t+1) dt × s formula, q is the size of flow, and unit is l/min;S is the sectional area of pipeline, and unit is dm2; V is flow velocity, and unit is m/s, and t is the coefficient of flow, and t starts to increase from 0.5;S is the size of blade, and unit is dm2It is recommended that 0.3~1.5.
vwindow-scale=d × (2- θh×θv)/t2+kwIn formula, vwind-scaleFor the size of wind-force, unit is m/s;D leaf Density degree it is recommended that value 2~8;θhFor the angle of robotic spray apparatus revolution, unit is rad;θvFor robotic spray's dress Put the angle of pitching, unit is rad;T is time constant, and unit is s it is recommended that 40~60;kwFor corrected parameter it is recommended that 2~4.
Under wall type fruit and vegerable plantation spray pattern, control machine People's Bank of China to enter to reach specified location, control uninterrupted, wind Power size, luffing angle, luffing speed, angle of revolution, speed of gyration, realize reaching and specify spraying row to complete from wall type fruit and vegerable kind Plant the accurate spraying operation of type, show the current location information of robot by mobile phone electronic map in real time, and pass through electronics Capable color of spraying on map becomes red display spraying performance by green.Carrying out practically parametric mathematical model is as follows:
vrobotIn the formula of={ 0, v, 0, v... }, vrobotFor the gait of march of robot, unit is m/s;Due to from wall type Fruit and vegerable Planting Patterns need in the ranks to be pinpointed spraying, and speed adopts discrete type mathematical model, and wherein v is constant, scope 0~2.
The calculating of other specification is similar with calculating under dense planting green vegetable plantation spray pattern, is not repeating.
The parameter configuration of logistic pattern: the related chamber operation parameter of exploitation calculates pc machine software, and operator are in pc machine The parameter directly perceived obtaining in upper input greenhouse, calculates, by pc machine software, the parameter that single-chip microcomputer can identify automatically, wherein temperature The parameter directly perceived of indoor acquisition includes the weight of material to be carried, carrying position;The parameter that single-chip microcomputer can identify includes: machine The speed of people's traveling, robot stop position.The stop position of greenhouse logistics plant protection robot is exactly the carrying position of parameter input Put, directly transmission range in pc machine software.
vrobot=200/m+ldisIn/t formula, vrobotFor the gait of march of robot, unit is m/s;M is carrying material Weight, unit is kg;ldisFor the distance of carrying, unit is m;T is to estimate handling time, and unit is s it is recommended that 30~240.
As shown in Fig. 2 described detecting system includes: position and speed detector, flow detection, wind-force detection dress Put, the detection means of detection means, angle of revolution and speed of luffing angle and speed, residual drug detection means.Described Position and speed detector adopt existing technology for example: radar fix, gps positioning, laser ranging positioning, encoder are surveyed Speed, positioning mode of agv intelligent carriage etc., install corresponding module cooperation single-chip microcomputer using these technology and use, realize in machine Positioning in greenhouse for the device people;Described flow detection, installs effusion meter, by 485 buses on robot liquor piping The flow information monitoring is sent to single-chip microcomputer by mode;Described wind detection device is to install to survey in the rotary shaft of blower fan Fast encoder, the pulse information detecting is sent to single-chip microcomputer by way of Differential Input by encoder, according to blower fan axle speed The change of size can get the change of wind-force;The detection means of described luffing angle and speed installs Hall angle on pitch axis Degree sensor, and be connected with single-chip microcomputer by gpio mouth, the information detecting is delivered to single-chip microcomputer by gpio oral instructions;Described Angle of revolution and the detection means of speed on gyroaxis, Hall angular transducer is installed, and pass through gpio mouth and single-chip microcomputer phase Connect, the information detecting is delivered to single-chip microcomputer by gpio oral instructions;Described residual drug detection means is under medicinal liquor barrel A pressure transducer is installed by side, and pressure transducer detects the change of dose, detection information is inputted to a/d modular converter, The digital signal converting is sent to single-chip microcomputer by a/d module.
As shown in figure 3, described control system includes pc machine parameter software for calculation, mobile phone control software, single-chip microcomputer, power supply And other peripheral controllers.Described pc machine parameter software for calculation, is calculated thus being obtained single-chip microcomputer to the parameter of input The parameter converting is sent to the Internet according to certain data form packing by discernible parameter simultaneously;Described handss Machine control software receives the packet that pc machine is sent to the Internet, and by router, packet is sent to single-chip microcomputer, furthermore The data that singlechip feedbsck is returned can be received, by the data of feedback at the electric map module in mobile phone control software Reason, thus showing the current position of robot and handling situations in real time, wherein, the formation basic theory of greenhouse electronic chart is by greenhouse Ground condition (greenhouse size, plantation row distribution) parameter be written as one and can change txt text, corresponding literary composition is set according to current greenhouse This parameter, imports cell phone software thus forming the electronic chart in current greenhouse;The high property of arm3 series selected by described single-chip microcomputer Can stm32 single-chip microcomputer;Preferentially the power supply from 24v, 5v direct current supplies described power supply to single-chip microcomputer, other peripheral controllers etc. Electricity;Other described peripheral controllers include motor driver, wireless communication module, pump controller, fan driver etc., wherein Wireless communication module has wireless router and wifi to turn serial ports submodule for the data transfer between single-chip microcomputer and mobile phone.
As shown in figure 4, the main interface of described cell phone software and locating and displaying interface, mobile phone main interface includes network connection With two parts of model selection, network connection is the ip wireless connection corresponding with mobile phone that wifi turns serial ports submodule, and network is true The selection of row mode after recognizing connection, is entered according to chamber operation, the invention provides the selection of logistic pattern and spray pattern.Positioning Interface includes current greenhouse map and two parts of spraying machine current location information.
As shown in figure 5, described spray operations are illustrated, under spray pattern, sprayer unit carries out revolution and two fortune of pitching Dynamic, before and after chassis is carried out and start and stop campaign, complete the spraying operation to object of spraying.
As shown in fig. 6, a kind of control method of greenhouse logistics plant protection robot controller, comprise the steps:
3) operator obtain intuitively parameter in pc generator terminal input greenhouse, the corresponding computed in software developed by pc machine Afterwards, computed information is sent to network.
4) open mobile phone control software, receive pc machine and be sent to the data on network;Start greenhouse logistics plant protection robot, By way of wireless wifi transmission signal, complete the connection of mobile phone and single-chip microcomputer.
3) it is currently needed for according to greenhouse, logistic pattern or spray pattern are selected on mobile phone, the packet obtaining is sent To single-chip microcomputer.
4) single-chip microcomputer receives the information that mobile phone control software sends, and proceeds by the spraying operation in greenhouse or thing Stream operation, all the sensors are in running order simultaneously, and by the feedback of the information detecting to single-chip microcomputer, single-chip microcomputer is according to feedback letter Breath carries out the adjustment of attitude automatically, forms the control system of closed loop, realizes automatically controlling;Robot location is believed by single-chip microcomputer simultaneously Breath and working condition sent to mobile phone by router, and on mobile phone in the way of electronic chart Dynamic Announce.
5) after fulfiling assignment, operator's operating handset software, control robot to move to home position by operating position, Closing machine people's power supply.

Claims (2)

1. a kind of greenhouse logistics plant protection robot control system is it is characterised in that include: job parameter configuration system, detecting system And control system;Described job parameter configuration system, generates Different Crop cropping pattern in different growing stages in server end Suitable logistics plant protection robot job parameter collection;Detection data is fed back to monolithic by sensor by described detecting system Machine, constitutes the control system of a closed loop;The data letter that described control system, main process sensor and mobile phone send Breath, and spraying operation or logistics transportation are completed by the control of single-chip microcomputer;
Described job parameter configuration system includes spray pattern parameter configuration and logistic pattern parameter configuration;Described spraying mould Formula parameter configuration: the related chamber operation parameter of exploitation calculates pc machine software, and operator input on pc machine in greenhouse and obtain Parameter directly perceived, the parameter that single-chip microcomputer can identify automatically is calculated by pc machine software;The ginseng directly perceived obtaining in its medium temperature chamber Number includes the height degree of plant type, density degree, the size of blade, plant strain growth;Work needed for logistics plant protection robot Industry parameter set includes: robot gait of march, mist flow, blower fan wind rotating speed, luffing angle, luffing speed, angle of revolution, return Rotary speed;In greenhouse, plant type is divided into dense planting green vegetable and two kinds from wall type fruit and vegerable Planting Patterns, thus spray pattern divides Plant spray pattern for dense planting green vegetable and from wall type fruit and vegerable plantation spray pattern;
Under dense planting green vegetable plantation spray pattern, scalable robot gait of march, uninterrupted, wind-force size, pitching Angle, luffing speed, angle of revolution, speed of gyration, realize complete to dense planting green vegetable Planting Patterns while robot advances Become spraying operation, show the current location information of robot by mobile phone electronic map in real time, and by spraying on electronic chart The color of row becomes red display spraying performance by green;Operator input on the pc machine be provided with parameter software for calculation After parameter, pc machine application program exports the discernible parameter of single-chip microcomputer automatically by following computing formula;
vrobot=∫ 1/dxdx (10 > x > 0)
In above formula, vrobotFor the gait of march of robot, unit is m/s;D is the density degree of leaf it is recommended that value 3~8;X is Robot forward acceleration constant, unit is m/s2
θh=((θ_r_l)/2π+l/r)×kh
In above formula, θhFor the angle of robotic spray apparatus revolution, unit is rad;θ_rFor line and robot direction of advance Angle, wherein line are the line of the point of point and two row centre position near-ends of the right row distalmost end, and unit is to spend;θ_lFor line With the angle of robot direction of advance, wherein line is the company of the point of the point of left line distalmost end and two row centre position near-ends Line, unit is degree;L is row length, and unit is m;R is the distance of robot to row near-end, and unit is m;khFor corrected parameter it is recommended that 1.1~1.3;
θv=((θ_up_down)/2π+h/r)×kv
In above formula, θvFor the angle of robotic spray apparatus pitching, unit is rad;θ_upFor the angle of line and ground, wherein connect Line is the line with robot barycenter for the point of plant canopy of plant row most proximal end, and unit is degree;θ_downFor line and ground Angle, wherein line are the line with robot barycenter for the point of plant root of plant row distalmost end, and unit is degree;H is machine People's barycenter height from the ground, unit is m;R is the distance of robot to row near-end, and unit is m;kvFor corrected parameter it is recommended that 0.8~1.2;
vh-rotation=d × θh/t
In above formula, vh-rotationFor speed of gyration, unit is rad/s;The density degree of d leaf is it is recommended that value 2~8;θhFor machine The angle of people's sprayer unit revolution, unit is rad;T is time constant, and unit is s it is recommended that 40~60;
vv-rotation=d × θv/t
In above formula, vv-rotationFor luffing speed, unit is rad/s;The density degree of d leaf is it is recommended that value 2~8;θvFor machine The angle of people's sprayer unit pitching, unit is rad;T is time constant, and unit is s it is recommended that 40~60;
Q=s × v ∫ 1/ (t+1) dt × s
In above formula, q is the size of flow, and unit is l/min;S is the sectional area of pipeline, and unit is dm2;V is flow velocity, and unit is M/s, t are the coefficient of flow, and t starts to increase from 0.5;S is the size of blade, and unit is dm2It is recommended that 0.3~1.5;
vwindow-scale=d × (2- θh×θv)/t2+kw
In above formula, vwind-scaleFor the size of wind-force, unit is m/s;The density degree of d leaf is it is recommended that value 2~8;θhFor machine The angle of people's sprayer unit revolution, unit is rad;θvFor the angle of robotic spray apparatus pitching, unit is rad;T is the time Constant, unit is s it is recommended that 40~60;kwFor corrected parameter it is recommended that 2~4;
Under wall type fruit and vegerable plantation spray pattern, control machine People's Bank of China to enter to reach specified location, control uninterrupted, wind-force big Little, luffing angle, luffing speed, angle of revolution, speed of gyration, realize reaching and specify spraying row to complete to plant class from wall type fruit and vegerable The accurate spraying operation of type, shows the current location information of robot in real time by mobile phone electronic map, and passes through electronic chart The color of upper spraying row becomes red display spraying performance by green.Carrying out practically parametric mathematical model is as follows:
vrobot={ 0, v, 0, v... }
In above formula, vrobotFor the gait of march of robot, unit is m/s;Due to needing to carry out from wall type fruit and vegerable Planting Patterns Fixed point spraying in the ranks, speed adopts discrete type mathematical model, and wherein v is constant, scope 0~2;
The calculating of other specification is similar with calculating under dense planting green vegetable plantation spray pattern, is not repeating.
The parameter configuration of logistic pattern: the related chamber operation parameter of exploitation calculates pc machine software, and operator are defeated on pc machine Enter the parameter directly perceived obtaining in greenhouse, the parameter that single-chip microcomputer can identify automatically is calculated by pc machine software, in its medium temperature chamber The parameter directly perceived obtaining includes the weight of material to be carried, carrying position;The parameter that single-chip microcomputer can identify includes: machine People's Bank of China The speed entered, robot stop position.The stop position of greenhouse logistics plant protection robot is exactly the carrying position of parameter input, directly It is connected on transmission range in pc machine software.
vrobot=200/m+ldis/t
In above formula, vrobotFor the gait of march of robot, unit is m/s;M is the weight of carrying material, and unit is kg;ldisFor The distance of carrying, unit is m;T is to estimate handling time, and unit is s it is recommended that 30~240;
Described detecting system includes: position and speed detector, flow detection, wind detection device, luffing angle and speed The detection means of detection means, angle of revolution and speed of degree, residual drug detection means.Described position and velocity measuring dress Put using existing technology for example: radar fix, gps positioning, laser ranging positioning, encoder are tested the speed, the determining of agv intelligent carriage Position mode etc., installs corresponding module cooperation single-chip microcomputer using these technology and uses, realize in robot the positioning in greenhouse; Described flow detection, installs effusion meter on robot liquor piping, is believed, by way of 485 buses, the flow monitoring Breath is sent to single-chip microcomputer;Described wind detection device is installation speed measuring coder in the rotary shaft of blower fan, and encoder will be examined The pulse information measuring is sent to single-chip microcomputer by way of Differential Input, can get wind-force according to the change of blower fan axle speed size Change;The detection means of described luffing angle and speed installs Hall angular transducer on pitch axis, and passes through gpio Mouth is connected with single-chip microcomputer, and the information detecting is delivered to single-chip microcomputer by gpio oral instructions;Described angle of revolution and speed Detection means installs Hall angular transducer on gyroaxis, and is connected with single-chip microcomputer by gpio mouth, by the letter detecting Breath delivers to single-chip microcomputer by gpio oral instructions;Described residual drug detection means installs a pressure sensing in the lower section of medicinal liquor barrel Device, pressure transducer detects the change of dose, detection information is inputted to a/d modular converter, and a/d module will convert Digital signal is sent to single-chip microcomputer;
Described control system include pc machine parameter software for calculation, mobile phone control software, single-chip microcomputer, power supply and other outer contain Device processed;Described pc machine parameter software for calculation, is calculated thus being obtained the discernible parameter of single-chip microcomputer to the parameter of input, with When the parameter converting is sent to the Internet according to certain data form packing;Described mobile phone control software receipt pc Machine is sent to the packet of the Internet, and by router, packet is sent to single-chip microcomputer, furthermore it is anti-to receive single-chip microcomputer Being fed back to the data come, electric map module in mobile phone control software for the data of feedback being processed, thus showing in real time The current position of robot and handling situations, wherein, the formation basic theory of greenhouse electronic chart is that (greenhouse is big by the ground condition in greenhouse Little, plantation row distribution) parameter is written as one and can change txt text, and corresponding text parameter is set according to current greenhouse, imports handss Machine software is thus form the electronic chart in current greenhouse;The high-performance stm32 single-chip microcomputer of arm3 series selected by described single-chip microcomputer; Preferentially the power supply from 24v, 5v direct current is powered described power supply to single-chip microcomputer, other peripheral controllers etc.;Described other Peripheral controllers includes motor driver, wireless communication module, pump controller, fan driver etc., wherein wireless communication module Wireless router and wifi is had to turn serial ports submodule for the data transfer between single-chip microcomputer and mobile phone.
2. as claimed in claim 1 a kind of control method of greenhouse logistics plant protection robot controller it is characterised in that its Control process is as follows:
1) operator pc generator terminal input greenhouse in obtain intuitively parameter, the corresponding computed in software developed by pc machine it Afterwards, computed information is sent to network;
2) open mobile phone control software, receive pc machine and be sent to the data on network;Start greenhouse logistics plant protection robot, pass through The mode of wireless wifi transmission signal, completes the connection of mobile phone and single-chip microcomputer;
3) it is currently needed for according to greenhouse, mobile phone selects logistic pattern or spray pattern, the packet obtaining is sent to list Piece machine;
4) single-chip microcomputer receives the information that mobile phone control software sends, and proceeds by the spraying operation in greenhouse or logistics is made Industry, all the sensors are in running order simultaneously, and by the feedback of the information detecting to single-chip microcomputer, single-chip microcomputer is according to feedback information certainly The dynamic adjustment carrying out attitude, forms the control system of closed loop, realizes automatically controlling;Simultaneously single-chip microcomputer by robot location's information and Working condition is sent to mobile phone by router, and on mobile phone in the way of electronic chart Dynamic Announce;
5) after fulfiling assignment, operator's operating handset software, control robot to move to home position by operating position, close Robot power supply.
CN201610887534.XA 2016-10-11 2016-10-11 A kind of greenhouse logistics plant protection robot control system and method Active CN106338994B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610887534.XA CN106338994B (en) 2016-10-11 2016-10-11 A kind of greenhouse logistics plant protection robot control system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610887534.XA CN106338994B (en) 2016-10-11 2016-10-11 A kind of greenhouse logistics plant protection robot control system and method

Publications (2)

Publication Number Publication Date
CN106338994A true CN106338994A (en) 2017-01-18
CN106338994B CN106338994B (en) 2019-06-07

Family

ID=57840159

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610887534.XA Active CN106338994B (en) 2016-10-11 2016-10-11 A kind of greenhouse logistics plant protection robot control system and method

Country Status (1)

Country Link
CN (1) CN106338994B (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107870624A (en) * 2017-11-30 2018-04-03 沈阳农业大学 A kind of heliogreenhouse self-navigation multifunctional intellectual Operation Van
CN109644834A (en) * 2018-12-26 2019-04-19 丰疆智慧农业股份有限公司 Multifunctional nozzle sprays Operation Van and its application
CN109819958A (en) * 2019-02-21 2019-05-31 山东理工大学 A kind of high pressure ionization wind spraying aid type AGV system plant protection vehicle for adding water that pesticide is not added
CN110352837A (en) * 2019-08-01 2019-10-22 盐城工学院 A kind of intelligent irrigation device
CN113412780A (en) * 2021-05-24 2021-09-21 江苏大学 Intelligent atomization cultivation control system and method based on Internet of things
CN113534823A (en) * 2021-09-16 2021-10-22 季华实验室 Planting robot path planning method and device, electronic equipment and storage medium

Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004284522A (en) * 2003-03-24 2004-10-14 Shiyooshin:Kk Agricultural vehicle
KR20050099743A (en) * 2004-04-12 2005-10-17 한아에쎄스 주식회사 Agricultural medicine spray apparatus
CN2852624Y (en) * 2005-09-29 2007-01-03 袁家军 Multifunction agricultural machine
CN101622983A (en) * 2009-08-14 2010-01-13 潘虹 Soil pest microwave killing machine
FR2963200A1 (en) * 2010-07-30 2012-02-03 Eurl Buchet Control system i.e. controller for agricultural machine used for spreading e.g. fertilizer, on field or plot of land, has control unit including closed loop control unit to control movement speed of movement unit around speed set point
CN102599138A (en) * 2012-04-06 2012-07-25 山东农业大学 Operating environment sensing based active control system for boom sprayer
JP2013176307A (en) * 2012-02-28 2013-09-09 Iseki & Co Ltd Chemical spraying vehicle
CN103927685A (en) * 2014-04-23 2014-07-16 广西力源宝科技有限公司 Agricultural (forestal) intelligent fertilizer applying system
CN104020706A (en) * 2014-06-23 2014-09-03 华南农业大学 Automatic ordered spraying system of orchard pipelines and control method of system
CN105360095A (en) * 2015-12-08 2016-03-02 山东农业大学 Monorail plant protection robot for greenhouse and control method thereof
CN105501863A (en) * 2015-12-08 2016-04-20 山东农业大学 Monorail logistics trolley based on greenhouse interior accurate positioning and control method thereof
CN205233273U (en) * 2015-12-08 2016-05-18 山东农业大学 Greenhouse is with single track plant protection robot
CN205250035U (en) * 2015-06-03 2016-05-25 祖元丁 Leading maize of gearbox is castrated and is spouted medicine multifunctional integral machine
CN205311599U (en) * 2015-12-08 2016-06-15 山东农业大学 Single track commodity circulation car of accurate positioning for industrialized agriculture
JP5939502B2 (en) * 2011-12-13 2016-06-22 井関農機株式会社 Drug sprayer

Patent Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004284522A (en) * 2003-03-24 2004-10-14 Shiyooshin:Kk Agricultural vehicle
KR20050099743A (en) * 2004-04-12 2005-10-17 한아에쎄스 주식회사 Agricultural medicine spray apparatus
CN2852624Y (en) * 2005-09-29 2007-01-03 袁家军 Multifunction agricultural machine
CN101622983A (en) * 2009-08-14 2010-01-13 潘虹 Soil pest microwave killing machine
FR2963200A1 (en) * 2010-07-30 2012-02-03 Eurl Buchet Control system i.e. controller for agricultural machine used for spreading e.g. fertilizer, on field or plot of land, has control unit including closed loop control unit to control movement speed of movement unit around speed set point
JP5939502B2 (en) * 2011-12-13 2016-06-22 井関農機株式会社 Drug sprayer
JP2013176307A (en) * 2012-02-28 2013-09-09 Iseki & Co Ltd Chemical spraying vehicle
CN102599138A (en) * 2012-04-06 2012-07-25 山东农业大学 Operating environment sensing based active control system for boom sprayer
CN103927685A (en) * 2014-04-23 2014-07-16 广西力源宝科技有限公司 Agricultural (forestal) intelligent fertilizer applying system
CN104020706A (en) * 2014-06-23 2014-09-03 华南农业大学 Automatic ordered spraying system of orchard pipelines and control method of system
CN205250035U (en) * 2015-06-03 2016-05-25 祖元丁 Leading maize of gearbox is castrated and is spouted medicine multifunctional integral machine
CN105360095A (en) * 2015-12-08 2016-03-02 山东农业大学 Monorail plant protection robot for greenhouse and control method thereof
CN105501863A (en) * 2015-12-08 2016-04-20 山东农业大学 Monorail logistics trolley based on greenhouse interior accurate positioning and control method thereof
CN205233273U (en) * 2015-12-08 2016-05-18 山东农业大学 Greenhouse is with single track plant protection robot
CN205311599U (en) * 2015-12-08 2016-06-15 山东农业大学 Single track commodity circulation car of accurate positioning for industrialized agriculture

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
刘欢: "自走式对靶喷雾机对靶喷雾控制系统的设计与试验", 《中国优秀硕士学位论文全文数据库 农业科技辑》 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107870624A (en) * 2017-11-30 2018-04-03 沈阳农业大学 A kind of heliogreenhouse self-navigation multifunctional intellectual Operation Van
CN109644834A (en) * 2018-12-26 2019-04-19 丰疆智慧农业股份有限公司 Multifunctional nozzle sprays Operation Van and its application
CN109819958A (en) * 2019-02-21 2019-05-31 山东理工大学 A kind of high pressure ionization wind spraying aid type AGV system plant protection vehicle for adding water that pesticide is not added
CN110352837A (en) * 2019-08-01 2019-10-22 盐城工学院 A kind of intelligent irrigation device
CN113412780A (en) * 2021-05-24 2021-09-21 江苏大学 Intelligent atomization cultivation control system and method based on Internet of things
CN113534823A (en) * 2021-09-16 2021-10-22 季华实验室 Planting robot path planning method and device, electronic equipment and storage medium
CN113534823B (en) * 2021-09-16 2021-12-14 季华实验室 Planting robot path planning method and device, electronic equipment and storage medium

Also Published As

Publication number Publication date
CN106338994B (en) 2019-06-07

Similar Documents

Publication Publication Date Title
CN106338994A (en) Greenhouse logistics plant protection robot control system and method
CN108156918B (en) Large-scale farmland wireless Internet of things intelligent drip irrigation system and method
CN206833217U (en) A kind of field planting monitoring system
CN205594695U (en) Agricultural intelligent application system based on thing networking
CN105360095B (en) A kind of greenhouse single track plant protection robot and its control method
CN109566359B (en) Flower watering robot system based on Beidou satellite positioning
CN105557476B (en) A kind of intelligent and high-efficiency spray irrigation system and method adjusted based on soil moisture
CN103999841A (en) Automatic targeting and spraying system
CN204731617U (en) A kind of life cycle characteristic analysis system based on greenhouse gardening organic plant
CN103988824A (en) Automatic targeting and spraying system based on binocular vision technology
CN112772385B (en) Full-automatic remote irrigation system
CN104881012A (en) CPS-based intelligent crop culture plantation management system
CN204104581U (en) A kind of automatic target detection spraying system based on binocular vision technology
CN203860304U (en) Automatic targeting and spraying system
CN109050931A (en) A kind of four-axle linked sprinkling system of plant protection drone
CN113057154A (en) Greenhouse liquid medicine spraying robot
CN202257252U (en) Remote monitor of edible fungi growing library
CN109656207A (en) A kind of wisdom tobacco leaf planting analysis and management system based on big data analysis platform
CN106779414A (en) Industrialized agriculture remote monitoring and intelligent decision system
CN205375166U (en) Agriculture monitored control system of intelligence based on thing networking
CN205281296U (en) Vegetation environment monitor control system
CN109964905A (en) Robot and its control method are administered to target based on walking certainly for fruit tree identification positioning
CN108945469A (en) Pesticide spraying management system based on unmanned plane
CN209749570U (en) Orchard intelligence is from walking water-spraying system
CN110178817A (en) A kind of variable farm chemical applying information processing system and method

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