WO2019044653A1 - 力センサ、トルクセンサ、力覚センサ、指先力センサ、およびその製造方法 - Google Patents

力センサ、トルクセンサ、力覚センサ、指先力センサ、およびその製造方法 Download PDF

Info

Publication number
WO2019044653A1
WO2019044653A1 PCT/JP2018/031156 JP2018031156W WO2019044653A1 WO 2019044653 A1 WO2019044653 A1 WO 2019044653A1 JP 2018031156 W JP2018031156 W JP 2018031156W WO 2019044653 A1 WO2019044653 A1 WO 2019044653A1
Authority
WO
WIPO (PCT)
Prior art keywords
elastic structure
elastic
force sensor
sensor
force
Prior art date
Application number
PCT/JP2018/031156
Other languages
English (en)
French (fr)
Inventor
根岸 真人
Original Assignee
キヤノン株式会社
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 キヤノン株式会社 filed Critical キヤノン株式会社
Priority to CN201880055047.4A priority Critical patent/CN111094922B/zh
Publication of WO2019044653A1 publication Critical patent/WO2019044653A1/ja
Priority to US16/781,419 priority patent/US11220010B2/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085Force or torque sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/081Touching devices, e.g. pressure-sensitive
    • B25J13/082Grasping-force detectors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/081Touching devices, e.g. pressure-sensitive
    • B25J13/084Tactile sensors
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L1/00Measuring force or stress, in general
    • G01L1/04Measuring force or stress, in general by measuring elastic deformation of gauges, e.g. of springs
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L3/00Measuring torque, work, mechanical power, or mechanical efficiency, in general
    • G01L3/02Rotary-transmission dynamometers
    • G01L3/04Rotary-transmission dynamometers wherein the torque-transmitting element comprises a torsionally-flexible shaft
    • G01L3/08Rotary-transmission dynamometers wherein the torque-transmitting element comprises a torsionally-flexible shaft involving optical means for indicating
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L3/00Measuring torque, work, mechanical power, or mechanical efficiency, in general
    • G01L3/02Rotary-transmission dynamometers
    • G01L3/04Rotary-transmission dynamometers wherein the torque-transmitting element comprises a torsionally-flexible shaft
    • G01L3/10Rotary-transmission dynamometers wherein the torque-transmitting element comprises a torsionally-flexible shaft involving electric or magnetic means for indicating
    • G01L3/101Rotary-transmission dynamometers wherein the torque-transmitting element comprises a torsionally-flexible shaft involving electric or magnetic means for indicating involving magnetic or electromagnetic means
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/16Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring several components of force
    • G01L5/166Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring several components of force using photoelectric means
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/16Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring several components of force
    • G01L5/169Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring several components of force using magnetic means

Definitions

  • the present invention relates to a force sensor that measures force and torque, and a method of manufacturing the same.
  • the present invention relates to a force sensor suitably used in the field of an automatic assembly apparatus, a robot, and the like.
  • torque sensors for detecting torque and force.
  • force sensors for detecting torque and force.
  • the torque sensor is attached to, for example, a rotary joint of a robot, and is used as a device that measures torque in one direction transmitted through the joint.
  • a force sensor is disposed, for example, on a wrist between a robot arm and a robot hand, and is used as a device for detecting forces or moments in six directions applied to the tip of the robot hand.
  • the fingertip force sensor is used, for example, as a device that measures forces in three directions applied to the fingertip of the end of the robot hand and detects the force that the object to be grasped receives from the environment.
  • Japanese Patent Laid-Open No. 2010-169586 discloses a torque sensor that measures the rotational torque about the Y axis generated between the first member and the second member.
  • the torque sensor includes a strain-flexing portion disposed between the first member and the second member, and includes a plurality of pillars connected to the first member and the second member outside the strain-flexing portion.
  • the torque sensor described in Patent Document 1 is a sensor that deforms the strain generating portion when a twisting torque is applied, reads this deformation with a strain gauge, and converts it into a torque value.
  • the column portion since the column portion is provided, it is perpendicular to the Y axis Even if a bending moment force is applied around an axis, the deformation of the strain generating portion can be suppressed.
  • the column supporting the bending moment needs to be rigid against the bending moment but must be soft against the rotational torque. If it is hard, since the column portion also supports the rotational torque, the deformation of the strain generating portion is suppressed, and it becomes difficult to measure the torque. In order to make it softer against rotational torque, it is necessary to increase the length of the column, but if the length is increased, the first and second members which are objects to measure rotational torque around the Y axis The distance gets far.
  • the measurement sensitivity decreases as the distance to the object to be measured increases. Therefore, increasing the length of the column makes it difficult to construct a highly sensitive sensor.
  • achieving a sensitivity (resolution) of 1 nm at a long distance of 10 mm is much more difficult than achieving the same sensitivity at a short distance of 10 ⁇ m.
  • a magnetic displacement meter is a displacement meter that utilizes the fact that the strength of the magnetic field of a permanent magnet changes with distance.
  • B is the magnetic flux density at a distance x from the magnet
  • Br is the residual magnetic flux density of the magnet
  • the size of the part to which the detection unit for detecting a change in magnetism must be increased.
  • An increase in size is disadvantageous for a highly sensitive sensor, considering the temperature of the mounting parts, dimensional changes due to its own weight, and vibrations.
  • the sensor since the length of the column portion is required, the sensor becomes thick.
  • the thickness of the sensor affects the size of each joint, for example, when it is mounted as a robot part, and if the thickness increases, it adversely affects the movable area of the joint and the working area of the robot.
  • the present invention is a force sensor for detecting information of force by a relative displacement amount between a first member and a second member, wherein the first member and the second member are a first elastic structure, The first elastic structure connects the first member and the intermediate member, and the second elastic structure connects the second member with the second member. The first member and the second member are connected to the intermediate member, and the first member and the second member are provided with displacement detection means for detecting a relative displacement amount between the first member and the second member. It is a force sensor.
  • FIG. 1 shows a six-axis articulated robot 100 equipped with a force sensor according to a first embodiment of the present invention.
  • the force sensor according to this embodiment is attached to six revolute joints J1 to J6 connecting between the links 200 to 206, and measures the torque transmitted through the joints.
  • the force sensor according to the present embodiment may be referred to as a torque sensor in the following description.
  • FIG. 2 the structural example which changed the attachment method of the torque sensor is shown in FIG.
  • the torque sensor 522 is fixed by bolting from both sides, but in the example of FIG. 3, bolting from one side is possible.
  • the sensor of this embodiment is more suitable for such joint configurations. Also in this example, since the thickness Lb of the joint is determined by the motor 512 and the torque sensor 522, the smaller thickness of the torque sensor is preferable.
  • the configuration of the torque sensor according to the present embodiment is shown in the schematic perspective view of FIG. 4 and the partial cross-sectional view of FIG. For convenience of description, XYZ coordinates are defined at the center of the sensor. The method of mounting this torque sensor will be described in the case of the J2 joint shown in FIG.
  • the torque sensor comprises a first member 1 and a second member 2, wherein the first member 1 is fixed to the motor 512 and the second member 2 is fixed to the link 202.
  • an intermediate member 4 is provided, and the first member 1 and the intermediate member 4 are connected by a first elastic structure 5 such as a leaf spring, and the second member 2 and the intermediate member 4 are second elastic structures such as a leaf spring Connect with body 6
  • a first elastic structure 5 such as a leaf spring
  • the second member 2 and the intermediate member 4 are second elastic structures such as a leaf spring Connect with body 6
  • a plurality of elastic structures 5 and a plurality of elastic structures 6 are provided, and are alternately arranged.
  • the first member 1, the second member 2, the intermediate member 4, the first elastic structure 5, and the second elastic structure 6 constitute an elastic body 7 of a torque sensor.
  • the first member and the second member disposed around the Z axis, which is a central axis, have annular portions that are concentric but have different radii.
  • Angle detecting means for measuring the displacement (relative angle) of the first member and the second member are provided at two positions located opposite to each other across the Z axis.
  • the angle detection means includes the scale 8 and the sensor substrate 9 and outputs the relative displacement of the scale 8 and the sensor substrate 9.
  • the distance between the first member and the second member is smaller than any one of the distance between the intermediate member and the first member and the distance between the intermediate member and the second member.
  • the first member, the second member, and the intermediate member are an end portion connected to the first elastic structure in the first member, and an end portion connected to the second elastic structure in the second member. And are opposed to the end of the intermediate member connected to the first and second elastic structures.
  • the distance to be detected (the distance between the first member and the second member) is short.
  • the scale 8 and the sensor substrate 9 can also be close, which is an advantageous configuration for achieving high sensitivity. Furthermore, with this configuration, the component size for mounting the detection means can be small. It is important to reduce the size as dimensional changes and vibrations of this part affect the accuracy of the measurement.
  • the distance between the first member and the second member is preferably in the range of 10 ⁇ m to 10 mm.
  • the relative positions of the first member and the second member change due to the deformation of the elastic body, so the distance between the first member and the second member is greater than the maximum deformation of the elastic body to prevent contact. It must be big. Increasing the rigidity of the elastic body can reduce the maximum deformation amount and is preferable for reducing the distance, but if the distance is too small, the displacement detection means needs to have extremely high measurement sensitivity. Therefore, practically, the distance between the first member and the second member is preferably about 10 ⁇ m. The lower limit is preferably 10 ⁇ m also in consideration of the machining accuracy of machine parts.
  • the upper limit of the distance between the first member and the second member affects the size of the torque sensor.
  • the upper limit is preferably about 10 mm.
  • the sensor substrate 9 is fixed to the first member 1 by the mounting bolt 10, and the scale 8 is adhesively fixed to the second member 2.
  • Signal lines from the two sensor boards 9 are connected to the control board 11 of the torque sensor.
  • the control board 11 performs the following signal processing. That is, the relative angle of the first member and the second member is calculated by averaging the outputs of the two sensor substrates 9 and dividing by the mounting radius of the displacement detection means. This relative angle is multiplied by the torsional rigidity Kz of the elastic body 7 which is information set in advance, converted into a value of torque, and output.
  • the distance between the first member 1 and the second member 2 is small. As described above, measuring the relative distance between parts having a small distance can achieve higher sensitivity than when the distance is large.
  • the rigidity ratio can be increased by increasing the number of elastic structures. For example, if the number of the first elastic structure and the number of the second elastic structure are 192, four times the rigidity ratio can be expected.
  • the size and the number of elastic structures can be designed by simulation using, for example, a finite element method.
  • the torque sensor is composed of an elastic body and rotation angle measuring means, the mechanical performance is determined by the elastic body. Therefore, first, from the viewpoint of material dynamics, the characteristics of the structure in which elastic structures are arranged on the circumference are clarified. In particular, it is clarified that the larger the ratio of the rigidity in the twisting direction and the bending direction is, and the higher performance torque sensor can be configured, as the number of elastic structures is larger.
  • XYZ coordinates are set at the center of the torque sensor.
  • a bending torque Mx is also applied to the torque sensor.
  • the torque sensor detects torsional deformation due to Mz, that is, a minute rotation angle, and converts it into a torque value using the torsional rigidity Kz. Therefore, the stiffness Kz is a design value determined from the measurable range of the torque sensor, the resolution of the rotation angle detection means, and the like.
  • the rigidity Kx or Ky in the bending direction orthogonal to the twisting direction affects the natural frequency of the entire device to which the torque sensor is attached, so it is preferable to be hard. If it can not be hardened, the joints of the robot arm shown in FIG. 1 become soft, so that the natural frequency decreases and it becomes easy to vibrate.
  • the torque sensor it is important for the torque sensor that the rigidity Kx or Ky in the bending direction is higher than the rigidity Kz in the torsion direction.
  • the first member 1 and the second member 2 are made to face each other as in the conventional torque sensor, and a plurality of elastic structures 3a, 3b, 3c,. It is connected with.
  • the rotational stiffness Kz about the Z axis is defined as the bending stiffness of an elastic structure arranged N pieces around the radius R as Ks,
  • the rotational stiffness Kx around the X axis is defined as the stiffness in the compression direction of N elastic structures, as Kp,
  • the torque sensor has a high stiffness Kx in the direction of the bending relative to the stiffness Kz in the direction of the measurement. Assuming that the rigidity ratio of the two is ⁇ ,
  • the thickness H may be changed in inverse proportion to 1/3 power of N so that the rigidity Kz which is the design condition does not change even if the number N of elastic structures is increased.
  • FIG. 1 A graph plotting the rigidity ratio ⁇ against the number N of elastic structures is shown in FIG. As apparent from this figure, it is possible to configure a torque sensor with a higher rigidity ratio as the number of elastic structures increases.
  • FIG. 17A is a cross-sectional view of the conventional torque sensor elastic body described in FIG.
  • the elastic structure 3 connects the first member 1 and the second member 2.
  • an intermediate member 4 is provided, the first member 1 and the intermediate member 4 are connected by the first elastic structure 5, and the second member 2 and the intermediate member 4 are secondly Are connected by the elastic structure 6 of
  • the stiffness is inversely proportional to the third power of L according to Equation 3, the length L is about 0.8 times, and the thickness of the torque sensor can be reduced by about 20%.
  • the thin torque sensor can be realized by the present embodiment having the two-stage elastic structure structure.
  • the thickness can be further reduced by the amount of inclination.
  • the thickness is sin (45 degrees), so it can be thinned by about 30%.
  • this configuration also has other effects.
  • the intermediate member 4 is deformed by the bending torque Mx, and the bending rigidity is reduced.
  • the configuration of FIG. 17C since the size of the intermediate member 4 can be reduced to half or less, the deformation of the intermediate member is suppressed and the bending rigidity is increased. As a result, a torque sensor with high rigidity ratio can be configured.
  • FIG. 7 is a perspective view illustrating the three-dimensional configuration of the torque sensor of the present embodiment.
  • the first member and the second member are arranged along the same plane, and the intermediate member is arranged such that at least a part of the projection overlaps the gap between the first member and the second member when projected onto the plane. It is arranged away from the plane.
  • the plurality of first elastic structures are arranged such that the inclination when viewed from the first member toward the intermediate member is away from the center of the annular portion.
  • the plurality of second elastic structures are arranged such that the inclination when viewed from the second member to the intermediate member is directed to the center of the annular portion.
  • the elastic body of the present embodiment can be manufactured using a lamination molding apparatus or a lamination molding method.
  • the overhang angle is limited, and in particular, it is difficult to form a horizontal ceiling.
  • the overhang angle can be suppressed within the limit by connecting a large number of elastic structures and connecting the elastic structures and the elastic structures with the inclined surface S. It is possible.
  • FIG. 6A is a view for explaining the constraint conditions of the additive manufacturing method.
  • the arched target object 111 is formed on the base 110.
  • This shaped object is overhanging, and the overhanging angle at point Q in the figure is ⁇ .
  • this overhang angle has a limit, and a portion larger than the angle can not be shaped.
  • This angle is, for example, an angle of 60 degrees.
  • the horizontal ceiling can not be generally shaped because the overhang angle is 90 degrees.
  • FIG. 6B shows a shape 112 capable of being layered and formed. This is a shape obtained by cutting a portion where the limit angle of the overhang is ⁇ or more.
  • FIG. 8 shows a schematic view of an elastic body focusing on the overhang angle.
  • portions where overhang is a concern are S 1 to S shown in FIGS. 7 and 8.
  • the pitch B of the elastic structure is narrower, that is, the number of elastic structures is larger. Increasing the number of elastic structures also helps to improve the stiffness ratio of the torque sensor, as will be described later.
  • the elastic body in the present embodiment can improve the rigidity ratio, suppress the overhang angle, and enable layered manufacturing.
  • FIG. 9A is an FEM model of an elastic body used for simulation. The difference from the schematic view of FIG. 4 is as follows. A: In order to mount the displacement detection means on the upper side, two areas where the elastic structure is not provided are disposed. B: A bolt hole was provided to attach a torque sensor. C: In order to reduce the volume of the elastic body, the top of the intermediate member was rounded.
  • FIG. 10 stress distribution of the elastic structure when twisting torque Mz is applied is shown in FIG.
  • 1 denotes a first member
  • 2 denotes a second member
  • 4 denotes an intermediate member
  • 5 denotes a first elastic structure
  • 6 denotes a second elastic structure 6.
  • intensity of the color is used to indicate the magnitude of stress, the lighter the color, the larger the stress, and the darker the color, the smaller the stress.
  • the stress concentrates most at the lower and outer A parts, and the second largest stress is at the upper and inner B parts.
  • the stress concentrates most at the lower and inner C parts, and the second largest stress is at the upper and outer D parts.
  • One solution is to reduce the thickness of the elastic structure.
  • the distance from the neutral plane of the elastic structure with small stress is shortened, and the stress can be reduced.
  • the maximum value of stress can be reduced by thinning portions A to D where stress concentrates in the figure.
  • This elastic structure is shown in FIG.
  • the thickness is drawn in an exaggerated manner at an unequal scale for the convenience of explanation.
  • the thickness of the portions A to D where the stress is large in the above-described deformation simulation is reduced.
  • As another method of reducing stress there is a method of giving a curvature at a corner to make it smooth, but a combination with such a method is also effective.
  • the senor according to the present embodiment since the sensor according to the present embodiment has a small overhang angle, it can be manufactured by the additive manufacturing method.
  • FIG. 12A is an exploded view of the modeling unit 20
  • FIG. 12B is a completed view of the modeling unit 20 assembled.
  • the first member 1 and the second member 2 are ring-shaped parts.
  • the shape is manufactured in advance by a lathe or the like, and screwed to the forming plate 21 to complete the forming unit 20.
  • the powder of the molding material is laminated, and laser light is irradiated according to the shapes of the first elastic structure, the second elastic structure, and the intermediate member to form the first elastic structure and the second elastic structure. Form the intermediate member.
  • FIG. 13A is a view in which the first elastic structure, the second elastic structure, and the intermediate member are formed on the forming unit 20 using the layered forming apparatus to form the elastic body 7. It has already been described that this shape can be produced by additive manufacturing. When the fixing screw of the shaping plate is removed, the completed elastic body 7 can be taken out as shown in FIG. 13B.
  • the first member and the second member are releasably positioned and fixed with respect to the modeling plate, and the layers of the modeling material are stacked on the upper surfaces of the first member and the second member to form the first elastic structure and the second elastic structure.
  • the elastic structure and the intermediate member of the After forming a three-dimensional structure in which the first member, the second member, the first elastic structure, the second elastic structure, and the intermediate member are integrated, the three-dimensional structure is detached from the formation plate.
  • This manufacturing method can reduce the manufacturing cost in the following points as compared with the conventional additive manufacturing method.
  • the object is separated by mechanical processing such as wire cutting.
  • the process is simplified and cost can be reduced because the object is detached simply by removing the screw.
  • machining after shaping can be minimized.
  • a portion of the three-dimensional structure requiring high accuracy has to be machined after formation.
  • a dedicated jig for processing is required, which is costly.
  • the first member and the second member requiring the accuracy are prepared in advance, and additional modeling is not required for this portion, additional machining is unnecessary, and the cost can be reduced.
  • the amount of build material can be reduced.
  • the molding material used in the additive manufacturing method is generally expensive. According to the present embodiment, since only a part of the elastic body 7 is formed instead of being laminated and formed, the number of forming materials can be reduced, and the cost can be suppressed. More specifically, since the first member 1 and the second member 2 of the elastic body 7 are not laminated and formed, expensive molding material can be saved.
  • the shaping plate it is possible to use the shaping plate repeatedly.
  • the layered manufacturing method which carries out the laser sintering of the modeling material laminated on the modeling plate, since the surface of a modeling plate is melted by laser irradiation after modeling, it can not be used for the next modeling.
  • the laser beam since the laser beam does not hit the shaping plate, it does not deteriorate and can be used many times, so that the manufacturing cost of the elastic structure can be reduced.
  • the torque sensor of the present embodiment can be manufactured by the additive manufacturing method, and the manufacturing cost can be reduced. In addition, even if a manufacturing error occurs, the manufacturing error of one elastic structure is averaged since the number of elastic structures is large, and the functional influence is small.
  • the layered manufacturing method can form a complicated shape, so it is easy to increase the number of elastic structures and to further improve the rigidity ratio in the twisting direction and the bending direction.
  • the method of manufacturing by the additive manufacturing method was described in this embodiment, it may not restrict to this and may manufacture only by machining depending on the case.
  • the cross section of the elastic structure was demonstrated as a rectangle in this embodiment, it is not limited to a rectangle.
  • a thin sensor with a high rigidity ratio can be realized.
  • a structure without a horizontal ceiling can be adopted, a sensor that can be manufactured by the additive manufacturing method can be realized.
  • stress concentration applied to the elastic structure can be alleviated, fatigue failure of the elastic structure can be prevented, the life of the torque sensor can be extended, and reliability can be improved.
  • FIG. 14 shows a partial perspective view of a modification of the first embodiment.
  • the first embodiment is different from the first embodiment in that the elastic structure is divided into slits.
  • a slit of a gap G is provided at the center of the first elastic structure, and a structure consisting of two pieces 5a and 5b is used.
  • the second elastic structure also has a structure consisting of two pieces 6a and 6b. That is, the first elastic structure and / or the second elastic structure have a plurality of elastic bodies separated by the slits.
  • the torsional rigidity of the elastic structure that is, the torsional rigidity around the ⁇ axis in FIG. 14 is proportional to the polar moment of the second cross section.
  • the cross-sectional secondary pole moment Ip 1 of one elastic structure having a cross section of a ⁇ b can be calculated by the following equation.
  • the term "division" as used herein does not mean to physically cut and separate what was originally an object, but to constitute the elastic structure including two independent parts. It means that. Therefore, the two parts separated and disposed across the slit may be formed by the additive manufacturing method.
  • the above equation becomes smaller than half. That is, even if the number of elastic structures is two, the cross-sectional secondary pole moment is smaller than half, so the overall torsional rigidity decreases.
  • the rigidity in the ⁇ -axis direction in the figure is proportional to the cross-sectional area of the elastic structure. If the gap G for dividing the elastic structure is made sufficiently small, the same rigidity as before dividing can be obtained. Since the rigidity in the ⁇ -axis direction does not change, the rigidity in the bending direction of the torque sensor also does not change.
  • the torsional rigidity decreases and the bending rigidity does not change. Therefore, the ratio of stiffness in the bending direction to stiffness in the torsional direction can be further increased.
  • the gap G for separating the elastic structure is described as being sufficiently small. If the design is performed in a range that satisfies this assumption, the rigidity ratio can be improved as the number of divisions increases.
  • a light beam emitted from a laser light source 1001 is collimated by a collimator lens 1002, passes through a polarization beam splitter 1017 and a wavelength plate 1005, is incident on a first diffraction grating 1101, and is split into two as first-order diffracted light. Diffracted light enters the second reflective diffraction grating 1102, and the reflected diffracted light again transmits through the diffraction grating 1101 and interferes. Light and dark of the interference light are detected by the light receiving unit 1008.
  • a technique for determining the moving direction by providing two light receiving means 1008 and measuring the phase of the interference light is also known, for example, from Japanese Patent Application Laid-Open No. 63-311121.
  • A100 is a circuit unit in which an optical unit and an electric circuit are integrated and integrated.
  • the circuit portion A100 is provided with an electrode for extracting an electrical signal.
  • the scale A101 having the diffraction grating is held with a predetermined gap from the circuit part A100, and can measure the relative displacement in the direction of the engraved A102 of the diffraction grating.
  • FIG. 56 shows a torque sensor constructed by incorporating this light sensor. Compared to the previous embodiment, only the part where the magnetic sensor is changed to the light sensor differs.
  • the scale A 101 a is fixed to the second member 2 and provided.
  • This scale A101a has a diffraction grating in the direction A102a. As illustrated, the rotation direction about the Z axis coincides with the direction A102a of the scale.
  • the circuit portion A100a is fixed to the electric substrate A103a so as to face the scale A101a.
  • the electrical substrate A103a for the light sensor is fixed to the first member using the screw 10.
  • Another set of the above A100a to A103a is provided at symmetrical positions with respect to the Z axis, such as A100b to A103b. Signals from the electric substrates A103a and A103b for light sensors are connected to the control substrate 11, and the relative rotational displacement of the first member 1 and the second member 2 is output.
  • the configuration of the remaining part and the operation are the same as those of the above-described embodiment, and thus the description thereof is omitted.
  • Second Embodiment In the first embodiment, in the robot system shown in FIG. 1, an example of the torque sensor attached to the revolute joints J1 to J6 is shown. In the second embodiment, a force sensor disposed and used at a wrist between the robot arm and the robot hand 210 will be described.
  • the force sensor according to the present embodiment may be referred to herein as a force sensor.
  • the force sensor 207 detects forces in six directions and rotational moment applied to the tip of the hand during assembly work and the like, and the controller 102 controls the robot according to the measured value.
  • the distance P from the force sensor 207 to the tip of the hand is generally not small. For example, it is 100 mm or more.
  • the force sensor 207 needs to have high moment rigidity, because the force applied to the tip can not assemble it with high accuracy if the position of the tip of the hand is shifted.
  • FIG. 18 is a perspective view showing the configuration of a force sensor according to a second embodiment
  • FIG. 19 is a partial sectional view
  • FIG. 20 is a partially enlarged view.
  • the elastic body 607 of the force sensor includes a first member 602 fixed to the robot arm, a second member 603 fixed to the robot hand, and an intermediate member 604.
  • the first member 602 and the intermediate member 604 are connected via a first elastic structure 605 such as a leaf spring
  • the second member 603 and the intermediate member 604 are connected with a second elastic structure such as a leaf spring.
  • the first elastic structure 605 is arranged to be inclined with respect to the normal direction from the surface of the outer surface of the first member 602 connected to the first elastic structure.
  • the second elastic structure 606 is disposed to be inclined with respect to the normal direction from the surface of the outer surface of the second member 603 that is connected to the second elastic structure.
  • the first and second members have annular portions that are concentric but have different radii.
  • the plurality of first elastic structures 605 are arranged such that the inclination when viewed from the first member toward the intermediate member is aligned counterclockwise, and the plurality of second elastic structures 606 are The inclination when viewed from the two members toward the intermediate member is arranged in a clockwise direction. Since the first elastic structure and the second elastic structure may be arranged in the opposite direction, the clockwise and counterclockwise relationship may be reversed.
  • the plurality of first elastic structures are disposed in a direction in which the inclination when viewed from the first member toward the intermediate member is directed toward the center of the annular portion, and the plurality of second elastic structures are The inclination as viewed from the member to the intermediate member is arranged to be away from the center of the annular portion.
  • the first elastic structure and the second elastic structure are disposed at a predetermined twist and tilt angle.
  • first member 602, the second member 603, and the intermediate member 604 are dimensioned so as to be sufficiently hard and not easily deformed with respect to the first elastic structure 605 and the second elastic structure 606. . Specifically, it is designed using a deformation simulation to be described later.
  • the number of elastic structures is shown as 36 in this embodiment, the moment rigidity can be further enhanced by increasing the number of elastic structures.
  • the size and the number of elastic structures are designed using a deformation simulation or the like described later.
  • a magnet 608 that constitutes the displacement detection means is adhesively fixed to the first member 2.
  • the position of the magnet in three directions is detected by a magnetoresistive element or a Hall element disposed around it.
  • the detection substrate 609 constituting the displacement detection means is fixed to the second member 3 using a screw 610. The purpose of screwing the substrate in this way is to adjust and fix the position with the fixed magnet.
  • the detection substrate 609 outputs three types of signals in accordance with the position of the magnet 608 in three directions. Since there are three sets of detection substrates, a total of nine signals can be obtained.
  • the distance between the first member and the second member is greater than any of the distance between the intermediate member and the first member and the distance between the intermediate member and the second member. small.
  • the first member, the second member, and the intermediate member are arranged in the same manner as in the first embodiment. As described above, since the displacement detection can realize high sensitivity when the distance between the detection target (the distance between the first member and the second member) is short, the configuration of the present embodiment is advantageous.
  • the distance between the first member and the second member is preferably in the range of 10 ⁇ m to 10 mm for the same reason as in the first embodiment.
  • the nine signals from the three sets of detection substrates are described as a vector a.
  • This signal or vector a is sent to the controller 102 of FIG. 1 and converted to a 6-axis force sense vector F using the following equation.
  • the matrix A i, j of 6 rows and 9 columns is a constant obtained in advance by experiments or deformation simulation to be described later. Specifically, a large number of combinations of signals a obtained for the force F applied to the force sensor are collected by experiment or simulation, and the coefficient matrix Ai, j is determined using the method of least squares.
  • the elastic body according to the present embodiment can be manufactured by the additive manufacturing method in consideration of the overhang angle as in the first embodiment.
  • FIG. 20 shows a conceptual view of the elastic body of the present embodiment focusing on the overhang angle.
  • the intermediate member 604 and the first elastic structure 605 connecting the two, parts where overhang is concerned are the three points A, B, and C shown in the figure.
  • A is the lower surface of the elastic structure, and the inclination angle of the elastic structure can be made equal to or less than the overhang angle, for example, 60 degrees or less.
  • B and C are the lower surfaces of the intermediate member, and in FIG. 20, the angles of the B and C planes determined by the distance D of the elastic structure 605 and the notch distance E of the intermediate member 604 are less than the overhang angle, for example It is possible to make it 60 degrees or less.
  • the notch distance E is related to the size in the longitudinal direction of the entire sensor, so it is desirable to reduce it. Therefore, it is preferable to reduce the distance D of the elastic structure 605. In other words, a configuration in which the number of elastic structures is large is preferable.
  • the elastic body according to the present embodiment can suppress the overhang angle, and can be manufactured by the additive manufacturing method.
  • the force sensor 207 is a device attached to a wrist portion between the robot arm and the hand to detect a force or a moment applied to the hand.
  • the displacement ⁇ in the force sensor should be as small as possible. This is because if the displacement is large, the position of the tip of the hand may be displaced, which may interfere with precision work such as assembly.
  • FIG. 25A consider the case where a hand 601 is connected to the tip of the cantilevered elastic structure, and an external force F in the horizontal direction is applied to the tip.
  • the external force F deforms as shown in FIG. 25B.
  • the distance P to the position to which the external force is applied is much larger than the size L of the elastic body in the force sensor.
  • L 10 mm
  • P 100 mm
  • the above ratio ⁇ is 15.
  • the influence of inclination is 15 times larger than the influence of horizontal movement. Therefore, in order to suppress the positional deviation of the tip, it is important to increase the moment rigidity more than the translational direction.
  • FIG. 26A a case is considered in which a hand 601 is connected to the ends of two elastic structures and an external force F in the horizontal direction is applied to the ends.
  • the external force F deforms as shown in FIG. 26B.
  • the displacement ⁇ of the tip is divided into the influence ⁇ F of horizontal movement and the influence ⁇ M of inclination.
  • ⁇ F is considered to apply a force evenly to the two elastic structures, it can be calculated by the following equation using the equation of the elastic structure fixed at both ends.
  • the force in the compression direction applied to the elastic structure is calculated as F 1 and the displacement thereof as ⁇ 1 as follows.
  • this embodiment utilizes the fact that the moment rigidity is higher than the rigidity in the translational direction of the elastic structure.
  • ⁇ F is considered to be uniformly applied to the N elastic structures, it can be calculated by the following equation using the equations of the elastic structures fixed at both ends.
  • the force in the compression direction applied to the i-th elastic structure is calculated as F i and the displacement thereof as ⁇ i as follows.
  • the force F i in the compression direction applied to the i-th elastic structure is determined as follows.
  • the horizontal movement ⁇ F increases in inverse proportion to the cube of the thickness h of the elastic structure.
  • the plate thickness h is defined by the following equation, where H is a constant.
  • the graph of Formula 34 is shown in FIG.
  • the horizontal axis is the number N of elastic structures.
  • the vertical axis is the ratio of the two elastic structures normalized to one, that is, ⁇ (N) / ⁇ (2).
  • a member connecting the first elastic structures is called an intermediate member 604, and a member connecting the second elastic structures is called a second member (action member) 603.
  • the two stages of elastic structures need to be arranged in different directions. If it is in the same direction, it is the same as the one-stage elastic structure, so the two-stage effect is not sufficiently exerted.
  • FIG. 30 schematically shows the structure of the elastic body in the present embodiment.
  • a first member (base member) 602 fixed to the robot arm, a second member (action member) 603 fixed to the robot hand, and an intermediate member 604 are provided, and a first elastic structure 605 and a second elasticity are provided therebetween.
  • the structures 606 are connected.
  • the first elastic structure 605 is arranged to be inclined with respect to the normal direction from the surface of the outer surface of the first member 602 connected to the first elastic structure.
  • the second elastic structure 606 is disposed to be inclined with respect to the normal direction from the surface of the outer surface of the second member 603 that is connected to the second elastic structure.
  • the first member (base member) 602, the second member (acting member) 603, and the intermediate member 604 must be harder than the elastic structures 605 and 606. Otherwise, the effect of the elastic structure is diminished and the moment rigidity is reduced. That is, the first member (base member) 602, the second member (action member) 603, and the intermediate member 604 are designed to have a sufficiently large thickness and width so as to be harder than the elastic structures 605 and 606.
  • the distance between the first member 602 and the second member 603 appears to be relatively large because they are shown at an unscaled scale for the convenience of illustration, but this distance is the distance between the first member and the intermediate member, and Smaller than the distance between the two members and the intermediate member.
  • the rigidity of the elastic body of the force sensor does not change depending on the direction. This is to prevent the measurement sensitivity of the force sensor from changing depending on the direction. Therefore, elastic structures are arranged circumferentially to realize a structure in which the rigidity does not depend on the direction.
  • FIG. 31A shows an exploded view of the elastic body 607 of the inclined two-step elastic structure disposed along the circumference
  • FIG. 31B shows a completed view of the elastic body 607.
  • a first member (base member) 602 fixed to the robot arm, a second member (action member) 603 fixed to the robot hand, and an intermediate member 604 are provided, and a first elastic structure 605 and a second elasticity are provided therebetween.
  • the structures 606 are connected.
  • the direction in which the first elastic structure 605 is installed and the direction in which the second elastic structure 606 is installed must be different. If it is in the same direction, a large difference in effect can not be expected as compared with the case of using a single-stage elastic structure.
  • a direction vector e a of the first resilient structure 605 When representing this condition in a formula, a direction vector e b of the second elastic structure 606 have different sign of the inner product with respect to the circumferential direction e r of the sensor From this, it can be expressed as follows.
  • the two-stage elastic structure by adopting the two-stage elastic structure, it is possible to realize high moment stiffness that is important for a force sensor. At that time, the greater the number of elastic structures, the higher the moment rigidity can be. Moreover, it can be manufactured by the layered manufacturing method by inclining the elastic structure. Also, by arranging the elastic structures circumferentially, rigidity independent of direction can be realized.
  • FIG. 21A Shown in FIG. 21A is a FEM model of an elastic body. The outline of this model is shown below.
  • First member Outer diameter 5 56.0 mm, width 2.0 mm, thickness 2.0 mm Intermediate member: Outer diameter 4 47.0 mm, width 3.0 mm, thickness 1.5 mm
  • Second member Outer diameter 48.0 mm, width 2.0 mm, thickness 2.0 mm
  • Elastic structure 72 pieces, width 1.0 mm, thickness 0.5 mm, inclination angle 39 degrees
  • Material stainless steel
  • the first member is fixed, and the displacement of the second member when a force or a moment is applied to the second member is calculated.
  • FIG. 21B shows deformation when an external force Fy in the Y direction is applied.
  • FIG. 21C shows deformation when an external force Fz in the Z direction is applied.
  • FIG. 21D shows deformation when a moment force My in the Y direction is applied.
  • FIG. 21E shows a deformation when a moment force Mz in the Z direction is applied.
  • the X direction is the same as the Y direction in view of symmetry, so the description will be omitted.
  • a six-dimensional force vector is F
  • a deformation vector is ⁇
  • a compliance matrix is C
  • the units of F are N and Nm.
  • the units of ⁇ are m and rad.
  • is as small as 0.26. From this result, it is understood that the influence of the inclination is small and high moment rigidity can be realized. Also, the reason why ⁇ is small is that the effect of the elastic structure appears.
  • the force sensor according to the present embodiment since the force sensor according to the present embodiment has a small overhang angle, it can be manufactured by the additive manufacturing method.
  • FIG. 22A is an exploded view for explaining the modeling unit 620 attached to the layered manufacturing apparatus
  • FIG. 22B is an assembly diagram of the modeling unit 620.
  • the first member 602 fixed to the robot arm and the second member 603 fixed to the robot hand are ring-shaped parts. Production of a shape by a lathe or the like, screwing of the shaping plate 621 in FIG. 22A, irradiation of a laser beam and the like are the same as in the first embodiment, and therefore detailed description will be omitted.
  • FIG. 23A is a view immediately after layered modeling on the modeling unit 620.
  • FIG. 23B When the fixing screw of the shaping plate is removed, the elastic body 607 can be detached from the shaping plate as shown in FIG. 23B.
  • the present embodiment it is possible to manufacture by the additive manufacturing method, and the manufacturing cost can be reduced. Moreover, compared with the conventional additive manufacturing method, it is possible to reduce the manufacturing cost at the first to fourth points described in the first embodiment.
  • the layered manufacturing method since a complicated shape can also be created, it is possible to easily improve the moment rigidity by increasing the number of elastic structures. Moreover, even if a manufacturing error may occur, since the number of elastic structures is large, the manufacturing error of one elastic structure is averaged and the influence is small.
  • the cross section of the elastic structure was demonstrated as a rectangle in this embodiment, it is not limited to a rectangle.
  • the elastic body 607 of the force sensor has a first member 602 fixed to the robot arm, a second member 603 fixed to the robot hand, and an intermediate member 604.
  • the first member 602 and the intermediate member 604 are connected via the first elastic structure 605, and the second member 603 and the intermediate member 604 are connected via the second elastic structure 606.
  • the first member and the second member are arranged along the same plane, and the intermediate member is arranged such that at least a part of the projection overlaps the gap between the first member and the second member when projected onto the plane. It is arranged away from the plane.
  • the first elastic structure 605 is curved outward, and the second elastic structure 606 is curved inward. That is, the second member is an annular member disposed concentrically with the first member and having a smaller radius than the first member, and the first elastic structure has a curved shape so as to be convex in the direction away from the center
  • the second elastic structure has a curved shape so as to be convex in the direction toward the center.
  • the first elastic structure and the second elastic structure overlap. That is, since one of the beams of the first elastic structure and the beam of the second elastic structure goes from the outside to the inside and the other goes from the inside to the outside, increasing the number of beams and increasing the density, Both beams will come into contact just in the middle. Therefore, the number of beams has a limit which can not be increased further.
  • the number of elastic structures can be further increased. According to this embodiment, since the number of elastic structures can be increased, higher moment rigidity can be realized.
  • an optical sensor may be used as a displacement detection unit instead of the magnetic sensor.
  • the configuration is the same as that of the first embodiment, so detailed description will be omitted.
  • the robot hand 210 of the six-axis articulated robot 100 shown in FIG. 1 has a plurality of drivable fingers. Although the illustrated hand includes two fingers, even if the hand has three or more fingers, the fingertip force sensor of this embodiment can be used. A finger 230a and a finger 230b are attached to each finger via the fingertip force sensor 220a and the fingertip force sensor 220b of the present embodiment.
  • the force applied to the object to be held is detected by the fingertip force sensor 220a and the fingertip force sensor 220b.
  • the controller 101 controls the joints J1 to J6 based on the measured values.
  • the robot joint is controlled to make the part approach the flat plate until the measurement value of the fingertip force sensor becomes a predetermined force.
  • This is an essential function to control the operation of the assembling robot in accordance with the force applied to the fingertip.
  • a force sensor is provided on the wrist of the robot to perform the same function.
  • the fingertip force sensor has an advantage that the response is fast because the inertia is small.
  • work process which grips components is mentioned as another example which utilizes a fingertip force sensor.
  • the finger approaches until the measurement value of the fingertip force sensor reaches a predetermined force. This is an essential function for an assembly robot that holds and assembles soft parts while suppressing small deformation, and for example, when handling a thin plastic ring, it is necessary to hold it with a small force of about 1N.
  • FIG. 32 is an exploded view of the fingertip force sensor
  • FIG. 33 is a perspective view
  • FIG. 34 is a sectional view.
  • the first member 701 is fixed to a drive unit of a finger (not shown), and a second member 702 and an intermediate member 704 are provided.
  • the first elastic structure 705 is used to connect the first member 701 and the intermediate member 704.
  • the first elastic structure is composed of two elastic structures in six lines per side, 12 in total, but the number and the number of lines are limited to this. It is not a thing.
  • the second elastic member 706 is used to connect the second member 702 and the intermediate member 704.
  • the second elastic structure is constituted of two elastic structures in two rows and three central portions on a single side, and a total of 13 elastic structures. Is not limited to this.
  • the first member 701, the second member 702, the intermediate member 704, the first elastic structure 705, and the second elastic structure 706 constitute an elastic body.
  • the elastic body is an integral part of which one part is formed by the additive manufacturing method, as described later.
  • the first member and the second member are arranged along the same plane, and the intermediate member is arranged such that at least a part of the projection overlaps the gap between the first member and the second member when projected onto the plane. It is arranged away from the plane.
  • the finger 730 is fixed to the second member 702 with a screw 712.
  • the finger has an appropriate shape according to the shape of the object assembled by the robot hand.
  • a sensor substrate 709 constituting a displacement detection unit is fixed to the first member 701 with a screw 713.
  • the magnet 708 which comprises a displacement detection means is fixed to the 2nd member 702.
  • the displacement detection means may be a magnetic displacement meter having a magnet, or may be an optical displacement meter as described later.
  • This embodiment detects the displacement of the first member and the second member, which have the shortest relative distance among the three members of the first member, the second member, and the intermediate member, and therefore is most advantageous in achieving high sensitivity. Configuration.
  • the first member, the second member, and the intermediate member are arranged in the same manner as in the first embodiment.
  • the distance between the first member and the second member is preferably in the range of 10 ⁇ m to 10 mm for the same reason as in the first embodiment.
  • the magnet 708 moves, the magnetic field lines around it also move.
  • the movement of the magnetic lines of force is detected by a plurality of Hall elements or magnetoresistive elements provided on the sensor substrate 709. In this way, the movement of the magnet 708 in the three directions XYZ can be detected.
  • the detection signals ⁇ x, ⁇ y, ⁇ z are input to the control substrate 711 of FIG. 32, and fingertip forces Fx, Fy, Fz in three directions of XYZ are output. This conversion is performed by the following equation.
  • [K] is a stiffness matrix, which is a constant to be obtained in advance. This matrix can be measured by applying a force in three directions to the fingertip. In addition, as described later, it is also possible to obtain by calculation using FEM.
  • the elastic body of the present embodiment can be manufactured by the additive manufacturing method.
  • the overhang angle is limited, and in particular, the horizontal ceiling is difficult to form.
  • FIG. 35 shows a schematic view of the elastic body of the present embodiment focusing on the overhang angle.
  • the first member 701 and the intermediate member 704 are connected by the first elastic structure 705.
  • Portions overhang is a concern in the figure, is S 1 and S 2 parts. It is necessary to design the distance B between the elastic structures and the longitudinal dimension C such that this overhang falls within the aforementioned limit value. According to this schematic diagram, the following conditions are satisfied.
  • the elastic body of the present embodiment improves the rigidity ratio by increasing the number of elastic structures, suppresses the overhang angle, and can be layered and formed.
  • the fingertip force sensor is composed of an elastic body and displacement measuring means, the mechanical performance is determined by the elastic body. Therefore, first, the stiffness of the elastic body is clarified from the viewpoint of material dynamics.
  • FIG. 36A consider two elastic structures disposed along a direction radially extending from point A.
  • a coordinate system C 0 is set at the center of the elastic structure, and the distance between the origin and the point A is L A.
  • the distance between the two elastic structures is Lx.
  • the distance to the point A is Lp, and the inclination angle is ⁇ .
  • the force F applied to the point A and the left shoulder of the rotational moment M are distinguished by attaching a symbol representing a point, A.
  • the force applied to the elastic structure is expressed as W in the axial direction and P in the bending direction.
  • the notation of displacement ⁇ and rotation angle ⁇ of point A is also distinguished by attaching a symbol representing a point on the left shoulder and “A” of the symbol.
  • the displacement of the elastic structure is expressed as ⁇ w in the axial direction and ⁇ p in the bending direction.
  • E Young's modulus
  • I is a second moment of area
  • A is a cross sectional area
  • L is a length of the elastic structure.
  • the fingertip force sensor is a sensor that detects the deformation of the elastic body due to the force applied to the fingertip.
  • the rigidity is high, the deformation of the elastic body is also reduced, and the sensitivity of the sensor is reduced.
  • the horizontal stiffness Kx can be reduced by the parallel arrangement, but the vertical stiffness Kz is still high.
  • an elastic structure is comprised in 2 steps. That is, the first member 701, the second member 702, and the intermediate member 704 are provided, and the first elastic structure 705 couples the first member 701 and the intermediate member 704, and the second elastic structure 706 is used to connect the second member 702. And the intermediate member 704 are connected.
  • the first member is fixed to a finger moving member (not shown), and the second member 702 is fixed to the finger 730.
  • all the three XYZ axes can be made to coincide with the bending direction of the elastic structure, and the rigidity can be designed to be low.
  • first elastic structure 705 and the second elastic structure 706 have different directions. In the case of the same direction, it is the same as the one-stage elastic structure, and the difference in rigidity between the horizontal and vertical directions becomes large.
  • the orientations of the elastic structures are most effective if they differ by 90 degrees as described below.
  • FIG. 39 shows a schematic view of an elastic body connected at an angle ⁇ by combining the rigidity Kx and Kz in the horizontal and vertical directions.
  • Equation 47 can be simplified as follows.
  • the ratio R xz of stiffness in two directions of X and Z of the whole elastic body is as follows.
  • FIG. 40 is a graph showing the relationship between the rigidity ratio R zx of Equation 49 and the angle ⁇ .
  • the fingertip force sensor preferably has the same sensitivity in the three axial directions of XYZ, but the rigidity ratio is best 1 when the angle is 90 degrees. If the practical limit of this sensitivity ratio is about 0.1, it is understood that an angle of 25 degrees or more is necessary.
  • the bending stiffness is inversely proportional to the cube of the length L of the elastic structure. Therefore, the longer the length L, the better. Furthermore, the stress applied to the elastic structure can also be reduced. However, if L is made longer, the fingertip sensor becomes thicker.
  • the two-step elastic structure structure is disposed by being inclined.
  • the first elastic structure is disposed to be inclined with respect to the normal direction from the surface of the outer surface of the first member connected to the first elastic structure.
  • the second elastic structure is arranged to be inclined with respect to the normal direction from the surface of the outer surface of the second member connected to the second elastic structure.
  • the distance between the first member 701 and the second member 702 seems to be relatively large because they are shown at an unscaled scale for the convenience of illustration, but this distance is the distance between the first member and the intermediate member, and Less than the distance between the two members and the intermediate member.
  • the second elastic structure 706 does not have to be spaced apart in the thickness direction, so a thinner sensor can be realized.
  • the present embodiment has been described in the plan view so far, considering the direction perpendicular to the paper surface, the two-step elastic structure is a set of four or more elastic structures arranged in an XY grid. .
  • FIG. 42A is an exploded view for explaining the structure of this embodiment, and FIG. 42B is a perspective view of a completed product.
  • a first member 701, a second member 702, and an intermediate member 704 are provided, and the first elastic structure 705 composed of four or more elastic structures connects the first member 701 and the intermediate member 704. . Further, the second member 702 and the intermediate member 704 are connected by a second elastic structure 706 composed of four or more elastic structures.
  • the first member is fixed to a finger moving member (not shown), and the second member 702 is fixed to the finger 730.
  • H x and H y are thicknesses of the elastic structure in the XY directions.
  • the deformation is calculated when Nx elastic structures are arranged in the X direction and Ny arranged in the Y direction.
  • the rigidity in the translational direction can be written as follows since the elastic structures described above are connected in parallel.
  • the rotation angle ⁇ y with respect to the moment My around the Y axis can be similarly expressed.
  • the stiffness of the elastic body at the coordinate C 0 of the fingertip force sensor has been described above. At this time, it was stated that a highly sensitive fingertip force sensor can be realized if the rigidity in the translational direction is weak. However, it is preferable that the rotational rigidity be strong. If the position of the fingertip is largely displaced due to the force applied to the fingertip, high precision work such as assembly will be hindered.
  • the ratio of rotational stiffness to translational stiffness is considered. As this ratio is larger, a higher performance finger force sensor can be configured.
  • the rigidity in the translational direction is a design value that determines the sensitivity of the fingertip force sensor
  • Bx is a constant so that the rigidity in the translational direction does not change even if the number Nx of elastic structures changes.
  • H x B x (N x ) -1/3
  • the stiffness ratio ⁇ is of,
  • the vertical axis 1 indicates that the number of elastic structures is equal to the rigidity ratio of two. If the number of elastic structures is 6 or less, the case of 2 is the most excellent rigidity ratio, but if the number is increased to 7 or more, the rigidity ratio is better than 2 or more.
  • a thin fingertip force sensor can be configured with high sensitivity to fingertip force. Further, it has been described that by increasing the number of elastic structures, a sensor with high moment rigidity can be configured.
  • the overhang angle can be suppressed within the limit by connecting a large number of elastic structures and connecting the elastic structures and the elastic structures with the inclined surface, and layered manufacturing is possible.
  • the displacement of the fingertip can be enlarged and detected, so that a more sensitive fingertip force sensor can be realized.
  • FIG. 45 shows a schematic view of an elastic structure in a radial arrangement in consideration of the fingertip position and the sensor position.
  • a point A is a target point for determining the direction of the two elastic structures
  • a point B is the position of the fingertip, to which a fingertip force is applied.
  • Point C is the position of the sensor, which detects the displacement of this point.
  • Equation 45 The relationship between the displacement at point A and the force at point A is shown in Equation 45.
  • the relationship between the displacement at point C and the force at point B is shown.
  • Point B is a position at which the fingertip receives a force from the article.
  • the equation for coordinate transformation of the force at point A to point B can be written as follows.
  • a point C is a position at which a sensor that measures deformation of the elastic body is disposed.
  • An equation for coordinate transformation of the displacement of point C to point A can be written as follows.
  • Equation 45 the displacement of the position (point C) of the sensor with respect to the force applied to the fingertip (point B) can be calculated.
  • the component of the force related to the fingertip force sensor is as follows.
  • the coefficient of the above equation is the sensitivity matrix of this fingertip sensor. From the above equation, it can be understood that the term of 1 row and 1 column, that is, the sensitivity S x in the X direction is affected by changing the position L B of the point B where the force is applied. Focus on this section.
  • the sensor sensitivity can be improved by arranging the point A which is the center of the radial elastic structure at a position farther than the point B of the fingertip to which the force is applied.
  • the width and thickness of the elastic structure are 1 mm
  • the sensitivity ratio is greater than 1, the better.
  • a highly sensitive fingertip force sensor can be configured.
  • FIG. 47A is an FEM model of an elastic body used for simulation. This model is the same as the structure described with reference to FIGS. 32-34.
  • the main features are: firstly, the width of the elastic structure is larger than the thickness; secondly, the first elastic structure 705 is six on one side, 12 in all; third, the second elastic structure There are five bodies 705 on one side, three in the center, and 13 in all.
  • the width, thickness, length, the number of elastic structures, etc. of the elastic structure are the design parameters of the fingertip force sensor according to the present embodiment. It is the purpose of FEM simulation to determine this design parameter.
  • the displacement detection means for detecting the deformation of the elastic body measures the position of the magnet 708.
  • the position change of the magnet obtained by FEM calculation is summarized in the following table.
  • the highest sensitivity was in the Y direction.
  • the equation for calculating the fingertip force is obtained from the output of the displacement detection means corresponding to equation 39.
  • the above FEM deformation simulation is repeatedly performed to determine design parameters such as the width and thickness of the elastic structure so as to obtain a desired sensitivity.
  • FIG. 48A is an exploded view of the shaping unit 720 attached to the additive manufacturing apparatus for the sake of illustration, and FIG. 48B is a completed view of the shaping unit 720.
  • the first member 701 and the second member 702 are high-precision parts manufactured by a milling machine or the like, and are screwed to the shaping plate 721 to complete the shaping unit 720. Production of a form by a lathe or the like, screwing of the shaping plate 721 in FIG.
  • FIG. 49A shows a state in which an elastic body 707 is completed by laminating on the modeling unit 720.
  • the elastic body 707 is a structure in which the first elastic structure 705, the second elastic structure 706, and the intermediate member 704 are laminated and formed on the first member 701 and the second member 702.
  • the elastic body 707 is completed as shown in FIG. 49B.
  • the three-dimensional structure is detached from the formation plate.
  • This manufacturing method can reduce the manufacturing cost at the first to fourth points described in the first embodiment, as compared with the conventional additive manufacturing method. Therefore, the fingertip force sensor of the present embodiment can be manufactured by the additive manufacturing method, and the manufacturing cost can be reduced.
  • the cross-sectional shape of the elastic structure was demonstrated as a rectangle in this embodiment, it is possible also except a rectangle. For example, it is possible to implement even a rectangle or an ellipse rounded by a quad.
  • FIG. 50A is an exploded view for explanation, and FIG. 50B is a completed view.
  • a first member 701, a second member 702, and an intermediate member 704 are provided, and the first member 701 and the intermediate member 704 are connected by a first elastic structure 705 composed of four or more elastic structures. Further, the second member 702 and the intermediate member 704 are connected by a second elastic structure 706 composed of four or more elastic structures.
  • the first member is fixed to a finger movement member (not shown), and the second member 702 is fixed to the finger 730.
  • the first elastic structure 705 is a radial elastic structure disposed on a plane ⁇ that is stretched by the vertical axis ⁇ and the horizontal axis ⁇ . This is centered point P 2 on the plane, the first elastic structure structure is oriented at this point. On the other hand, a point obtained by projecting the point at the tip of the finger 730 onto the plane ⁇ is P 1 .
  • This embodiment is characterized by the center point P 2 is located outside the point P 1.
  • FIGS. 51A and 51B Modification 2 of the third embodiment will be described with reference to FIGS. 51A and 51B. And another embodiment shown in FIG. 50, the first elastic structure, different particular arrangement of the center point P 2, is similar for the other.
  • FIG. 51A is an exploded view for explanation, and FIG. 51B is a completed view.
  • the first elastic structure 705 is a radial elastic structure disposed on a plane ⁇ including the horizontal axis ⁇ and the point P 1 of the tip of the finger 730. On this plane, there is the central point P 2, the first elastic structure is oriented at this point.
  • FIG. 57 shows an example in which three light sensors are combined to constitute relative position detection means in three directions.
  • the scale A101 has diffraction gratings A102a to A102c in three directions, and three circuit parts A100a to A100c are provided opposite to the diffraction gratings.
  • FIG. 58 Shown in FIG. 58 is an exploded view of a fingertip force sensor incorporating such an optical sensor.
  • the third embodiment differs from the third embodiment only in the part of the relative position detection means, so this part will be mainly described.
  • the scale A 101 is fixed to the second member 2 and provided.
  • the scale A101 is a rectangular parallelepiped, and is provided with diffraction gratings A102a to A102c on three sides of the rectangular parallelepiped in different directions.
  • Three circuit units A100a to A100c are fixed to the electric substrate A103 so as to face the diffraction grating.
  • the electric substrate A103 for the light sensor is fixed to the first member using the screw 13.
  • the electric signals of the circuit parts A100a to A100c are connected to the control board 11 through the electric board A103, and output relative displacements of the first member 1 and the second member 2 in three directions.
  • Embodiments of the present invention are not limited to the examples described above, and some modifications and combinations may be made under the technical concept of the present invention.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Electromagnetism (AREA)
  • Force Measurement Appropriate To Specific Purposes (AREA)
  • Manipulator (AREA)

Abstract

力センサは、第1部材と、第2部材と、中間部材と、第1部材と中間部材とを連結する第1の弾性構造体と、第2部材と前記中間部材とを連結する第2の弾性構造体と、第1部材と第2部材の変位を測定する変位検出手段とを備える。検出精度が高く、コンパクトな力センサを提供することができる。

Description

力センサ、トルクセンサ、力覚センサ、指先力センサ、およびその製造方法
 本発明は、力やトルクを測定する力センサおよびその製造方法に関する。中でも、自動組み立て装置やロボット等の分野で好適に用いられる力センサに関する。
 例えばロボットの分野では、トルクや力を検知するための力センサとして、トルクセンサ、力覚センサ、指先力センサなどが用いられている。
 トルクセンサは、例えばロボットの回転関節に取り付けられ、関節を介して伝達される1方向のトルクを測定する装置として用いられている。
 力覚センサは、例えばロボットアームとロボットハンドの間の手首に配置され、ロボットハンドの先端にかかる6方向の力やモーメントを検出する装置として用いられている。指先力センサは、例えばロボットハンド先端の指先にかかる3方向の力を測定し、把持物が環境から受ける力を検出する装置として用いられている。
 特開2010-169586号公報は、第1部材と第2部材との間に発生するY軸周りの回転トルクを測定するトルクセンサが開示されている。このトルクセンサは、第1部材と第2部材との間に配置された起歪部を備え、起歪部の外側に、第1部材と第2部材に連結された複数の柱部を備える。特許文献1のトルクセンサは、ねじれトルクがかかると起歪部が変形し、この変形を歪みゲージで読み取り、トルク値に換算するセンサであるが、柱部を備えているため、Y軸に直角な軸まわりの曲げモーメント力がかかっても、起歪部の変形が抑えられる。
 しかしながら引用文献1に記載されているセンサにおいて、曲げモーメントを支える柱部は、曲げモーメントに対して硬い必要があるが、回転トルクに対しては柔らかくなければならない。もし硬ければ、回転トルクも柱部が支えてしまうので、起歪部の変形が抑制されて、トルクの測定が困難になるからである。回転トルクに対して柔らかくするためには、柱部の長さを大きくする必要があるが、長さを大きくするとY軸周りの回転トルクを測定する対象物である第1部材と第2部材の距離が遠くなってしまう。
 第1部材と第2部材との変位を測定する際、一般に測定対象の距離が離れると測定感度が落ちる。従って、柱部の長さを大きくすると高感度なセンサを構成するのが困難になる。
 例えば、10mmの長距離において1nmの感度(分解能)を達成するのは、10μmの近距離において同じ感度を達成するよりも、はるかに困難である。
 上記に関して、磁気式変位計を例に、より具体的に説明する。磁気式変位計は、永久磁石の磁場の強さが、距離に応じて変化することを利用する変位計である。
 半径R、長さLの円筒磁石の磁場の強さと、測定対象間の距離との関係は、次式で表される。
Figure JPOXMLDOC01-appb-M000001
 ここで、Bは磁石から距離x離れた場所の磁束密度、Brは磁石の残留磁束密度である。
 Br=12000Gaussのネオジウム磁石を用いた場合の距離と感度の関係をグラフにして、図52に示す。図から、距離が10mmまで離れると、感度が極端に落ちることがわかる。数値を計算すると、距離が10μmの場合の感度に対し、距離が10mmの感度はわずか0.5%しかない。これでは高感度なセンサを構成することが困難である。
 さらに、測定対象の距離が離れていると、磁気の変化を検出するための検出部を取付ける部品のサイズも大きくならざるを得ない。取付け部品の温度や自重による寸法変化、および振動を考えると、サイズが大きくなることは高感度なセンサにとって不利である。
 また、柱部に長さが必要であるためセンサが厚くなってしまう。センサの厚さは、例えばロボットの部品として実装する場合には各関節のサイズに影響し、厚さが大きくなると関節の可動領域やロボットの作業領域に対して好ましくない影響を及ぼす。
 そこで、検出精度が高く、コンパクトな力センサの実現が期待されている。
 本発明は、第1部材と第2部材との相対変位量により、力の情報を検出する力センサであって、前記第1部材と前記第2部材は、第1の弾性構造体と、第2の弾性構造体と、中間部材とで連結され、前記第1の弾性構造体は、前記第1部材と前記中間部材とを連結し、前記第2の弾性構造体は、前記第2部材と前記中間部材とを連結し、前記第1部材と前記第2部材には、前記第1部材と前記第2部材との相対変位量を検出する変位検出手段が設けられていることを特徴とする力センサである。
6軸多関節ロボット組立て装置の斜視図である。 第一の実施形態に係る関節構造の例を説明する図である。 第一の実施形態に係る関節構造の別の例を説明する図である。 第一の実施形態に係るトルクセンサの構成図である。 第一の実施形態に係るトルクセンサの部分断面図である。 積層造形法の制約条件を示す図である。 積層造形法で積層造形可能な形状を示す図である。 第一の実施形態を説明するトルクセンサの斜視図である。 第一の実施形態に係る弾性体の模式図である。 第一の実施形態に係る変形シミュレーションモデルである。 変形シミュレーション結果である。 第一の実施形態に係る応力解析結果である。 第一の実施形態に係る弾性構造体の模式図である。 第一の実施形態に係る造形ユニットの分解図である。 造形ユニットの組立て図である。 造形プレート上に積層造形された弾性体の図である。 完成した弾性体の斜視図である。 第一の実施形態に係る弾性構造体の模式図である。 円周配置する弾性構造体の枚数を検討するモデルの模式図である。 弾性構造体の数と剛性比のグラフである。 図15に示したモデルの断面図である。 実施形態のトルクセンサの断面図である。 実施形態のトルクセンサの断面図である。 第二の実施形態に係る力覚センサの構成図である。 第二の実施形態に係る力覚センサの断面図である。 第二の実施形態に係る弾性体の模式図である。 第二の実施形態に係る変形シミュレーションモデルである。 Y方向の外力Fyをかけた時の変形を示す。 Z方向の外力Fzをかけた時の変形を示す。 Y方向のモーメント力Myをかけた時の変形を示す。 Z方向のモーメント力Mzをかけた時の変形を示す。 第二の実施形態に係る造形ユニットの分解図である。 造形ユニットの組立て図である。 造形プレート上に積層造形された弾性体の図である。 完成した弾性体の斜視図である。 第二の実施形態の変形例に係る力覚センサの構成図である。 第二の実施形態の片持ち弾性構造体の模式図である。 片持ち弾性構造体の変形を示す図である。 第二の実施形態の2本の片持ち弾性構造体の模式図である。 片持ち弾性構造体の変形を示す図である。 第二の実施形態を説明するN本の弾性構造体の模式図である。 第二の実施形態を説明する弾性構造体の本数と、変位の比のグラフである。 第二の実施形態の2段弾性構造体の模式図である。 片持ち弾性構造体の変形を示す図である。 第二の実施形態の傾斜2段弾性構造体の模式図である。 第二の実施形態に係る円周配置・傾斜2段弾性構造体の分解図である。 円周配置・傾斜2段弾性構造体の完成図である。 第三の実施形態に係る指先力センサの分解図である。 第三の実施形態に係る指先力センサの斜視図である。 第三の実施形態に係る指先力センサの断面図である。 第三の実施形態に係るオーバーハング角度を説明する図である。 第三の実施形態を説明する放射状配置した2本の弾性構造体の模式図である。 第三の実施形態を説明する放射状配置した2本の弾性構造体の模式図である。 第三の実施形態を説明する放射状配置した2本の弾性構造体の模式図である。 第三の実施形態を説明する平行配置した2本の弾性構造体の模式図である。 第三の実施形態を説明する2段弾性構造体の模式図である。 第三の実施形態を説明する傾斜して接続した弾性体の模式図である。 第三の実施形態を説明する剛性比のグラフである。 第三の実施形態を説明する傾斜した2組の弾性構造体を示す模式図である。 第三の実施形態を説明する傾斜した2組の弾性構造体を示す分解図である。 完成体の斜視図である。 第三の実施形態を説明する弾性構造体の斜視図である。 第三の実施形態を説明する剛性比のグラフである。 第三の実施形態を説明する傾斜した2組の弾性構造体を示す模式図である。 第三の実施形態を説明する感度比のグラフである。 第三の実施形態に係る変形シミュレーションモデルである。 X方向の外力Fxをかけた時の変形である。 Y方向の外力Fyをかけた時の変形である。 Z方向の外力Fzをかけた時の変形である。 第三の実施形態に係る造形ユニットの分解図である。 造形ユニットの組立て図である。 造形プレート上に積層造形された弾性体の図である。 完成した弾性体の斜視図である。 第三の実施形態の変形例1に係る弾性構造体の分解図である。 第三の実施形態の変形例1に係る弾性構造体の完成図である。 第三の実施形態の変形例2に係る弾性構造体の分解図である。 第三の実施形態の変形例2に係る弾性構造体の完成図である。 円筒形の永久磁石における距離と磁束密度の関係を表すグラフである。 光学式変位センサの公知技術を説明する第1の図である。 光学式変位センサの公知技術を説明する第2の図である。 光学式変位センサの構成を説明する図である。 第三の実施形態の、そのほかの実施形態に係るトルクセンサの模式図である。 光学式変位センサの組合せを説明する図である。 第三の実施形態の、変形例に係る指先力センサの模式図である。
 以下、図面を参照して、本発明の実施形態について説明する。
 (第一の実施形態)
 図1に、本発明の第一の実施形態である力センサを備えた6軸多関節ロボット装置100を示す。本実施形態に係る力センサは、リンク200~206間を接続する6つの回転関節J1~J6に取り付け、関節を介して伝達されるトルクを測定する。本実施形態にかかる力センサを、以下の説明ではトルクセンサと称する場合がある。
 トルクセンサの関節への取り付けについて、図2を参照して説明する。ここでは、リンク201と202を接続するJ2関節を示すが、6軸多関節ロボット装置100の他の関節も同様の構成である。関節は、モーター512とトルクセンサ522を介してリンク間を接続する。この構成によれば、関節を伝わるトルクはすべてトルクセンサ522を通過するので、正確な関節トルクMzを測定することができる。ただし、トルクセンサには不要な曲げトルクMxやMyがかかる。曲げ方向の剛性が弱いと、ロボット全体の固有振動数が下がり、ロボットの運動性能に好ましくない影響が生じるので、曲げ方向については高い剛性が必要である。従って剛性の比α=Mx/Mzが高いほうが高性能なトルクセンサと言える。また、関節の厚さLaは、モーター512とトルクセンサ522で決まるので、トルクセンサの厚さは小さい方が好ましい。
 また、トルクセンサの取付け方法を変更した構成例を図3に示す。図2の例では、トルクセンサ522の固定は両側からボルト締めで行うことを想定していたが、図3の例では片側からのボルト締めが可能である。本実施形態のセンサは、このような関節構成に、より適している。また、この例でも関節の厚さLbは、モーター512とトルクセンサ522で決まるので、トルクセンサの厚さは小さい方が好ましい。
 本実施形態のトルクセンサの構成を、図4の概観斜視図および図5の部分断面図に示す。説明の便宜のため、センサの中心にXYZ座標を定義する。このトルクセンサの取り付け方法を、図3に示したJ2関節の場合で説明する。トルクセンサは、第1部材1と第2部材2を備えており、第1部材1はモーター512に固定し、第2部材2はリンク202に固定する。
 また、中間部材4を設け、第1部材1と中間部材4を板ばね等の第1の弾性構造体5で連結し、第2部材2と中間部材4を板ばね等の第2の弾性構造体6で連結する。弾性構造体5と弾性構造体6は、それぞれ複数設けられており、交互に配置されている。
 第1部材1、第2部材2、中間部材4、および第1の弾性構造体5、第2の弾性構造体6で、トルクセンサの弾性体7を構成する。中心軸であるZ軸を中心に配置された第1部材と第2部材は、同心だが互いに半径が異なる環状部分を有している。
 Z軸を挟んで対向する位置にある2箇所に、第1部材と第2部材の変位(相対角)を測定するための角度検出手段を設ける。角度検出手段は、スケール8とセンサ基板9を備え、スケール8とセンサ基板9の相対変位を出力する。
 本実施形態のトルクセンサは、図5に示すように、第1部材と第2部材の距離は、中間部材と第1部材の距離、および中間部材と第2部材の距離のいずれよりも小さい。また、第1部材と、第2部材と、中間部材は、第1部材における第1の弾性構造体と連結される端部と、第2部材における第2の弾性構造体と連結される端部と、が中間部材における第1及び第2の弾性構造体と連結される端部と対向するよう配置されている。
 前述したように、変位を検出するには、検出対象の距離(第1部材と第2部材の距離)が短いほうが高感度を実現しやすい。
 すなわち、本実施形態では、第1部材、第2部材、中間部材の3つの部材のうち、相対距離が最も短い第1部材と第2部材の変位を検出するので、スケール8とセンサ基板9との距離も近くすることができ、高感度を実現する上で有利な構成となる。さらに、この構成なら、検出手段を取り付けるための部品サイズも小型ですむ。この部品の寸法変化や振動は測定値の精度に影響するので、サイズを小さくすることは重要である。
 第1部材と第2部材の距離は、具体的には10μmから10mmまでの範囲が好ましい。本発明によるセンサでは、第1部材と第2部材は弾性体の変形により相対位置が変化するため、接触を防止するために第1部材と第2部材の距離は弾性体の最大変形量よりも大きくなければならない。弾性体の剛性を高くした方が最大変形量を小さくでき、距離を小さくするうえでは好ましいが、距離が小さくなりすぎると変位検出手段に極めて高い測定感度が必要となる。そこで、現実的には第1部材と第2部材の距離は10μm程度とするのが好ましい。機械部品の加工精度を考慮しても、やはり下限を10μmとするのが好ましい。
 一方、第1部材と第2部材の距離の上限はトルクセンサのサイズに影響する。ロボットアームやロボットハンドへの搭載を考えると、上限は10mm程度とするのが好ましい。
 ここでは、変位検出手段としてまず磁気式を前提に説明するが、後述するように光学式を用いることも可能である。第1部材1にセンサ基板9を取付けボルト10で固定し、第2部材2にスケール8を接着固定する。2つのセンサ基板9からの信号線を、トルクセンサの制御基板11に接続する。制御基板11では、次のような信号処理を行う。すなわち、2つのセンサ基板9の出力を平均し、変位検出手段の取り付け半径で割ることによって第1部材と第2部材の相対角度を計算する。この相対角度に、あらかじめ設定した情報である弾性体7のねじり剛性Kzをかけて、トルクの値に変換して出力する。
 以上の構成において、トルクセンサにねじりトルクMzがかかると、第1の弾性構造体5および第2の弾性構造体6が変形し、第1部材1と第2部材2が相対的に回転変位する。この回転変位は2箇所に配置した変位検出手段で検出される。点対称の2箇所で検出した変位を平均しているため、回転以外の誤差成分、例えばXYの平行移動などの誤差はキャンセルされ、高精度にトルクを検出できる。
 ここで、第1の部材1と第2の部材2の距離が小さいことが重要である。前述したように距離が小さい部品間の相対距離を測定するほうが、距離が大きい場合より高い感度を実現できるからである。
 この実施形態では、第1の弾性構造体と第2の弾性構造体を各々24本設けたが、本発明の実施形態はこの例に限られない。弾性構造体の本数を増やせば、剛性比を高くすることができる。例えば、第1の弾性構造体と第2の弾性構造体を各々192本にすれば、4倍の剛性比が期待できる。弾性構造体のサイズや本数は、例えば有限要素法などを用いたシミュレーションによって設計することができる。
 次に、本実施形態における弾性構造体のサイズや本数の求め方を説明する。まず、本実施形態の考え方について説明する。
 本実施形態の説明において、数式で扱う主な記号の定義は、以下のとおりである。
L:弾性構造体の長さ
H:弾性構造体の厚さ
B:弾性構造体の幅
E:弾性構造体の縦弾性係数
R:弾性構造体の円周配置、半径
N:弾性構造体の数
Mx:x軸まわりの回転モーメント、曲げトルク
Mz:z軸まわりの回転モーメント、ねじりトルク
 トルクセンサは弾性体と回転角測定手段から構成されているので、力学的な性能は弾性体で決まる。そこでまず、材料力学の観点から、円周上に弾性構造体を配置した構造の特性を明らかにする。特に、弾性構造体の数が多い方が、ねじれ方向と曲げ方向の剛性の比が高く、性能の高いトルクセンサを構成できることを明らかにする。
 図15に示すモデルを参照して、弾性構造体の枚数について説明する。説明の便宜のため、トルクセンサの中心にXYZ座標を設定する。トルクセンサには測定すべきz軸回りのねじりトルクMzの他に、曲げトルクMxもかかる。
 トルクセンサは、Mzによるねじれ変形、すなわち微小な回転角を検出し、ねじれ方向の剛性Kzを使ってトルク値に変換する。従って剛性Kzはトルクセンサの測定可能範囲や、回転角検出手段の分解能などから決まる設計値である。
 一方、ねじれ方向と直交する曲げ方向の剛性KxやKyはトルクセンサを取付ける装置全体の固有振動数に影響するので硬いほうが望ましい。もし硬くできないと、図1に示すロボットアームの関節が柔らかくなるため、固有振動数が下がり、振動しやすくなってしまう。
 つまり、ねじれ方向の剛性Kzに対し曲げ方向の剛性KxやKyが高いことがトルクセンサにとって重要である。
 また、対称性を考えるとKxとKyは同じなので、これ以後はKxのみを考える。
 図15に示すモデルは、実施形態とは異なり、従来のトルクセンサと同様に第1部材1と第2部材2を対向させ、その間を複数の弾性構造体3a、3b、3c、・・・、で連結している。
 Z軸まわりの回転剛性Kzは、半径Rの円周にN本配置した弾性構造体のまげ剛性をKsとして、
Figure JPOXMLDOC01-appb-M000002
 弾性構造体を矩形断面としてKsをさらに展開すると、
Figure JPOXMLDOC01-appb-M000003
 一方、X軸まわりの回転剛性Kxは、N本配置した弾性構造体の圧縮方向の剛性をKpとして、
Figure JPOXMLDOC01-appb-M000004
 弾性構造体を矩形断面としてKpをさらに展開すると、
Figure JPOXMLDOC01-appb-M000005
 トルクセンサは測定方向の剛性Kzに対してまげ方向の剛性Kxが高いほうが好ましい。両者の剛性比をαとすると、
Figure JPOXMLDOC01-appb-M000006
 つまり、弾性構造体の長さと厚さの比L/Hが大きいほど剛性比が大きいので、優れたトルクセンサを構成できる。さらに、数式3を代入すると次式を得る。
Figure JPOXMLDOC01-appb-M000007
 前述したように、トルクセンサのねじれ方向の剛性Kzは設計条件として与えられるので、剛性比αを大きくするためには、次の項を大きくすれば良いことがわかる。
Figure JPOXMLDOC01-appb-M000008
 例えば、弾性構造体の数Nは大きいほうが有利である。
 次に、以下に列挙する具体的な数値を入れて、弾性構造体の数の効果を示す。
材料を鉄系とし、E=200 Gpa
センサの半径: R=100 mm
センサの厚さ: L=10 mm
弾性構造体の幅: B=10 mm
弾性構造体の厚さ: H=2 mm
弾性構造体の数 : N=24 本
ねじれ方向剛性: Kz=120kNm/rad  (数式3より)
曲げ方向剛性: Kx=6000 kNm/rad  (数式4より)
剛性比: α=50  (数式6より)
 弾性構造体の数Nを増やしても設計条件である剛性Kzが変わらないように、厚さHをNの1/3乗に反比例して変化させればよい。
 弾性構造体の数Nに対して剛性比αをプロットしたグラフを図16に示す。この図から明らかなように、弾性構造体の数が多いほど剛性比が高いトルクセンサを構成できる。
 数式6でL/Hの比が大きいほど有利なことを述べたが、Lはトルクセンサの厚さを決定する。つまり、トルクセンサを薄型にすることと、剛性比を高めることはトレードオフの関係にあり、この構成では薄型化に限界がある。そこで、次に弾性構造体を2分割することを考える。
 図17Aは、図15で説明した従来のトルクセンサ弾性体の断面図である。第1部材1と、第2部材2の間を弾性構造体3で連結する構造であった。
 本発明の実施形態では、図17Bに示すように中間部材4を設け、第1部材1と中間部材4を第1の弾性構造体5で連結し、第2部材2と中間部材4を第2の弾性構造体6で連結する。
 弾性構造体が直列に2段あるので、1段あたりでは2倍の剛性が弾性構造体に必要である。一方、剛性は数式3よりLの3乗に反比例するので、長さLは約0.8倍となり、トルクセンサの厚さを、約20%薄くできる。
 以上、2段の弾性構造体構造を有する本実施形態によって、薄型のトルクセンサを実現できることを説明した。
 さらに、本発明の実施形態では、図17Cに示すように、2組の弾性構造体5、弾性構造体6を傾斜させ紙面に前後にずらして配置すれば、傾斜させた分だけ、さらに薄くできる。例えば45度傾斜させれば、厚さはsin(45度)となるので、おおよそ30%薄くできる。
 また、この構成にはトルクセンサを薄くする他に、別の効果がある。図17Bの構成は、曲げトルクMxにより中間部材4が変形し、曲げ剛性が下がる。図17Cの構成は、中間部材4のサイズを半分以下にできるので中間部材の変形が抑えられ、曲げ剛性が上がる。その結果、剛性比の高いトルクセンサを構成できる。
 以上、2段の弾性構造体を交互に組み合わせる構造によって、さらに薄型で、剛性比の高いトルクセンサを実現できる。
 図7は、本実施形態のトルクセンサの3次元的な構成を例示する斜視図である。第1部材と第2部材は同一の平面に沿うよう配置され、中間部材は、該平面に投影したときに射影の少なくとも一部が第1部材と第2部材の間隙部と重なるように、該平面から離れて配置されている。
 また、複数の第1の弾性構造体は、第1部材から中間部材に向けて見たときの傾きが、環状部分の中心から離れる向きになるよう配置されている。また、複数の第2の弾性構造体は、第2部材から中間部材に向けて見たときの傾きが、環状部分の中心に向かうよう配置されている。
 本実施形態の弾性体は、積層造形装置や積層造形法を用いて製作可能である。一般的な積層造形法ではオーバーハング角に限界があり、特に水平天井は造形することが困難である。しかし、本実施形態によれば、弾性構造体を多数化し、弾性構造体と弾性構造体の間を傾斜面Sで接続することにより、オーバーハング角を制限内に抑えることができるため、積層造形可能である。
 図6Aは、積層造形法の制約条件を説明するための図である。ベース110の上にアーチ状の目標造形物111を造形する。この造形物はオーバーハングしており、図中の点Qにおけるオーバーハング角はβである。一般に、積層造形法ではこのオーバーハング角に限界があり、その角度より大きい部分は造形できない。この角度は、例えば60度といった角度である。水平天井は、オーバーハング角90度なので、一般に造形できない。図6Bに積層造形可能な形状112を示す。これはオーバーハングの限界角がβ以上の部分をカットした形状である。
 図8に、オーバーハング角に着目した弾性体の模式図を示す。第1部材1、中間部材4、およびその間をつなぐ第1の弾性構造体5、第2の弾性構造体6において、オーバーハングが懸念される部分は図7と図8に示したS~S部である。このオーバーハングが、前述した制限値以内になるように、弾性構造体のピッチBと、縦方向の寸法Cを設計する必要がある。図8の模式図によれば次のような条件である。
Figure JPOXMLDOC01-appb-M000009
 寸法Cを小さくしてトルクセンサを薄型にするためには、弾性構造体のピッチBが狭い方が、すなわち弾性構造体の数が多いほうが好ましい。弾性構造体の数を増やすことは、後述するように、トルクセンサの剛性比を向上するためにも役に立つ。
 本実施形態における弾性体は、弾性構造体の数を増やすことによって、剛性比を改善し、オーバーハング角を抑え、積層造形可能とすることができる。
 このことを踏まえ、弾性構造体のサイズ、本数を、シミュレーションにより求める方法の一例について説明する。
 図9Aは、シミュレーションに用いた弾性体のFEMモデルである。図4の模式図と異なる点は以下である。
A:変位検出手段を上側に取り付けるため、弾性構造体を設けない領域を2箇所配置した。
B:トルクセンサを取り付けるため、ボルト穴を有した。
C:弾性体の体積を減らすため、中間部材上面のカドに丸みをもたせた。
 図9Bは外側の部材にZ方向のモーメント力Mz=1Nmをかけた時の変形を示す。
 同様にMxも計算する。FEMシミュレーションの計算結果を以下の表にまとめた。
Figure JPOXMLDOC01-appb-T000010
 この表より、剛性比Mz/Mxは16.7である。
 また、ねじりトルクMzがかかる時の弾性構造体の応力分布を、図10に示す。図10において、1は第1部材、2は第2部材、4は中間部材、5は第1の弾性構造体、6は第2の弾性構造体6を示す。また、色の濃淡を用いて応力の大きさを示すが、色が淡いほど応力が大きく、色が濃いほど応力は小さい。
 第1の弾性構造体5で最も応力が集中するのは下側かつ外側のA部、次に応力が大きいのは上側かつ内側のB部であった。第2の弾性構造体6で最も応力が集中するのは下側かつ内側のC部、次に応力が大きいのは上側かつ外側のD部であった。
 一般に応力が高い部分から破壊が起こるので応力の集中は低減したいが、応力を下げるためには、ひずみを低減すれば良い。
 一つの解決方法は、弾性構造体の厚さを薄くすることである。応力の小さい弾性構造体の中立面からの距離が短くなり、応力を下げることができる。図中、応力の集中するA~D部を薄くすることにより、応力の最大値を低減できる。
 この弾性構造体を、図11に示す。厚さについては、説明の便宜のため非等縮尺で誇張して描いている。さきほどの変形シミュレーションで応力が大きかった部分A~D部の板厚を薄くした構成である。尚、応力を下げる別の方法として、隅部に曲率をつけて滑らかにする方法があるが、このような方法との組み合わせも有効である。
 次に、このように設計したセンサの製造方法を説明する。前述したように、本実施形態によるセンサはオーバーハング角が小さいため、積層造形法による製造が可能である。
 図12A、図12Bを用いて、積層造形装置に取り付ける造形ユニット20の説明をする。図12Aは、造形ユニット20の分解図で、図12Bは造形ユニット20を組み立てた完成図である。
 第1部材1と、第2部材2はリング状の部品である。旋盤などであらかじめ形を製作し、造形プレート21にねじ止めし、造形ユニット20を完成させる。この時、造形ユニット20の最上面が、第1部材1と、第2部材2の上面になるように設計しておくことが肝要である。すなわち、第1部材の外面のうち第1の弾性構造体と連結する面と、第2部材の外面のうち第2の弾性構造体と連結する面は、平行になるようにする。積層造形装置は、第1部材および第2部材の最上面から造形を開始するからである。造形材料の粉体を積層し、第1の弾性構造体と第2の弾性構造体と中間部材の形状に応じてレーザ光を照射して第1の弾性構造体と第2の弾性構造体と中間部材を造形する。
 図13Aは造形ユニット20の上に、積層造形装置を用いて第1の弾性構造体、第2の弾性構造体、および中間部材を造形し、弾性体7を形成した図である。この形状を積層造形法で製作できることは、すでに説明済みである。造形プレートの固定ねじを外すと図13Bに示すように完成した弾性体7を取り出すことができる。
 すなわち、第1部材と、第2部材を造形プレートに対して脱着可能に位置決め固定し、第1部材と第2部材の上面に、造形材料の層を積み重ねて第1の弾性構造体と第2の弾性構造体と中間部材を造形する。そして、第1部材と第2部材と第1の弾性構造体と第2の弾性構造体と中間部材が一体化した3次元造形物を形成した後に、3次元造形物を造形プレートから脱着する。
 この製造方法は、従来の積層造形法と比べて、次の点で製造コストを低減することができる。
 第一に、造形物を切り出す加工が不要である。従来はワイヤカットなどの機械加工により造形物を切り離していたが、本発明によれば、ねじを外すだけで脱着するので工程が簡易化されコストを低減できる。
 第二に、造形後の機械加工が必要最小限で済む。従来は、三次元造形物のうち高い精度が必要な部分は、造形後に機械加工する必要があった。造形後に機械加工を行うと、被加工物が複雑な形状をしているので、加工用の専用治具が必要となりコストがかかっていた。本実施形態によれば、精度が必要な第1部材と第2部材をあらかじめ準備し、この部分については積層造形をしていないため追加の機械加工は不要であり、コストを低減できる。
 第三に、造形材料の量を減らすことができる。積層造形法で使用する造形材料は、一般に高価である。本実施形態によれば、弾性体7の全体を積層造形するのではなく、一部だけ造形するので造形材料を減らすことができ、コストを抑制できる。より具体的には、弾性体7のうち第1部材1と第2部材2は積層造形しないため、高価な造形材料を節約できる。
 第四に、本実施形態によれば、造形プレートを繰り返し使用することが可能である。造形プレートの上に積層した造形材をレーザ焼結する積層造形法では、造形後には、レーザ照射によって造形プレートの表面が溶融するので、次の造形には使えない。本実施形態によれば、造形プレートにはレーザが当たらないので劣化することがなく、何度も使えるので、弾性構造体の製造コストを低減することが可能である。
 以上のように本実施形態のトルクセンサは、積層造形法で製作する事が可能であり、製作コストを低減できる。また、製造誤差が生じても、弾性構造体の本数が多いので1本の弾性構造体の製作誤差は平均化され、機能上の影響は小さい。
 また、従来の機械加工と異なり積層造形法は複雑な形状を形成できるため、弾性構造体の本数を増やし、ねじり方向と曲げ方向の剛性比をさらに向上させることも容易である。尚、本実施形態では積層造形法により製造する方法について述べたが、これに限ることはなく、場合によっては、機械加工のみによって製造してもよい。
 また、本実施形態では弾性構造体の断面を矩形として説明したが、矩形に限定されるものではない。例えば、角を丸めた矩形や、楕円を採用することも可能である。
 以上説明したように、本実施形態によれば、薄型で、剛性比が高いセンサを実現できる。また、水平天井が存在しない構造を採用できるため、積層造形法で製造可能なセンサを実現できる。また、弾性構造体にかかる応力集中を緩和させることができ、弾性構造体の疲労破壊を防止し、トルクセンサの寿命を延ばし、信頼性を向上させることができる。
 (第一の実施形態の変形例1)
 図14に、第一の実施形態の変形例の部分斜視図を示す。第一の実施形態に対して、弾性構造体にスリットを入れて分割した点が異なる。図において、第1の弾性構造体の中央に隙間Gのスリットを設け、5aと5bの2枚より成る構造とする。第2の弾性構造体も同様に、6aと6bの2枚より成る構造とする。すなわち、第1の弾性構造体および/または第2の弾性構造体は、スリットにより分離された複数の弾性体を有する。
 弾性構造体のねじり剛性、すなわち図14におけるγ軸まわりのねじり剛性は、断面2次極モーメントに比例する。断面がa×bの1枚の弾性構造体の断面2次極モーメントIpは次式で計算できる。
Figure JPOXMLDOC01-appb-M000011
 弾性構造体を分割して2枚にすることを考える。尚、ここでいう分割とは、もともと一つの物体であったものを物理的に切断加工して分離することを意味するものではなく、弾性構造体が独立した2つの部分を含むように構成することを意味するものである。したがって、スリットを挟んで分離して配置された2つの部分を、積層造形法で形成したものであってもよい。
 寸法aを半分にすると、上式は半分よりも小さくなる。つまり、弾性構造体が2枚になっても、断面2次極モーメントが半分より小さくなるので、全体のねじり剛性は下がる。一方、図におけるγ軸方向の剛性は、弾性構造体の断面積に比例する。弾性構造体を分割する隙間Gを十分小さくすれば、分割する前と同じ剛性が得られる。γ軸方向の剛性が変わらないのでトルクセンサの曲げ方向の剛性も変わらない。
 以上をまとめると、弾性構造体の総体積を変えずに複数に分離して配置すると、ねじり剛性が下がり、曲げ剛性は変わらない。従って曲げ方向の剛性とねじり方向の剛性の比をさらに大きくすることができる。
 本変形例では、弾性構造体を分離する隙間Gは十分小さいとして説明した。この仮定が成り立つ範囲で設計すれば、分割数を増やせば増やすほど剛性比を改善できる。
 また、分割した弾性構造体においても、図10を用いて説明した応力分布は同じことが言えるので、図11に示したように弾性構造体の厚さを変化させることにより、応力集中を防止し、耐久性を向上させることができる。
 (第一の実施形態の変形例2)
 また、第一の実施形態の変形例2として、磁気式センサの代わりに光センサを変位検出手段として用いた実施形態を、図53~図56を用いて示す。
 図53、図54に光センサの例を示す。これは、例えば特開平4-130220に記載されているセンサと類似のものである。レーザ光源1001から出射した光線は、コリメータレンズ1002で平行光線となり、偏光ビームスプリッタ1017、波長板1005を通過し、第1の回折格子1101に入射し、1次回折光として2つに分割される。回折光は、第2の反射型回折格子1102に入射し、反射した回折光が再び回折格子1101を透過し干渉する。この干渉光の明暗を、受光手段1008で検出する。図示してないが、受光手段1008を2つ設けて干渉光の位相も測定することにより移動方向を知る技術も、例えば特開昭63-311121号公報により公知である。
 このような構成による光センサの模式図を、図55に示す。図中、A100は、光学部と電気回路を集積して一体化した回路部である。回路部A100には、電気信号を取り出すための電極が設けられている。回折格子を有するスケールA101は、回路部A100と一定の隙間をあけて保持され、回折格子の刻まれるA102方向の相対変位を測定することができる。
 図56に、この光センサを組み込んで構成したトルクセンサを示す。さきほどの実施形態に対し、磁気式センサが光センサに変更された部分だけが異なる。
 スケールA101aを第2部材2に固定して設ける。このスケールA101aは方向A102aの回折格子を有する。図示したように、Z軸まわりの回転方向とスケールの方向A102aを一致させる。このスケールA101aに対向して、回路部A100aを電気基板A103aに固定して設ける。光センサ用の電気基板A103aは、第1部材にねじ10を用いて固定する。以上のA100a~A103aを、Z軸に対して対称な位置にもう一組、A100b~A103bのように設ける。光センサ用の電気基板A103a、A103bからの信号を制御基板11に接続し、第1部材1と第2部材2の、相対的な回転変位を出力する。残余の部分の構成と、作用は前述した実施形態と同じなので説明を省略する。
 以上説明したように、第一の実施形態およびその変形例によれば、検出精度が高く、コンパクトで製造コストが低廉なトルクセンサを提供することができる。
 (第二の実施形態)
 第一の実施形態では、図1に示すロボットシステムにおいて、回転関節J1~J6に取り付けられるトルクセンサの例を示した。第二の実施形態では、ロボットアームとロボットハンド210の間の手首部に配置されて用いられる力センサについて説明する。本実施形態に係る力センサを、本明細書では力覚センサと称する場合がある。
 力覚センサ207は、組付け作業などでハンドの先端にかかる6方向の力や回転モーメント力を検出し、コントローラ102により、測定値に応じたロボットの制御を行う。
 ここで図25より、力覚センサ207からハンド先端までの距離Pは、一般的に小さくない。例えば、100mm以上である。先端にかかる力により、ハンドの先端の位置がずれると、高い精度の組立はできないので、力覚センサ207には高いモーメント剛性が必要である。
 図18は第二の実施形態の力覚センサの構成を示す斜視図、図19は部分断面図、図20は一部拡大図である。図示のように、力覚センサの弾性体607は、ロボットアームに固定する第1部材602と、ロボットハンドに固定する第2部材603、および中間部材604を有する。第1部材602と中間部材604の間を、板ばね等の第1の弾性構造体605を介して連結し、第2部材603と中間部材604の間を、板ばね等の第2の弾性構造体606を介して連結する。
 図18に示すように、第1の弾性構造体605は、第1部材602の外面のうち第1の弾性構造体と連結する面からの法線方向に対して傾くように配置されている。また、第2の弾性構造体606は、第2部材603の外面のうち第2の弾性構造体と連結する面からの法線方向に対して傾くように配置されている。第1部材と第2部材は、同心だが互いに半径が異なる環状部分を有している。
 また、複数の第1の弾性構造体605は、第1部材から中間部材に向けて見たときの傾きが反時計回りに並ぶように配置され、複数の第2の弾性構造体606は、第2部材から中間部材に向けて見たときの傾きが時計回りに並ぶように配置されている。尚、第1の弾性構造体と第2の弾性構造体で向きが逆になるよう並べばよいので、時計回りと反時計回りの関係は、逆であってもよい。
 また、複数の第1の弾性構造体は、第1部材から中間部材に向けて見たときの傾きが環状部分の中心に向かう向きに配置され、複数の第2の弾性構造体は、第2部材から中間部材に向けて見たときの傾きが環状部分の中心から離れる向きに配置されている。上記により、第1の弾性構造体と第2の弾性構造体は、所定のねじれ傾斜角で配置されている。
 ここで、第1部材602、第2部材603、および中間部材604は、第1の弾性構造体605および第2の弾性構造体606に対して十分に硬く、変形しにくいように寸法を設計する。具体的には後述する変形シミュレーションを用いて設計する。
 また、この実施形態では弾性構造体の本数を36本として示したが、弾性構造体の本数を増やせば、モーメント剛性をさらに高くすることができる。弾性構造体のサイズや本数は、後述する変形シミュレーションなどを用いて設計する。
 この弾性体607の3カ所に、次に説明する磁気式の変位検出手段を設ける。変位検出手段を構成する磁石608は、第1部材2に接着固定する。この磁石の3方向の位置を周囲に配置した磁気抵抗素子や、ホール素子で検出する。変位検出手段を構成する検出基板609は、第2部材3にねじ610を用いて固定する。このように基板をねじで固定する目的は、固定されている磁石との位置を調節して固定するためである。この検出基板609は磁石608の3方向の位置に応じて3種類の信号を出力する。検出基板は3セットあるので合計9つの信号が得られる。
 本実施形態のセンサは、図19に部分断面を示すように、第1部材と第2部材の距離は、中間部材と第1部材の距離、および中間部材と第2部材の距離のいずれよりも小さい。また、第1部材と、第2部材と、中間部材は、第一の実施形態と同様に配置されている。前述したように変位検出は、検出対象の距離(第1部材と第2部材の距離)が短いほうが高感度を実現できるので、本実施形態の構成は有利である。
 第1部材と第2部材の距離は、第一の実施形態と同様の理由により10μmから10mmまでの範囲が好ましい。
 3セットの検出基板からの9つの信号をベクトルaと記述する。この信号すなわちベクトルaを、図1のコントローラ102に送信し、6軸の力覚値ベクトルFに次式を使って変換する。
Figure JPOXMLDOC01-appb-M000012
 ここで、6行9列の行列Ai,jは、実験や後述する変形シミュレーションにより、予め求める定数である。具体的には、力覚センサにかける力Fに対して得られる信号aの組合せを、実験やシミュレーションで多数収集し、最小2乗法などを用いて係数行列Ai,jを求める。
 弾性体の変形は微小なので、上式の線形変換で十分だが、より精度よく変換するには上式ではなく、一般化した関数f(a)を用いる。
Figure JPOXMLDOC01-appb-M000013
 本実施形態に係る弾性体は、第一の実施形態と同様にオーバーハング角を考慮した上で積層造形法で製作可能である。
 図20に、オーバーハング角に着目した本実施形態の弾性体の概念図を示す。第1部材602と中間部材604と、その間をつなぐ第1の弾性構造体605において、オーバーハングが懸念される部分は図に示した3カ所のA、B、Cである。
 Aは、弾性構造体の下面であり、弾性構造体の傾斜角をオーバーハング角以下、例えば60度以下にすることは可能である。
 BおよびCは、中間部材の下面であり、図20中、弾性構造体605の間隔Dと、中間部材604の切り欠き距離Eで決まるB面やC面の角度を、オーバーハング角以下、例えば60度以下にすることは可能である。
 ここで、切り欠き距離Eはセンサ全体の縦方向のサイズに関係しているので、小さくしたい。従って弾性構造体605の間隔Dを小さくするのが好ましい。言い換えると、弾性構造体の本数が多い構成が好ましい。
 以上説明したように、本実施形態による弾性体はオーバーハング角を抑えることが可能であり、積層造形法により製造することが可能である。
 次に、図18で示した本実施形態による弾性体607の第1の弾性構造体605、第2の弾性構造体606のサイズや本数をシミュレーションによって求める方法の一例について説明する。
 まず、本実施形態の考え方について説明する。
 本実施形態の説明において、数式で扱う主な記号の意味は、以下のとおりである。
L:弾性構造体の長さ
h:弾性構造体の厚さ
b:弾性構造体の幅
I:弾性構造体の断面2次モーメント
厚さh、幅bの矩形断面の場合、I=bh/12
A:弾性構造体の断面積、矩形断面の場合、A=bh
E:縦弾性係数
F:外力
P:外力がかかる先端位置
δ:変位
D:弾性構造体の間隔
N:弾性構造体の本数
 まず、材料力学の観点から、力覚センサが備えるべき回転モーメントに対する剛性の考え方について述べる。
 図1に示したように、力覚センサ207は、ロボットアームとハンドの間の手首部分に取り付けられ、ハンドにかかる力やモーメントを検出する装置である。力覚センサ207からP離れた位置に外力Fがかかった時、力覚センサにおける変位δはできるだけ小さくしたい。なぜならば、変位が大きいとハンドの先端の位置がずれてしまい、組み立て等の精密な作業に支障をきたす可能性があるからである。
 図25Aに示すように、片持ち弾性構造体の先端にハンド601を接続し、先端に水平方向の外力Fが加わる場合を考える。この場合、外力Fにより、図25Bのように変形する。
 この時の先端の変位δを、水平移動の影響δと、傾きの影響δに分けて考える。
Figure JPOXMLDOC01-appb-M000014
 片持ち弾性構造体の公式から、それぞれの変位量は次のように求まる。
Figure JPOXMLDOC01-appb-M000015
Figure JPOXMLDOC01-appb-M000016
 両者を比較するため、水平移動の影響δと、傾きの影響δの比をαとすると、次のようになる。
Figure JPOXMLDOC01-appb-M000017
 一般に、力覚センサ内の弾性体のサイズLに対して、外力がかかる位置までの距離Pの方がずっと大きい。例えば、L=10mm、P=100mmのように、具体的な数値を入れて考えると、上の比αは15となる。
 つまり、水平移動の影響よりも傾きの影響の方が15倍も大きい。従って、先端の位置ずれを抑制するには、並進方向よりもモーメント剛性を高めることが重要である。
 モーメント剛性を高める簡便な方法は、弾性構造体の構造に工夫をすることである。そこで、図26Aに示すように、2本の弾性構造体の先端にハンド601を接続し、先端に水平方向の外力Fが加わる場合を考える。この場合、外力Fにより、図26Bのように変形する。さきほどと同様、先端の変位δを、水平移動の影響δと、傾きの影響δに分けて考える。
 δは、2本の弾性構造体に均等に力がかかると考えられるので、両端固定の弾性構造体の式を使って次式で計算できる。
Figure JPOXMLDOC01-appb-M000018
 弾性構造体の断面を矩形とし、断面2次モーメントIを書き直すと、
Figure JPOXMLDOC01-appb-M000019
 一方、傾きの影響については、弾性構造体にかかる圧縮方向の力をF、その変位をδとして、次のように計算する。
 弾性構造体の傾斜はδ/Pなので、弾性構造体の変位は、
Figure JPOXMLDOC01-appb-M000020
 弾性構造体の圧縮の式より、
Figure JPOXMLDOC01-appb-M000021
 この2つの式から、力Fが次のように求まる。
Figure JPOXMLDOC01-appb-M000022
 一方、弾性構造体にはFPのモーメントがかかるので、力の釣り合いから、
Figure JPOXMLDOC01-appb-M000023
 これに、先ほどのFを代入して整理すると、
Figure JPOXMLDOC01-appb-M000024
 さきほどと同様、水平移動の影響δと、傾きの影響δの比をαとすると、
Figure JPOXMLDOC01-appb-M000025
 となる。
 具体的な数値を入れて考える。L=10mm、P=100mmとし、弾性構造体の幅をD=50mm、厚さをh=1mmとすると、α=0.08となる。
 さきほどのα=15と比較すると、約1800分の1であり、桁違いに小さい。つまり、傾斜の影響が抑えられ、モーメント剛性が高いことがわかる。
 以上説明してきたように、本実施形態は、弾性構造体の並進方向の剛性に対してモーメント剛性が高いことを利用している。
 次に、弾性構造体の本数を増やすと、このモーメント剛性をさらに改善し、性能を向上できることを示す。
 図27に示すように、間隔Dの間に設けたN本の弾性構造体であるB~Bについて外力Fによる先端の変位を考える。
 これまでの検討と同様に、変位は水平移動の影響δと、傾きの影響δに分けて考える。
 δは、N本の弾性構造体に均等に力がかかると考えられるので、両端固定の弾性構造体の式を使って次式で計算できる。
Figure JPOXMLDOC01-appb-M000026
 弾性構造体の断面を矩形とし、断面2次モーメントIを書きなおすと、
Figure JPOXMLDOC01-appb-M000027
 一方、傾きの影響については、第i番目の弾性構造体にかかる圧縮方向の力をF、その変位をδとして、次のように計算する。
 弾性構造体の傾斜はδ/Pなので、それぞれの弾性構造体の圧縮方向の変位は、
Figure JPOXMLDOC01-appb-M000028
 弾性構造体の圧縮の式より、
Figure JPOXMLDOC01-appb-M000029
 従って、第i番目の弾性構造体にかかる圧縮方向の力Fが、次のように求まる。
Figure JPOXMLDOC01-appb-M000030
 外力により、弾性構造体にはFPのモーメントがかかるので、力の釣り合いから、
Figure JPOXMLDOC01-appb-M000031
 これに、先ほどのFを代入すると、
Figure JPOXMLDOC01-appb-M000032
Figure JPOXMLDOC01-appb-M000033
 となる。
 以上で、変位は水平移動の影響δと、傾きの影響δが求まった。次に、δが一定の条件で、δとδとの比を計算し評価する。
 よく知られているように、水平移動δは弾性構造体の厚さhの3乗に反比例して変位が増える。
 そこで、Hを定数として、板厚hを次式のように定義する。
Figure JPOXMLDOC01-appb-M000034
 弾性構造体の本数がN本の時の両者の比であるα(N)=δ/δを計算すると、
Figure JPOXMLDOC01-appb-M000035
 となる。
 図28に、数式34のグラフを示す。横軸は弾性構造体の本数Nである。縦軸は2本の弾性構造体の時を1に正規化して示した比、つまりα(N)/α(2)である。
 弾性構造体の本数を増やすほど、α(N)が小さい。つまり、水平移動の影響δに対して、傾きの影響δが小さくなっており、モーメント剛性が高いといえる。以上、弾性構造体の本数が多いほど、モーメント剛性を高めることができることを説明した。
 また、弾性構造体の本数が多ければ、1本の弾性構造体の製作誤差の平均化が期待できるとともに、1本あたりの製造コストを低く抑える効果がある。
 ここまでは、水平方向の力について説明してきたが、垂直方向についても同じ考え方が適用できる。
 図29Aに示すように、2段の弾性構造体の先端にハンド601を接続し、先端に水平方向の力と垂直方向の力が加わる場合を考える。ここでは、第1の弾性構造体を連結する部材を中間部材604と呼び、第2の弾性構造体を連結する部材を第2部材(作用部材)603と呼ぶ。
 水平方向の外力がかかると、図29Bのように変形するが、これまでと同じ理由により、弾性構造体によって傾斜の影響が抑えられる。
 尚、2段の弾性構造体は異なる方向を向いて配置する必要がある。もし同じ方向なら1段の弾性構造体と同じなので、2段にした効果が十分に発揮されないからである。
 図30は、本実施形態における弾性体の構造を模式的に表している。ロボットアームに固定する第1部材(台座部材)602と、ロボットハンドに固定する第2部材(作用部材)603、中間部材604を設け、その間を第1の弾性構造体605と、第2の弾性構造体606で連結する。第1の弾性構造体605は、第1部材602の外面のうち第1の弾性構造体と連結する面からの法線方向に対して傾くように配置されている。また、第2の弾性構造体606は、第2部材603の外面のうち第2の弾性構造体と連結する面からの法線方向に対して傾くように配置されている。
 第1部材(台座部材)602、第2部材(作用部材)603、中間部材604については、弾性構造体605、606よりも硬くなければならない。そうしないと、弾性構造体の効果が減殺され、モーメント剛性が下がってしまうからである。つまり、第1部材(台座部材)602、第2部材(作用部材)603、中間部材604は、弾性構造体605、606よりも硬くなるように、十分大きな厚さや幅になるように設計する。
 以上説明した傾斜2段弾性構造体により、積層造形可能で、モーメント剛性の高い力覚センサを実現できる。
 尚、図30では、図示の便宜のため非等縮尺で示したため第1部材602と第2部材603の距離が比較的大きく見えるが、この距離は、第1部材と中間部材の距離、および第2部材と中間部材の距離よりも小さい。
 さらに、力覚センサの弾性体の剛性は方向によって変わらないのが望ましい。力覚センサの測定感度が、方向によって変化してしまうことを防止するためである。そこで円周状に弾性構造体を配置し、剛性が方向に依存しない構造を実現する。
 図31Aに、円周に沿って配置した傾斜2段弾性構造体の弾性体607の分解図を、図31Bに弾性体607の完成図を示す。
 ロボットアームに固定する第1部材(台座部材)602と、ロボットハンドに固定する第2部材(作用部材)603、中間部材604を設け、その間を第1の弾性構造体605と、第2の弾性構造体606で連結する。
 この構成によれば、垂直軸まわりに対称なので、方向によらず一定の剛性が得られる。この時、弾性体607が3回以上の回転対称性を持つことが重要である。そうでないと方向によって剛性が変化する。
 また、図31Aにおいて、第1の弾性構造体605が設置される方向と第2の弾性構造体606が設置される方向は、異なる方向でなければならない。もし同じ方向なら、1段の弾性構造体を用いる場合に比べて、大きな効果上の差異が期待できないからである。
 この条件を数式で表現すると、第1の弾性構造体605の方向ベクトルeと、第2の弾性構造体606の方向ベクトルeは、センサの円周方向eに対する内積の符号が異なることから、次のように表現できる。
Figure JPOXMLDOC01-appb-M000036
 以上のように、本実施形態によれば、2段の弾性構造体を採用することにより、力覚センサにとって重要な高いモーメント剛性を実現できる。その際に、弾性構造体の本数は多い方が、モーメント剛性を高めることができる。また、弾性構造体を傾斜させることにより、積層造形法で製作することができる。また、弾性構造体を円周状に配置することにより、方向に依存しない剛性を実現できる。
 このことを踏まえ、弾性構造体のサイズ、本数を、シミュレーションにより求める方法の一例について説明する。
 図21Aに示すのは、弾性体のFEMモデルである。このモデルの概要を次に示す。
第1部材:外形Φ56.0mm、幅2.0mm、厚さ2.0mm
中間部材:外形Φ47.0mm、幅3.0mm、厚さ1.5mm
第2部材:外形Φ48.0mm、幅2.0mm、厚さ2.0mm
弾性構造体:72本、幅1.0mm、厚さ0.5mm、傾斜角度39度
材質:ステンレス
 次に、第1部材を固定し、第2部材に力やモーメントをかけた時の第2部材の変位を計算する。
 図21Bに、Y方向の外力Fyをかけた時の変形を示す。図21Cに、Z方向の外力Fzをかけた時の変形を示す。図21Dに、Y方向のモーメント力Myをかけた時の変形を示す。図21Eに、Z方向のモーメント力Mzをかけた時の変形を示す。
 X方向については、対称性から考えてY方向と同じ結果になるので、説明を省略する。6次元の力のベクトルをF、変形のベクトルをδ、コンプライアンス行列をCとし、変形シミュレーションの計算結果を次に示す。
Figure JPOXMLDOC01-appb-M000037
Figure JPOXMLDOC01-appb-M000038
 ここで、Fの単位は、NとNmである。δの単位は、mとradである。
 100mm離れた位置に、1Nの力をかけた場合を考える。このとき、力覚センサにかかる回転モーメントは、0.1Nmである。上記コンプライアンス行列から、水平移動の影響δ、傾きの影響δ、および両者の比αは次のようになる。
Figure JPOXMLDOC01-appb-M000039
 αは、0.26と小さい。この結果から、傾きの影響が小さく、高いモーメント剛性を実現できていることがわかる。また、αが小さい理由は、弾性構造体の効果が現れているからである。
 次に、本実施形態に係る力覚センサの製造方法を説明する。前述したように、本実施形態による力覚センサはオーバーハング角が小さいため、積層造形法による製造が可能である。
 図22Aは、積層造形装置に取り付ける造形ユニット620を説明するための分解図で、図22Bは、造形ユニット620の組立て図である。
 ロボットアームに固定する第1部材602と、ロボットハンドに固定する第2部材603は、リング状の部品である。旋盤などによる形の製作、図22Aにおける造形プレート621へのねじ止め、レーザ光の照射等は第一の実施形態と同様であるため詳細な説明は割愛する。
 図23Aは、造形ユニット620の上に積層造形した直後の図である。造形プレートの固定ねじを外すと、図23Bに示すように弾性体607を造形プレートから脱着できる。
 以上のように、本実施形態によれば、積層造形法で製作する事が可能であり、製作コストを低減できる。また、従来の積層造形法と比べると、第一の実施形態で述べた第一から第四の点で製造コストを下げることが可能である。
 また、積層造形法によれば複雑な形状も作成できるため、弾性構造体の本数を増やし、モーメント剛性をさらに向上させることが容易に可能である。また、たとえ製造誤差が生じることがあったとしても、弾性構造体の本数が多いので、1本の弾性構造体の製作誤差は平均化され、影響は少ない。
 尚、本実施形態では積層造形法により製造する方法について述べたが、これに限ることはなく、場合によっては、機械加工のみによって製造してもよい。
 また、本実施形態では弾性構造体の断面を矩形として説明したが、矩形に限定されるものではない。例えば、角を丸めた矩形や、楕円を採用することも可能である。
 (第二の実施形態の変形例1)
 次に、第二の実施形態の変形例を示すが、具体的には、弾性構造体が湾曲している点が異なる。
 図24において、力覚センサの弾性体607は、ロボットアームに固定する第1部材602と、ロボットハンドに固定する第2部材603、および中間部材604を有する。第1部材602と中間部材604の間を第1の弾性構造体605を介して連結し、第2部材603と中間部材604の間を第2の弾性構造体606を介して連結する。
 第1部材と第2部材は同一の平面に沿うよう配置され、中間部材は、該平面に投影したときに射影の少なくとも一部が第1部材と第2部材の間隙部と重なるように、該平面から離れて配置されている。
 第1の弾性構造体605は外側に湾曲しており、第2の弾性構造体606は内側に湾曲している。すなわち、第2部材は第1部材と同心に配置され、第1部材よりも半径が小さな環状の部材であり、第1の弾性構造体は中心から離れる方向に凸になるよう湾曲した形状を有し、第2の弾性構造体は中心に向かう方向に凸になるよう湾曲した形状を有する。
 これらの弾性構造体が湾曲しない直線の場合には、弾性構造体の本数を増やすと、第1の弾性構造体と第2の弾性構造体が重なり合う。つまり、第1の弾性構造体と第2の弾性構造体の梁は、一方が外側から内側に向かい、もう一方が内側から外側に向かうので、梁の本数を増やして密度を上げていくと、両方の梁はちょうど中間付近で接触してしまうようになる。従って梁の本数には、それ以上増やせない限界がある。
 しかし、本実施形態のように湾曲していれば、重なり合うのを回避する事ができるため、弾性構造体の本数をさらに増やすことができる。本実施形態によれば、弾性構造体の本数を増やすことができるため、より高いモーメント剛性を実現できる。
 (第二の実施形態の変形例2)
 また、第二の実施形態の変形例2として、磁気式センサの代わりに光センサを変位検出手段として用いてもよい。構成は第一の実施形態と同様であるため詳しい説明は割愛する。光センサを用いることで検出精度が高く、コンパクトで製造コストが低廉な力覚センサを提供することができる。
 (第三の実施形態)
 第三の実施形態を、図面に基づいて説明する。図1のロボットシステムにおいて、第一の実施形態では回転関節J1~J6に取り付けられるトルクセンサの例を示し、第二の実施形態ではロボットアームとロボットハンド210の間の手首部に配置される力覚センサ207について説明した。本実施形態では、把持物にかかる力を検出するための指先力センサ220a、指先力センサ220bについて説明する。本実施形態に係る力センサを、本明細書では指先力センサと称する場合がある。
 図1に示した6軸多関節ロボット装置100のロボットハンド210は、駆動可能な複数の指を有する。図示したハンドは2本の指を備えるが、3本以上の指があるハンドであっても、本実施形態の指先力センサを用いることができる。それぞれの指には、本実施形態の指先力センサ220aおよび指先力センサ220bを介して、指230aと指230bが取付けられている。
 このロボットハンド210で部品を把持し、組立て作業を行う時には、把持物にかかる力を指先力センサ220aと指先力センサ220bで検出する。この測定値に基づき、制御装置101で関節J1~J6を制御する。
 例えば、部品を平板に突き当てる作業工程では、指先力センサの測定値があらかじめ定めた力になるまで、ロボット関節を制御して部品を平板に接近させる。これは、指先にかかる力に応じて組立ロボットの動作を制御するには必須の機能である。ロボットの手首部に力覚センサを設け、同様の機能を行う方法も知られているが、指先力センサの方が、慣性が小さいので応答が速いという利点がある。
 また、指先力センサを活用する別の例として、部品を把持する作業工程が挙げられる。把持工程では、指先力センサの測定値が、あらかじめ定めた力になるまで指を接近させる。これは、やわらかい部品を、小さい変形に抑えつつ把持して組み立てる組立てロボットには必須の機能であり、例えば薄いプラスチック製のリングを取り扱う場合には、1N程度の小さい力で把持する必要がある。
 本実施形態の指先力センサの構成を、図32、図33、および図34に示す。それぞれ図32は指先力センサの分解図、図33は斜視図、図34は断面図である。
 第1部材701を、不図示の指の駆動部に固定して設け、第2部材702と、中間部材704を設ける。第1の弾性構造体705を用いて、第1部材701と中間部材704を連結する。本実施形態では、第1の弾性構造体は片側につき6本の弾性構造体が2列、合計12本の弾性構造体で構成した例を示しているが、本数と列数はこれに限られるものではない。
 また、第2の弾性構造体706を用いて、第2部材702と中間部材704を連結する。この実施形態では、第2の弾性構造体は、片側につき5本の弾性構造体が2列と中央部3本、合計13本の弾性構造体で構成する例を示しているが、本数と配置はこれに限られるものではない。
 第1部材701、第2部材702、中間部材704、第1の弾性構造体705、第2の弾性構造体706で、弾性体を構成する。弾性体は、後述するように、その一部が積層造形法で形成された一体の部品である。
 第1部材と第2部材は同一の平面に沿うよう配置され、中間部材は、該平面に投影したときに射影の少なくとも一部が第1部材と第2部材の間隙部と重なるように、該平面から離れて配置されている。
 第2部材702には、指730をネジ712で固定する。指は、ロボットハンドが組み立てる対象物の形に合わせて、適宜の形状のものを用いる。
 第1部材701には、変位検出手段を構成するセンサ基板709をネジ713で固定する。第2部材702には、変位検出手段を構成する磁石708を固定する。この変位検出手段は、磁石を有する磁気式の変位計であってもよいし、後述するように光学式の変位計であってもよい。
 本実施形態は、第1部材、第2部材、中間部材の3つの部材のうち、相対距離が最も短い第1部材と第2部材の変位を検出するので、高感度を実現する上で最も有利な構成である。また、第1部材と、第2部材と、中間部材は、第一の実施形態と同様に配置されている。
 第1部材と第2部材の距離は、第一の実施形態と同様の理由により10μmから10mmまでの範囲が好ましい。
 磁気式の変位計を用いる場合は、磁石708が動くと、その周囲の磁力線も動く。その磁力線の動きをセンサ基板709に設けた複数のホール素子、もしくは磁気抵抗素子で検出する。この方法で、磁石708のXYZの3方向の動きを検出できる。この検出信号δx、δy、δzを、図32の制御基板711に入力し、XYZの3方向の指先力Fx、Fy、Fz、を出力する。この変換は次式で行う。
Figure JPOXMLDOC01-appb-M000040
 ここで、[K]は剛性行列であり、あらかじめ求める定数である。この行列は、指先に3方向の力をかけて実測することが可能である。また、後述するようにFEMを用いて計算で求めることも可能である。
 次に、本実施形態の弾性体は、積層造形法で製作可能な事を説明する。前述したように、積層造形法ではオーバーハング角に限界があり、特に水平天井は造形が困難である。
 図35に、オーバーハング角に着目した本実施形態の弾性体の模式図を示す。第1部材701と中間部材704を第1の弾性構造体705で連結する。オーバーハングが懸念される部分は図中、SとS部である。このオーバーハングが、前述した制限値以内になるように、弾性構造体の間隔Bと、縦方向の寸法Cを設計する必要がある。この模式図によれば、次のような条件である。
Figure JPOXMLDOC01-appb-M000041
 寸法Cを小さくして指先力センサを薄型にするためには、弾性構造体の間隔ピッチBを狭く、すなわち、弾性構造体の数が多いほうが好ましい。弾性構造体の数を増やすことは、前述したように、指先力センサの剛性比を向上するためにも役に立つ。本実施形態の弾性体は、弾性構造体の数を増やすことによって、剛性比を改善し、オーバーハング角を抑え、積層造形可能である。
 次に、より具体的な設計例として、FEMシミュレーション結果を説明する。
 まず、本実施形態の考え方について説明する。本明細書の数式で扱う主な記号の定義は、以下のとおりである。
L:弾性構造体の長さ
E:弾性構造体の縦弾性係数
I:弾性構造体の断面2次モーメント
厚さh、幅bの矩形断面の場合、I=bh/12
P:弾性構造体にかかる曲げ方向の力
W:弾性構造体にかかる軸方向の力
F、M:力とモーメント
δ,θ:変位と回転角
、H:弾性構造体のx、y方向の厚さ
、L:弾性構造体列のx、y方向の長さ
、N:弾性構造体列のx、y方向の数
:センサ座標系
 指先力センサは弾性体と変位測定手段から構成されているので、力学的な性能は弾性体で決まる。そこでまず、材料力学の観点から弾性体の剛性を明らかにする。
 図36Aに示すように、点Aから放射状に伸びる方向に沿って配置した2本の弾性構造体を検討する。弾性構造体の中心に座標系Cを設定し、その原点と点Aまでの距離をLとする。2本の弾性構造体の間隔をLxとする。また、点Aまでの距離をLp、傾斜角度をηとする。
 すなわち、
Figure JPOXMLDOC01-appb-M000042
 である。
 力の表記法に関し、図36Bに示すように、点Aにかかる力Fと回転モーメントMの左肩に点を表す記号、Aをつけて区別する。弾性構造体にかかる力は軸方向の力をW、曲げ方向の力をPと表記する。
 変位の表記法に関し、図36Cに示すように、点Aの変位δと回転角θの表記にも左肩に点を表す記号、記号の「A」をつけて区別する。弾性構造体の変位は軸方向をδw、曲げ方向をδpなどと表記する。
 図36Bにおいて、点Aにかかる力Fx、Fzとモーメント力Myを考える。これらを、2つの弾性構造体にかかる軸方向の力W、Wと曲げ方向の力P、Pに分けて力のつりあいを考え次式を得る。
Figure JPOXMLDOC01-appb-M000043
 弾性構造体の軸方向の変形δと曲げ方向の変形δに関して、材料力学の公式から次式を得る。
Figure JPOXMLDOC01-appb-M000044
 ここで、Eはヤング率、Iは断面2次モーメント、Aは断面積、Lは弾性構造体の長さである。
 図36Cにおいて、点Aの並進移動量δx、δzと回転角、θyについては、幾何学的な関係より次式を得る。
Figure JPOXMLDOC01-appb-M000045
 数式42~数式44をまとめ、点Aにかかる力と変位の関係、すなわち剛性行列を計算すると次式を得る。
Figure JPOXMLDOC01-appb-M000046
 一方、図37に示す平行配置した弾性構造体についても同様に計算すると、点Aにかかる力と変位の関係は次式となる。
Figure JPOXMLDOC01-appb-M000047
 以上、計算した放射状配置と平行配置の弾性構造体の剛性を、次表にまとめる。
Figure JPOXMLDOC01-appb-T000048
 弾性構造体の剛性は、軸方向のほうが曲げ方向よりも強いことが知られている。
 表2において、軸方向の剛性に関する断面積Aを含む項に着目すると、放射状配置は平行配置に対して、水平方向の剛性Kxが高いことがわかる。
 次に、具体的な数字を入れて説明する。指先力センサのサイズを左右する弾性構造体の間隔をLx=20mmとし、センサから点Aまでの距離をL=30mmとする。弾性構造体のヤング率をE=200GPa、弾性構造体の幅と厚さを1mm、長さをL=10mmとする。この時、放射状配置の弾性構造体の傾斜角は、η=18.4度となり、剛性は次表のように計算できる。
Figure JPOXMLDOC01-appb-T000049
 表3の水平方向の剛性Kxに着目すると、放射状配置は平行配置に対して10倍以上高い。指先力センサは、指先にかかる力による弾性体の変形を検出するセンサである。剛性が高いと弾性体の変形も小さくなり、センサの感度が低下してしまう。
 上表で説明したように、水平方向の剛性Kxは平行配置により軽減できるが、垂直方向の剛性Kzは依然として高い。
 そこで、本実施形態では、図38に示すように、弾性構造体を2段に構成する。すなわち、第1部材701、第2部材702、中間部材704を設け、第1の弾性構造体705で第1部材701と中間部材704を連結し、第2の弾性構造体706で第2部材702と中間部材704を連結する。第1部材は、図示しない指の移動部材に固定し、第2部材702は指730に固定する。
 このような構成によれば、XYZの3軸とも弾性構造体の曲げ方向と一致させることができて、剛性を低く設計することができる。
 第1の弾性構造体705と第2の弾性構造体706は、方向が異なることが重要である。同じ方向の場合には1段の弾性構造体と同じことになり、水平と垂直方向の剛性の差が大きくなってしまう。弾性構造体の方向は、以下に説明するように90度異なる場合が最も効果的である。
 図39に、水平と垂直方向の剛性KxとKzを組合せ、角度θで接続した弾性体の模式図を示す。
 この構造のX、Y方向の変位は直列ばねになるので、次のように計算できる。
Figure JPOXMLDOC01-appb-M000050
 また、前述したように、KzはKxより十分大きいので、数式47は次のように単純化できる。
Figure JPOXMLDOC01-appb-M000051
 上式から、弾性体全体のXとZの2方向の剛性の比Rxzは次のようになる。
Figure JPOXMLDOC01-appb-M000052
 図40に、数式49の剛性の比Rzxと角度θの関係をグラフにして示す。指先力センサは、XYZの3軸方向とも同じ感度を持つことが好ましいが、剛性の比は角度が90度の場合に最良の1となる。この感度比の実用的な限界を約0.1とすると、角度として25度以上が必要なことがわかる。
 また、材料力学によると、曲げ剛性は弾性構造体の長さLの3乗に反比例する。従って、長さLは長いほうが有利である。さらに、弾性構造体にかかる応力も下げることができる。しかし、Lを長くすると指先センサが厚くなってしまう。
 そこで、図41に示すように、傾斜させて2段の弾性構造体構造を配置する。図に示すように同じ弾性構造体の長さLでも45度傾斜させることにより、センサの厚さを約0.7倍に抑えることが可能である。第1の弾性構造体は、第1部材の外面のうち第1の弾性構造体と連結する面からの法線方向に対して傾くように配置されている。また、第2の弾性構造体は、第2部材の外面のうち第2の弾性構造体と連結する面からの法線方向に対して傾くように配置されている。
 尚、図41では、図示の便宜のため非等縮尺で示したため第1部材701と第2部材702の距離が比較的大きく見えるが、この距離は、第1部材と中間部材の距離、および第2部材と中間部材の距離よりも小さい。
 さらに、図41を図36と比較すると、第2の弾性構造体706の間隔L’についても厚さ方向に間隔をあけて配置しなくても良くなるので、さらに薄いセンサを実現できる。また、これまで平面図で本実施形態を説明したが、紙面に垂直な方向も考慮すると、2段の弾性構造体はそれぞれがXY格子状に配列した4本以上の弾性構造体の集合である。
 図42Aは、本実施形形態の構造を説明するための分解図で、図42Bは完成体の斜視図である。
 同図において、第1部材701、第2部材702、中間部材704を設け、4本以上の弾性構造体から構成される第1の弾性構造体705で第1部材701と中間部材704を連結する。また、4本以上の弾性構造体から構成される第2の弾性構造体706で第2部材702と中間部材704を連結する。第1部材は、図示しない指の移動部材に固定し、第2部材702は指730に固定する。
 次に、XY格子状に2次元配置した4本以上の弾性構造体構造について、力学的な特性を明らかする。そして、弾性構造体の本数が多いほうが、性能の高い指先力センサを構成できることを明らかにする。
 図43を用いて説明する。説明のため指先力センサの中心に座標系Cを設定し、外力のかかる作用点に座標系Cを設定する。
 図中のC座標系において、XY格子状に配列した弾性構造体のうち、第i行、j列の弾性構造体1本の変形を考える。両端の回転を拘束した矩形断面の弾性構造体のXY方向の曲げ変形δpx、δpyとZ方向の変形δpzは、XYZ方向の力Px、Py、Pzと次の関係にある。
Figure JPOXMLDOC01-appb-M000053
Figure JPOXMLDOC01-appb-M000054
Figure JPOXMLDOC01-appb-M000055
 ここで、H、Hは、XY方向の弾性構造体の厚さである。この弾性構造体が、X方向にNx本、Y方向にNy本配列した場合の変形を計算する。並進方向の剛性は、上記の弾性構造体を並列接続するので、次のように書ける。
Figure JPOXMLDOC01-appb-M000056
Figure JPOXMLDOC01-appb-M000057
Figure JPOXMLDOC01-appb-M000058
 X軸まわりのモーメントMxに対する回転角をθxと表記すると、原点からL((j-1)/(N-1)+1/2)離れた位置のばねを並列接続するので、
Figure JPOXMLDOC01-appb-M000059
 Y軸まわりのモーメントMyに対する回転角θyについても同様に表現できる。
Figure JPOXMLDOC01-appb-M000060
 以上、指先力センサの座標Cにおける、弾性体の剛性を示した。この時、並進方向の剛性は弱い方が、高感度な指先力センサを実現できることを述べた。しかし、回転剛性については強いほうが好ましい。指先にかかる力によって指先の位置が大きくずれてしまっては、組立てなどの高精度な作業に支障がでるからである。
 そこで、回転剛性と並進剛性との比を考える。この比が大きいほうが、より高性能な指先力センサを構成することができる。
 X方向について回転方向と並進方向との剛性比αを計算すると、
Figure JPOXMLDOC01-appb-M000061
 ここで、並進方向の剛性は指先力センサの感度を決める設計値なので、弾性構造体の本数Nxを変更しても並進方向の剛性が変わらないように、Bxを定数とし、弾性構造体の厚さをH=B(N-1/3、と定義すると、剛性比αは、
Figure JPOXMLDOC01-appb-M000062
 となる。
 図44に、弾性構造体の本数Nx=2の値で正規化し、弾性構造体の本数とαの関係をプロットしたグラフを示す。
 縦軸の1は、弾性構造体の本数が2本の剛性比と同じであることを表す。弾性構造体が6本以下なら、2本の場合が最も優れた剛性比となるが、本数を7本以上に増やせば、2本より優れた剛性比となる。
 以上のように、本実施形態によれば、指先力に対して高感度で、薄い指先力センサを構成できる。さらに、弾性構造体の数を増やすことにより、モーメント剛性の高いセンサを構成できることを説明した。
 本実施形態によれば、弾性構造体を多数化し、弾性構造体と弾性構造体の間を傾斜面で接続することにより、オーバーハング角を制限内に抑えることができ、積層造形可能である。
 また、以下に説明するように、指先の変位を拡大して検出できるので、より高感度な指先力センサを実現できる。
 図45に、指先位置とセンサ位置も考慮した放射状配置の弾性構造体の模式図を示す。点Aは2本の弾性構造体の方向を決める目標点、点Bは指先の位置で、この点に指先力がかかる。点Cはセンサの位置で、この点の変位を検出する。点Aの変位と点Aの力の関係は数式45に示したが、ここでは点Cの変位と点Bの力との関係を示す。
 点Bは、指先が物品から受ける力がかかる位置である。点Aにかる力を点Bに座標変換する式は次のように書ける。
Figure JPOXMLDOC01-appb-M000063
 また、点Cは、弾性体の変形を測定するセンサを配置する位置である。点Cの変位を点Aに座標変換する式は、次のように書ける。
Figure JPOXMLDOC01-appb-M000064
 これらと、数式45から、指先(点B)にかける力に対するセンサの位置(点C)の変位を計算できる。指先力センサに関係する力の成分だけ示すと、次のようになる。
Figure JPOXMLDOC01-appb-M000065
 上式の係数は、この指先センサの感度行列である。力をかける点Bの位置Lを変えると、上式から1行1列の項、すなわちX方向の感度Sが影響を受けることがわかる。この項に着目する。
Figure JPOXMLDOC01-appb-M000066
 右辺第1項の括弧部分の符号を考える。弾性構造体を、幅bで厚さhの矩形断面とすると、この部分は次のようになる。
Figure JPOXMLDOC01-appb-M000067
 弾性構造体は、通常は厚さhより長さLのほうが大きいので、上式は正である。従って、感度Sは、Lが正ならばLがゼロの場合より必ず大きくなり、センサ感度が向上する。
 言い換えると、力のかかる指先の点Bより遠い位置に放射状弾性構造体の中心である点Aを配置することにより、センサ感度を向上させることができる。
 例えば、指先力センサのサイズを左右する弾性構造体の間隔をLx=20mmとし、弾性構造体のヤング率をE=200GPa、弾性構造体の幅と厚さを1mm、長さをL=10mmとする。変位センサから力をかける指先までの距離を、一定値L-L=30mmとする。
 図46に、放射状配置の弾性構造体の中心点までの距離LとLとの比を横軸とし、数式63の感度Sを、L=0の時の値で正規化してプロットしたグラフを示す。図中、PはL=30mm、すなわち、L=0の場合を表し、縦軸の値は1である。図からわかるように、弾性構造体の中心点Lが30mmより長い場合、感度比が1よりも大きく、良好である。
 以上説明したように、弾性構造体の中心点を指先より遠方に配置することにより、高感度な指先力センサを構成できる。
 図47Aは、シミュレーションに用いた弾性体のFEMモデルである。このモデルは、図32~34を参照して説明した構造と同じである。主な特徴は、第一に弾性構造体の幅が厚さより大きいこと、第二に第1の弾性構造体705は片側に6本、全部で12本あること、第三に第2の弾性構造体705は片側に5本、中央部に3本、全部で13本あることである。
 上記、弾性構造体の幅、厚さ、長さ、および弾性構造体の本数などは、本実施形態の指先力センサの設計パラメータである。この設計パラメータを決定するのが、FEMシミュレーションの目的である。
 図47Bは、指先にFx=30Nの力をかけたときの変形計算結果である。この図は変形を見やすいように誇張して描画されている。図47Cは、指先にFy=30Nの力をかけたときの変形計算結果である。図47Dは、指先にFz=30Nの力をかけたときの変形計算結果である。
 前述したように、弾性体の変形を検出する変位検出手段は、磁石708の位置を測定する。FEM計算で得られた磁石の位置変化を、次表にまとめる。
Figure JPOXMLDOC01-appb-T000068
 上表に示したように、この設計例では最も感度が高いのはY方向であった。
 この結果を行列で表現すると、
Figure JPOXMLDOC01-appb-M000069
 この式から、数式39にあたる変位検出手段の出力から指先力を計算する式を求めると、
Figure JPOXMLDOC01-appb-M000070
 となる。
 以上のFEM変形シミュレーションを繰り返し行い、所望の感度が得られるように弾性構造体の幅や厚さなどの設計パラメータを決定する。
 次に、本発明による力覚センサの製造方法を説明する。
 図48Aは、積層造形装置に取り付ける造形ユニット720を説明のために分解して示した図で、図48Bは造形ユニット720の完成図である。
 第1部材701と第2部材702は、フライス盤などで製作した高精度な部品であり、造形プレート721にねじ止めし、造形ユニット720を完成させる。旋盤などによる形の製作、図48Aにおける造形プレート721へのねじ止め、レーザ光の照射等は第一の実施形態と同様であるため詳細な説明は割愛する。
 図49Aに、造形ユニット720の上に積層造形し、弾性体707を完成させた状態を示す。弾性体707は、第1部材701と第2部材702の上に、第1の弾性構造体705、第2の弾性構造体706、および中間部材704を積層造形した構造物である。造形プレートの固定ねじを外すと、図49Bに示すように弾性体707が完成する。そして、第1部材と第2部材と第1の弾性構造体と第2の弾性構造体と中間部材が一体化した3次元造形物を形成した後に、3次元造形物を造形プレートから脱着する。
 この製造方法は、従来の積層造形法と比べて、第一の実施形態で述べた第一から第四の点で製造コストを下げることが可能である。よって、本実施形態の指先力センサは、積層造形法で製作する事が可能であり、製作コストを低減できる。
 また、従来の機械加工と異なり積層造形は、弾性構造体の本数を増やし、モーメント剛性の剛性比をさらに向上させることも容易である。また、製造誤差が生じても、弾性構造帯の本数が多いので、1本の弾性構造体の製作誤差は平均化され影響は小さい。
 また、本実施形態では積層造形法により製造する方法について述べたが、これに限られることはない。例えば、機械加工によって製造することも可能である。
 また、本実施形態では弾性構造体の断面形状を矩形として説明したが、矩形以外でも可能である。例えばカドを丸めた矩形や楕円でも、実施することが可能である。
 (第三の実施形態の変形例1)
 図50を用いて、第三の実施形態の変形例について説明する。第三の実施形態とは第1の弾性構造体が異なり、その他については同様である。
 図50Aは説明のために分解した図で、図50Bは完成図である。
 第1部材701、第2部材702、中間部材704を設け、4本以上の弾性構造体から構成される第1の弾性構造体705により第1部材701と中間部材704を連結する。また、4本以上の弾性構造体から構成される第2の弾性構造体706により第2部材702と中間部材704を連結する。第1部材は、不図示の指の移動部材に固定し、第2部材702は指730に固定する。
 第1の弾性構造体705は、垂直軸ηと水平軸ξで張られる平面η-ξ上に配置される放射状弾性構造体である。この平面上に中心点Pがあり、第1の弾性構造体構造はこの点の方向を向いている。一方、指730の先端の点を、平面η-ξに投影した点をPとする。
 本実施形態は、中心点Pが点Pよりも外側に配置されているのが特徴である。このように配置すると、すでに説明したように、指先Pにかかる力に対するセンサ位置での変位が大きくなるため、高感度な指先力センサを構成できる。
 (第三の実施形態の変形例2)
 図51A、図51Bを用いて、第三の実施形態の変形例2を説明する。図50に示す他の実施形態とは、第1の弾性構造体、特に中心点Pの配置が異なり、その他については同様である。図51Aは説明のために分解した図で、図51Bは完成図である。
 第1の弾性構造体705は、水平軸ξと指730の先端の点Pを含む平面η-ξ上に配置される放射状弾性構造体である。この平面上に、中心点Pがあり、第1の弾性構造体はこの点の方向を向いている。
 このように配置すると、すでに説明したように、指先Pにかかる力に対するセンサ位置での変位が大きくなるため、高感度な指先力センサを構成できる。
 (第三の実施形態の変形例3)
 また、第三の実施形態の変形例3として、磁気式センサの代わりに光センサを変位検出手段として用いた実施形態を、図57、図58を用いて説明する。
 図57は、光センサを3つ組み合わせ、3方向の相対位置検出手段を構成した例である。スケールA101は3方向の回折格子A102a~A102cを有し、その回折格子に対向して3つの回路部A100a~A100cを設ける。
 また、2方向に刻んだ回折格子を用い、2方向の変位を同時に測定する光センサも知られている。この場合でも集積化が可能なので、指先力センサを小型に構成できる。さらに、特許第4779117号に開示されているように、光学系を工夫することによって、一つの回折格子で3方向の変位を同時に測定することも可能である。
 図58に示すのは、このような光センサを組み込んだ指先力センサの分解図である。第三の実施形態に対し、相対位置検出手段の部分だけが異なるので、この部分を中心に説明する。
 スケールA101を、第2部材2に固定して設ける。このスケールA101は、直方体であり、直方体の3面にそれぞれ異なる方向に回折格子A102a~A102cを備える。この回折格子に対向して3つの回路部A100a~A100cを電気基板A103に固定して設ける。光センサ用の電気基板A103は、第1部材にねじ13を用いて固定する。回路部A100a~A100cの電気信号は電気基板A103を介して制御基板11に連結し、第1部材1と第2部材2の、3方向の相対変位を出力する。尚、この変形例では1方向だけ測定する光センサを3つ組合せた例を示したが、1つの回折格子で3方向を同時に測定する光センサを用いてもよい。
 以上説明したように、第三の実施形態およびその変形例によれば、検出精度が高く、コンパクトで製造コストが低廉な指先力センサを提供することができる。
 [その他の実施形態]
 本発明の実施形態は、上述した例に限られるものではなく、本発明の技術思想の下に、一部を変更したり、組み合わせたりすることも可能である。
 本発明は上記実施の形態に制限されるものではなく、本発明の精神及び範囲から離脱することなく、様々な変更及び変形が可能である。従って、本発明の範囲を公にするために以下の請求項を添付する。
 本願は、2017年8月30日提出の日本国特許出願特願2017-166220を基礎として優先権を主張するものであり、その記載内容の全てをここに援用する。

Claims (16)

  1.  第1部材と第2部材との相対変位量により、力の情報を検出する力センサであって、
     前記第1部材と前記第2部材は、第1の弾性構造体と、第2の弾性構造体と、中間部材とで連結され、
     前記第1の弾性構造体は、前記第1部材と前記中間部材とを連結し、
     前記第2の弾性構造体は、前記第2部材と前記中間部材とを連結し、
     前記第1部材と前記第2部材には、前記第1部材と前記第2部材との相対変位量を検出する変位検出手段が設けられていることを特徴とする力センサ。
  2.  前記第1部材と、前記第2部材と、前記中間部材は、
     前記第1部材における前記第1の弾性構造体と連結される端部と、前記第2部材における前記第2の弾性構造体と連結される端部とが、前記中間部材における前記第1の弾性構造体と前記第2の弾性構造体とが連結される端部と、対向するよう配置されている、
     ことを特徴とする請求項1に記載の力センサ。
  3.  前記第1部材と、前記第2部材と、前記中間部材は、
     前記第1部材と前記第2部材の距離は、前記中間部材と前記第1部材の距離、および前記中間部材と前記第2部材の距離よりも小さくなるよう配置されている、
     ことを特徴とする請求項1または請求項2に記載の力センサ。
  4.  前記第1部材と前記第2部材は所定の平面に沿うよう配置され、
     前記中間部材は、前記平面に投影したときに射影の少なくとも一部が、前記第1部材と前記第2部材の間隙部と重なるように前記平面から離れて配置されている、
     ことを特徴とする請求項1から請求項3のいずれか1項に記載の力センサ。
  5.  前記第1の弾性構造体は、前記第1部材における前記第1の弾性構造体と連結された面の法線方向に対して傾いている、
     ことを特徴とする請求項1から請求項4のいずれか1項に記載の力センサ。
  6.  前記第2の弾性構造体は、前記第2部材における前記第2の弾性構造体と連結された面の法線方向に対して傾いている、
     ことを特徴とする請求項5に記載の力センサ。
  7.  複数の前記第1の弾性構造体および複数の前記第2の弾性構造体を備え、
     複数の前記第1の弾性構造体と、複数の前記第2の弾性構造体は、所定の方向から見た際、交差するよう配置されていることを特徴とする請求項6に記載の力センサ。
  8.  請求項1に記載の力センサを製造する方法であって、
     前記第1部材と、前記第2部材を造形プレートに対して脱着可能に位置決め固定し、
     前記第1部材と前記第2部材の上面に、造形材料の層を積み重ねて前記第1の弾性構造体と前記第2の弾性構造体と前記中間部材を造形し、
     前記第1部材と前記第2部材と前記第1の弾性構造体と前記第2の弾性構造体と前記中間部材が一体化した3次元造形物を形成した後に前記3次元造形物を前記造形プレートから脱着する、
     ことを特徴とする力センサの製造方法。
  9.  前記造形材料の粉体を積層し、前記第1の弾性構造体と前記第2の弾性構造体と前記中間部材の形状に応じてレーザ光を照射して前記第1の弾性構造体と前記第2の弾性構造体と前記中間部材を造形する、
     ことを特徴とする請求項8に記載の力センサの製造方法。
  10.  環状の第1部材と、環状の第2部材との相対変位角度により、トルク値を検出するトルクセンサであって、
     前記第1部材と前記第2部材は、第1の弾性構造体と、第2の弾性構造体と、中間部材とで連結され、
     前記第2部材は、前記第1部材よりも大きな半径を有し、
     前記第1部材と前記第2部材は、所定の平面に沿うよう、かつ前記第1部材の中心軸と前記第2部材の中心軸が同軸になるよう配置され、
     前記第1の弾性構造体は、前記第1部材と前記中間部材とを連結し、
     前記第2の弾性構造体は、前記第2部材と前記中間部材とを連結し、
     前記第1部材と前記第2部材には、前記第1部材と前記第2部材との相対変位角度を検出する変位検出手段が設けられ、
     前記第1の弾性構造体と前記第2の弾性構造体は、前記中心軸を中心とする円周方向に沿って交互に配置されている、
     ことを特徴とするトルクセンサ。
  11.  前記第1の弾性構造体の厚さは、前記第1部材の側において前記中心軸に近い側より遠い側が小さく、前記中間部材の側において前記中心軸に遠い側より近い側が小さく、
     前記第2の弾性構造体の厚さは、前記第2部材の側において前記中心軸に遠い側より近い側が小さく、前記中間部材の側において前記中心軸に近い側より遠い側が小さい、
     ことを特徴とする請求項10に記載のトルクセンサ。
  12.  前記第1の弾性構造体および/または前記第2の弾性構造体は、
     スリットにより分離された複数の弾性体を有する、
     ことを特徴とする請求項10または請求項11に記載のトルクセンサ。
  13.  環状の第1部材と、環状の第2部材との相対変位量により、力とモーメントを含む6軸の外力を測定する力覚センサであって、
     前記第1部材と前記第2部材は、第1の弾性構造体と、第2の弾性構造体と、中間部材とで連結され、
     前記第2部材は、前記第1部材よりも大きな半径を有し、
     前記第1部材と前記第2部材は、所定の平面に沿うよう、かつ前記第1部材の中心軸と前記第2部材の中心軸が同軸になるよう配置され、
     前記第1の弾性構造体は、前記第1部材と前記中間部材とを連結し、
     前記第2の弾性構造体は、前記第2部材と前記中間部材とを連結し、
     前記第1部材と前記第2部材には、前記第1部材と前記第2部材との相対変位量を検出する変位検出手段が設けられ、
     前記複数の第1の弾性構造体は、前記第1部材の中心軸と同心の円周上に間隔を開けて配置され、かつ、該円周に対して垂直な軸線に対して第1のねじれ傾斜角で傾斜して配置され、
     前記複数の第2の弾性構造体は、前記第1部材の中心軸と同心の円周上に間隔を開けて配置され、かつ、該円周に対して垂直な軸線に対して第2のねじれ傾斜角で傾斜して配置され、
     前記第1のねじれ傾斜角と前記第2のねじれ傾斜角は、互いに逆方向のねじれ傾斜角度であり、
     前記第1の弾性構造体および第2の弾性構造体は、前記第1部材、前記中間部材、前記第2部材よりも剛性が低い、
     ことを特徴とする力覚センサ。
  14.  前記第1の弾性構造体は、前記中心から離れる方向に凸になるよう湾曲した形状を有し、
     前記第2の弾性構造体は、前記中心に向かう方向に凸になるよう湾曲した形状を有する、
     ことを特徴とする請求項13に記載の力覚センサ。
  15.  ロボットハンドの指先に設けられ、第1部材と第2部材との相対変位量により、前記指先にかかる力を検出する指先力センサであって、
     前記第1部材と前記第2部材は、第1の弾性構造体と、第2の弾性構造体と、中間部材とで連結され、
     前記第1部材と前記第2部材は、所定の平面に沿うよう配置され、
     前記第1の弾性構造体は、前記第1部材と前記中間部材とを連結し、
     前記第2の弾性構造体は、前記第2部材と前記中間部材とを連結し、
     前記第1部材と前記第2部材には、前記第1部材と前記第2部材との相対変位量を検出する変位検出手段が設けられ、
     前記第1の弾性構造体は、2列以上かつ4本以上配置され、
     前記第2の弾性構造体は、2列以上かつ4本以上配置され、
     前記第1の弾性構造体が配置された方向と前記第2の弾性構造体が配置された方向が25度以上異なる、
     ことを特徴とする指先力センサ。
  16.  前記変位検出手段の位置に原点を持つ座標系から見て、前記第1の弾性構造体が、前記指先よりも離れた位置の方向を向くように配置されている、
     ことを特徴とする請求項15に記載の指先力センサ。
PCT/JP2018/031156 2017-08-30 2018-08-23 力センサ、トルクセンサ、力覚センサ、指先力センサ、およびその製造方法 WO2019044653A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201880055047.4A CN111094922B (zh) 2017-08-30 2018-08-23 力传感器、扭矩传感器、力感测传感器、指尖力传感器及其制造方法
US16/781,419 US11220010B2 (en) 2017-08-30 2020-02-04 Force sensor, torque sensor, force-sense sensor, fingertip-force sensor, and method of manufacturing the same

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2017-166220 2017-08-30
JP2017166220A JP6918647B2 (ja) 2017-08-30 2017-08-30 力センサ、トルクセンサ、力覚センサ、指先力センサ、およびその製造方法

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US16/781,419 Continuation US11220010B2 (en) 2017-08-30 2020-02-04 Force sensor, torque sensor, force-sense sensor, fingertip-force sensor, and method of manufacturing the same

Publications (1)

Publication Number Publication Date
WO2019044653A1 true WO2019044653A1 (ja) 2019-03-07

Family

ID=65527378

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2018/031156 WO2019044653A1 (ja) 2017-08-30 2018-08-23 力センサ、トルクセンサ、力覚センサ、指先力センサ、およびその製造方法

Country Status (4)

Country Link
US (1) US11220010B2 (ja)
JP (1) JP6918647B2 (ja)
CN (1) CN111094922B (ja)
WO (1) WO2019044653A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11524414B2 (en) * 2018-08-30 2022-12-13 Toyota Jidosha Kabushiki Kaisha Sensor unit, sensor system, robot hand, robot arm, server device, calculation method, and program

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6950427B2 (ja) * 2017-10-03 2021-10-13 株式会社デンソー 位置検出装置
US10928227B2 (en) * 2019-04-15 2021-02-23 Caterpillar Inc. Mounting system for mounting a sensor assembly
KR20210007771A (ko) * 2019-07-12 2021-01-20 엘지전자 주식회사 커피 제조 로봇 및 그 제어방법
JP7471825B2 (ja) 2020-01-07 2024-04-22 キヤノン株式会社 検出装置、検出方法、制御方法、ロボット装置、物品の製造方法、プログラム、および記録媒体
CN112141435A (zh) * 2020-09-27 2020-12-29 重庆文理学院 一种涂料机自动输送装置
US11731282B2 (en) * 2021-03-03 2023-08-22 Dishcare Inc. Dish handling robot
CN114323381A (zh) * 2021-12-10 2022-04-12 安徽灵轴科创有限公司 一种旋转关节的摩擦力矩测量装置

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62162935A (ja) * 1986-01-13 1987-07-18 Agency Of Ind Science & Technol 触覚センサ
JPH041540A (ja) * 1990-04-12 1992-01-07 Fuji Electric Co Ltd 力覚センサ
JPH10282134A (ja) * 1997-04-04 1998-10-23 Ngk Insulators Ltd 周設センサ
DE10301059A1 (de) * 2003-01-14 2004-07-22 3Dconnexion Gmbh Anordnung zum Erfassen von Bewegungen oder Positionen zweier Objekte relativ zueinander
WO2010088922A1 (en) * 2009-02-06 2010-08-12 Abb Ag Set of multiaxial force and torque sensor and assembling method
JP2012237570A (ja) * 2011-05-10 2012-12-06 Canon Inc 力覚センサ
CN105651446A (zh) * 2016-03-18 2016-06-08 安徽锐聪机器人有限公司 六维力传感器
US20160288338A1 (en) * 2015-03-31 2016-10-06 Google Inc. Flexure Based Torque Sensor
JP2017096929A (ja) * 2015-11-18 2017-06-01 キヤノン株式会社 センサ、駆動機構、およびロボット

Family Cites Families (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH073344B2 (ja) 1987-06-15 1995-01-18 キヤノン株式会社 エンコ−ダ−
JP3038860B2 (ja) 1990-09-21 2000-05-08 キヤノン株式会社 エンコーダ
JPH08199856A (ja) * 1995-01-27 1996-08-06 Masakatsu Takahashi 防災用テント
CN1091252C (zh) * 1999-02-10 2002-09-18 燕山大学 一种具有弹性铰链六维力与力矩传感器
JP2000272575A (ja) * 1999-03-26 2000-10-03 Sunstar Eng Inc 電動アシスト自転車
DE10034569B4 (de) * 2000-07-14 2004-02-12 Deutsches Zentrum für Luft- und Raumfahrt e.V. Einrichtung zum Erfassen von Relativbewegungen eines Objekts
JP4072506B2 (ja) * 2003-05-20 2008-04-09 ミネベア株式会社 光学式変位センサおよび外力検出装置
ITMI20031500A1 (it) * 2003-07-22 2005-01-23 Milano Politecnico Dispositivo e metodo per la misura di forze e momenti
US6886415B1 (en) * 2004-08-03 2005-05-03 Toshiba Electric Engineering Corporation Tactile sensor and gripping robot using the same
JP2007040774A (ja) * 2005-08-02 2007-02-15 Ono Sokki Co Ltd トルク計
JP4779117B2 (ja) 2006-05-15 2011-09-28 国立大学法人東北大学 Xyz軸変位測定装置
JP2007315878A (ja) * 2006-05-25 2007-12-06 Mitsubishi Electric Corp 多軸力覚センサ
JP2008162935A (ja) 2006-12-28 2008-07-17 Daicel Chem Ind Ltd アミド又はラクタムの製造法
CN100523753C (zh) * 2007-02-07 2009-08-05 燕山大学 上下预紧式并联结构六维力传感器
JP2010131743A (ja) * 2008-10-30 2010-06-17 Canon Inc 力覚センサを内蔵した把持装置
JP2010169586A (ja) 2009-01-23 2010-08-05 Minebea Co Ltd トルク量変換器
JP5439068B2 (ja) * 2009-07-08 2014-03-12 株式会社ワコー 力検出装置
JP5640905B2 (ja) * 2011-06-14 2014-12-17 トヨタ自動車株式会社 起歪体及びこれを含む装置
JP2013064706A (ja) * 2011-09-20 2013-04-11 Kazuhiro Nakamura センサ
JP5936255B2 (ja) * 2012-03-02 2016-06-22 株式会社フコク 入力装置
NO20130884A1 (no) * 2013-06-21 2014-12-22 Sinvent As Sensorelement med optisk forskyvning
TWI485376B (zh) * 2014-03-11 2015-05-21 Hon Hai Prec Ind Co Ltd 多維力/力矩感測器
JP6287482B2 (ja) * 2014-03-28 2018-03-07 株式会社Soken 操作入力装置
DE102014019546B3 (de) * 2014-12-23 2016-05-04 Samson Aktiengesellschaft Federkörper für einen Kraftaufnehmer, wie Drehmoment- und/oder Zugkraft-/Druckkraftmesszelle
US10350767B2 (en) * 2015-11-18 2019-07-16 Canon Kabushiki Kaisha Sensor, driving mechanism, and robot
CN205826190U (zh) * 2016-03-18 2016-12-21 安徽锐聪机器人有限公司 可变信号线走向的力传感器
JP6501746B2 (ja) * 2016-10-07 2019-04-17 キヤノン株式会社 変位測定装置、ロボット、ロボットアーム及び物品の製造方法
GB201617097D0 (en) * 2016-10-07 2016-11-23 King S College London Multi-Axis force sensor

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62162935A (ja) * 1986-01-13 1987-07-18 Agency Of Ind Science & Technol 触覚センサ
JPH041540A (ja) * 1990-04-12 1992-01-07 Fuji Electric Co Ltd 力覚センサ
JPH10282134A (ja) * 1997-04-04 1998-10-23 Ngk Insulators Ltd 周設センサ
DE10301059A1 (de) * 2003-01-14 2004-07-22 3Dconnexion Gmbh Anordnung zum Erfassen von Bewegungen oder Positionen zweier Objekte relativ zueinander
WO2010088922A1 (en) * 2009-02-06 2010-08-12 Abb Ag Set of multiaxial force and torque sensor and assembling method
JP2012237570A (ja) * 2011-05-10 2012-12-06 Canon Inc 力覚センサ
US20160288338A1 (en) * 2015-03-31 2016-10-06 Google Inc. Flexure Based Torque Sensor
JP2017096929A (ja) * 2015-11-18 2017-06-01 キヤノン株式会社 センサ、駆動機構、およびロボット
CN105651446A (zh) * 2016-03-18 2016-06-08 安徽锐聪机器人有限公司 六维力传感器

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11524414B2 (en) * 2018-08-30 2022-12-13 Toyota Jidosha Kabushiki Kaisha Sensor unit, sensor system, robot hand, robot arm, server device, calculation method, and program

Also Published As

Publication number Publication date
US20200173869A1 (en) 2020-06-04
CN111094922B (zh) 2021-11-26
US11220010B2 (en) 2022-01-11
CN111094922A (zh) 2020-05-01
JP2019045216A (ja) 2019-03-22
JP6918647B2 (ja) 2021-08-11

Similar Documents

Publication Publication Date Title
WO2019044653A1 (ja) 力センサ、トルクセンサ、力覚センサ、指先力センサ、およびその製造方法
KR102080426B1 (ko) 4개 미만의 빔 표면 상에 계측기기를 갖는 힘/토크 센서
CN107914265B (zh) 位移测量设备、机器人及机器人臂
US9200969B2 (en) Force sensor
US8966996B2 (en) Force sensor
JP5687384B1 (ja) 力覚センサ
US7490524B2 (en) Force sensor chip
JP2010281635A (ja) 力覚センサ
KR20130061902A (ko) 스트레인게이지 타입의 힘-토크 센서 및 그 제조 방법
WO2007096322A2 (en) A system for controlling the position and orientation of an object in dependence on received forces and torques from a user
CN112611499B (zh) 多维力传感器的负载平台微位移测量方法及测量敏感元件的安装方法
JP2010008343A (ja) 力覚センサおよびその組立方法
JP2007163405A (ja) 多軸力ロードセル
JP6664742B2 (ja) 力覚センサ
JP2023117402A (ja) 結合負荷とより少ない歪みゲージを用いたトルクセンサ
Jiang et al. Design, development, and application of a compact flexure-based decoupler with high motion transmission efficiency and excellent input decoupling performance
JP5117804B2 (ja) 6軸力センサ
JPH0772026A (ja) 起歪体構造物およびこの起歪体構造物を用いた多軸力検出センサ
JPH05149811A (ja) 6軸力覚センサ
US20050120809A1 (en) Robotic force sensing device
JP5719521B2 (ja) 3軸力センサ
JPH01119731A (ja) 多軸力覚センサ
JP2006058211A (ja) 歪みゲージ型センサ
JPH01156632A (ja) 多分力センサ
JP2010160099A (ja) 多軸センサ

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 18852267

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 18852267

Country of ref document: EP

Kind code of ref document: A1