WO2019059403A1 - 食品移載システム及び食品把持装置 - Google Patents

食品移載システム及び食品把持装置 Download PDF

Info

Publication number
WO2019059403A1
WO2019059403A1 PCT/JP2018/035501 JP2018035501W WO2019059403A1 WO 2019059403 A1 WO2019059403 A1 WO 2019059403A1 JP 2018035501 W JP2018035501 W JP 2018035501W WO 2019059403 A1 WO2019059403 A1 WO 2019059403A1
Authority
WO
WIPO (PCT)
Prior art keywords
food
gripping
fruit
vegetables
fruits
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/JP2018/035501
Other languages
English (en)
French (fr)
Inventor
貴裕 野崎
大西　公平
佑貴 斉藤
福島　聡
和則 二宮
充隆 栗田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Keio University
Shibuya Seiki Co Ltd
Original Assignee
Keio University
Shibuya Seiki Co Ltd
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 Keio University, Shibuya Seiki Co Ltd filed Critical Keio University
Publication of WO2019059403A1 publication Critical patent/WO2019059403A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B07—SEPARATING SOLIDS FROM SOLIDS; SORTING
    • B07C—POSTAL SORTING; SORTING INDIVIDUAL ARTICLES, OR BULK MATERIAL FIT TO BE SORTED PIECE-MEAL, e.g. BY PICKING
    • B07C5/00—Sorting according to a characteristic or feature of the articles or material being sorted, e.g. by control effected by devices which detect or measure such characteristic or feature; Sorting by manually actuated devices, e.g. switches
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B07—SEPARATING SOLIDS FROM SOLIDS; SORTING
    • B07C—POSTAL SORTING; SORTING INDIVIDUAL ARTICLES, OR BULK MATERIAL FIT TO BE SORTED PIECE-MEAL, e.g. BY PICKING
    • B07C5/00—Sorting according to a characteristic or feature of the articles or material being sorted, e.g. by control effected by devices which detect or measure such characteristic or feature; Sorting by manually actuated devices, e.g. switches
    • B07C5/16—Sorting according to weight
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices

Definitions

  • the present invention relates to a food transfer system and a food gripping apparatus for transferring food products such as fruits and vegetables having an uneven shape individually to each other, food items such as fried chicken and fish fillets, and vegetables each having an uneven shape individually.
  • Patent Document 1 discloses a technique relating to an adsorption and transfer device that transports fruits and vegetables by adjusting the suction force when the fruits and vegetables are adsorbed according to the size and hardness of the fruits and vegetables.
  • An object of the present invention is to provide a technique for more appropriately holding food of irregular shape and size.
  • the food transfer system concerning one mode of the present invention is: Transport means for transporting food; Data acquisition means for acquiring data relating to the food conveyed by the conveyance means; An individual information acquisition unit that acquires individual information including at least one of the position and the quality of the food based on the acquisition result of the data acquisition unit; Grasping means for grasping the food to be grasped based on the individual information; Position detection means for detecting the position of the movable member holding the food in the holding means; A moving mechanism for moving the gripping means to a predetermined position; Control means for controlling the movement of the movable member in the holding means based on the position information of the position detection means; Equipped with Further, according to a second aspect of the invention, in the invention according to the first aspect, the control means sets control energy to energy of speed or position and energy of force, which is set corresponding to the gripping operation of the food.
  • the control means includes storage means for storing a plurality of setting values of the quality of the food, and the control means is The setting value corresponding to the quality of the food to be gripped is read out from the setting values stored in the storage unit based on the acquisition result of the individual information acquiring unit, and the setting value is read based on the setting value.
  • the operation of the gripping means is controlled.
  • the holding means further includes a weight measuring unit, and the control means holds the food when the holding means holds the food.
  • the control means is configured to grip the food based on the acquisition result of the individual information acquisition means. It is characterized in that the contact position is controlled.
  • the sixth invention is a food gripping apparatus, wherein individual information acquiring means for acquiring individual information including the quality of the food with respect to the food to be gripped; Grasping means for grasping the food to be grasped based on the individual information; Position detection means for detecting the position of the movable member holding the food in the holding means; And control means for controlling the movement of the movable member in the gripping means on the basis of the position information of the position detecting means.
  • control means sets control energy to energy of speed or position and energy of force, which is set corresponding to the gripping operation of the food. It is characterized in that the operation in the holding means is controlled by performing the conversion to be assigned.
  • an efficient gripping operation set corresponding to the gripping operation according to the invention of claim 1 can be performed.
  • the invention of claim 3 by controlling the operation of the hand based on the data of the reference value set in advance, it becomes possible to perform the gripping operation adapted to the conditions of the food to be gripped.
  • the weight of the food can be determined by the gripping operation of the hand, and the food can be transferred to the determined sorting destination of the food.
  • the place to be gripped can be changed according to the quality of the food, and the food can be held more appropriately.
  • the invention of claim 6 can provide a technique for holding food more appropriately.
  • an efficient gripping operation set corresponding to the gripping operation according to the invention of claim 7 becomes possible.
  • FIG. 6 is a schematic view showing a configuration of a hand unit 53. It is a schematic diagram which shows the state which the hand unit 53 rotated from the state of FIG. 2A.
  • FIG. 2 is a block diagram showing a functional configuration of a control device 10. It is a schematic diagram which shows the concept of the control law in the holding
  • FIG. 6 is a flow chart for explaining the flow of a fruit and vegetable sorting process performed in the fruit and vegetable transfer system 1; FIG.
  • the system for transferring fruits and vegetables and the holding apparatus for fruits and vegetables shoots fruits to be sorted by a photographing device, and based on the photographed image, the size, shape and characteristics of individual fruits and vegetables And get quality information such as the presence or absence of raw injury) and weight.
  • the gripping operation of the vegetable gripping device is started with the reference value of the gripping operation set in advance as an initial value based on the acquired quality information of the fruit vegetables, and the vegetable gripping device
  • the Real Haptics was applied based on the information of the predetermined position in the fruit vegetable gripping device (for example, the positional information of the moving element of the actuator etc.) or the information of the force received by the fruit vegetable gripping device from the fruit vegetable Control position (or speed) and force.
  • FIG. 1 is a schematic diagram which shows the structure of the fruit vegetable transfer system 1 which concerns on one Embodiment of this invention.
  • the fruit vegetable transfer system 1 includes a control device 10, a carrier device 20, an illumination device 30, an imaging device 40, and a gripping robot (fruit vegetable gripping device) 50.
  • the control device 10 controls the entire fruit and vegetable transfer system 1.
  • the control device 10 is configured by an information processing device including an arithmetic processing device, a memory, a storage device, a communication interface, and the like, and realizes various functions in the fruit vegetable transfer system 1 by executing a program by the arithmetic processing device. .
  • control device 10 can be configured by an information processing device such as a programmable logic controller (PLC) or a personal computer (PC). Specifically, the control device 10 controls the operation (drive, stop, conveyance speed, etc.) of the conveyance device 20, the on / off of the illumination device 30, and the photographing operation of the photographing device 40.
  • PLC programmable logic controller
  • PC personal computer
  • control device 10 controls the sorting operation (transfer) of the fruits including the gripping operation of the gripping robot 50 by executing the fruit and vegetable sorting processing described later. At this time, the control device 10 performs the gripping operation of the fruit by controlling the position (or velocity) and the force to which the real haptics are applied based on the information of the predetermined position (or velocity) in the gripping robot 50. Control.
  • the functional configuration realized in the control device 10 by executing the fruit and vegetable sorting process will be described later.
  • the transfer device 20 constitutes a conveyor for transferring the fruits and vegetables in multiple rows, and includes a transfer body 21, a passive pulley 22, a drive pulley 23, a transfer motor 24, and a brake plate 25.
  • the transport body 21 receives the supply of the fruits and vegetables to be sorted, passes the photographing area by the photographing device 40, and then conveys the fruits and vegetables to the pickup area by the holding robot 50.
  • the conveyance body 21 in the present embodiment includes a plurality of rotation rollers 21 a arranged so that the rotation axes are parallel, and has a ring structure in which the plurality of rotation rollers 21 a are installed over the entire circumference. There is.
  • the plurality of rotary rollers 21a are rotatably held at both ends by an annular chain or belt.
  • the plurality of rotating rollers 21a are disposed at an arrangement interval in which the fruits to be sorted do not fall from the gap, and in the present embodiment, the interval of the plurality of rotating rollers 21a is about several centimeters.
  • the transport body 21 is wound around the passive pulley 22 and the drive pulley 23, and the rotation shaft of the drive pulley 23 is connected to the rotation shaft of the transport motor 24 by a belt member. Therefore, when the transport motor 24 rotates, the rotation is transmitted to the drive pulley 23, and the transport body 21 wound around the drive pulley 23 circulates with the passive pulley 22 to continuously transport. Do the action.
  • the brake plate 25 is installed at a specific position (position to rotate the transported vegetables) in the passage area of the transport body 21 and on the lower surface side (the back surface side with respect to the mounting surface of the vegetables) of the plurality of rotating rollers 21a.
  • the friction is generated with the surface (cylindrical surface) of each rotating roller 21a. That is, when the transport body 21 carries out the transport operation, the rotating roller 21a in contact with the brake plate 25 is driven to rotate by the friction with the brake plate 25, and by this rotation, the area where the brake plate 25 is installed An action occurs to rotate the fruit that passes through the Hereinafter, the area in which the brake plate 25 is installed will be referred to as "rotational area" as appropriate.
  • non-rotational area areas other than the area where the brake plate 25 is installed will be referred to as “non-rotational area” as appropriate.
  • the lighting device 30 includes a visible light lamp that emits visible light and an ultraviolet light lamp that emits ultraviolet light, and according to the control of the control device 10, the fruit that is conveyed is irradiated with visible light and ultraviolet light.
  • the lighting devices 30 are respectively provided upstream and downstream of the photographing device 40 in the direction of transporting fruits and vegetables.
  • the photographing device 40 is configured of a digital camera capable of photographing a visible light image and an ultraviolet light image, and photographs the visible light image and the ultraviolet light image respectively according to the control of the control device 10.
  • the visible light image is mainly used to recognize the position, size and shape of the fruit vegetables
  • the ultraviolet light image is mainly for detecting the characteristics of the fruit vegetables (such as detection of spoilage on the surface or inside, and detection of a bruise) Used for
  • the control device 10 can track the fruit to be conveyed at a time interval Control the photographing device 40 so as to take a picture.
  • the gripping robot 50 is provided with a 3-axis parallel link robot (delta-type articulated robot).
  • a 3-axis parallel link robot delta-type articulated robot
  • two gripping robots 50 are installed, and these two gripping robots 50 share the task of sorting fruits and vegetables.
  • robots of other types such as a 6-axis parallel link robot and a vertical articulated robot can be adopted.
  • FIG. 2A is a schematic view showing the configuration of the hand unit 53.
  • the hand unit 53 is configured as a tool for gripping fruits and vegetables, and movable members 53a to 53c that contact the fruits and produce a holding action, and opening and closing for controlling the opening and closing of the movable members 53a to 53c.
  • a motor 53 d and a vertical motor 53 e for moving the hand unit 53 in the vertical direction are provided.
  • the extension motors 52a to 52c of the gripping robot 50, the opening / closing motor 53d of the hand unit 53, the vertical motor 53e, and the rotation motor 54 operate according to the control of the control device 10.
  • the expansion and contraction motors 52a to 52c control the expansion and contraction of the arms 51a to 51c so that the hand unit 53 moves to the position of the object to be gripped according to the control of the control device 10.
  • the open / close motor 53d opens and closes the movable members 53a to 53c so that the movable members 53a to 53c have the open / close position and the contact force based on the real haptics according to the object to be gripped. Control the operation.
  • the open / close motor 53d is provided with a position detection sensor 53d-1 that detects the rotational position of the motor rotation shaft.
  • the detection result of the position detection sensor 53d-1 is information indicating the open / close position of the movable members 53a to 53d, and is used as an input (input of a grip parameter determination unit 16b described later) in a fruit vegetable sorting process described later.
  • the initial values (position and force) of the gripping operation of the movable members 53a to 53c are values according to the quality such as the size and characteristics of fruits and vegetables according to the analysis result of the visible light image and the ultraviolet light image Is set to the reference value data). Then, after the hand unit 53 grips the fruit to be gripped (after the start of the gripping operation), the control device 10 sequentially calculates the rotational position and the rotational torque of the motor rotation shaft in the opening / closing motor 53 d The open / close positions and contact forces of 53a to 53c are controlled. As a result, the hand unit 53 in the present embodiment can perform the gripping operation adapted to individual conditions such as the size, shape, and softness of the fruit to be gripped.
  • the vertical motor 53e is provided with a position detection sensor 53e-1, and is controlled to keep the distance between the rotation motor 54 and the movable members 53a to 53c constant under the control of the control device 10. Furthermore, the vertical motor 53e performs weight control by performing control based on real haptics (control of at least one of position (or velocity) and / or force in the lifting operation of the hand unit 53) according to the weight of the fruit to be gripped. Can be measured. That is, the weight of the holding fruit can be detected based on the drive current or the like flowing when the vertical motor 53e holds the fruit. Further, it can be determined from the load of the vertical motor 53e, the detection result of the position detection sensor 53e-1, etc. that the hand unit 53 is in contact with an object (fruit and the like) in the vertical direction.
  • FIG. 2B is a schematic view showing a state in which the hand unit 53 is rotated from the state of FIG. 2A.
  • FIG. 2B by rotating the hand unit 53 with respect to the fruit vegetables from the state of FIG. 2A, the possibility of the movable members 53a to 53c coming into contact with the rotten part of the fruit vegetables can be reduced, and the movable members 53a to 53c. Can inhibit the attachment of fragments of rotten parts.
  • the movable members 53a to 53c are prevented from contacting the surrounding fruits. be able to.
  • FIG. 3 is a block diagram showing a functional configuration of the control device 10.
  • the control device 10 executes the fruit and vegetable sorting process to obtain an image acquisition unit 11, an image analysis unit 12, an item determination unit 13, a fruit and vegetable identification unit 14, and a robot as functional components.
  • a control unit 15, a hand unit control unit 16, a weight determination unit 17, a transport control unit 18, and a control data storage unit 19 are formed.
  • the image acquisition unit 11 outputs, to the imaging device 40, an imaging instruction for imaging the visible light image and the ultraviolet light image alternately, and acquires the captured visible light image and the ultraviolet light image.
  • the image analysis unit 12 analyzes the visible light image (object recognition, color detection, etc.) to recognize the position where the fruits are distributed on the carrier 21, the size, color, injury, and shape of the fruits. .
  • the image analysis unit 12 analyzes the ultraviolet light image (brightness detection and the like) to recognize the presence or absence of rotten portions such as water rot and the like of the fruit vegetables.
  • the image analysis unit 12 when recognizing the size, color, injury, and shape of the fruit vegetables, refers to the visible light image of the rotation area in the transport device 20, and rots such as water rot of the fruit vegetables In the case of recognizing the detection of a raw injury or the like, the ultraviolet light image of the rotation area in the transfer device 20 is referred to. Further, the image analysis unit 12 individually tracks each of the fruits by correlating each of the fruits and vegetables captured in the visible light image of the rotation area of the transport device 20 with each of the fruits and vegetables photographed in the ultraviolet light image.
  • the image analysis unit 12 refers to the visible light image of the non-rotation area in the conveyance device 20 (an image in a state in which the rotation of the fruit has been stopped), and recognizes the position of each fruit being conveyed to the pickup area. As a result, the size, shape, and characteristics (such as color and degree of injury, presence or absence of spoilage and live injury, etc.) of individual fruits and vegetables are recognized. Furthermore, the image analysis unit 12 stores these recognition results (position and quality) as individual information.
  • the item determination unit 13 determines, based on the analysis result of the image analysis unit 12, an evaluation item of a fruit based on a standard.
  • the items determined by the item determination unit 13 include the size and shape of the fruit vegetables (classification of the size and shape in the standard), the characteristics of the fruit vegetables (color, degree of injury, presence or absence of rotten parts and raw injuries), Items related to quality such as weight are included.
  • the weight of fruits and vegetables is determined by a weight determination unit 17 described later.
  • the fruit and vegetable identification unit 14 assigns fruits and vegetables to be picked up to the respective holding robots 50, and specifies fruits and vegetables to be picked up by the respective holding robots 50. Specifically, the fruit and vegetable identification unit 14 sequentially specifies the position of the fruit and vegetables to be picked up and sorted by each of the two gripping robots 50 in each of the fruit and vegetables that are transported to the pickup region by the carrier 21.
  • the position of fruits and vegetables in the pick-up area can be specified by taking into consideration the transport speed of the transfer device 20 based on the position of fruits and vegetables in the non-rotational area recognized by the image analysis unit 12. In this embodiment, among the fruits and vegetables which are transported to the pickup area by the transport body 21, only extraneous individuals and rotten individuals are picked up by the gripping robot and excluded, and the work place installed on the downstream side Transport the fruits and vegetables to the workplace etc.)
  • the robot control unit 15 outputs drive signals of the extension motors 52a to 52c that control the extension and contraction of the arms 51a to 51c, whereby the hand unit of the gripping robot 50 is positioned at the position of each fruit identified by the fruit identification unit 14. Move 53. Further, the robot control unit 15 vertically outputs the hand unit 53 by outputting a drive signal of the vertical motor 53e according to control of at least one of position (or velocity) in the vertical direction based on real haptics and / or force. Move it. In this case, the robot control unit 15 receives the current position of the rotation axis of the vertical motor 53e (or the current position corresponding to the rotation axis, such as the current position in the vertical direction of the hand unit 53) as an input.
  • a parameter representing the operation of the vertical motor 53e is determined by performing an operation (for example, an operation according to the equations (1) and (2) described later) in at least one of the regions.
  • the robot control unit 15 selects the destination of the fruits based on the result of the judgment of the evaluation item of the fruits and vegetables by the item judgment unit 13 and the result of the judgment of the weight of the fruits and vegetables by the weight judgment unit 17 ), And transfer the fruits to the selected fruits.
  • the storage box corresponding to the sorting destination of fruits and vegetables is installed in the side of the pick-up area
  • the hand unit control unit 16 performs a gripping operation adapted to individual conditions such as the size, shape, or softness of the fruit to be gripped.
  • the hand unit control unit 16 includes a rotation motor drive unit 16a, a grip parameter determination unit 16b, an open / close motor drive unit 16c, a movable member position acquisition unit 16d, and a grip success / failure determination unit 16e. And have.
  • the rotation motor drive unit 16a controls the drive of the rotation motor 54 in the gripping operation of the fruits and vegetables. Specifically, based on the analysis result of the quality of the fruits and vegetables (the rotted portion such as water rot and the presence or absence of a live injury) by the image analysis unit 12, the rotation motor drive unit 16a has movable members 53a to 53c in the hand unit 53. The hand unit 53 is rotated in the horizontal direction so as not to contact the rotten portion or the position of the raw injury of the fruit to be gripped. In addition, the rotation motor drive unit 16a rotates the hand unit 53 in the horizontal direction so that the movable members 53a to 53c from the position of the fruits and vegetables by the image analysis unit 12 do not contact the surrounding fruits and vegetables.
  • the grip parameter determination unit 16b receives at least the position (or speed) or the force based on the current position of the rotation axis of the open / close motor 53d (or the current position corresponding to the rotation axis such as the current position of the movable members 53a to 53c). By performing the calculation in one of the regions, a parameter representing the operation of the open / close motor 53d is determined.
  • the gripping parameter determining unit 16b reads out and reads the reference value of the gripping operation stored in the control data storage unit 19 based on the quality of fruits and vegetables recognized by the image analyzing unit 12.
  • the position and force (rotational torque) of the rotation shaft of the opening and closing motor 53d are controlled with the reference value as an initial value.
  • FIG. 4 is a schematic view showing the concept of the control rule in the gripping parameter determination unit 16b by the real haptics technique.
  • the control rule in the grip parameter determination unit 16b is the opening / closing motor 53d (control target system), the force / speed assignment conversion block 110, the ideal force source block 120 or the ideal speed (position) source block It is expressed as a control law including at least one of 130 and an inverse transformation block 140.
  • the force / speed assignment conversion block 110 defines coordinate conversion using as input a value (reference value) serving as a reference of the operation of the opening / closing motor 53 d and the current position of the rotation axis of the opening / closing motor 53 d.
  • This coordinate transformation converts an input vector having a reference value and the current velocity (or position) into an output vector consisting of a velocity (or position) for calculating a control target value of velocity (or position), and a reference
  • An input vector having a value and a current force as an element is converted into an output vector consisting of forces for calculating a control target value of the force.
  • coordinate conversion in the force / velocity allocation conversion block 110 is expressed as the following equations (1) and (2).
  • d is an operator representing a first-order derivative
  • dX2 is a velocity vector for deriving a state value of velocity
  • dX1 is a velocity based on the reference value
  • the action of the switching motor 53d (for switching A vector whose element is the speed of the rotation axis of the motor 53d or the speed of a portion corresponding to the rotation axis of the open / close motor 53d, such as the movable members 53a to 53c
  • H is a transformation matrix representing a gripping function.
  • d 2 F 2 (where d 2 is an operator representing the second derivative) is a force vector for deriving a state value of force, d 2 F 1 is a reference value and the action of the motor 53 d for opening and closing Is a vector based on the force based on (the rotational torque of the rotation shaft of the opening / closing motor 53d, or the force of a portion corresponding to the rotation shaft of the opening / closing motor 53d such as the movable members 53a to 53c).
  • the ideal force source block 120 is a block that performs operations in the area of force in accordance with the coordinate transformation defined by the force / velocity assignment transformation block 110.
  • a target value regarding a force when performing an operation based on the coordinate transformation defined by the function-based force / velocity assignment transformation block 110 is set. This target value is set as a fixed value or a variable value corresponding to the gripping function to be gripped in accordance with the individual conditions of the fruit to be gripped.
  • the ideal velocity (position) source block 130 is a block that performs operations in the region of velocity (position) in accordance with the coordinate transformation defined by the force / velocity assignment transformation block 110.
  • a target value regarding the velocity (position) when performing an operation based on the coordinate transformation defined by the force / velocity assignment transformation block 110 is set. This target value is set as a fixed value or a variable value corresponding to the gripping function to be gripped in accordance with the individual conditions of the fruit to be gripped.
  • the inverse conversion block 140 is a block for converting the values of the velocity (position) and force regions into values (for example, voltage values or current values) of the input region to the switching motor 53d.
  • the force / velocity assignment conversion is performed using the information on the velocity (position) and force obtained based on the position information.
  • the control laws of the position and the force area respectively corresponding to the gripping function to be adapted to the specific condition of the fruit to be gripped and gripping are applied.
  • calculation of force according to the function is performed in the ideal force source block 120
  • calculation of speed (position) according to the function is performed in the ideal velocity (position) source block 130
  • force and speed (position) are calculated. Control energy is distributed to each.
  • the calculation results in the ideal force source block 120 and the ideal speed (position) source block 130 become information indicating the control target of the opening / closing motor 53d, and these calculation results are taken as input values of the opening / closing motor 53d in the inverse conversion block 140. Ru.
  • the open / close motor 53d executes an operation according to the function defined by the force / velocity assignment conversion block 110 (gripping function adapted to the specific conditions of the fruit to be gripped and gripped), and the target hand unit 53 gripping operations are realized. That is, the gripping robot 50 performs the gripping operation based on the real haptics according to the equations (1) and (2), and conforms to individual conditions such as size, shape or surface / internal state of the fruit to be gripped The gripping operation is realized.
  • the opening / closing motor drive unit 16 c controls the driving of the opening / closing motor 53 d in the gripping operation of the fruits and vegetables.
  • the open / close motor drive unit 16c performs control using a parameter representing a preset gripping operation as an initial value of control in the gripping operation, and after the start of the gripping operation, it is determined by the gripping parameter determination unit 16b.
  • the control is performed using the parameters (parameters sequentially calculated based on the above control rule).
  • the movable member position acquisition unit 16d acquires the current position of the rotary shaft of the opening / closing motor 53d (or the current position corresponding to the rotary shaft such as the current position of the movable members 53a to 53c) from the position detection sensor 53d-1.
  • the current position of the rotary shaft of the opening and closing motor 53d can be obtained, for example, by a rotary encoder or the like.
  • the positions of the end portions of the movable members 53a to 53c can be acquired by an encoder or the like. It is also possible to estimate the position from the electrical characteristics of the motor without using a sensor such as an encoder.
  • the gripping success / failure determination unit 16e determines whether or not actual gripping of the fruit that the hand unit 53 has made a gripping target has succeeded.
  • the determination result is stored as a part of data of the result of the sorting operation in the fruit vegetable transfer system 1, or the correction of the algorithm (for example, the equation for determining the parameter representing the operation of the open / close motor 53d) It can be used for the correction of the elements of the transformation matrix H in (1) and (2). If the gripping is successful, the gripping robot 50 transfers the fruits and vegetables to a predetermined storage box.
  • the weight determination unit 17 determines the weight of the fruit that the hand unit 53 holds.
  • the weight determination unit 17 is similar to the schematic diagram showing the concept of the control law shown in FIG. Position)
  • the weight determination unit 17 determining the weight of the fruit vegetables all the judgments of the judgment items of the standard such as the size, shape, characteristics and weight of the fruit vegetables are completed, and the sorting destination of the held fruit vegetables is decided.
  • the weight determination unit 17 stores the determined weight in the individual information.
  • the conveyance control unit 18 controls the conveyance of the fruits and vegetables in the conveyance device 20 by controlling the rotation speed and the rotation torque of the conveyance motor 24. Further, the transport control unit 18 is configured such that the pace of sorting of vegetables by the gripping robot 50 is a transport device based on the number of fruits and vegetables transported to the pick-up area of the gripping robot 50 and the number of fruits and vegetables sorted by the gripping robot 50 It is judged whether it is under the pace of conveyance of fruit vegetables by 20 or not. Then, when the transfer control unit 18 determines that the pace of sorting of fruits and vegetables by the gripping robot 50 is lower than the pace of transfer of fruits and vegetables by the transfer device 20, the transfer device 20 is temporarily stopped (or the speed is reduced). Let
  • the control data storage unit 19 includes data preset for performing the fruit vegetable sorting process (a parameter representing a reference value of the gripping operation set in advance), and various data (gripping done by the fruit vegetable sorting process)
  • the parameters etc. determined by the parameter determination unit 16 b are stored.
  • parameters representing the reference value of the gripping operation values in which the size of the fruit vegetables and the characteristics of the fruit vegetables are classified into a plurality of stages are prepared. For example, with respect to the size of fruits and vegetables, reference values of positions corresponding to S size, M size, and L size are set in advance.
  • the gripping parameter determination unit 16b reads the parameter of the reference value stored in the control data storage unit 19 as an initial value according to the size and characteristics of the fruit and vegetables determined by the item determination unit 13 and starts the gripping operation .
  • FIG. 5 is a flowchart for explaining the flow of the fruit and vegetable sorting process performed in the fruit and vegetable transfer system 1.
  • the fruit and vegetable sorting process is started in response to the operation of instructing the execution of the fruit and vegetable sorting process in the control device 10.
  • step S1 the image acquisition unit 11 outputs an imaging instruction for imaging the visible light image and the ultraviolet light image alternately to the imaging device 40, and acquires the captured visible light image and the ultraviolet light image.
  • step S2 the image analysis unit 12 analyzes the visible light image (object recognition, color detection, etc.) to detect the position at which the fruit is distributed on the transport body 21, the size of the fruit, color, injury, and the like. Recognize the shape.
  • step S3 the image analysis unit 12 analyzes the ultraviolet light image (brightness detection and the like) to recognize the presence or absence of a rotten part such as water rot and the like of a fruit vegetable.
  • step S4 the item determination unit 13 determines the evaluation item of the fruit based on the standard based on the analysis result of the image analysis unit 12.
  • the items to be determined at this time include the size and shape of the fruit vegetables (classification of the size and shape in the standard), and the characteristics of the fruit vegetables (color, degree of injury, presence or absence of rotten parts and raw injuries).
  • step S5 the fruit and vegetable identification unit 14 assigns the fruit and vegetables to be picked up to each holding robot 50, and specifies the fruits and vegetables to be picked up by each holding robot 50. At this time, the fruit and vegetable identification unit 14 specifies the position of the fruit and vegetable to be picked up and sorted by each of the two gripping robots 50 in each fruit and vegetable conveyed to the pickup area by the carrier 21.
  • step S6 the robot control unit 15 holds the robot at the position of each fruit identified by the fruit identification unit 14 by outputting drive signals of the extension motors 52a to 52c that control extension and contraction of the arms 51a to 51c. 50 hand units 53 are moved. Further, the robot control unit 15 vertically outputs the hand unit 53 by outputting a drive signal of the vertical motor 53e according to control of at least one of position (or velocity) in the vertical direction based on real haptics and / or force. Move it.
  • step S7 the hand unit control unit 16 performs a gripping operation adapted to individual conditions such as the size, shape or softness of the fruit to be gripped. At this time, the hand unit control unit 16 implements a gripping function of gripping and meeting the individual conditions of the fruit to be gripped in accordance with the control rule shown in FIG. 4.
  • step S8 the hand unit control unit 16 (gripping success / failure determination unit 16e) determines whether the actual gripping of the fruit that the hand unit 53 has made a gripping target has succeeded. If the hand unit 53 succeeds in actually gripping the fruit to be gripped, YES is determined in step S8, and the process proceeds to step S9. On the other hand, when the hand unit 53 has not succeeded in actually gripping the fruit to be gripped, NO is determined in step S8, and the process proceeds to step S11.
  • step S9 the weight determination unit 17 determines the weight of the fruit that the hand unit 53 grips.
  • step S10 the robot control unit 15 selects the fruits selected based on the judgment result of the evaluation item of the fruit by the item judgment unit 13 and the judgment result of the weight of the fruit by the weight judgment unit 17 Etc.), and transfer the fruits to the selected fruits.
  • step S11 the transport control unit 18 determines the pace of sorting of the fruits and vegetables by the gripping robot 50 based on the number of fruits and vegetables transported to the pick-up area of the gripping robot 50 and the number of fruits and vegetables sorted by the gripping robot 50. It is determined whether it is below the pace of conveyance of fruits and vegetables by the conveyance apparatus 20. If the pace of sorting of the fruits and vegetables by the gripping robot 50 is lower than the pace of conveyance of the fruits and vegetables by the conveyance device 20, YES is determined in step S11, and the process proceeds to step S12. On the other hand, when the pace of sorting of the fruits and vegetables by the gripping robot 50 is not less than the pace of conveyance of the fruits and vegetables by the conveyance device 20, NO is determined in step S11, and the process proceeds to step S1.
  • step S12 the transport control unit 18 temporarily stops the transport device 20 (or reduces the speed). After step S12, the fruit and vegetable sorting process is repeated until an operation for instructing the end of the fruit and vegetable sorting process is performed in the control device 10.
  • the gripping robot 50 performs gripping operation adapted to individual conditions such as the size, shape or surface state of the fruit to be gripped by control based on real haptics. Therefore, in the fruit vegetable transfer system 1, it is possible to more reliably hold fruits and vegetables of irregular shape and size. Moreover, even if it is a weak fruit vegetable, it can be hold
  • the gripping robot 50 outputs the gripping force according to the individual fruit vegetables without using a force sensor, the gripping force is determined promptly without being influenced by the convergence of the vibration when gripping the fruit vegetables, etc. It is then possible to transport fruits and vegetables.
  • a force sensor may be provided.
  • the gripping parameter determining unit 16 b is a reference value of the gripping operation stored in the control data storage unit 19 based on the size of the fruit and the characteristics of the fruit recognized by the image analyzing unit 12 Is read out, and the position and force (rotational torque) of the rotation shaft of the motor 53 d for opening and closing are controlled with the read out reference value as an initial value. Therefore, the fruit can be transferred with a more appropriate gripping force regardless of the fruit to be gripped. For example, even with extremely soft fruits and vegetables due to rot and overripening, etc., it is possible to realize an appropriate gripping operation without crushing or disintegrating the fruits. Furthermore, even if the posture of the fruit is changed while the fruit is being transferred, the hand unit 53 can be operated to maintain the gripping force and the gripping can be continued without dropping the fruit.
  • the present invention can be appropriately modified or improved as long as the effects of the present invention are achieved, and the present invention is not limited to the above-described embodiment.
  • the fruit-plant transfer system 1 picks up extra individuals and rotten individuals from among the fruits carried by the conveyor and removes them by the gripping robot, and packs them according to the specification of fruits.
  • the work place work place etc. which selects the individual used as goods installed in the lower stream side was mentioned as an example and explained, it is not restricted to this.
  • the fruit and vegetables transfer system 1 picks up and removes extraneous individuals and rotten individuals by the gripping robot 50, and grips the individual to be a commodity to measure the weight. Alternatively, they may be boxed directly for each equal rank. In this case, the processing line in the fruit-plant transfer system 1 can be simplified.
  • the gripping robot 50 may perform an operation of gripping and boxing fruits and vegetables sorted according to the specifications in advance by the fruit collecting machine.
  • the specific form of the hand unit 53 is not limited to the configuration shown in FIG. 2, and various configurations can be made.
  • the movable members 53a to 53c in the hand unit 53 can have various shapes.
  • the tips of the movable members 53a to 53c may be bent inward to make it easier to hold fruits and vegetables.
  • the conversion matrix in the equations (1) and (2) can be changed according to the purpose, and by changing this conversion matrix, the motor for opening and closing determined by the gripping parameter determination unit 16b Parameters representing the operation of 53 d can be easily changed. That is, by changing the transformation matrix, outputting parameters representing an operation according to the purpose, such as a state in which the movable members 53a to 53c generate a gripping force by an elastic force or a state in which a constant gripping force is maintained. Is possible.
  • photographs a visible light image and an ultraviolet light image was mentioned as the example and demonstrated in the above-mentioned embodiment, it is not restricted to this. That is, if it is a method that can recognize the quality such as appearance and characteristics of fruits and vegetables, for example, by irradiating laser light, an image (shape data) representing the shape of fruits and three-dimensional data representing overlap between fruits and vegetables are acquired Alternatively, it is possible to use a method of acquiring various data related to fruits such as obtaining sugar content of fruits and vegetables by infrared rays. Furthermore, although the operation and transfer destination of the open / close motor 53d are determined using a plurality of quality information in the above embodiment, at least one of the quality information may be used according to the purpose.
  • the present invention can be implemented by appropriately combining the examples described in the above embodiments.
  • the processing for control in the above-described embodiment can be performed by either hardware or software. That is, the fruit transfer system 1 only needs to have a function capable of executing the above-mentioned processing, and what kind of functional configuration and hardware configuration to realize this function is not limited to the above example.

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Sorting Of Articles (AREA)

Abstract

形状や大きさが不定形の食品をより適切に保持する技術を提供すること。　食品移載システムは、食品を搬送する搬送手段と、前記搬送手段によって搬送される前記食品に関するデータを取得するデータ取得手段と、前記データ取得手段の取得結果に基づいて、前記食品の位置または品質の少なくともいずれかを含む個体情報を取得する個体情報取得手段と、前記個体情報に基づいて、把持対象の前記食品を把持する把持手段と、前記把持手段における食品を把持する可動部材の位置を検出する位置検出手段と、前記把持手段を所定位置に移動させる移動機構と、前記位置検出手段の位置情報に基づいて、前記把持手段における前記可動部材の動作を制御する制御手段と、を備える。

Description

食品移載システム及び食品把持装置
　本発明は、果物や野菜等の個々に形状が不均一な農産物や、唐揚げや魚の切り身、惣菜等の個々に形状が不均一な食品を移載する食品移載システム及び食品把持装置に関する。
　従来、果物や野菜等の果菜を自動的に移載する技術が知られている。
　例えば、特許文献１には、青果物の大きさや硬さに合わせて青果物を吸着した時の吸引力を調節して、青果物を移送する吸着移送装置に関する技術が開示されている。
特開２０１７－０２４８１１公報
　しかしながら、特許文献１に記載された技術においては、青果物を吸着して保持することから、形状や大きさが不定形な果菜を確実に保持することが困難である。また、軟弱な果菜や腐敗部分を有する果菜を吸着した場合、吸引力によって果菜を傷付けたり、腐敗部分の切片によって吸引の詰まりを発生させたりする可能性がある。
　また、果菜に限らず形状や大きさが不定形な総菜等の食品においても個々の形状が不均一であるため、その取り扱いが困難である。そのため、このような食品の取り扱いを自動化することは難しく、お弁当の詰め合わせ作業等は人手により行っているのが現状である。
　このように、従来の技術においては、果菜や総菜等の形状や大きさが不定形の食品を適切に保持することが困難であった。
　本発明の課題は、形状や大きさが不定形の食品をより適切に保持する技術を提供することである。
　上記課題を解決するため、本発明の一態様に係る食品移載システムは、
　食品を搬送する搬送手段と、
　前記搬送手段によって搬送される前記食品に関するデータを取得するデータ取得手段と、
　前記データ取得手段の取得結果に基づいて、前記食品の位置または品質の少なくともいずれかを含む個体情報を取得する個体情報取得手段と、
　前記個体情報に基づいて、把持対象の前記食品を把持する把持手段と、
　前記把持手段における食品を把持する可動部材の位置を検出する位置検出手段と、
　前記把持手段を所定位置に移動させる移動機構と、
　前記位置検出手段の位置情報に基づいて、前記把持手段における前記可動部材の動作を制御する制御手段と、
　を備える。
　また、第２の発明は、前記請求項１に記載した発明において、前記制御手段は、前記食品の把持動作に対応して設定された、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行うことにより、前記把持手段における動作を制御することを特徴とするものである。
　さらに、第３の発明は、前記請求項１または請求項２に記載した発明において、前記制御手段は、前記食品の品質について、複数段階の設定値を記憶する記憶手段を備え、前記制御手段は、前記個体情報取得手段の取得結果に基づいて、前記記憶手段に記憶された前記設定値の中から、把持対象の前記食品の品質に対応する前記設定値を読み出し、当該設定値に基づいて、前記把持手段における動作を制御することを特徴とするものである。
　さらに、第４の発明は、前記請求項１ないし請求項３に記載した発明において、前記把持手段は、重量計測部をさらに備え、前記制御手段は、前記把持手段が前記食品を把持した際に算出された制御のためのパラメータに基づいて、前記食品の重量を判定することを特徴とするものである。
　さらに、第５の発明は、前記請求項１ないし請求項４に記載した発明において、前記制御手段は、前記個体情報取得手段の取得結果に基づいて、前記把持手段が前記食品を把持する際の接触位置を制御することを特徴とするものである。
　さらに、第６の発明は、食品把持装置であって、把持対象の食品に関して当該食品の品質を含む個体情報を取得する個体情報取得手段と、
　前記個体情報に基づいて、把持対象の前記食品を把持する把持手段と、
　前記把持手段における食品を把持する可動部材の位置を検出する位置検出手段と、
　前記位置検出手段の位置情報に基づいて、前記把持手段における可動部材の動作を制御する制御手段と、を備えることを特徴とするものである。
　さらに、第７の発明は、前記請求項６に記載した発明において、前記制御手段は、前記食品の把持動作に対応して設定された、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行うことにより、前記把持手段における動作を制御することを特徴とするものである。
　本発明によれば、形状や大きさが不定形の食品をより適切に保持する技術を提供することができる。
　また、請求項２の発明では、前記請求項１の発明において、把持動作に対応して設定された効率のよい把持動作が可能となる。
　さらに、請求項３の発明では、予め設定されている基準値のデータに基づきハンドの動作を制御することで、把持対象の食品個別の条件に適合した把持動作を行うことが可能となる。
　さらに、請求項４の発明では、ハンドの把持動作により食品の重量を判定し、判定した食品の選別先に食品を移送することができる。
　さらに、請求項５の発明では、食品の品質に応じて把持する箇所を変更することができ、食品をより適切に保持することができる。
　さらに、請求項６の発明では、食品をより適切に保持する技術を提供することができる。
　さらに、請求項７の発明では、前記請求項７の発明において、把持動作に対応して設定された効率のよい把持動作が可能となる。
本発明の一実施形態に係る果菜移載システム１の構成を示す模式図である。 ハンドユニット５３の構成を示す模式図である。 図２Ａの状態からハンドユニット５３が回転した状態を示す模式図である。 制御装置１０の機能的構成を示すブロック図である。 把持パラメータ決定部１６ｂにおける制御則の概念を示す模式図である。 果菜移載システム１において実行される果菜選別処理の流れを説明するフローチャートである。
　以下、本発明を果菜移載システムに応用した実施形態について、図面を参照して説明する。
　本発明に係る果菜移載システム及び果菜把持装置は、選別される果菜を撮影装置によって撮影し、撮影された画像から、個別の果菜の大きさ、形状、特性（色や傷害の程度、腐敗部分及び生傷の有無等）、重量といった品質情報を取得する。そして、把持ロボットにより果菜を把持する際に、取得された果菜の品質情報に基づいて、予め設定されている把持動作の基準値を初期値として果菜把持装置の把持動作を開始し、果菜把持装置が果菜を把持する際は、果菜把持装置における所定の位置の情報（例えば、アクチュエータの移動子の位置情報等）または果菜把持装置が果菜から受ける力の情報に基づいて、リアルハプティクスを応用した位置（または速度）及び力の制御を行う。
　これにより、把持対象の果菜の大きさ、形状あるいは表面状態等の個別の条件に適合した把持動作を行うことができ、果菜を適切に保持することが可能となる。
　なお、本実施形態においては、把持ロボットによって、コンベアで搬送される果菜の中から、格外の個体は加工食品用として、及び腐敗を有する個体は廃棄用としてピックアップして除外すると共に、把持した際に重量を判定し、格外の個体であっても重量不足で加工食品用として使用できないものを廃棄用として除外する場合を例に挙げて説明する。
　図１は、本発明の一実施形態に係る果菜移載システム１の構成を示す模式図である。
　図１に示すように、果菜移載システム１は、制御装置１０と、搬送装置２０と、照明装置３０と、撮影装置４０と、把持ロボット（果菜把持装置）５０と、を備えている。
　制御装置１０は、果菜移載システム１全体を制御する。例えば、制御装置１０は、演算処理装置、メモリ、ストレージデバイス及び通信インターフェース等を備える情報処理装置によって構成され、演算処理装置によってプログラムを実行することにより、果菜移載システム１における各種機能を実現する。一例として、制御装置１０は、ＰＬＣ（Ｐｒｏｇｒａｍｍａｂｌｅ　Ｌｏｇｉｃ　Ｃｏｎｔｒｏｌｌｅｒ）あるいはＰＣ（Ｐｅｒｓｏｎａｌ　Ｃｏｍｐｕｔｅｒ）等の情報処理装置によって構成することができる。
　具体的には、制御装置１０は、搬送装置２０の動作（駆動、停止、搬送速度等）、照明装置３０のオン／オフ及び撮影装置４０の撮影動作を制御する。
　また、制御装置１０は、後述する果菜選別処理を実行することにより、把持ロボット５０の把持動作を含む果菜の選別動作（移送）を制御する。このとき、制御装置１０は、把持ロボット５０における所定の位置（または速度）の情報に基づいて、リアルハプティクスを応用した位置（または速度）及び力の制御を行うことにより、果菜の把持動作を制御する。なお、果菜選別処理を実行することにより、制御装置１０において実現される機能的な構成については後述する。
　搬送装置２０は、果菜を多列で搬送するコンベアを構成し、搬送体２１と、受動プーリー２２と、駆動プーリー２３と、搬送用モータ２４と、ブレーキ板２５とを備えている。
　搬送体２１は、選別される果菜の供給を受け、撮影装置４０による撮影領域を経た後、把持ロボット５０によるピックアップ領域に果菜を搬送する。
　本実施形態における搬送体２１は、回転軸が平行となるように配列された複数の回転ローラ２１ａを備えており、これら複数の回転ローラ２１ａが全周にわたって設置された環状の構造を有している。搬送体２１において、複数の回転ローラ２１ａは、両端を環状のチェーンあるいはベルトによってそれぞれ回転可能に保持されている。これら複数の回転ローラ２１ａは、選別される果菜が隙間から落下しない配列間隔で設置されており、本実施形態においては、複数の回転ローラ２１ａの間隔を数センチメートル程度としている。
　また、搬送体２１は、受動プーリー２２と駆動プーリー２３とに巻き掛けられており、駆動プーリー２３の回転軸は、ベルト部材によって搬送用モータ２４の回転軸と連結されている。
　したがって、搬送用モータ２４が回転すると、その回転が駆動プーリー２３に伝達され、駆動プーリー２３に巻き掛けられている搬送体２１は、受動プーリー２２との間で周回することにより、連続的な搬送動作を行う。
　ブレーキ板２５は、搬送体２１の通過領域における特定の位置（搬送される果菜を回転させる位置）であって、複数の回転ローラ２１ａの下面側（果菜の載置面に対する裏面側）に設置され、各回転ローラ２１ａの表面（円筒面）との間に摩擦を生じさせる。即ち、搬送体２１が搬送動作を行うと、ブレーキ板２５に接触した回転ローラ２１ａは、ブレーキ板２５との摩擦により従動して回転することとなり、この回転により、ブレーキ板２５が設置された領域を通過する果菜を回転させる作用が発生する。以下、ブレーキ板２５が設置された領域を適宜「回転領域」と称する。なお、ブレーキ板２５が設置された領域以外において、回転ローラ２１ａは、ほぼ回転することなく果菜を載置した状態で移動する。以下、ブレーキ板２５が設置された領域以外を適宜「非回転領域」と称する。
　照明装置３０は、可視光を発する可視光ランプと、紫外光を発する紫外光ランプとを備え、制御装置１０の制御に従って、搬送される果菜に可視光及び紫外光を照射する。本実施形態において、照明装置３０は、果菜の搬送方向において、撮影装置４０の上流及び下流にそれぞれ備えられている。
　撮影装置４０は、可視光画像及び紫外光画像を撮影可能なデジタルカメラによって構成され、制御装置１０の制御に従って、可視光画像及び紫外光画像をそれぞれ撮影する。可視光画像は、主に果菜の位置、大きさ及び形状を認識するために用いられ、紫外光画像は、主に果菜の特性を検出（表面または内部の腐敗部分や生傷の検出等）するために用いられる。
　なお、搬送される果菜の形状、大きさ及び表面／内部の状態は、撮影装置４０によって撮影した画像に基づいて認識されることから、制御装置１０は、搬送される果菜を追跡可能な時間間隔で撮影するよう撮影装置４０を制御する。一例として、撮影装置４０によって、１／３０秒間隔で、可視光画像と紫外光画像とを交互に撮影すること等が可能である。
　把持ロボット５０は、３軸のパラレルリンクロボット（デルタ型の多関節ロボット）を備えている。本実施形態においては、２台の把持ロボット５０が設置されており、これら２台の把持ロボット５０が分担して果菜の選別作業を行う。なお、把持ロボット５０は、果菜をピックアップ可能な形態であれば、６軸のパラレルリンクロボットや垂直多関節ロボット等、他の方式のロボットを採用することも可能である。
　具体的には、把持ロボット５０は、筐体５０ａから延びる３つのアーム５１ａ～５１ｃと、各アーム５１ａ～５１ｃの伸縮を制御する伸縮用モータ５２ａ～５２ｃと、アーム５１ａ～５１ｃの先端に設置されたハンドユニット５３と、ハンドユニット５３を水平方向に回転させる回転用モータ５４と、を備えている。
　図２Ａは、ハンドユニット５３の構成を示す模式図である。
　図２Ａに示すように、ハンドユニット５３は、果菜把持用のツールとして構成され、果菜に接触して保持作用を生じさせる可動部材５３ａ～５３ｃと、可動部材５３ａ～５３ｃの開閉を制御する開閉用モータ５３ｄと、ハンドユニット５３を垂直方向に移動させる垂直モータ５３ｅと、を備えている。
　本実施形態において、把持ロボット５０の伸縮用モータ５２ａ～５２ｃ、ハンドユニット５３の開閉用モータ５３ｄ、垂直モータ５３ｅ及び回転用モータ５４は、制御装置１０の制御に従って動作する。
　例えば、伸縮用モータ５２ａ～５２ｃは、制御装置１０の制御に従って、ハンドユニット５３が把持対象の果菜の位置に移動するように、各アーム５１ａ～５１ｃの伸縮を制御する。
　また、開閉用モータ５３ｄは、制御装置１０の制御に従って、可動部材５３ａ～５３ｃが把持対象の果菜に応じてリアルハプティクスに基づく開閉位置及び接触力となるように、可動部材５３ａ～５３ｃの開閉動作を制御する。本実施形態において、開閉用モータ５３ｄは、モータ回転軸の回転位置を検出する位置検出センサ５３ｄ－１を備えている。位置検出センサ５３ｄ－１の検出結果は、可動部材５３ａ～５３ｄの開閉位置を示す情報であり、後述する果菜選別処理における入力（後述する把持パラメータ決定部１６ｂの入力）として用いられる。また、可動部材５３ａ～５３ｃの把持動作の初期値（位置及び力）は、可視光画像及び紫外光画像の解析結果に応じて、果菜の大きさ及び特性等の品質に応じた値（予め設定されている基準値のデータ）に設定される。そして、ハンドユニット５３が把持対象の果菜を把持した後（把持動作の開始後）は、制御装置１０が開閉用モータ５３ｄにおけるモータ回転軸の回転位置及び回転トルクを逐次演算することにより、可動部材５３ａ～５３ｃの開閉位置及び接触力が制御される。
　この結果、本実施形態におけるハンドユニット５３は、把持対象の果菜の大きさ、形状あるいは柔らかさ等の個別の条件に適合した把持動作を行うことが可能となる。
　また、垂直モータ５３ｅは、位置検出センサ５３ｅ－１を備えており、制御装置１０の制御に従って、回転用モータ５４と可動部材５３ａ～５３ｃの距離を一定に保つように制御される。さらに、垂直モータ５３ｅは、把持対象の果菜の重量に応じてリアルハプティクスに基づく制御（ハンドユニット５３を持ち上げる動作における位置（または速度）あるいは力の少なくともいずれかの制御）を行うことにより、重量を計測することができるようになっている。即ち、垂直モータ５３ｅが果菜を把持した際に流れる駆動電流等に基づいて、把持している果菜の重さを検出することができる。また、垂直モータ５３ｅの負荷または位置検出センサ５３ｅ－１の検出結果等から、ハンドユニット５３が垂直方向において物体（果菜等）に接触したことを判定することができる。
　回転用モータ５４は、ハンドユニット５３を水平方向に回転させることにより、把持対象の果菜に対する可動部材５３ａ～５３ｃの位置を変化させる。
　図２Ｂは、図２Ａの状態からハンドユニット５３が回転した状態を示す模式図である。
　図２Ｂに示すように、図２Ａの状態から、ハンドユニット５３が果菜に対して回転することにより、果菜の腐敗部分に可動部材５３ａ～５３ｃが接触する可能性を低減でき、可動部材５３ａ～５３ｃに腐敗部分の断片が付着することを抑制できる。
　また、密集して流れてくる果菜から把持対象の果菜を把持する際、可動部材５３ａ～５３ｃを果菜の隙間に位置させることで、周りの果実に可動部材５３ａ～５３ｃが接触することを防止することができる。
［機能的構成］
　次に、果菜移載システム１における制御装置１０の機能的構成について説明する。
　図３は、制御装置１０の機能的構成を示すブロック図である。
　図３に示すように、制御装置１０が果菜選別処理を実行することにより、機能的構成として、画像取得部１１と、画像解析部１２と、項目判定部１３と、果菜特定部１４と、ロボット制御部１５と、ハンドユニット制御部１６と、重量判定部１７と、搬送制御部１８と、制御データ記憶部１９と、が形成される。
　画像取得部１１は、撮影装置４０に対して、可視光画像と紫外光画像とを交互に撮影させる撮影指示を出力し、撮影された可視光画像及び紫外光画像を取得する。
　画像解析部１２は、可視光画像を解析（オブジェクト認識及び色彩検出等）することにより、搬送体２１上で果菜が分布している位置、果菜の大きさ、色や傷害、及び形状を認識する。また、画像解析部１２は、紫外光画像を解析（輝度検出等）することにより、果菜の水腐れ等の腐敗部分及び生傷の有無を認識する。本実施形態において、画像解析部１２は、果菜の大きさ、色や傷害、及び形状を認識する場合、搬送装置２０における回転領域の可視光画像を参照し、果菜の水腐れ等の腐敗部や生傷の検出等を認識する場合、搬送装置２０における回転領域の紫外光画像を参照する。また、画像解析部１２は、搬送装置２０における回転領域の可視光画像に撮影されている各果菜と紫外光画像に撮影されている各果菜とを対応付けて、果菜を個別に追跡する。そして、画像解析部１２は、搬送装置２０における非回転領域の可視光画像（果菜の回転が停止した状態の画像）を参照して、ピックアップ領域に搬送される各果菜の位置を認識する。これにより、個別の果菜の大きさ、形状、特性（色や傷害の程度、腐敗部分及び生傷の有無等）が認識される。さらに、画像解析部１２は、これらの認識結果（位置及び品質）を個体情報として記憶する。
　項目判定部１３は、画像解析部１２の解析結果に基づいて、規格に基づく果菜の評価項目を判定する。なお、項目判定部１３によって判定される項目には、果菜の大きさ及び形状（規格におけるサイズ及び形状の分類）、果菜の特性（色や傷害の程度、腐敗部分及び生傷の有無）、果菜の重量等の品質に関する項目が含まれる。なお、本実施形態において、果菜の重量については、後述する重量判定部１７によって判定される。
　果菜特定部１４は、ピックアップの対象とする果菜を各把持ロボット５０に割り当て、各把持ロボット５０によってピックアップする果菜を特定する。具体的には、果菜特定部１４は、搬送体２１によってピックアップ領域に搬送される各果菜において、２台の把持ロボット５０それぞれがピックアップして選別する対象の果菜の位置を逐次特定する。ピックアップ領域における果菜の位置は、画像解析部１２によって認識された非回転領域における果菜の位置を基に、搬送装置２０の搬送速度を加味することで特定することができる。本実施形態においては、搬送体２１によってピックアップ領域に搬送される果菜の中から、格外の個体及び腐敗を有する個体のみを把持ロボットによりピックアップして除外し、下流側に設置された作業場（商品となる個体を選別する作業場等）へ果菜を搬送する。
　ロボット制御部１５は、各アーム５１ａ～５１ｃの伸縮を制御する伸縮用モータ５２ａ～５２ｃの駆動信号を出力することにより、果菜特定部１４によって特定された各果菜の位置に把持ロボット５０のハンドユニット５３を移動させる。また、ロボット制御部１５は、リアルハプティクスに基づく垂直方向の位置（または速度）あるいは力の少なくともいずれかの制御に従って、垂直モータ５３ｅの駆動信号を出力することにより、ハンドユニット５３を垂直方向に移動させる。この場合、ロボット制御部１５は、垂直モータ５３ｅの回転軸の現在位置（あるいはハンドユニット５３の垂直方向の現在位置等、回転軸と対応する現在位置）を入力として、位置（または速度）あるいは力の少なくとも一方の領域における演算（例えば、後述する式（１）及び（２）に従う演算）を行うことにより、垂直モータ５３ｅの動作を表すパラメータを決定する。また、ロボット制御部１５は、項目判定部１３による果菜の評価項目の判定結果及び重量判定部１７による果菜の重量の判定結果に基づいて、果菜の選別先（「腐敗果」、「格外」等）を決定し、決定した果菜の選別先に果菜を移送する。なお、本実施形態においては、搬送装置２０におけるピックアップ領域の側方に果菜の選別先に対応する収容箱が設置されている。
　ハンドユニット制御部１６は、把持対象の果菜の大きさ、形状あるいは柔らかさ等の個別の条件に適合した把持動作を行う。
　具体的には、ハンドユニット制御部１６は、回転用モータ駆動部１６ａと、把持パラメータ決定部１６ｂと、開閉用モータ駆動部１６ｃと、可動部材位置取得部１６ｄと、把持成功／失敗判定部１６ｅと、を備えている。
　回転用モータ駆動部１６ａは、果菜の把持動作における回転用モータ５４の駆動を制御する。具体的には、回転用モータ駆動部１６ａは、画像解析部１２による果菜の品質（水腐れ等の腐敗部分及び生傷の有無）の解析結果に基づいて、ハンドユニット５３における可動部材５３ａ～５３ｃが把持対象の果菜の腐敗部分あるいは生傷の位置に接触しないように、ハンドユニット５３を水平方向に回転させる。また、回転用モータ駆動部１６ａは、画像解析部１２による果菜の位置からの可動部材５３ａ～５３ｃが周囲の果菜に接触しないようにハンドユニット５３を水平方向に回転させる。
　把持パラメータ決定部１６ｂは、開閉用モータ５３ｄの回転軸の現在位置（あるいは可動部材５３ａ～５３ｃの現在位置等の回転軸と対応する現在位置）を入力として、位置（または速度）あるいは力の少なくとも一方の領域における演算を行うことにより、開閉用モータ５３ｄの動作を表すパラメータを決定する。なお、把持パラメータ決定部１６ｂは、把持動作の開始時には、画像解析部１２によって認識された果菜の品質に基づいて、制御データ記憶部１９に記憶されている把持動作の基準値を読み出し、読み出した基準値を初期値として、開閉用モータ５３ｄの回転軸の位置及び力（回転トルク）を制御する。
　図４は、リアルハプティクス技術による把持パラメータ決定部１６ｂにおける制御則の概念を示す模式図である。
　図４に示すように、把持パラメータ決定部１６ｂにおける制御則は、開閉用モータ５３ｄ（制御対象システム）と、力・速度割当変換ブロック１１０と、理想力源ブロック１２０あるいは理想速度（位置）源ブロック１３０の少なくとも一つと、逆変換ブロック１４０とを含む制御則として表される。
　力・速度割当変換ブロック１１０は、開閉用モータ５３ｄの動作の基準となる値（基準値）と、開閉用モータ５３ｄの回転軸の現在位置とを入力とする座標変換を定義している。この座標変換は、基準値及び現在速度（または位置）を要素とする入力ベクトルを速度（または位置）の制御目標値を算出するための速度（または位置）からなる出力ベクトルに変換すると共に、基準値及び現在の力を要素とする入力ベクトルを力の制御目標値を算出するための力からなる出力ベクトルに変換するものである。具体的には、力・速度割当変換ブロック１１０における座標変換は、次式（１）及び（２）のように表される。
ｄＸ２＝［Ｈ］・ｄＸ１　　　（１）
Ｆ２＝［Ｈ］・Ｆ１　　　（２）
　ただし、式（１）において、ｄは一階微分を表す演算子、ｄＸ２は速度の状態値を導出するための速度ベクトル、ｄＸ１は、基準値及び開閉用モータ５３ｄの作用に基づく速度（開閉用モータ５３ｄの回転軸の速度、または、可動部材５３ａ～５３ｃ等、開閉用モータ５３ｄの回転軸と対応する部分の速度）を要素とするベクトル、Ｈは把持機能を表す変換行列である。また、式（２）において、ｄ２Ｆ２（ただし、ｄ２は二階微分を表す演算子）は力の状態値を導出するための力ベクトル、ｄ２Ｆ１は基準値及び開閉用モータ５３ｄの作用に基づく力（開閉用モータ５３ｄの回転軸の回転トルク、または、可動部材５３ａ～５３ｃ等、開閉用モータ５３ｄの回転軸と対応する部分の力）を要素とするベクトルである。
　理想力源ブロック１２０は、力・速度割当変換ブロック１１０によって定義された座標変換に従って、力の領域における演算を行うブロックである。理想力源ブロック１２０においては、機能別力・速度割当変換ブロック１１０によって定義された座標変換に基づく演算を行う際の力に関する目標値が設定されている。この目標値は、把持対象の果菜の個別の条件に適合させて把持する把持機能に対応して、固定値または可変値として設定される。
　理想速度（位置）源ブロック１３０は、力・速度割当変換ブロック１１０によって定義された座標変換に従って、速度（位置）の領域における演算を行うブロックである。理想速度（位置）源ブロック１３０においては、力・速度割当変換ブロック１１０によって定義された座標変換に基づく演算を行う際の速度（位置）に関する目標値が設定されている。この目標値は、把持対象の果菜の個別の条件に適合させて把持する把持機能に対応して、固定値または可変値として設定される。
　逆変換ブロック１４０は、速度（位置）及び力の領域の値を開閉用モータ５３ｄへの入力の領域の値（例えば電圧値または電流値等）に変換するブロックである。
　これにより、開閉用モータ５３ｄにおける位置の情報が力・速度割当変換ブロック１１０に入力されると、位置の情報に基づいて得られる速度（位置）及び力の情報を用いて、力・速度割当変換ブロック１１０において、把持対象の果菜の個別の条件に適合させて把持する把持機能に応じた位置及び力の領域それぞれの制御則が適用される。そして、理想力源ブロック１２０において、機能に応じた力の演算が行われ、理想速度（位置）源ブロック１３０において、機能に応じた速度（位置）の演算が行われ、力及び速度（位置）それぞれに制御エネルギーが分配される。
　理想力源ブロック１２０及び理想速度（位置）源ブロック１３０における演算結果は、開閉用モータ５３ｄの制御目標を示す情報となり、これらの演算結果が逆変換ブロック１４０において開閉用モータ５３ｄの入力値とされる。
　その結果、開閉用モータ５３ｄは、力・速度割当変換ブロック１１０によって定義された機能（把持対象の果菜の個別の条件に適合させて把持する把持機能）に従う動作を実行し、目的とするハンドユニット５３の把持動作が実現される。即ち、把持ロボット５０は、式（１）及び（２）に従って、リアルハプティクスに基づく把持動作を行い、把持対象の果菜の大きさ、形状あるいは表面／内部の状態等の個別の条件に適合した把持動作が実現される。
　図３に戻り、開閉用モータ駆動部１６ｃは、果菜の把持動作における開閉用モータ５３ｄの駆動を制御する。例えば、開閉用モータ駆動部１６ｃは、把持動作における制御の初期値として、予め設定されている把持動作を表すパラメータを用いて制御を行い、把持動作の開始後は、把持パラメータ決定部１６ｂによって決定されたパラメータ（上記制御則に基づいて逐次算出されるパラメータ）を用いて制御を行う。
　可動部材位置取得部１６ｄは、位置検出センサ５３ｄ－１から開閉用モータ５３ｄの回転軸の現在位置（あるいは可動部材５３ａ～５３ｃの現在位置等の回転軸と対応する現在位置）を取得する。なお、開閉用モータ５３ｄの回転軸の現在位置は、例えば、ロータリーエンコーダ等によって取得することができる。また、可動部材５３ａ～５３ｃの現在位置を取得する場合、可動部材５３ａ～５３ｃの端部の位置を検出するエンコーダ等によって取得することができる。モータの電気的特性からエンコーダ等のセンサを用いずに位置を推定することも可能である。
　把持成功／失敗判定部１６ｅは、ハンドユニット５３が把持対象とした果菜の実際の把持に成功したか否かの判定を行う。この判定結果は、果菜移載システム１における選別作業の結果のデータの一部として記憶したり、把持パラメータ決定部１６ｂが開閉用モータ５３ｄの動作を表すパラメータを決定するアルゴリズムの補正（例えば、式（１）及び（２）における変換行列Ｈの要素の補正等）に用いたりすることができる。なお、把持が成功した場合、把持ロボット５０によって、果菜が所定の収容箱へ移載される。
　重量判定部１７は、ハンドユニット５３が把持した果菜の重量を判定する。本実施形態において、重量判定部１７は、図４に示した制御則の概念を示す模式図と同様に、垂直モータ５３ｅに関して力・速度割当変換ブロック１１０と、理想力源ブロック１２０あるいは理想速度（位置）源ブロック１３０の少なくとも一つと、逆変換ブロック１４０とを有しており、上記のリアルハプティクス技術により垂直モータ５３ｅ（位置検出センサ５３ｅ－１）から取得される位置と力のパラメータから、把持している果菜の重量を判定する。重量判定部１７によって果菜の重量が判定される結果、果菜のサイズ、形状、特性及び重量等、規格の判定項目の判定が全て完了し、把持された果菜の選別先が確定する。なお、重量判定部１７は、判定した重量を個体情報に含めて記憶する。
　搬送制御部１８は、搬送用モータ２４の回転速度及び回転トルクを制御することにより、搬送装置２０における果菜の搬送を制御する。また、搬送制御部１８は、把持ロボット５０のピックアップ領域に搬送される果菜の個数と、把持ロボット５０によって選別された果菜の個数とに基づいて、把持ロボット５０による果菜の選別のペースが搬送装置２０による果菜の搬送のペースを下回っているか否かを判定する。そして、搬送制御部１８は、把持ロボット５０による果菜の選別のペースが搬送装置２０による果菜の搬送のペースを下回っていると判定した場合、搬送装置２０を一時的に停止（または速度を低下）させる。
　制御データ記憶部１９は、果菜選別処理を実行するために予め設定されたデータ（予め設定されている把持動作の基準値を表すパラメータ）や、果菜選別処理の実行によって生成された各種データ（把持パラメータ決定部１６ｂによって決定されたパラメータ等）を記憶する。本実施形態において、把持動作の基準値を表すパラメータは、果菜の大きさ及び果菜の特性について、それぞれ複数段階に分類した値が用意されている。例えば、果菜の大きさについて、Ｓサイズ、Ｍサイズ、Ｌサイズそれぞれに対応する位置の基準値が予め設定されている。同様に、果菜の特性について、良品（腐敗部分がないもの）、不良品（腐敗部分があるもの）それぞれに対応する力の基準値が予め設定されている。把持パラメータ決定部１６ｂは、項目判定部１３によって判定された果菜の大きさ及び特性に応じて、制御データ記憶部１９に記憶されている基準値のパラメータを初期値として読み出し、把持動作を開始する。
［動作］
　次に、果菜移載システム１の動作を説明する。
　図５は、果菜移載システム１において実行される果菜選別処理の流れを説明するフローチャートである。
　果菜選別処理は、制御装置１０において、果菜選別処理の実行を指示する操作が行われることに対応して開始される。
　ステップＳ１において、画像取得部１１は、撮影装置４０に対して、可視光画像と紫外光画像とを交互に撮影させる撮影指示を出力し、撮影された可視光画像及び紫外光画像を取得する。
　ステップＳ２において、画像解析部１２は、可視光画像を解析（オブジェクト認識及び色彩検出等）することにより、搬送体２１上で果菜が分布している位置、果菜の大きさ、色や傷害、及び形状を認識する。
　ステップＳ３において、画像解析部１２は、紫外光画像を解析（輝度検出等）することにより、果菜の水腐れ等の腐敗部分及び生傷の有無を認識する。
　ステップＳ４において、項目判定部１３は、画像解析部１２の解析結果に基づいて、規格に基づく果菜の評価項目を判定する。このとき判定される項目には、果菜の大きさ及び形状（規格におけるサイズ及び形状の分類）、果菜の特性（色や傷害の程度、腐敗部分及び生傷の有無）が含まれる。
　ステップＳ５において、果菜特定部１４は、ピックアップの対象とする果菜を各把持ロボット５０に割り当て、各把持ロボット５０によってピックアップする果菜を特定する。このとき、果菜特定部１４は、搬送体２１によってピックアップ領域に搬送される各果菜において、２台の把持ロボット５０それぞれがピックアップして選別する対象の果菜の位置を特定する。
　ステップＳ６において、ロボット制御部１５は、各アーム５１ａ～５１ｃの伸縮を制御する伸縮用モータ５２ａ～５２ｃの駆動信号を出力することにより、果菜特定部１４によって特定された各果菜の位置に把持ロボット５０のハンドユニット５３を移動させる。また、ロボット制御部１５は、リアルハプティクスに基づく垂直方向の位置（または速度）あるいは力の少なくともいずれかの制御に従って、垂直モータ５３ｅの駆動信号を出力することにより、ハンドユニット５３を垂直方向に移動させる。
　ステップＳ７において、ハンドユニット制御部１６は、把持対象の果菜の大きさ、形状あるいは柔らかさ等の個別の条件に適合した把持動作を行う。このとき、ハンドユニット制御部１６は、図４に示す制御則に従い、把持対象の果菜の個別の条件に適合させて把持する把持機能を実現する。
　ステップＳ８において、ハンドユニット制御部１６（把持成功／失敗判定部１６ｅ）は、ハンドユニット５３が把持対象とした果菜の実際の把持に成功したか否かの判定を行う。
　ハンドユニット５３が把持対象とした果菜の実際の把持に成功した場合、ステップＳ８においてＹＥＳと判定されて、処理はステップＳ９に移行する。
　一方、ハンドユニット５３が把持対象とした果菜の実際の把持に成功していない場合、ステップＳ８においてＮＯと判定されて、処理はステップＳ１１に移行する。
　ステップＳ９において、重量判定部１７は、ハンドユニット５３が把持した果菜の重量を判定する。
　ステップＳ１０において、ロボット制御部１５は、項目判定部１３による果菜の評価項目の判定結果及び重量判定部１７による果菜の重量の判定結果に基づいて、果菜の選別先（「腐敗果」、「格外」等）を決定し、決定した果菜の選別先に果菜を移送する。
　ステップＳ１１において、搬送制御部１８は、把持ロボット５０のピックアップ領域に搬送される果菜の個数と、把持ロボット５０によって選別された果菜の個数とに基づいて、把持ロボット５０による果菜の選別のペースが搬送装置２０による果菜の搬送のペースを下回っているか否かを判定する。
　把持ロボット５０による果菜の選別のペースが搬送装置２０による果菜の搬送のペースを下回っている場合、ステップＳ１１においてＹＥＳと判定されて、処理はステップＳ１２に移行する。
　一方、把持ロボット５０による果菜の選別のペースが搬送装置２０による果菜の搬送のペースを下回っていない場合、ステップＳ１１においてＮＯと判定されて、処理はステップＳ１に移行する。
　ステップＳ１２において、搬送制御部１８は、搬送装置２０を一時的に停止（または速度を低下）させる。
　ステップＳ１２の後、制御装置１０において、果菜選別処理の終了を指示する操作が行われるまで、果菜選別処理が繰り返される。
　以上のように、本実施形態に係る果菜移載システム１は、搬送装置２０によって搬送される果菜の大きさ、形状あるいは特性等の品質に関する情報（品質情報）を、撮影装置４０によって撮影された画像等を基に解析する。そして、把持ロボット５０は、リアルハプティクスに基づく制御により、把持対象の果菜の大きさ、形状あるいは表面状態等の個別の条件に適合した把持動作を行う。
　そのため、果菜移載システム１においては、形状や大きさが不定形な果菜をより確実に保持することができる。また、軟弱な果菜であっても、表面を傷付けることなく、果菜の柔らかさに応じた把持力で保持することができる。
　したがって、果菜移載システム１によれば、果菜を適切に保持することが可能となる。
　また、把持ロボット５０は、力センサを用いることなく、個別の果菜に応じた把持力を出力するため、果菜を把持した際の振動の収束等に影響されることなく、速やかに把持力を決定して、果菜を移送することが可能となる。なお、本実施形態におけるリアルハプティクスに基づく制御を補助するために、力センサを備えることとしてもよい。
　また、把持パラメータ決定部１６ｂは、把持動作の開始時には、画像解析部１２によって認識された果菜の大きさ及び果菜の特性に基づいて、制御データ記憶部１９に記憶されている把持動作の基準値を読み出し、読み出した基準値を初期値として、開閉用モータ５３ｄの回転軸の位置及び力（回転トルク）を制御する。
　したがって、把持対象の果菜によらず、より適切な把持力で果菜を移送することができる。例えば、腐敗や過熟等によって極端に柔らかい果菜であっても、果菜を潰したり崩壊させたりすることなく、適切な把持動作を実現することができる。
　さらに、果菜を移送中に、果菜の姿勢が変化しても、把持力を保持するようにハンドユニット５３が動作して果菜を落とすことなく把持し続けることができる。
　なお、本発明は、本発明の効果を奏する範囲で変形、改良等を適宜行うことができ、上述の実施形態に限定されない。
　例えば、上述の実施形態において、果菜移載システム１が、コンベアで搬送される果菜の中から、格外の個体及び腐敗を有する個体を把持ロボットによりピックアップして除外すると共に、果菜の規格毎に箱詰めする下流側に設置された作業場（商品となる個体を選別する作業場等）へ果菜を搬送する場合を例に挙げて説明したが、これに限られない。
　即ち、果菜移載システム１が、コンベアで搬送される果菜の中から、格外の個体及び腐敗を有する個体を把持ロボット５０によりピックアップして除外すると共に、商品となる個体を把持して重量を計測し、各等階級毎に直接箱詰めすることとしてもよい。この場合、果菜移載システム１における処理ラインを簡素化できる。
　また、上述の実施形態においては搬送装置上に直接果菜を乗せ搬送しているが、コンテナ内に収容された果菜を搬送し、対象となる個体を直接把持して、規格毎に選別して箱詰めすることとしてもよい。
　また、把持ロボット５０によって、選果機で事前に規格毎に選別された果菜を把持して箱詰めする作業を行うこととしてもよい。
　上述の実施形態において、把持ロボット５０を２台設置することとして説明したが、これに限られない。即ち、選別する果菜の数や必要とされる選別のペース等を加味して、より多くの把持ロボット５０を設置したり、１台の把持ロボット５０で果菜を選別したりすることができる。
　また、上述の実施形態において、ハンドユニット５３の具体的な形態は、図２に示す構成に限られるものではなく、種々の構成とすることができる。例えば、ハンドユニット５３における可動部材５３ａ～５３ｃを各種形状とすることが可能である。一例として、可動部材５３ａ～５３ｃの先端を内側に屈曲させた形状とし、果菜の保持をより容易なものとすることができる。
　また、上述の実施形態において、式（１）及び（２）における変換行列は目的に応じて変化させることができ、この変換行列を変化させることにより、把持パラメータ決定部１６ｂが決定する開閉用モータ５３ｄの動作を表すパラメータを簡単に変化させることができる。即ち、変換行列を変化させることで、可動部材５３ａ～５３ｃが弾性力によって把持力を生成している状態や一定の把持力を維持する状態等、目的に応じた動作を表すパラメータを出力することが可能である。
　また、上述の実施形態において、撮影装置４０が可視光画像及び紫外光画像を撮影する場合を例に挙げて説明したが、これに限られない。即ち、果菜の外観や特性等の品質を認識できる方法であれば、例えば、レーザー光を照射することにより、果菜の形状を表す画像（形状データ）や果菜同士の重なりを表す３次元データを取得したり、赤外線によって果菜の糖度を取得したりする等、果菜に関する種々のデータを取得する方法を用いることが可能である。
　さらに、上述の実施形態においては品質情報の複数を用いて開閉用モータ５３ｄの動作や移送先を決定しているが、目的に応じて品質情報の少なくとも一つを用いることとしてもよい。
　また、上述の実施形態に記載された例を適宜組み合わせて、本発明を実施することが可能である。
　上述の実施形態における制御のための処理は、ハードウェア及びソフトウェアのいずれにより実行させることも可能である。
　即ち、上述の処理を実行できる機能が果菜移載システム１に備えられていればよく、この機能を実現するためにどのような機能構成及びハードウェア構成とするかは上述の例に限定されない。
　さらに、本実施形態は果菜把持装置において説明したが、不定形の食品を扱う食品把持装置にも応用できる。
　なお、上記実施形態は、本発明を適用した一例を示しており、本発明の技術的範囲を限定するものではない。即ち、本発明は、本発明の要旨を逸脱しない範囲で、省略や置換等種々の変更を行うことができ、上記実施形態以外の各種実施形態を取ることが可能である。本発明が取ることができる各種実施形態及びその変形は、特許請求の範囲に記載された発明とその均等の範囲に含まれる。
　１　果菜移載システム、１０　制御装置、１１　画像取得部、１２　画像解析部、１３　項目判定部、１４　果菜特定部、１５　ロボット制御部、１６　ハンドユニット制御部、１６ａ　回転用モータ駆動部、１６ｂ　把持パラメータ決定部、１６ｃ　開閉用モータ駆動部、１６ｄ　可動部材位置取得部、１６ｅ　把持成功／失敗判定部、１７　重量判定部、１８　搬送制御部、１９　制御データ記憶部、２０　搬送装置、２１　搬送体、２１ａ　回転ローラ、２２　受動プーリー、２３　駆動プーリー、２４　搬送用モータ、２５　ブレーキ板、３０　照明装置、４０　撮影装置、５０　把持ロボット（移動機構）、５０ａ　筐体、５１ａ～５１ｃ　アーム、５２ａ～５２ｃ　伸縮用モータ、５３　ハンドユニット、５３ａ～５３ｃ　可動部材、５３ａ～５３ｃ　可動部材、５３ｄ　開閉用モータ、５３ｄ－１，５３ｅ－１　位置検出センサ、５３ｅ　垂直モータ、５４　回転用モータ、１１０　力・速度割当変換ブロック、１２０　理想力源ブロック、１３０　理想速度（位置）源ブロック、１４０　逆変換ブロック

Claims (7)

  1. 　食品を搬送する搬送手段と、
    　前記搬送手段によって搬送される前記食品に関するデータを取得するデータ取得手段と、
    　前記データ取得手段の取得結果に基づいて、前記食品の位置または品質の少なくともいずれかを含む個体情報を取得する個体情報取得手段と、
    　前記個体情報に基づいて、把持対象の前記食品を把持する把持手段と、
    　前記把持手段における食品を把持する可動部材の位置を検出する位置検出手段と、
    　前記把持手段を所定位置に移動させる移動機構と、
    　前記位置検出手段の位置情報に基づいて、前記把持手段における前記可動部材の動作を制御する制御手段と、
    　を備えることを特徴とする食品移載システム。
  2. 　前記制御手段は、前記食品の把持動作に対応して設定された、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行うことにより、前記把持手段における動作を制御することを特徴とする請求項１に記載の食品移載システム。
  3. 　前記食品の品質について、複数段階の設定値を記憶する記憶手段を備え、
    　前記制御手段は、前記個体情報取得手段の取得結果に基づいて、前記記憶手段に記憶された前記設定値の中から、把持対象の前記食品の品質に対応する前記設定値を読み出し、当該設定値に基づいて、前記把持手段における動作を制御することを特徴とする請求項１または２に記載の食品移載システム。
  4. 　前記把持手段は、重量計測部をさらに備え、
    　前記制御手段は、前記重量計測部が前記食品を把持した際に算出したパラメータに基づいて、前記食品の重量を判定することを特徴とする請求項１から３のいずれか１項に記載の食品移載システム。
  5. 　前記制御手段は、前記個体情報取得手段の取得結果に基づいて、前記把持手段が前記食品を把持する際の接触位置を制御することを特徴とする請求項１から４のいずれか１項に記載の食品移載システム。
  6. 　把持対象の食品に関して当該食品の品質を含む個体情報を取得する個体情報取得手段と、
    　前記個体情報に基づいて、把持対象の前記食品を把持する把持手段と、
    　前記把持手段における食品を把持する可動部材の位置を検出する位置検出手段と、
    　前記位置検出手段の位置情報に基づいて、前記把持手段における前記可動部材の動作を制御する制御手段と、
    　を備えることを特徴とする食品把持装置。
  7. 　前記制御手段は、前記食品の把持動作に対応して設定された、制御エネルギーを速度または位置のエネルギーと力のエネルギーとに割り当てる変換を行うことにより、前記把持手段における動作を制御することを特徴とする請求項６に記載の食品把持装置。
PCT/JP2018/035501 2017-09-25 2018-09-25 食品移載システム及び食品把持装置 Ceased WO2019059403A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2017-184104 2017-09-25
JP2017184104A JP7201313B2 (ja) 2017-09-25 2017-09-25 食品移載システム及び食品把持装置

Publications (1)

Publication Number Publication Date
WO2019059403A1 true WO2019059403A1 (ja) 2019-03-28

Family

ID=65810449

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2018/035501 Ceased WO2019059403A1 (ja) 2017-09-25 2018-09-25 食品移載システム及び食品把持装置

Country Status (2)

Country Link
JP (1) JP7201313B2 (ja)
WO (1) WO2019059403A1 (ja)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7493741B2 (ja) * 2019-08-05 2024-06-03 株式会社イシダ 物品把持装置
JP7308770B2 (ja) * 2020-01-22 2023-07-14 アンリツ株式会社 箱詰検査システム及び箱詰検査方法
JP7481735B2 (ja) * 2020-03-19 2024-05-13 株式会社イシダ 物品把持装置
WO2022157890A1 (ja) * 2021-01-21 2022-07-28 東都フォルダー工業株式会社 布類ピックアップ装置
KR102905412B1 (ko) * 2022-12-29 2025-12-31 주식회사 생명과기술 과일 분류 장치
KR102812344B1 (ko) * 2022-12-29 2025-05-27 주식회사 생명과기술 과일 분류 장치
CN120882542A (zh) * 2023-03-31 2025-10-31 株式会社富士 异物去除装置及异物去除方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0663291U (ja) * 1993-02-17 1994-09-06 高野ベアリング株式会社 加工食品の把持装置
JPH08323678A (ja) * 1995-05-25 1996-12-10 Sanyo Electric Co Ltd 柔軟物体把持装置
JPH10217172A (ja) * 1997-01-30 1998-08-18 Kubota Corp ロボットハンド
JP2010005732A (ja) * 2008-06-26 2010-01-14 Toyota Industries Corp ロボットハンド機構、ロボットハンド機構を備えたロボット及びロボットハンド機構の制御方法
JP2013086229A (ja) * 2011-10-20 2013-05-13 Yaskawa Electric Corp ロボットシステム
WO2015041046A1 (ja) * 2013-09-19 2015-03-26 学校法人慶應義塾 位置・力制御装置、位置・力制御方法及びプログラム
WO2017017751A1 (ja) * 2015-07-27 2017-02-02 株式会社ニレコ 青果物選別装置及び青果物選別方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3143261B2 (ja) * 1993-05-28 2001-03-07 三洋電機株式会社 ロボットハンドの制御方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0663291U (ja) * 1993-02-17 1994-09-06 高野ベアリング株式会社 加工食品の把持装置
JPH08323678A (ja) * 1995-05-25 1996-12-10 Sanyo Electric Co Ltd 柔軟物体把持装置
JPH10217172A (ja) * 1997-01-30 1998-08-18 Kubota Corp ロボットハンド
JP2010005732A (ja) * 2008-06-26 2010-01-14 Toyota Industries Corp ロボットハンド機構、ロボットハンド機構を備えたロボット及びロボットハンド機構の制御方法
JP2013086229A (ja) * 2011-10-20 2013-05-13 Yaskawa Electric Corp ロボットシステム
WO2015041046A1 (ja) * 2013-09-19 2015-03-26 学校法人慶應義塾 位置・力制御装置、位置・力制御方法及びプログラム
WO2017017751A1 (ja) * 2015-07-27 2017-02-02 株式会社ニレコ 青果物選別装置及び青果物選別方法

Also Published As

Publication number Publication date
JP2019058967A (ja) 2019-04-18
JP7201313B2 (ja) 2023-01-10

Similar Documents

Publication Publication Date Title
WO2019059403A1 (ja) 食品移載システム及び食品把持装置
KR102027040B1 (ko) 대상물 픽업 공급 자동화 시스템 및 대상물 자동 픽업 공급 방법
CN109070146B (zh) 尤其用于包装带脐水果的带脐水果定向方法和装置
KR20220165262A (ko) 픽 앤 플레이스 로봇 시스템
KR102109698B1 (ko) 영상처리분석을 이용한 대상물 자동 선별, 분류 시스템 및 자동선별 분류방법
JP2018027581A (ja) ピッキングシステム
CN117163380B (zh) 基于机器视觉的自动抓取系统、方法、装置以及包装面点
JP2010519013A (ja) 品物（ｉｔｅｍ）を処理するための方法及びシステム
JP7248317B2 (ja) 豆腐類製造システム
WO2022090705A1 (en) Item packing system, end effetor and method of sorting and/or packing vine fruit
JP7765812B2 (ja) ロボット、及びこれを備えた細長い部材のピックアップシステム
Panda et al. Robotics for general material handling machines in food plants
KR20230004507A (ko) 두부류 제조 시스템
JP6958663B2 (ja) 解体物の選別装置
JP3400359B2 (ja) 農産物の検査装置
EP3897166A2 (en) Automatic suspension of meat items
CN107422700A (zh) 一种机器人自动化生产线实验平台的控制方法
EP4102978A1 (en) Automatic suspension of meat items
WO2023201248A1 (en) Systems, methods and apparatus for picking and sorting products
DK181226B1 (en) A robotic meat handling system and method for use in slaughterhouses
KR102027039B1 (ko) 영상처리분석을 이용한 대상물 자동 정렬, 공급 시스템, 및 대상물 자동 정렬, 공급 방법
JP7418743B2 (ja) 対象ワークの識別移載装置及び識別移載方法
JP2020151613A (ja) 農作物選別装置
WO2017042760A1 (en) System for grain sorting
JP7765813B2 (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: 18858893

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: 18858893

Country of ref document: EP

Kind code of ref document: A1