CN106965167A - Modularization robot optimization of inside structure method - Google Patents
Modularization robot optimization of inside structure method Download PDFInfo
- Publication number
- CN106965167A CN106965167A CN201710296302.1A CN201710296302A CN106965167A CN 106965167 A CN106965167 A CN 106965167A CN 201710296302 A CN201710296302 A CN 201710296302A CN 106965167 A CN106965167 A CN 106965167A
- Authority
- CN
- China
- Prior art keywords
- module
- internal structure
- son
- mother
- sons
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/08—Programme-controlled manipulators characterised by modular constructions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
Abstract
The present invention provides a kind of modularization robot optimization of inside structure method, including:Q1 obtains the element to be assembled in robot module of user's input and sets the locus of each element to constrain;The component size that Q2 is inputted according to user obtains the submodule length of side S of robot module candidate collection;A value in Q3 selection candidate collections, by default element orders and the RANDOM SOLUTION and its correspondence global energy functional value of additional space position constraint one internal structure of acquisition;Q4 obtains the adjacent solution and its correspondence global energy functional value of RANDOM SOLUTION, and the internal structure of optimization is obtained using default optimized algorithm;Q5 judges whether to have traveled through above-mentioned candidate collection, if the internal structure of the optimization then obtained is final optimization of inside structure result, otherwise return to step Q3, existing module robot architecture design can be overcome more excellent than the existing artificial result for empirically carrying out structure design according to the shortcomings of the different type manual designs of user's input element.
Description
Technical field
The present invention relates to modularization robot technical field, more particularly to a kind of modularization robot optimization of inside structure side
Method.
Background technology
Modularization robot is assembled by a large amount of identical robot modules, can according to environment and the difference of task,
It is flexible to change configuration.Each module can be considered as a simple robot cell, possess disposal ability, carry and drive
Device, sensor, power supply, connecting element and communication device.Compared to traditional fixed configuration robot, modularization robot is by increasing
Subtract certain module or existing module is reconfigured, another adapt to newly can be transformed to rapidly by certain geometric configuration
The configuration of environment, new task.In recent years, modularization robot has turned into the focus that academia and industrial quarters research are paid close attention to.
Different modularization robot appearance differences is larger, from the point of view of slave module structure, can be divided into single mode block type and Shuangzi
Module type.In the modularization robot of single module each module be separated from each other, it is necessary to when be connected with each other again, such as Massachusetts science and engineering
M-BLOCKS that institute proposes, the SMORES that the University of Pennsylvania proposes etc.;Each mould in the modularization robot of Shuangzi module
Block is made up of two inseparable submodules and connector, such as the M-TRAN that Japanese industries Technical Integration Studies are proposed, Lip river
Roombots that the Sang Lianbang Institute of Technology proposes etc..
At present, existing Shuangzi inside modules construction design method needs people to have been manually done, very cumbersome, when selection not
With element when, generally require manual redesign, the quality of design result relies on the experience of designer, it is difficult to ensure that obtaining
More excellent result.
In consideration of it, how the element for selecting user according to the intended applications of modularization robot be reasonably in the layout of it is double
Turn into the current technical issues that need to address in the robot module of sub-module types.
The content of the invention
To solve above-mentioned technical problem, the present invention provides a kind of modularization robot optimization of inside structure method, can
Realize the layout of element progress automatically and reasonably in the robot module of Shuangzi module type that input user, to be assembled simultaneously
Relevant position generates supporting construction inside robot module, so as to obtain a kind of modularization robot internal structure of optimization.
The present invention provides a kind of modularization robot optimization of inside structure method, including:
Q1, the element to be assembled in robot module for obtaining user's input, and each element for setting user to input
Locus constraint;
Q2, the element inputted according to user size, obtain the length of side S of the submodule of robot module Candidate Set
Close;
A value in Q3, selection length of side S candidate collection, according to default element orders and corresponding space
Position constraint, obtains the corresponding global energy functional value of RANDOM SOLUTION and the RANDOM SOLUTION of an internal structure;
Q4, the adjacent solution for obtaining the RANDOM SOLUTION and the corresponding global energy functional value of the adjacent solution, utilize default optimization
Algorithm, obtains the internal structure of optimization;
Q5, judge whether to have traveled through the candidate collection of the length of side S, if so, the internal structure of the optimization then obtained is most
Whole optimization of inside structure result, if it is not, then returning to the step Q3.
Alternatively, the robot module is the robot module of Shuangzi module type, is made up of two submodules;It is described
Two submodules are respectively son's module and mother and sons' module, are fixed and connected using connector between son's module and mother and sons' module
Connect, it is inseparable;
The mother and sons' module for tangling another robot module is stretched out by son's module of a robot module, it is real
The connection of existing two robot modules, point that the hook tangled realizes two robot modules has been stretched out by withdrawing son's module
From;
The shell of son's module and mother and sons' module is the association that semicylinder is constituted with cuboid, wherein, it is long
The length of side of cube is respectively S, S+1 and S/2, a diameter of S of the bottom surface semicircle of semicylinder, a height of S+1 of semicylinder, and S is
Default positive number, by the way that a length of S+1 in semicylinder, a width of S rectangular planes are superimposed upon into a length of S+1 in cuboid, a width of S
A rectangular planes on constitute and be provided with rotation between the association, the center of circle of two bottom surface semicircles of the semicylinder
Rotating shaft, son's module and mother and sons' module can rotate 180 degree around the rotary shaft of itself;
The shell of son's module has three planes, and the position of centre of gravity of each plane is provided with for stretching out and receiving
Hang back the in-line groove of hook;The shell of mother and sons' module has three planes, and the position of centre of gravity of each plane is provided with
Groove for tangling hook.
Alternatively, the element to be assembled in robot module of user's input, including:One battery, two masters
Steering wheel, three small steering wheels and two control boards;
Wherein, two control boards are arranged in mother and sons' module;
One main rudder machine is arranged in son's module, with the control board company being arranged in mother and sons' module
Connect, for the instruction sent according to connected control board, control son's module to be rotated around the rotary shaft of itself;
Another main rudder machine is arranged in mother and sons' module, with the control board company being arranged in mother and sons' module
Connect, for the instruction sent according to connected control board, control mother and sons' module to be rotated around the rotary shaft of itself;
Three small steering wheels are separately positioned in three planes of son's module, respectively with being arranged on the mothers and sons
Control board connection in module, wherein, the instruction that each small steering wheel is sent according to connected control board respectively,
The stretching and withdrawal of the hook set in son's module flat where controlling it.
Alternatively, the step Q1 is when setting the locus constraint of each element of user's input, to any element
ci, i=1,2 ..., 8, select its bounding box BBox (ci) one of two maximum faces of area are used as bottom surface in upper six faces, utilize
Five dimension coordinatesDetermine the element ciPosition, wherein,For bounding box BBox
(ci) barycentric coodinates,For for specifying bounding box BBox (ci) bottom surface normal direction two spherical angles;
Correspondingly, the locus constraint of each element of user's input, including:
Constraint 1:Any element ciBounding box BBox (ci) it is being contained in ΩM(S)∪ΩF(S), wherein, ΩM(S) represent
By the shell area encompassed of son's module, ΩF(S) represent by the shell area encompassed of mother and sons' module;
Constraint 2:Steering wheel SmallServo three small in son's modulemThere are two times in corresponding shell plane
Bit selecting is put, and the location candidate set of wherein m=1,2,3, m-th small steering wheels is:
Wherein,For the 1st position candidate of small m-th steering wheel,For the 2nd time of small m-th steering wheel
Bit selecting is put;
Constraint 3:Make the main rudder machine MainServo in son's module1Rotary shaft overlapped with y-axis, then son's mould
Main rudder machine MainServo in block1Five dimension coordinates in three parametersWithIt is unique
It is determined that, the main rudder machine MainServo in son's module1Location candidate set be
Constraint 4:Main rudder machine MainServo in son's module1With the main rudder in mother and sons' module
Machine MainServo2Y-axis direction coordinate it is identical:Then in son's module
After the position candidate of main rudder machine is determined, the main rudder machine MainServo in mother and sons' module2Location candidate set is
Constraint 5:Control board ctrl in the battery battery, son's module1In mother and sons' module
Control board ctrl2Location candidate set be respectively Γbattery、WithWherein,WithIn position candidate be five dimension coordinatesWherein, ci=battery, ctrl1,ctrl2。
Alternatively, the step Q2 includes:
The size of the element inputted according to user, is calculated by the first formula and obtained in son's module/mother and sons' module
Length is the length minimum value S on S+1 sidemin+ 1, and then obtain S minimum value Smin;
The size of the element inputted according to user, is calculated by the second formula and obtained in son's module/mother and sons' module
Length is the length maximum S on S+1 sidemax+ 1, and then obtain S maximum Smax;
In S in the form of arithmetic progressionminAnd SmaxBetween choose predetermined number numerical value, constitute length of side S candidate collection;
Wherein, first formula is:
Smin+ 1=HMainServo+2×WSmallServo+2×WLink+ τ,
Wherein, HMainServoFor the height of main steering wheel fuselage sections, WSmallServoFor small steering wheel thickness, WLinkFor single connection
Part width, τ is tolerance;
Second formula is:
Wherein,For the thickness of the control board in son's module,For the control board in mother and sons' module
Thickness, WbatteryFor the thickness of battery.
Alternatively, the step Q3 includes:
A value in Q31, selection length of side S candidate collection, according to selected S value and each element
Locus constraint, calculate each element ciLocation candidate set Γi;
Q32, to each element ci, in its location candidate set ΓiOne position candidate of middle selection, and be the candidate automatically
Position generates supporting construction, obtains the RANDOM SOLUTION s of an internal structure;
Q33, according to default element orders, judge whether current internal structure s collides;
Q34, the internal structure s for not colliding, calculate its structural strength, space availability ratio and can assemble respectively
Property, and by the 3rd formula by the structural strength, space availability ratio and assembling capacity weighted sum, obtain current internal structure
S energy function value F;
Wherein, the 3rd formula is:
F=w1fstruct+w2fspace+w3fassembly
Wherein, fstructFor structural strength, fspaceFor space availability ratio, fassemblyFor assembling capacity, w1For structural strength
Weight, w2For the weight of space availability ratio, w3For the weight of assembling capacity, w1、w2And w3It is nonnegative value.
Alternatively, the step Q33, including:
Internal structure set struct is initially set to empty set
Given set I=i | and i=1,2,3 ..., 8 }, correspondingly default element orders are:
{SmallServo1,SmallServo2,SmallServo3,MainServo1,
MainServo2,battery,ctrl1,ctrl2};
According to the default element orders, each element c in current internal structure s is judgediWhether with it is existing
Struct collides;
In the event of colliding, return and perform the step Q32;
It is current elements c if do not collidediGenerate its supporting construction S (ci), and update internal using the 4th formula
Structured set struct value;
Work as i==5, determine position and the revolution space Sweep of connectorlink, and update internal junction using the 5th formula
Structure set struct value;
If all 8 elements judge to finish and do not collide, it is determined that current internal structure s does not collide;
Wherein, the 4th formula is:
Struct=struct ∪ ci∪S(ci);
5th formula is:
Struct=struct ∪ Sweeplink。
Alternatively, the internal structure s not collided for judging to obtain, calculates its structural strength, sky respectively
Between utilization rate and assembling capacity, including:
For the internal structure s not collided for judging to obtain:
Apply the torque of gravity and steering wheel as external force, using the 6th formula, calculating obtains structural strength fstruct;
Using the 7th formula, calculating obtains space availability ratio fspace;
Component placement in the internal structure s not collided obtains a corresponding assembling matrix M, and M is n × n
Square formation, n is (i, j) representation element c in number of elements, MiIn element cjIn the presence of do not collide in the case of assembling side
To;According to preassigned Assembly sequences Π=(c1,c2,…,cn), calculate V (i)=∩j<iM (i, j), wherein cjRepresent in ci
The element assembled before;And if only ifWhen, Π is effective Assembly sequences;Calculate effective Assembly sequences Π=
(c1,c2,…,cn) redirection number of times, and according to the redirection number of times, using the 8th formula, calculating obtains assembling capacity;
Wherein, the 6th formula is:
Wherein, σabs_maxFor the maximum absolute stress on internal structure s, σrefFor preset reference stress;
7th formula is:
Wherein, VolmaleFor the volume of son's module, VolfemaleFor the volume of mother and sons' module, Vol (ci) it is element ci's
Volume;
8th formula is:
Wherein, nreorientFor effective Assembly sequences Π redirection number of times.
Alternatively, it is described to calculate effective Assembly sequences Π=(c1,c2,…,cn) redirection number of times, including:
IfThen in assembling ci,…,cjDuring be not required to redirect, ifAndThen assemble cj+1When need once to redirect;Count effective Assembly sequences Π=(c1,c2,…,cn)
Redirect number of times.
Alternatively, the default optimized algorithm is simulated annealing, correspondingly, the step Q4, including:
R1, set optimal energy functional value to be initial value, give set I={ i | i=1,2,3 ..., 8 }, it is correspondingly default
Element orders are:
{SmallServo1,SmallServo2,SmallServo3,MainServo1,
MainServo2,battery,ctrl1,ctrl2, adjacent solution s '=s is set,
Indicate flag=true;
If R2, flag=true, the number i in set I is randomly choosed, in the corresponding location candidate set Γ of iiIt is interior
Randomly choose another position and obtain internal structure s ' instead of current location;
R3, the current internal structure s in the step Q33 replaced with into internal structure s ', by performing the step
Q33, judges whether internal structure s ' collides;If internal structure s ' collides, return and perform the step R2;Such as
Fruit internal structure s ' does not collide, then flag=false, using the s ' not collided as RANDOM SOLUTION s adjacent solution;
R4, the internal structure s not collided in the step Q34 is replaced with to the s ' not collided, pass through and perform
The step Q34, the energy function value for the s ' not collided;
R5, the Metropolis criterions according to simulated annealing, calculating are changed into its adjacent solution s ' from current RANDOM SOLUTION s
Possibility probability P;
If R6, possibility probability P are more than predetermined threshold value, current RANDOM SOLUTION s is updated to s ', and T is updated to
0.95T;
R7, circulation perform the step R1-R6, until iterations reaches preset times and F '-F<0;
If R8, the energy function value of current RANDOM SOLUTION are less than optimal energy functional value, current internal structure is updated, and
Optimal energy functional value is updated to the energy function value of current RANDOM SOLUTION;
Wherein, the predetermined threshold value is a random number between 0 to 1, and the Metropolis of the simulated annealing is accurate
It is then:
Wherein, T is Current Temperatures, and F is current RANDOM SOLUTION s energy function value, and F ' is current RANDOM SOLUTION s adjacent solution s '
Energy function value.
As shown from the above technical solution, modularization robot optimization of inside structure method of the invention, by Q1, obtains and uses
The element to be assembled in robot module of family input, and the locus constraint of each element of user's input is set;Q2、
The size of the element inputted according to user, obtains the length of side S of the submodule of robot module candidate collection;Q3, selection
A value in the candidate collection of the length of side S, constrains according to default element orders and corresponding locus, obtains one
The RANDOM SOLUTION of individual internal structure and the corresponding global energy functional value of the RANDOM SOLUTION;Q4, the adjacent solution for obtaining the RANDOM SOLUTION and
The corresponding global energy functional value of adjacent solution, utilizes default optimized algorithm, obtains the internal structure of optimization;Q5, judge whether
Length of side S candidate collection is traveled through, if the internal structure of the optimization then obtained is final optimization of inside structure result, if otherwise
Return to step Q3, thereby, it is possible to realize the element inputting user, to be assembled in the robot module of Shuangzi module type
Carry out layout automatically and reasonably and relevant position generates supporting construction inside robot module, so as to obtain a kind of mould of optimization
Block robot interior structure, overcome existing module robot architecture design need inputted according to user, it is to be assembled
The shortcoming of the different type manual designs of element in the robot module of Shuangzi module type, it is artificial according to warp compared to existing
Result is more excellent for the carry out structure design tested.
Brief description of the drawings
A kind of flow signal for modularization robot optimization of inside structure method that Fig. 1 provides for one embodiment of the invention
Figure;
Fig. 2 is the contour structures schematic diagram of the robot module of Shuangzi module type provided in an embodiment of the present invention;
Fig. 3 is the change in coordinate axis direction of five dimension coordinate provided in an embodiment of the present invention and the length of side corresponding relation of submodule;
Fig. 4 is two position candidates of the small steering wheel provided in an embodiment of the present invention in the respective planes of son's module housing
Schematic diagram;
Fig. 5 be son's module provided in an embodiment of the present invention in main rudder machine position candidate schematic diagram;
Fig. 6 be mother and sons' module provided in an embodiment of the present invention in main rudder machine position candidate schematic diagram;
Fig. 7 is the two-dimensional graphical layout in a kind of robot module provided in an embodiment of the present invention and its corresponding assembling
Matrix schematic diagram;
Fig. 8 is the entity structure schematic diagram of a kind of electronic equipment provided in an embodiment of the present invention.
Embodiment
To make the purpose, technical scheme and advantage of the embodiment of the present invention clearer, below in conjunction with the embodiment of the present invention
In accompanying drawing, clear, complete description is carried out to the technical scheme in the embodiment of the present invention, it is clear that described embodiment is only
Only it is a part of embodiment of the invention, rather than whole embodiments.Based on embodiments of the invention, ordinary skill people
The every other embodiment that member is obtained under the premise of creative work is not made, belongs to the scope of protection of the invention.
Fig. 1 shows the flow signal for the modularization robot optimization of inside structure method that one embodiment of the invention is provided
Figure, as shown in figure 1, the modularization robot optimization of inside structure method of the present embodiment is as described below.
Q1, the element to be assembled in robot module for obtaining user's input, and each element for setting user to input
Locus constraint.
In a particular application, Fig. 2 is referred to, the robot module is the robot module of Shuangzi module type, by two
Individual submodule composition;Described two submodules are respectively son's module 01 and mother and sons' module 02, son's module 01 and mothers and sons
It is fixedly connected between module 02 using connector 03, it is inseparable;
The mother and sons' module for tangling another robot module is stretched out by son's module 01 of a robot module
02, the connection of two robot modules is realized, the hook tangled has been stretched out by withdrawing son's module 01 and has realized Liang Ge robots
The separation of module;
The shell of son's module 01 and mother and sons' module 02 is the association that semicylinder is constituted with cuboid, can be joined
Fig. 3 is examined, wherein, the length of side of cuboid is respectively S, S+1 and S/2, a diameter of S of the bottom surface semicircle of semicylinder, semicylinder
A height of S+1, S is default positive number, by the way that a length of S+1 in semicylinder, a width of S rectangular planes are superimposed upon in cuboid
The association, the circle of two bottom surface semicircles of the semicylinder are constituted on a length of S+1, an a width of S rectangular planes
Rotary shaft is provided between the heart, son's module 01 and mother and sons' module 02 can rotate 180 degree around the rotary shaft of itself;
The shell of son's module 01 has three planes, the position of centre of gravity of each plane be provided with for stretching out and
Withdraw the in-line groove of hook;The shell of mother and sons' module 02 has three planes, and the position of centre of gravity of each plane is all provided with
It is equipped with the groove for tangling hook.For example, the groove for being used to tangle hook can be imperfect shown in Fig. 2
Cross groove.
In a particular application, the element to be assembled in robot module of user's input, can include:One electricity
Pond, two main rudder machines, three small steering wheels and two control boards;
Wherein, two control boards are arranged in mother and sons' module;
One main rudder machine is arranged in son's module, with the control board company being arranged in mother and sons' module
Connect, for the instruction sent according to connected control board, control son's module to be rotated around the rotary shaft of itself;
Another main rudder machine is arranged in mother and sons' module, with the control board company being arranged in mother and sons' module
Connect, for the instruction sent according to connected control board, control mother and sons' module to be rotated around the rotary shaft of itself;
Three small steering wheels are separately positioned in three planes of son's module, respectively with being arranged on the mothers and sons
Control board connection in module, wherein, the instruction that each small steering wheel is sent according to connected control board respectively,
The stretching and withdrawal of the hook set in son's module flat where controlling it.
For example, first control board in mother and sons' module can use ATmega328P as control core
Piece, and integrated bluetooth module, second control board for receiving in instruction, mother and sons' module can be with integrated wireless mould
Block is used for intermodule communication, and provides the socket of steering wheel, and signal is provided for steering wheel.
In a particular application, the step Q1 is when setting the locus constraint of each element of user's input, to appointing
Anticipate element ci, i=1,2 ..., 8, select its bounding box BBox (ci) one of two maximum faces of area are used as bottom in upper six faces
Face, utilizes five dimension coordinatesDetermine the element ciPosition, wherein,For
Bounding box BBox (ci) barycentric coodinates,For for specifying bounding box BBox (ci) bottom surface normal direction two spheres
Angle;
Correspondingly, the locus constraint of each element of user's input, can include following constraint 1- constraints 5:
Constraint 1:Any element ciBounding box BBox (ci) it is being contained in ΩM(S)∪ΩF(S), wherein, ΩM(S) represent
By the shell area encompassed of son's module, ΩF(S) represent by the shell area encompassed of mother and sons' module.
Constraint 2:Steering wheel SmallServo three small in son's modulemThere are two times in corresponding shell plane
Bit selecting is put, and the location candidate set of wherein m=1,2,3, m-th small steering wheels is:
Wherein,For the 1st position candidate of small m-th steering wheel,For the 2nd time of small m-th steering wheel
Bit selecting is put.
It is understood that because the effect of three small steering wheels in son's module is its place son's module of control
The stretching and withdrawal of set hook in the plane of shell, and being used for of being set in son's module stretches out and withdraws hook
In-line groove each plane position of centre of gravity, therefore, each small steering wheel in the respective planes of son's module housing only
With two position candidates, Fig. 4 is referred to.
Constraint 3:Make the main rudder machine MainServo in son's module1Rotary shaft overlapped with y-axis, then the son
Main rudder machine MainServo in module1Five dimension coordinates in three parametersWithIt is now uniquely determined, the main rudder machine MainServo in son's module1Location candidate set beRefer to Fig. 5.
It is understood that due to the main rudder machine MainServo in each submodule (son's module/mother and sons' module)1With
In controlling son's module to be rotated around the rotary shaft of itself, so the rotary shaft weight that the rotary shaft of main rudder machine should be with the submodule
Close, the submodule can be made to be rotated against with connector, in the son's module and mother and sons' module in uniform machinery people's module
The connecting line of main rudder machine center of gravity should be vertical with y-axis direction, refer to Fig. 6.
Constraint 4:Main rudder machine MainServo in son's module1With the main rudder machine MainServo in mother and sons' module2
Y-axis direction coordinate it is identical:Then the position candidate of the main rudder machine in son's module is true
After fixed, the main rudder machine MainServo in mother and sons' module2Location candidate set isIt can join
Examine Fig. 6.
Constraint 5:Control board ctrl in the battery battery, son's module1In mother and sons' module
Control board ctrl2Location candidate set be respectively Γbattery、WithWherein, Γbattery、WithIn position candidate be five dimension coordinatesWherein, ci=battery, ctrl1,ctrl2。
Q2, the element inputted according to user size, obtain the length of side S of the submodule of robot module Candidate Set
Close.
In a particular application, the step Q2 can include the step Q21-Q23 not shown in figure:
Q21, the element inputted according to user size, are calculated by the first formula and obtain the son's module/mother son die
Length is the length minimum value S on S+1 side in blockmin+ 1, and then obtain S minimum value Smin。
Wherein, first formula is:
Smin+ 1=HMainServo+2×WSmallServo+2×WLink+τ (1)
Wherein, HMainServoFor the height of main steering wheel fuselage sections, WSmallServoFor small steering wheel thickness, WLinkFor single connection
Part width, τ is tolerance.
For example, it is 39 × 21 × 8 (millimeter mm) 7.4v by length, width and height of the battery in the element that user inputs,
500mAh chargeable lithium cells, two main rudder machines be length, width and height be 32 × 11.5 × 30 (mm) HX1218D main rudder machines, three
Small steering wheel be length, width and height be 32 × 12.2 × 29 (mm) the small steering wheels of SG90, and length, width and height be 31.75 × 20.96 respectively ×
Exemplified by 2.85 (mm) and 27.94 × 14.65 × 1.71 (mm) two control boards:Length is minimum for the length on S+1 side
Value Smin+ 1=27.2+2 × 12.2+2 × 6+ τ ≈ 69mm, wherein, the height (y-axis direction length) of main rudder machine fuselage sections is
27.2mm, small steering wheel thickness is 12.2mm, and single connector width is 6mm, and tolerance τ is set to 5mm.
Q22, the element inputted according to user size, are calculated by the second formula and obtain the son's module/mother son die
Length is the length maximum S on S+1 side in blockmax+ 1, and then obtain S maximum Smax。
Wherein, second formula is:
Wherein,For the thickness of the control board in son's module,For the control circuit in mother and sons' module
The thickness of plate, WbatteryFor the thickness of battery.
By taking step Q21 given examples as an example, length is the length maximum S on S+1 sidemax+ 1=69+2.85+1.71+8
≈ 82mm, wherein, 2.85,1.71,8 be respectively the thickness of two control boards and battery.
Q23, in the form of arithmetic progression in SminAnd SmaxBetween choose predetermined number numerical value, constitute length of side S candidate
Set.
By taking step Q21 given examples as an example, it is assumed that predetermined number numerical value is 4, can select S={ 68,72,76,81 }
For length of side S candidate collection.
A value in Q3, selection length of side S candidate collection, according to default element orders and corresponding space
Position constraint, obtains the corresponding global energy functional value of RANDOM SOLUTION and the RANDOM SOLUTION of an internal structure.
In a particular application, the step Q3 can include the step Q31-Q34 not shown in figure:
A value in Q31, selection length of side S candidate collection, according to selected S value and each element
Locus constraint, calculate each element ciLocation candidate set Γi。
Q32, to each element ci, in its location candidate set ΓiOne position candidate of middle selection, and be the candidate automatically
Position generates supporting construction, obtains the RANDOM SOLUTION s of an internal structure.
Q33, according to default element orders, judge whether current internal structure s collides.
Specifically, the step Q33 can include the step T1-T5 not shown in figure:
T1, internal structure set struct is initially set to empty set
T2, given set I={ i | i=1,2,3 ..., 8 }, correspondingly default element orders are:
{SmallServo1,SmallServo2,SmallServo3,MainServo1,
MainServo2,battery,ctrl1,ctrl2}。
T3, according to the default element orders, judge each element c in current internal structure siWhether with it is existing
Struct collides;In the event of colliding, return and perform the step Q32;It is current elements c if do not collidediIt is raw
Into its supporting construction S (ci), and utilize the 4th formula renewal internal structure set struct value.
Wherein, the 4th formula is:
Struct=struct ∪ ci∪S(ci) (3)。
It is understood that the step Q33 is after the step Q32 generates a RANDOM SOLUTION, current internal is checked
Whether structure s collides;If collision, it is returned to the execution step Q32 and regenerates a RANDOM SOLUTION, until generation one
The individual RANDOM SOLUTION not collided.
T4, work as i==5, determine position and the revolution space Sweep of connectorlink, and update internal using the 5th formula
Structured set struct value.
Wherein, the 5th formula is:
Struct=struct ∪ Sweeplink (4)。
It is understood that once the position on main rudder machine y-axis direction determines that the position of the end connection of main rudder machine two also can
Uniquely determine, the rotating range of connector is 180 °, and inswept space (i.e. revolution space) is Sweeplink。
If T5, all 8 elements judge to finish and do not collide, it is determined that current internal structure s is not touched
Hit, illustrate that current internal structure s's is rationally distributed.
Q34, the internal structure s for not colliding, calculate its structural strength, space availability ratio and can assemble respectively
Property, and by the 3rd formula by the structural strength, space availability ratio and assembling capacity weighted sum, obtain current internal structure
S energy function value F.
Wherein, the 3rd formula is:
F=w1fstruct+w2fspace+w3fassembly (5)
Wherein, fstructFor structural strength, fspaceFor space availability ratio, fassemblyFor assembling capacity, w1For structural strength
Weight, w2For the weight of space availability ratio, w3For the weight of assembling capacity, w1、w2And w3It is nonnegative value.For example, can set
w1=10.0, w2=1.0, w3=1.5.
Specifically, in the step Q34 " for the internal structure s not collided for judging to obtain, it is calculated respectively
Structural strength, space availability ratio and assembling capacity ", can be specifically included:
For the internal structure s not collided for judging to obtain:
1) torque of gravity and steering wheel is applied as external force, using the 6th formula, calculating obtains structural strength fstruct。
Wherein, the 6th formula is:
Wherein, σabs_maxFor the maximum absolute stress on internal structure s, σrefFor preset reference stress.
It should be noted that fstructValue is smaller, and structural strength is better.
2) the 7th formula is utilized, calculating obtains space availability ratio fspace。
Wherein, the 7th formula is:
Wherein, VolmaleFor the volume of son's module, VolfemaleFor the volume of mother and sons' module, Vol (ci) it is element ci's
Volume, Vol (ci) value is smaller, space availability ratio is bigger.
3) it is understood that it is final do not produce the component placement of collision it can also happen that situation about can not assemble, it is necessary to
Can the design is weighed with assembly complexity smoothly assembly or disassembly.Can be according in the internal structure s not collided
Component placement obtains a corresponding assembling matrix M, and M is n × n square formation, and n is (i, j) representation element c in number of elements, Mi
In element cjIn the presence of do not collide in the case of assembly direction, Fig. 7 be a kind of robot module in X-Y scheme cloth
Office and its corresponding assembling matrix schematic diagram, in the figure 7:A, B and C are small steering wheel, and D is main steering wheel, and E and F are side wall, and G is
Bottom plate, H is main steering wheel supporting table;According to preassigned Assembly sequences Π=(c1,c2,…,cn), calculate V (i)=∩j<iM
(i, j), wherein cjRepresent in ciThe element assembled before;And if only ifWhen, Π is effective Assembly sequences;Meter
Calculate effective Assembly sequences Π=(c1,c2,…,cn) redirection number of times, and according to the redirection number of times, utilize the 8th public
Formula, calculating obtains assembling capacity;
8th formula is:
Wherein, nreorientFor effective Assembly sequences Π redirection number of times.
Wherein, effective Assembly sequences Π=(c is calculated1,c2,…,cn) redirection number of times, may particularly include:
IfThen in assembling ci,…,cjDuring be not required to redirect, ifAndThen assemble cj+1When need once to redirect;Count effective Assembly sequences Π=(c1,c2,…,cn) weight
Orient number of times.
Q4, the adjacent solution for obtaining the RANDOM SOLUTION and the corresponding global energy functional value of the adjacent solution, utilize default optimization
Algorithm, obtains the internal structure of optimization.
In a particular application, the default optimized algorithm can be simulated annealing, and correspondingly, the step Q4 can
Specifically include the step R1-R8 not shown in figure:
R1, setting optimal energy functional value FoptFor initial value, set I={ i | i=1,2,3 ..., 8 } is given, correspondence is in advance
If element orders be:
{SmallServo1,SmallServo2,SmallServo3,MainServo1,
MainServo2,battery,ctrl1,ctrl2, adjacent solution s '=s is set,
Indicate flag=true.
It should be noted that the optimal energy functional value FoptInitial value be an abundant big numerical value, in theory may be used
To be infinitely great.For example, in the present embodiment, can be by FoptInitial value be set to 106.In subsequent iterative cycles
In, optimal energy functional value is the smaller the better.
If R2, flag=true, the number i in set I is randomly choosed, in the corresponding location candidate set Γ of iiIt is interior
Randomly choose another position and obtain internal structure s ' instead of current location.
R3, the current internal structure s in the step Q33 replaced with into internal structure s ', by performing the step
Q33, judges whether internal structure s ' collides;If internal structure s ' collides, return and perform the step R2;Such as
Fruit internal structure s ' does not collide, then flag=false, using the s ' not collided as RANDOM SOLUTION s adjacent solution.
R4, the internal structure s not collided in the step Q34 is replaced with to the s ' not collided, pass through and perform
The step Q34, the energy function value for the s ' not collided.
R5, the Metropolis criterions according to simulated annealing, calculating are changed into its adjacent solution s ' from current RANDOM SOLUTION s
Possibility probability P.
Wherein, the Metropolis criterions of the simulated annealing are:
Wherein, T is Current Temperatures, and F is current RANDOM SOLUTION s energy function value, and F ' is current RANDOM SOLUTION s adjacent solution s '
Energy function value.
If R6, possibility probability P are more than predetermined threshold value, current RANDOM SOLUTION s is updated to s ', and T is updated to
0.95T。
In a particular application, the predetermined threshold value is a random number between 0 to 1.
R7, circulation perform the step R1-R6, until iterations reaches preset times and F '-F<0.
If R8, the energy function value of current RANDOM SOLUTION are less than optimal energy functional value Fopt, then current internal knot is updated
Structure, and optimal energy functional value is updated to the energy function value of current RANDOM SOLUTION.
Q5, judge whether to have traveled through the candidate collection of the length of side S, if so, the internal structure of the optimization then obtained is most
Whole optimization of inside structure result, if it is not, then returning to the step Q3.
It is understood that can increase algorithm using simulated annealing when optimizing energy function jumps out local optimum
The possibility of solution.
By taking above-mentioned steps Q21 given examples as an example, the present embodiment methods described obtains the set of the element of user's input, will
Initial FoptIt is set to 106, optimization solution result starts as sky, selects S={ 68,72,76,81 } to be length of side S according to above-mentioned steps Q23
Candidate collection;To each candidate's length of side S ∈ { 68,72,76,81 }, constrain and calculate according to the locus in the step Q1
Go out the position candidate of each element, initial temperature T=100;One Lothrus apterus solution s of generation calculates its energy as current solution at random
Flow function value;If primary iteration number of times iter=0, often take turns iter after iteration and add one, the difference of energy function value in two-wheeled iteration
Δ F is initially set to 10;When iterations is less than 10000 or Δ F>0, generate adjacent solution s ' and calculate adjacent solution s ' energy
Functional value, calculates its acceptance probability value P, if P >=random (0,1), then will currently solve and update and reduce Current Temperatures,
That is T ← 0.95T;Jump out after circulation, the result after being optimized.
The modularization robot optimization of inside structure method of the present embodiment, can be realized by processor, can realize by
User the inputs, element to be assembled in the robot module of Shuangzi module type carries out layout automatically and reasonably and in machine
People's inside modules relevant position generates supporting construction, so as to obtain a kind of modularization robot internal structure of optimization.This implementation
Example methods described is general to the polytype of element, and overcoming existing module robot architecture design needs to be inputted according to user
, the shortcomings of the different type manual designs of the element to be assembled in the robot module of Shuangzi module type, pass through iteration
Optimization make it that the internal structure of the robot module result for existing artificial carry out structure design empirically is more excellent.
Fig. 8 shows the entity structure schematic diagram of a kind of electronic equipment provided in an embodiment of the present invention, as shown in figure 8, should
Electronic equipment can include:Processor 11, memory 12, bus 13 and it is stored on memory 12 and can be transported on processor 11
Capable computer program;
Wherein, the processor 11, memory 12 completes mutual communication by the bus 13;
The processor 11 realizes the method that above method embodiment is provided when performing the computer program, for example, wrap
Include:Q1, the element to be assembled in robot module for obtaining user's input, and the space of each element of user's input is set
Position constraint;Q2, the element inputted according to user size, obtain the length of side S of the submodule of robot module candidate
Set;A value in Q3, selection length of side S candidate collection, according to default element orders and corresponding space bit
Constraint is put, the corresponding global energy functional value of RANDOM SOLUTION and the RANDOM SOLUTION of an internal structure is obtained;Q4, acquisition are described random
The adjacent solution of solution and the corresponding global energy functional value of adjacent solution, utilize default optimized algorithm, obtain the internal structure of optimization;
Q5, judge whether to have traveled through the candidate collection of the length of side S, if so, the internal structure of the optimization then obtained is final internal junction
Structure optimum results, if it is not, then returning to the step Q3.
The embodiment of the present invention provides a kind of non-transient computer readable storage medium storing program for executing, is stored thereon with computer program, should
The method that above method embodiment is provided is realized when computer program is executed by processor, for example including:Q1, acquisition user are defeated
The element to be assembled in robot module entered, and the locus constraint of each element of user's input is set;Q2, basis
The size of the element of user's input, obtains the length of side S of the submodule of robot module candidate collection;Q3, selection are described
A value in length of side S candidate collection, constrains according to default element orders and corresponding locus, obtains in one
The RANDOM SOLUTION of portion's structure and the corresponding global energy functional value of the RANDOM SOLUTION;Q4, the adjacent solution and the phase for obtaining the RANDOM SOLUTION
The corresponding global energy functional value of neighbour's solution, using default optimized algorithm, obtains the internal structure of optimization;Q5, judge whether traversal
Complete length of side S candidate collection, if so, the internal structure of the optimization then obtained is final optimization of inside structure result, if it is not,
Then return to the step Q3.
It should be understood by those skilled in the art that, embodiments herein can be provided as method, system or computer program
Product.Therefore, the application can be using the reality in terms of complete hardware embodiment, complete software embodiment or combination software and hardware
Apply the form of example.Moreover, the application can be used in one or more computers for wherein including computer usable program code
The computer program production that usable storage medium is implemented on (including but is not limited to magnetic disk storage, CD-ROM, optical memory etc.)
The form of product.
The application is the flow with reference to method, equipment (system) and computer program product according to the embodiment of the present application
Figure and/or block diagram are described.It should be understood that can be by every first-class in computer program instructions implementation process figure and/or block diagram
Journey and/or the flow in square frame and flow chart and/or block diagram and/or the combination of square frame.These computer programs can be provided
The processor of all-purpose computer, special-purpose computer, Embedded Processor or other programmable data processing devices is instructed to produce
A raw machine so that produced by the instruction of computer or the computing device of other programmable data processing devices for real
The device for the function of being specified in present one flow of flow chart or one square frame of multiple flows and/or block diagram or multiple square frames/
System.
These computer program instructions, which may be alternatively stored in, can guide computer or other programmable data processing devices with spy
Determine in the computer-readable memory that mode works so that the instruction being stored in the computer-readable memory, which is produced, to be included referring to
Make the manufacture of device, the command device realize in one flow of flow chart or multiple flows and/or one square frame of block diagram or
The function of being specified in multiple square frames.
These computer program instructions can be also loaded into computer or other programmable data processing devices so that in meter
Series of operation steps is performed on calculation machine or other programmable devices to produce computer implemented processing, thus in computer or
The instruction performed on other programmable devices is provided for realizing in one flow of flow chart or multiple flows and/or block diagram one
The step of function of being specified in individual square frame or multiple square frames.
It should be noted that herein, such as first and second or the like relational terms are used merely to a reality
Body or operation make a distinction with another entity or operation, and not necessarily require or imply these entities or deposited between operating
In any this actual relation or order.Moreover, term " comprising ", "comprising" or its any other variant are intended to
Nonexcludability is included, so that process, method, article or equipment including a series of key elements not only will including those
Element, but also other key elements including being not expressly set out, or also include being this process, method, article or equipment
Intrinsic key element.In the absence of more restrictions, the key element limited by sentence "including a ...", it is not excluded that
Also there is other identical element in process, method, article or equipment including the key element.Term " on ", " under " etc. refers to
The orientation or position relationship shown is, based on orientation shown in the drawings or position relationship, to be for only for ease of the description present invention and simplify
Description, rather than indicate or imply that the device or element of meaning must have specific orientation, with specific azimuth configuration and behaviour
Make, therefore be not considered as limiting the invention.Unless otherwise clearly defined and limited, term " installation ", " connected ",
" connection " should be interpreted broadly, for example, it may be being fixedly connected or being detachably connected, or be integrally connected;Can be
Mechanically connect or electrically connect;Can be joined directly together, can also be indirectly connected to by intermediary, can be two
The connection of element internal.For the ordinary skill in the art, above-mentioned term can be understood at this as the case may be
Concrete meaning in invention.
In the specification of the present invention, numerous specific details are set forth.Although it is understood that, embodiments of the invention can
To be put into practice in the case of these no details.In some instances, known method, structure and skill is not been shown in detail
Art, so as not to obscure the understanding of this description.Similarly, it will be appreciated that disclose in order to simplify the present invention and helps to understand respectively
One or more of individual inventive aspect, above in the description of the exemplary embodiment of the present invention, each of the invention is special
Levy and be grouped together into sometimes in single embodiment, figure or descriptions thereof.However, should not be by the method solution of the disclosure
Release and be intended in reflection is following:I.e. the present invention for required protection requirement is than the feature that is expressly recited in each claim more
Many features.More precisely, as the following claims reflect, inventive aspect is to be less than single reality disclosed above
Apply all features of example.Therefore, it then follows thus claims of embodiment are expressly incorporated in the embodiment,
Wherein each claim is in itself as the separate embodiments of the present invention.It should be noted that in the case where not conflicting, this
The feature in embodiment and embodiment in application can be mutually combined.The invention is not limited in any single aspect,
Any single embodiment is not limited to, any combination and/or the displacement of these aspects and/or embodiment is also not limited to.And
And, can be used alone the present invention each aspect and/or embodiment or with other one or more aspects and/or its implementation
Example is used in combination.
Finally it should be noted that:Various embodiments above is merely illustrative of the technical solution of the present invention, rather than its limitations;To the greatest extent
The present invention is described in detail with reference to foregoing embodiments for pipe, it will be understood by those within the art that:Its according to
The technical scheme described in foregoing embodiments can so be modified, or which part or all technical characteristic are entered
Row equivalent substitution;And these modifications or replacement, the essence of appropriate technical solution is departed from various embodiments of the present invention technology
The scope of scheme, it all should cover among the claim of the present invention and the scope of specification.
Claims (10)
1. a kind of modularization robot optimization of inside structure method, it is characterised in that including:
Q1, the element to be assembled in robot module for obtaining user's input, and the sky of each element of user's input is set
Between position constraint;
Q2, the element inputted according to user size, obtain the length of side S of the submodule of robot module candidate collection;
A value in Q3, selection length of side S candidate collection, according to default element orders and corresponding locus
Constraint, obtains the corresponding global energy functional value of RANDOM SOLUTION and the RANDOM SOLUTION of an internal structure;
Q4, the adjacent solution for obtaining the RANDOM SOLUTION and the corresponding global energy functional value of the adjacent solution, using default optimized algorithm,
Obtain the internal structure of optimization;
Q5, judge whether to have traveled through the candidate collection of the length of side S, if so, the internal structure of the optimization then obtained is in final
Portion's structure optimization result, if it is not, then returning to the step Q3.
2. according to the method described in claim 1, it is characterised in that the robot module is the robot of Shuangzi module type
Module, is made up of two submodules;Described two submodules are respectively son's module and mother and sons' module, son's module and mother
It is fixedly connected between submodule using connector, it is inseparable;
The mother and sons' module for tangling another robot module is stretched out by son's module of a robot module, two are realized
The connection of individual robot module, the separation that the hook tangled realizes two robot modules has been stretched out by withdrawing son's module;
The shell of son's module and mother and sons' module is the association that semicylinder is constituted with cuboid, wherein, cuboid
The length of side be respectively S, S+1 and S/2, a diameter of S of the bottom surface semicircle of semicylinder, a height of S+1 of semicylinder, S is default
Positive number, by by a length of S+1 in semicylinder, a width of S rectangular planes be superimposed upon a length of S+1 in cuboid, a width of S one
Constituted in individual rectangular planes and be provided with rotation between the association, the center of circle of two bottom surface semicircles of the semicylinder
Axle, son's module and mother and sons' module can rotate 180 degree around the rotary shaft of itself;
The shell of son's module has three planes, and the position of centre of gravity of each plane is provided with for stretching out and withdrawing extension
The in-line groove of hook;The shell of mother and sons' module has three planes, and the position of centre of gravity of each plane, which is provided with, to be used for
Tangle the groove of hook.
3. method according to claim 2, it is characterised in that it is to be assembled in robot module that the user inputs
Element, including:One battery, two main rudder machines, three small steering wheels and two control boards;
Wherein, two control boards are arranged in mother and sons' module;
One main rudder machine is arranged in son's module, is connected with the control board being arranged in mother and sons' module, is used
In the instruction sent according to connected control board, son's module is controlled to be rotated around the rotary shaft of itself;
Another main rudder machine is arranged in mother and sons' module, is connected with the control board being arranged in mother and sons' module,
For the instruction sent according to connected control board, mother and sons' module is controlled to be rotated around the rotary shaft of itself;
Three small steering wheels are separately positioned in three planes of son's module, respectively with being arranged on mother and sons' module
In control board connection, wherein, each small steering wheel respectively according to connected control board send instruction, control
The stretching and withdrawal of the hook set in son's module flat where it.
4. method according to claim 3, it is characterised in that the step Q1 is setting each element of user's input
When locus is constrained, to any element ci, i=1,2 ..., 8, select its bounding box BBox (ci) area is maximum in upper six faces
One of two faces as bottom surface, utilize five dimension coordinatesDetermine the element ciPosition
Put, wherein,For bounding box BBox (ci) barycentric coodinates,For for specifying bounding box BBox
(ci) bottom surface normal direction two spherical angles;
Correspondingly, the locus constraint of each element of user's input, including:
Constraint 1:Any element ciBounding box BBox (ci) it is being contained in ΩM(S)∪ΩF(S), wherein, ΩM(S) represent by institute
State the shell area encompassed of son's module, ΩF(S) represent by the shell area encompassed of mother and sons' module;
Constraint 2:Steering wheel SmallServo three small in son's modulemThere are two candidate bits in corresponding shell plane
Put, the location candidate set of wherein m=1,2,3, m-th small steering wheels is:
Wherein,For the 1st position candidate of small m-th steering wheel,For the 2nd time of small m-th steering wheel
Bit selecting is put;
Constraint 3:Make the main rudder machine MainServo in son's module1Rotary shaft overlapped with y-axis, then in son's module
Main rudder machine MainServo1Five dimension coordinates in three parametersWithIt is now uniquely determined, institute
State the main rudder machine MainServo in son's module1Location candidate set be
Constraint 4:Main rudder machine MainServo in son's module1With the main rudder machine MainServo in mother and sons' module2's
Y-axis direction coordinate is identical:Then the position candidate of the main rudder machine in son's module is determined
Afterwards, the main rudder machine MainServo in mother and sons' module2Location candidate set is
Constraint 5:Control board ctrl in the battery battery, son's module1With the control in mother and sons' module
Circuit board ctrl processed2Location candidate set be respectively Γbattery、WithWherein, Γbattery、WithIn
Position candidate is five dimension coordinatesWherein, ci=battery, ctrl1,ctrl2。
5. method according to claim 3, it is characterised in that the step Q2 includes:
The size of the element inputted according to user, is calculated by the first formula and obtains length in son's module/mother and sons' module
For the length minimum value S on S+1 sidemin+ 1, and then obtain S minimum value Smin;
The size of the element inputted according to user, is calculated by the second formula and obtains length in son's module/mother and sons' module
For the length maximum S on S+1 sidemax+ 1, and then obtain S maximum Smax;
In S in the form of arithmetic progressionminAnd SmaxBetween choose predetermined number numerical value, constitute length of side S candidate collection;
Wherein, first formula is:
Smin+ 1=HMainServo+2×WSmallServo+2×WLink+ τ,
Wherein, HMainServoFor the height of main steering wheel fuselage sections, WSmallServoFor small steering wheel thickness, WLinkIt is wide for single connector
Degree, τ is tolerance;
Second formula is:
Wherein,For the thickness of the control board in son's module,For the thickness of the control board in mother and sons' module
Degree, WbatteryFor the thickness of battery.
6. method according to claim 4, it is characterised in that the step Q3 includes:
A value in Q31, selection length of side S candidate collection, according to selected S value and the sky of each element
Between position constraint, calculate each element ciLocation candidate set Γi;
Q32, to each element ci, in its location candidate set ΓiOne position candidate of middle selection, and be the position candidate automatically
Supporting construction is generated, the RANDOM SOLUTION s of an internal structure is obtained;
Q33, according to default element orders, judge whether current internal structure s collides;
Q34, the internal structure s for not colliding, calculate its structural strength, space availability ratio and assembling capacity respectively, and
By the 3rd formula by the structural strength, space availability ratio and assembling capacity weighted sum, current internal structure s energy is obtained
Flow function value F;
Wherein, the 3rd formula is:
F=w1fstruct+w2fspace+w3fassembly
Wherein, fstructFor structural strength, fspaceFor space availability ratio, fassemblyFor assembling capacity, w1For the power of structural strength
Weight, w2For the weight of space availability ratio, w3For the weight of assembling capacity, w1、w2And w3It is nonnegative value.
7. method according to claim 6, it is characterised in that the step Q33, including:
Internal structure set struct is initially set to empty set
Given set I=i | and i=1,2,3 ..., 8 }, correspondingly default element orders are:
{SmallServo1,SmallServo2,SmallServo3,MainServo1,
MainServo2,battery,ctrl1,ctrl2};
According to the default element orders, each element c in current internal structure s is judgediWhether occur with existing struct
Collision;
In the event of colliding, return and perform the step Q32;
It is current elements c if do not collidediGenerate its supporting construction S (ci), and update internal structure using the 4th formula
Set struct value;
Work as i==5, determine position and the revolution space Sweep of connectorlink, and update internal structure set using the 5th formula
Struct value;
If all 8 elements judge to finish and do not collide, it is determined that current internal structure s does not collide;
Wherein, the 4th formula is:
Struct=struct ∪ ci∪S(ci);
5th formula is:
Struct=struct ∪ Sweeplink。
8. method according to claim 6, it is characterised in that the internal junction not collided for judging to obtain
Structure s, calculates its structural strength, space availability ratio and assembling capacity respectively, including:
For the internal structure s not collided for judging to obtain:
Apply the torque of gravity and steering wheel as external force, using the 6th formula, calculating obtains structural strength fstruct;
Using the 7th formula, calculating obtains space availability ratio fspace;
Component placement in the internal structure s not collided obtains a corresponding assembling matrix M, and M is n × n side
Battle array, n is (i, j) representation element c in number of elements, MiIn element cjIn the presence of do not collide in the case of assembly direction;Root
According to preassigned Assembly sequences Π=(c1,c2,…,cn), calculate V (i)=∩j<iM (i, j), wherein cjRepresent in ciFill before
The element matched somebody with somebody;And if only ifWhen, Π is effective Assembly sequences;Calculate effective Assembly sequences Π=(c1,
c2,…,cn) redirection number of times, and according to the redirection number of times, using the 8th formula, calculating obtains assembling capacity;
Wherein, the 6th formula is:
Wherein, σabs_maxFor the maximum absolute stress on internal structure s, σrefFor preset reference stress;
7th formula is:
Wherein, VolmaleFor the volume of son's module, VolfemaleFor the volume of mother and sons' module, Vol (ci) it is element ciVolume;
8th formula is:
Wherein, nreorientFor effective Assembly sequences Π redirection number of times.
9. method according to claim 6, it is characterised in that the effective Assembly sequences Π=(c of calculating1,c2,…,
cn) redirection number of times, including:
IfThen in assembling ci,…,cjDuring be not required to redirect, ifAnd
Then assemble cj+1When need once to redirect;Count effective Assembly sequences Π=(c1,c2,…,cn) redirection number of times.
10. method according to claim 7, it is characterised in that the default optimized algorithm is simulated annealing, accordingly
Ground, the step Q4, including:
R1, set optimal energy functional value to be initial value, give set I={ i | i=1,2,3 ..., 8 }, correspondingly default element
Sequentially it is:
{SmallServo1,SmallServo2,SmallServo3,MainServo1,
MainServo2,battery,ctrl1,ctrl2, adjacent solution s '=s is set,
Indicate flag=true;
If R2, flag=true, the number i in set I is randomly choosed, in the corresponding location candidate set Γ of iiIt is interior random
Another position is selected to obtain internal structure s ' instead of current location;
R3, the current internal structure s in the step Q33 replaced with into internal structure s ', by performing the step Q33, sentenced
Whether disconnected internal structure s ' collides;If internal structure s ' collides, return and perform the step R2;If internal
Structure s ' does not collide, then flag=false, using the s ' not collided as RANDOM SOLUTION s adjacent solution;
R4, the internal structure s not collided in the step Q34 is replaced with to the s ' not collided, it is described by performing
Step Q34, the energy function value for the s ' not collided;
R5, the Metropolis criterions according to simulated annealing, calculate from current RANDOM SOLUTION s be changed into its adjacent solution s ' can
Can property probability P;
If R6, possibility probability P are more than predetermined threshold value, current RANDOM SOLUTION s is updated to s ', and T is updated to 0.95T;
R7, circulation perform the step R1-R6, until iterations reaches preset times and F '-F<0;
If R8, the energy function value of current RANDOM SOLUTION are less than optimal energy functional value, current internal structure is updated, and will most
Excellent energy function value is updated to the energy function value of current RANDOM SOLUTION;
Wherein, the predetermined threshold value is a random number between 0 to 1, and the Metropolis criterions of the simulated annealing are:
Wherein, T is Current Temperatures, and F is current RANDOM SOLUTION s energy function value, and F ' is current RANDOM SOLUTION s adjacent solution s ' energy
Flow function value.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710296302.1A CN106965167B (en) | 2017-04-28 | 2017-04-28 | Modularization robot optimization of inside structure method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710296302.1A CN106965167B (en) | 2017-04-28 | 2017-04-28 | Modularization robot optimization of inside structure method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106965167A true CN106965167A (en) | 2017-07-21 |
CN106965167B CN106965167B (en) | 2019-05-14 |
Family
ID=59330372
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710296302.1A Active CN106965167B (en) | 2017-04-28 | 2017-04-28 | Modularization robot optimization of inside structure method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106965167B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109358503A (en) * | 2018-10-22 | 2019-02-19 | 重庆大学 | One kind is towards energy-efficient machine tool motion component multiple objectives structure optimization method |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101288951A (en) * | 2008-03-10 | 2008-10-22 | 哈尔滨工业大学 | Double L-shaped cubic modularized self-reconstruction robot based on rotary hook hole |
CN103264389A (en) * | 2013-05-14 | 2013-08-28 | 东南大学 | Omni-directional moving unit module structure of modularized self-reconfiguration robot |
CN103332231A (en) * | 2013-07-12 | 2013-10-02 | 天津理工大学 | Mobile modularized self-reconfigurable robot |
US20150240848A1 (en) * | 2014-02-24 | 2015-08-27 | Robobuilder Co., Ltd. | Joining apparatus of module actuator |
-
2017
- 2017-04-28 CN CN201710296302.1A patent/CN106965167B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101288951A (en) * | 2008-03-10 | 2008-10-22 | 哈尔滨工业大学 | Double L-shaped cubic modularized self-reconstruction robot based on rotary hook hole |
CN103264389A (en) * | 2013-05-14 | 2013-08-28 | 东南大学 | Omni-directional moving unit module structure of modularized self-reconfiguration robot |
CN103332231A (en) * | 2013-07-12 | 2013-10-02 | 天津理工大学 | Mobile modularized self-reconfigurable robot |
US20150240848A1 (en) * | 2014-02-24 | 2015-08-27 | Robobuilder Co., Ltd. | Joining apparatus of module actuator |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109358503A (en) * | 2018-10-22 | 2019-02-19 | 重庆大学 | One kind is towards energy-efficient machine tool motion component multiple objectives structure optimization method |
CN109358503B (en) * | 2018-10-22 | 2022-04-08 | 重庆大学 | Energy-saving-oriented machine tool moving part multi-target structure optimization method |
Also Published As
Publication number | Publication date |
---|---|
CN106965167B (en) | 2019-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
He et al. | Digital twin-based sustainable intelligent manufacturing: A review | |
Song et al. | A novel five-degree-of-freedom parallel manipulator and its kinematic optimization | |
JP6154543B2 (en) | 3D modeling system, information processing apparatus, 3D modeling model arrangement method, and 3D modeling model arrangement program | |
CN104658033B (en) | Global illumination method for drafting and device under multiple light courcess | |
CN107481311A (en) | D Urban model rendering intent and device | |
Daniel Finistauri et al. | Reconfiguration analysis of a fully reconfigurable parallel robot | |
CN101901287A (en) | Geometry and behavior integrated three-dimensional modeling method for spacecraft | |
CN106709203A (en) | Three-dimensional simulating method for Texgen-based weft-knitted fabric model | |
CN103390101A (en) | General calculation method for inverse kinematics of serial robots | |
CN102393826A (en) | Multi-core parallel processing based flexible scene continuous collision detection method | |
Jiang et al. | A multi-objective optimization and decision algorithm for locator layout continuous searching in checking fixture design | |
CN106965167A (en) | Modularization robot optimization of inside structure method | |
GB2227106A (en) | Detecting collision | |
CN103810351B (en) | Data processing method and device on basis of computer-aided design | |
Du et al. | Fast continuous collision culling with deforming noncollinear filters | |
Khalilpour et al. | Kinematic performance indices analyzed on four planar cable robots via interval analysis | |
CN103438905B (en) | A kind of star sensor star catalogue complete evaluation method | |
CN113469337A (en) | Compiling method for optimizing neural network model and related product | |
CN115409678A (en) | Method for fusing operators of neural network and related product | |
CN115408568A (en) | Method for fusing operators of neural network and related product | |
Tian et al. | Multi-loop rover: a kind of modular rolling robot constructed by multi-loop linkages | |
Camata et al. | Parallel linear octree meshing with immersed surfaces | |
CN202929477U (en) | Automatic guided vehicle control system | |
CN106600641B (en) | Embedded visual servo control method based on multi-feature fusion | |
Lee et al. | Motion and virtual cutting simulation system for a five-axis virtual machine tool |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |