WO2020217306A1 - リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 - Google Patents
リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 Download PDFInfo
- Publication number
- WO2020217306A1 WO2020217306A1 PCT/JP2019/017194 JP2019017194W WO2020217306A1 WO 2020217306 A1 WO2020217306 A1 WO 2020217306A1 JP 2019017194 W JP2019017194 W JP 2019017194W WO 2020217306 A1 WO2020217306 A1 WO 2020217306A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- slider
- linear module
- coordinate axis
- linear
- coordinate
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G54/00—Non-mechanical conveyors not otherwise provided for
- B65G54/02—Non-mechanical conveyors not otherwise provided for electrostatic, electric, or magnetic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
- B65G43/08—Control devices operated by article or material being fed, conveyed or discharged
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
- B65G47/52—Devices for transferring articles or materials between conveyors i.e. discharging or feeding devices
- B65G47/64—Switching conveyors
- B65G47/641—Switching conveyors by a linear displacement of the switching conveyor
- B65G47/642—Switching conveyors by a linear displacement of the switching conveyor in a horizontal plane
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
- B65G47/74—Feeding, transfer, or discharging devices of particular kinds or types
- B65G47/90—Devices for picking-up and depositing articles or materials
- B65G47/905—Control arrangements
Definitions
- the present invention relates to a linear conveyor system provided with a mechanism for driving a slider by a linear module.
- Patent Document 1 discloses a linear drive transfer system in which a plurality of trucks for driving a moving body in a predetermined drive direction are arranged in parallel.
- the system is equipped with a junction track that transfers moving objects between multiple tracks. This junction track can receive a moving object from one track while facing one track, or vice versa.
- Patent Document 1 uses a movable linear module for transferring a slider (movable body) between a plurality of fixed linear modules (tracks) arranged in parallel.
- the following problems may occur in executing the transfer operation of moving the slider between the fixed linear module and the movable linear module.
- the slider delivery operation can be executed by controlling the position of the slider driven by the fixed linear module and the movable linear module.
- Such position control is executed based on the coordinate axes set for each of the fixed linear module and the movable linear module.
- the position control cannot be performed based on these coordinate axes, and the slider transfer operation may not be executed.
- the present invention has been made in view of the above problems, and due to the discontinuity of the coordinate axes set for each of the fixed linear module and the movable linear module, a situation occurs in which the transfer operation of moving the slider between them cannot be executed.
- the purpose is to provide technology that can be suppressed.
- the linear conveyor system faces a slider driven in the first direction, a plurality of fixed linear modules arranged in a second direction intersecting the first direction, and a plurality of fixed linear modules from the first direction.
- a movable linear module that moves between a plurality of facing ranges arranged in the second direction and drives the slider in the first direction, a slider transfer mechanism that conveys the movable linear module between the plurality of facing ranges, and a second.
- Coordinate axes indicating the position in the first direction by the coordinate values that change according to the change in the position in one direction are set for each of the plurality of fixed linear modules and movable linear modules, and are driven by the fixed linear module and the movable linear module.
- the slider is provided with a control unit that executes position control based on the coordinate axes, and the slider can be engaged with and detached from the fixed linear module and the movable linear module from one end in the first direction.
- the module and the movable linear module drive the engaging slider in the first direction, and the transfer operation of moving the slider between the fixed linear module and the movable linear module is executed, and the control unit is performed on the coordinate axes of the fixed linear module.
- the control method of the linear conveyor system includes a slider driven in the first direction, a plurality of fixed linear modules arranged in a second direction intersecting the first direction, and a plurality of fixed linear modules.
- a movable linear module that moves between a plurality of facing ranges arranged in a second direction while facing each other and drives a slider in the first direction, and a slider transfer mechanism that conveys a movable linear module between a plurality of facing ranges. It is a control method of a linear conveyor system including, and a coordinate axis indicating a position in the first direction by a coordinate value that changes according to a change in the position in the first direction is set by a plurality of fixed linear modules and movable linear modules.
- the process of setting each the process of executing the determination process of determining whether the one coordinate axis, which is the coordinate axis of the fixed linear module, and the other coordinate axis, which is the coordinate axis of the movable linear module, are continuous in the first direction, and the determination process.
- the transfer operation of moving the slider between the fixed linear module and the movable linear module is executed by the speed control that controls the speed of the slider based on the speed command value. It has a process.
- the control program of the linear conveyor system includes a slider driven in the first direction, a plurality of fixed linear modules arranged in a second direction intersecting the first direction, and a plurality of fixed linear modules.
- a movable linear module that moves between a plurality of facing ranges arranged in a second direction while facing each other and drives a slider in the first direction, and a slider transfer mechanism that conveys a movable linear module between a plurality of facing ranges.
- the process of setting each the process of executing the determination process of determining whether the one coordinate axis, which is the coordinate axis of the fixed linear module, and the other coordinate axis, which is the coordinate axis of the movable linear module, are continuous in the first direction, and the determination process.
- the transfer operation of moving the slider between the fixed linear module and the movable linear module is executed by the speed control that controls the speed of the slider based on the speed command value. Let the computer execute the process.
- the recording medium according to the present invention records the control program of the above linear conveyor system so that it can be read by a computer.
- a transfer operation of moving a slider between a fixed linear module and a movable linear module is performed. Will be executed.
- a determination process for determining whether the one coordinate axis, which is the coordinate axis of the fixed linear module, and the other coordinate axis, which is the coordinate axis of the movable linear module, is continuous in the first direction is executed.
- the transfer operation is performed while executing the speed control (not the position control) that controls the speed of the slider based on the speed command value.
- the speed control not the position control
- the control unit controls the slider by feedback control based on the deviation between the position command value generated based on the position profile indicating the time change of the slider position and the position detection value at which the slider position is detected.
- speed control the slider is driven by feedback control based on the deviation between the speed command value generated based on the speed profile indicating the time change of the slider speed and the speed detection value detected by the slider speed.
- a linear conveyor system may be configured. In this way, the position control and the speed control of the slider can be accurately executed by the position profile and the speed profile.
- the slider when the control unit completes the speed control in the transfer operation of moving the slider from the movement start position to the movement target position, the slider is controlled by the position from the stop position where the slider stops when the speed control is completed to the movement target position.
- the linear conveyor system may be configured to move. In such a configuration, the steady-state deviation remaining when the speed control is completed (that is, the difference between the stop position and the movement target position) can be eliminated by the position control, and the slider can be reliably moved to the movement target position.
- the control unit determines before the delivery operation that one coordinate axis and the other coordinate axis are continuous as a result of executing the determination process, the control unit configures the linear conveyor system so as to control the driving of the slider in the transfer operation by position control. You may.
- the determination process determines that the coordinate axes are continuous
- the slider transfer operation is executed by position control
- the determination process determines that the coordinate axes are not continuous
- the slider transfer operation is speedy. Executed by control. Therefore, due to the discontinuity of the coordinate axes set for each of the fixed linear module and the movable linear module, it is possible to suppress the occurrence of a situation in which the transfer operation of moving the slider between them cannot be executed.
- the control unit may configure the linear conveyor system so that the coordinate axes are set so that the coordinate values indicated by the coordinate axes of the plurality of fixed linear modules and the movable linear modules do not overlap with each other.
- control of the slider can be accurately performed based on a coordinate axis that does not overlap, in other words, a coordinate axis that uniquely indicates a position in the first direction.
- the coordinate axes may be configured as a linear conveyor system so that the coordinate values indicate the position in the first direction by the coordinate values that change linearly with a predetermined inclination according to the change in the position in the first direction.
- the control unit receives one coordinate axis and the other.
- the linear conveyor system may be configured so that it is determined that the coordinate axes are not continuous. As a result, the continuity of the coordinate axes can be easily determined.
- FIG. 3 is a block diagram showing an example of an electrical configuration included in the linear conveyor system of FIG.
- FIG. 3 is a flowchart showing an example of drive control executed by the linear conveyor system shown in FIG.
- the figure which shows an example of the initial setting executed by the drive control shown in FIG. 5 schematically.
- the figure which shows an example of the initial setting executed by the drive control shown in FIG. 5 schematically.
- FIG. 5 is a diagram schematically showing an example of a transfer operation executed by the drive control shown in FIG.
- FIG. 5 is a diagram schematically showing an example of a position / speed profile used in the drive control of FIG.
- FIG. 1 is a perspective view showing an example of a linear module included in the linear conveyor system according to the present invention
- FIG. 2 is a perspective view showing the inside of the linear module of FIG. 1 partially exposed.
- XYZ orthogonal coordinate axes having an X direction parallel to the horizontal direction, a Y direction parallel to the horizontal direction while being orthogonal to the X direction, and a Z direction parallel to the vertical direction are shown.
- the diagonally upper right side of both figures is described as the X1 side along the X direction
- the diagonally lower left side of both figures is described as the X2 side along the X direction.
- This linear module has, for example, the same basic configuration as the module of the linear conveyor device described in WO2018 / 055709A1.
- the linear module will be described, and then the entire linear conveyor system will be described.
- a linear module M extending in the X direction, a base member 3 that supports the linear module M from below, and a slider 4 that engages with the linear module M are shown.
- the linear module M is attached to the upper ends of three base members 3 arranged at equal intervals in the X direction, and drives the slider 4 in the X direction by magnetic force.
- the linear module M is composed of two module units 20 arranged in the X direction.
- the number of module units 20 constituting the linear module M is not limited to two, and may be one or three or more.
- the module unit 20 has a substrate 21 extending in the X direction.
- the substrate 21 is a flat plate having a rectangular shape in a plan view from the Z direction.
- Two guide rails 22 parallel to the X direction are arranged on the upper surface of the substrate 21 at intervals in the Y direction.
- a plurality of linear motor stators 23 arranged in a row in the X direction at a predetermined arrangement pitch P23 and a plurality of magnetic sensors 24 arranged in a row in the X direction at a predetermined arrangement pitch P24 are attached.
- the arrangement pitch P24 of the magnetic sensor 24 is longer than the arrangement pitch P23 of the linear motor stator 23.
- the plurality of linear motor stators 23 are arranged between the two guide rails 22, and the plurality of magnetic sensors 24 are arranged between the linear motor stator 23 and one guide rail 22. ing.
- the linear motor stator 23 is an electromagnet composed of a coil and a core inserted into the coil.
- the slider 4 is provided with a mover composed of a permanent magnet and a back yoke that holds the permanent magnet.
- the linear motor stator 23 applies a magnetic propulsive force to the mover of the slider 4 by generating a magnetic flux corresponding to the applied current, and drives the slider 4 in the X direction.
- a magnetic scale indicating a position in the X direction is attached to the slider 4, and the magnetic sensor 24 detects the position of the slider 4 in the X direction by reading the magnetic scale. Then, as will be described later, the slider 4 is driven in the X direction by feedback-controlling the current applied to the linear motor stator 23 based on the position of the slider 4 detected by the magnetic sensor 24.
- the module unit 20 has a rectangular cover member 25 in a plan view that covers the guide rail 22, the linear motor stator 23, and the magnetic sensor 24 from above.
- the cover member 25 has a support leg 251 projecting downward at the center in the Y direction, and the support leg 251 is attached to the upper surface of the substrate 21.
- a gap is formed between the cover member 25 and the substrate 21, and both ends of the slider 4 that has entered between the cover member 25 and the substrate 21 through this gap are two guide rails 22 respectively. Engage in.
- a linear module M is configured by arranging a plurality (two) of such module units 20 in the X direction.
- the linear module M has a rectangular shape in a plan view.
- the module unit 20 on the X1 side is erected between the base member 3 at the end on the X1 side and the base member 3 at the center of the three base members 3, and X2.
- the module unit 20 on the side is erected between the base member 3 at the end on the X2 side of the three base members 3 and the base member 3 at the center.
- the slider 4 can enter the center side of the linear module M from the end of the linear module M in the X direction and engage with the guide rail 22 of the linear module M. In this way, the slider 4 engaged with the guide rail 22 is driven in the X direction by the linear module M. Further, the slider 4 can be pulled out from the end of the linear module M in the X direction and can be separated from the guide rail 22 of the linear module M.
- FIG. 3 is a diagram schematically showing an example of a linear conveyor system according to the present invention.
- the linear conveyor system 1 includes five linear modules M.
- the five linear modules M are given different codes M1, M2, M3, M4, and M5.
- the linear modules M2, M3, and M4 are fixed linear modules fixed to the installation surface of the linear conveyor system 1, and the linear modules M1 and M5 are movable linear modules that can move in the Y direction with respect to the installation surface.
- the fixed linear modules M2, M3, and M4 and the movable linear modules M1 and M5 have the same width in the Y direction, but have different lengths in the X direction. However, they have the common basic configuration shown in FIGS. 1 and 2, except for the length in the X direction.
- the three fixed linear modules M2, M3, and M4 are arranged parallel to the X direction with an interval in the Y direction.
- the fixed linear modules M2, M3, and M4 arranged in parallel in the X direction thus have the same length in the X direction.
- the movable linear modules M1 and M5 have the same length in the X direction, which is shorter than the fixed linear modules M2, M3 and M4.
- the dimensional relationship between the movable linear modules M1 and M5 and the fixed linear modules M2, M3 and M4 is not limited to this example.
- the linear conveyor system 1 has two actuators 5a and 5b that drive the movable linear modules M1 and M5 in the Y direction.
- the actuator 5a is arranged parallel to the Y direction on the X2 side of the fixed linear modules M2, M3, and M4 in the X direction.
- the actuator 5b is arranged parallel to the Y direction on the X1 side of the fixed linear modules M2, M3, and M4 in the X direction. In this way, the two actuators 5a and 5b are arranged so as to sandwich the three fixed linear modules M2, M3, and M4 from the X direction.
- the actuator 5a is, for example, a single-axis robot equipped with a ball screw parallel to the Y direction, and a movable linear module M1 is attached to the nut of the ball screw of the actuator 5a.
- the actuator 5a drives the movable linear module M1 in the Y direction along the range of motion Ra.
- the movable range Ra is opposed to the facing range Fa2 facing the X2 side end of the fixed linear module M2 from the X2 side in the X direction and facing the X2 side end of the fixed linear module M3 from the X2 side in the X direction.
- the facing range Fa2 corresponds to the existence range of the movable linear module M1 arranged in a line in the X direction with the fixed linear module M2 (including the tolerance of the movable linear module M1), and the facing range Fa3 is in the fixed linear module M3 and the X direction.
- the existing range of the movable linear modules M1 arranged in a row corresponds to the existing range of the movable linear modules M1 arranged in a row in the X direction with the fixed linear module M4 (movable linear). Corresponds to (including the tolerance of module M1).
- the actuator 5b is, for example, a single-axis robot equipped with a ball screw parallel to the Y direction, and a movable linear module M5 is attached to the nut of the ball screw of the actuator 5b.
- the actuator 5b drives the movable linear module M5 in the Y direction along the range of motion Rb.
- the movable range Rb faces the opposite range Fb2 facing the X2 side end of the fixed linear module M2 from the X1 side in the X direction and facing the X1 side end of the fixed linear module M3 from the X1 side in the X direction.
- the facing range Fb2 corresponds to the existence range of the movable linear module M5 arranged in a line in the X direction with the fixed linear module M2 (including the tolerance of the movable linear module M5), and the facing range Fb3 corresponds to the fixed linear module M3 and the X direction.
- the existing range of the movable linear modules M5 arranged in a row corresponds to the existing range of the movable linear modules M4 arranged in a row in the X direction with the fixed linear module M4 (movable linear). (Including the tolerance of module M5).
- the slider 4 can be driven cyclically.
- the fixed linear module M2 drives the slider 4 engaged with the movable linear module M2 to the X1 side in the X direction, so that the slider from the fixed linear module M2 to the movable linear module M5. 4 can be moved.
- the actuator 5b moves the movable linear module M5 from the facing range Fb2 to the facing range Fb4
- the movable linear module M5 located in the facing range Fb4 drives the slider 4 engaged with the movable linear module M5 toward X2 in the X direction.
- the slider 4 can be moved from the movable linear module M5 to the fixed linear module M4.
- the fixed linear module M4 drives the slider 4 engaged with the slider 4 toward the X2 side in the X direction, so that the fixed linear module M4 becomes the movable linear module M1.
- the slider 4 can be moved.
- the actuator 5a moves the movable linear module M1 from the facing range Fa4 to the facing range Fa2
- the movable linear module M1 located in the facing range Fa2 drives the slider 4 engaged with the movable linear module M1 toward the X1 side in the X direction.
- the slider 4 can be moved from the movable linear module M1 to the fixed linear module M2.
- the slider 4 can be driven cyclically clockwise. Further, by executing the operation opposite to the above, the slider 4 can be driven cyclically counterclockwise. Further, such circulation drive is not limited to between the fixed linear module M2 and the fixed linear module M4, but also between the fixed linear module M2 and the fixed linear module M3, and between the fixed linear module M3 and the fixed linear module M4. Can be executed. Further, the circulation drive is only an example of a drive mode of the slider 4 that can be executed by the linear conveyor system 1, and the slider 4 can be driven in various other modes.
- FIG. 4 is a block diagram showing an example of the electrical configuration included in the linear conveyor system of FIG.
- the linear conveyor system 1 includes a control device 11 that controls the position of each slider 4 while monitoring the entire system.
- the control device 11 is a computer such as a personal computer.
- the control device 11 includes a control unit 12, a storage unit 13, and a display 14.
- the control unit 12 is, for example, a processor composed of a CPU (Central Processing Unit), and is responsible for calculations in the control device 11.
- the storage unit 13 is composed of, for example, an HDD (Hard Disk Drive), and stores data and programs used in calculations by the control device 2.
- the storage unit 13 stores a program 18 that causes the control unit 12 of the control device 11 to execute the drive control of FIG. 5, which will be described later.
- This program 18 may be provided in a state of being readable by the control device 11 by a recording medium 19 such as a USB (Universal Serial Bus) memory and installed in the storage unit 13, or may be downloaded from an Internet server and installed in the storage unit. It may be installed in 13.
- the display 14 is, for example, a touch panel display, and functions as a UI (User Interface) that not only displays to the user but also accepts input operations from the user.
- UI User Interface
- the control unit 12 of the control device 11 drives the slider 4 to each of the linear modules M1 to M5 by feedback-controlling the linear motor stator 23 based on the position of the slider 4 detected by the magnetic sensor 24.
- each of the actuators 5a and 5b has a servomotor 51 for rotating the ball screw and an encoder 52 for detecting the rotation position of the servomotor 51, and the control unit 12 servos based on the rotation position detected by the encoder 52.
- the movable linear modules M1 and M5 are driven by the actuators 5a and 5b, respectively.
- the control unit 12 controls the drive of the slider 4 by selectively executing the position control and the speed control for each slider 4. Specifically, the control unit 12 uses the movable linear module M1 based on the deviation between the position detection value Dp and the position command value Ip (FIG. 9) in which the position of the slider 4 is detected by the magnetic sensors 24 of the linear modules M1 to M5. The position of the slider 4 is controlled by executing feedback control for controlling the current supplied to the linear motor stator 23 of M5 (position control). Further, the control unit 12 of the movable linear modules M1 to M5 is based on the deviation between the speed detection value Dv obtained by detecting the speed of the slider 4 by the magnetic sensor 24 of the linear modules M1 to M5 and the speed command value Iv (FIG. 9). The speed of the slider 4 is controlled by executing feedback control for controlling the current supplied to the linear motor stator 23 (speed control).
- one fixed linear module while locating the movable linear modules M1 and M5 in a facing range facing the fixed linear module of one of the plurality of fixed linear modules M2, M3 and M4 arranged in parallel.
- the transfer operation of moving the slider 4 between the movable linear modules M1 and M5 can be executed. Such a delivery operation is controlled as follows.
- FIG. 5 is a flowchart showing an example of drive control for a delivery operation executed by the linear conveyor system shown in FIG. 3, and FIGS. 6 and 7 are an example of initial settings executed by the drive control shown in FIG. It is a diagram schematically showing, FIG. 8 is a diagram schematically showing an example of a transfer operation executed by the drive control shown in FIG. 5, and FIG. 9 is a diagram schematically showing an example of a transfer operation executed by the drive control shown in FIG. It is a figure which shows an example schematically.
- the flowchart of FIG. 5 is executed by the control unit 12 according to the program 18.
- step S101 the coordinate axes A1 to A5 are set for each of the linear modules M1 to M5 (initial setting of the coordinate axes).
- the coordinate axes A1 to A5 have position coordinate values P that increase linearly (that is, with a constant slope SL) according to a change in the position from the X1 side to the X2 side in the X direction, and are individually provided for the linear modules M1 to M5. Is set to.
- the movable linear modules M1 to M5 are connected in series by wiring W in this order, and among these linear modules M1 to M5, the most upstream linear module M1 of the signal path.
- a coordinate setting command is transmitted from the control device 11.
- the linear module M1 that has received the coordinate setting command has its own coordinate axis A1 having a position coordinate value P of "0 to 20" that tilts linearly from the end on the X1 side toward the end on the X2 side in the X direction and increases with SL. Set.
- the linear module M2 that has received the coordinate setting command has its own coordinate axis A2 having a position coordinate value P of "21 to 120" that tilts linearly from the end on the X1 side toward the end on the X2 side in the X direction and increases in SL. Set.
- the minimum value of the position coordinate value P set in the linear module M2 (in other words, the first value of) is a value continuously following the maximum value of the position coordinate value P received from the linear module M1 on the upstream side. It becomes.
- -Coordinate axis A1 having a position coordinate value P of "0 to 20" with respect to the linear module M1.
- -Coordinate axis A2 having a position coordinate value P of "21 to 120" with respect to the linear module M2.
- -Coordinate axis A3 having position coordinate values P of "121 to 220” with respect to the linear module M3.
- -Coordinate axis A4 having a position coordinate value P of "221 to 320” with respect to the linear module M4.
- -Coordinate axis A5 having a position coordinate value P of "321 to 340" with respect to the linear module M5.
- the rate of change in which the position coordinate value P changes with respect to the change in position in the X direction, that is, the inclination is the same on the coordinate axes A1 to A5.
- the drive control of the slider 4 can be executed in the initial setting state Si in which the coordinate axes A1 to A5 are set so that the position coordinate values P indicated by the coordinate axes A1 to A5 of the plurality of linear modules M do not overlap with each other. it can.
- the initial setting of the coordinate axes is completed in this way, it is confirmed whether or not the slider 4 is driven for the delivery operation (step S102). If it is determined in step S102 that the slider 4 is driven (YES), the linear module M (in other words, the movement) in which the coordinate axis A to which the movement start position Ls (that is, the current position) of the slider 4 belongs is set.
- the linear module M) with which the slider 4 that stops at the start position Ls is engaged is specified (step S103). Further, a linear module M (in other words, a linear module M with which the slider 4 that has reached the moving target position Ld is engaged) in which the coordinate axis A to which the moving target position Ld of the slider 4 belongs is specified is specified (step S104). ..
- step S105 the continuity between the coordinate axis A of the linear module M to which the movement start position Ls specified in step S103 belongs and the coordinate axis A of the linear module M to which the movement target position Ld specified in step S104 belongs is determined (step S105). .. Specifically, the position coordinate value P of the end on the movement target position Ld side of the coordinate axis A of the linear module M to which the movement start position Ls belongs and the movement start position Ls side of the coordinate axis A of the linear module M to which the movement target position Ld belongs.
- step S105 it is determined that the coordinate axes A4 and the coordinate axes A5 are continuous (YES), and the position control of the slider 4 is executed in step S106.
- the position profile Fp of FIG. 9 is generated based on the coordinate axes A4 and A5 having the continuous position coordinate values P of "220 to 340".
- the horizontal axis indicates time
- the vertical axis on the left side indicates the position of the slider 4 on the coordinate axes.
- the position profile Fp indicates the time change of the position (in other words, the position command value Ip) of the slider 4 that moves from the movement start position Ls to the movement target position Ld.
- the movable linear module M5 (that is, the opposite position) facing the fixed linear module M2 from the movement start position Ls belonging to the coordinate axis A2 of the fixed linear module M2.
- the slider 4 is driven to the moving target position Ld belonging to the coordinate axis A5 of the movable linear module M5) located in Fb2.
- the coordinate axis A2 of the fixed linear module M2 and the coordinate axis A5 of the movable linear module M5 are discontinuous, and the position of the end E2 on the coordinate axis A5 side of the coordinate axis A2.
- step S105 it is determined that the coordinate axes A2 and the coordinate axes A5 are not continuous (NO), and the process proceeds to step S107.
- it is determined whether the inclination SLb is the same as or different from the inclination SL at each of the coordinate axes A2 and A5. In this example, since the inclination SLb and the inclination SL are different, it is determined that the coordinate axes A2 and the coordinate axes A5 are not continuous.
- step S107 the velocity profile Fv of FIG. 9 is generated.
- the horizontal axis indicates time
- the vertical axis on the right side indicates the speed of the slider 4 on the coordinate axes.
- the speed profile Fv indicates a time change of the speed (in other words, the speed command value Iv) of the slider 4 moving from the movement start position Ls to the movement target position Ld.
- this speed control has a steady deviation, and when the speed control is completed, the slider 4 stops at the stop position La near the movement target position Ld.
- step S108 it is determined whether the speed control of the slider 4 is completed, in other words, whether the slider 4 has stopped. Then, when the slider 4 is stopped and it is determined that the speed control of the slider 4 is completed (“YES” in step S108), the position control is executed on the slider 4 (step S109). That is, as described above, a steady deviation remains between the stop position La of the slider 4 moved by the speed control and the movement target position Ld. Therefore, the control unit 12 moves the slider 4 by position control from the stop position La where the slider 4 stops when the speed control in the delivery operation C is completed to the movement target position Ld. The position of the slider 4 is moved from the fixed linear module M2 to the movable linear module M5 by the speed control accompanying the delivery operation C.
- the position control of the slider 4 is independently executed by the movable linear module M5 to which the slider 4 is moved by the transfer operation among the fixed linear module M2 and the movable linear module M5 used for the transfer operation. Therefore, the discontinuity of the coordinate axes A2 and A5 does not matter in this position control. Then, when the position control is completed and the slider 4 reaches the movement target position Ld, it is determined whether or not to end the drive control (step S110).
- step S110 If the drive control is not terminated (in the case of "NO” in step S110), the process returns to step S102, while if the drive control is terminated (in the case of "YES” in step S110), the flowchart of FIG. 5 is terminated.
- the control unit 12 selectively uses the position control and the speed control according to the continuity of the coordinate axes.
- the control unit 12 has a position command value Ip generated based on the position profile Fp indicating the time change of the position of the slider 4, and a position detection value that detects the position of the slider 4.
- the slider 4 is driven by feedback control based on the deviation from Dp.
- the speed control step S107
- feedback control is performed based on the deviation between the speed command value Iv generated based on the speed profile Fv indicating the time change of the speed of the slider 4 and the speed detection value Dv that detects the speed of the slider 4. Drives the slider 4.
- the movable linear module M5 is positioned in the facing range Fb2 facing the fixed linear module M2 of one of the plurality of linear modules M1 to M5 arranged in parallel, and the fixed linear module M2
- the transfer operation C for moving the slider to and from the movable linear module M5 is executed.
- a determination process for determining whether the coordinate axis A2 (one coordinate axis) of the fixed linear module M2 and the coordinate axis A5 (the other coordinate axis) of the movable linear module M5 are continuous in the X direction is executed (step S105). ..
- Step S107 if it is determined before the transfer operation C that the coordinate axes A2 and the coordinate axes A5 are not continuous, the transfer operation C is executed while executing the speed control (not the position control) for the slider 4 (not the position control). Step S107). Therefore, due to the discontinuity of the coordinate axes A2 and A5 set in the movable linear module M1 and the movable linear module M5, it is possible to suppress the occurrence of a situation in which the transfer operation C for moving the slider 4 cannot be executed between them. ing.
- the control device 11 stops the slider 4 when the speed control is completed.
- the slider 4 is moved by position control from La to the movement target position Ld (step S109).
- the steady-state deviation remaining when the speed control is completed that is, the difference between the stop position La and the movement target position Ld
- the slider 4 can be reliably moved to the movement target position Ld. Can be done.
- the control device 11 determines that the coordinate axis A4 (one coordinate axis) and the coordinate axis A5 (the other coordinate axis) are continuous before the delivery operation C (“YES” in step S105). ), The delivery operation C is executed while controlling the drive of the slider 4 in the transfer operation C by the position control (step S106). That is, when it is determined in the determination process (step S105) that the coordinate axes to which the movement start position Ls and the movement target position Ld belong are continuous, the transfer operation of the slider 4 is executed by the position control, and the determination process (step S105). When it is determined that these coordinate axes are not continuous, the transfer operation of the slider 4 is executed by the speed control.
- control device 11 is positioned so that the position coordinate values P indicated by the coordinate axes A2, A3, A4, A1 and A5 of the plurality of fixed linear modules M2, M3 and M4 and the movable linear modules M1 and M5 do not overlap each other.
- the coordinate value P is set.
- the control of the slider 4 is accurately performed based on the coordinate axes A2, A3, A4, A1, A5, that is, the coordinate axes A2, A3, A4, A1, A5 that uniquely indicate the position in the X direction. be able to.
- the coordinate axes A1 to A5 indicate the position in the X direction by the position coordinate value P which changes linearly with a predetermined inclination according to the change in the position in the X direction.
- the control device 11 has a tilt between the position coordinate value P of the end E2 on the coordinate axis A5 side of the coordinate axis A2 and the position coordinate value P of the end E5 on the coordinate axis A2 side of the coordinate axis A5.
- the linear conveyor system 1 corresponds to an example of the "linear conveyor system” of the present invention
- the control device 11 corresponds to an example of the "control unit” of the present invention
- the program 18 corresponds to the present invention.
- the recording medium 19 corresponds to an example of the "recording medium” of the present invention
- the slider 4 corresponds to an example of the "slider” of the present invention
- the coordinate axes A1 to A5 correspond to an example of the "linear conveyor system control program".
- the coordinate axis A2 corresponds to an example of the "one coordinate axis" of the present invention
- the coordinate axis A5 corresponds to an example of the "other coordinate axis” of the present invention
- the position coordinate value P corresponds to.
- the passing operation C corresponds to an example of the "delivery operation” of the present invention
- the facing ranges Fa2 to Fa4 and Fb2 to Fb4 correspond to an example of the "opposing range” of the present invention.
- the fixed linear modules M2, M3, and M4 correspond to an example of the "fixed linear module” of the present invention
- the fixed linear module M2 corresponds to an example of the "one fixed linear module” of the present invention.
- M1 and M5 correspond to an example of the "movable linear module” of the present invention
- the slider transfer mechanism Ta composed of the movable linear module M1 and the actuator 5a and the slider transfer composed of the movable linear module M5 and the actuator 5b.
- Each of the mounting mechanisms Tb corresponds to an example of the "slider transfer mechanism” of the present invention
- the movement start position Ls corresponds to an example of the "movement start position” of the present invention.
- the moving target position Ld corresponds to an example of the "moving target position" of the present invention
- the X direction corresponds to an example of the "first direction” of the present invention
- the Y direction corresponds to an example of the "second direction” of the present invention.
- the position profile Fp corresponds to an example of the "position profile” of the present invention
- the position command value Ip corresponds to an example of the "position command value” of the present invention
- the position detection value Dp corresponds to the "position detection” of the present invention
- the speed profile Fv corresponds to an example of the "speed profile” of the present invention
- the speed command value Iv corresponds to an example of the "speed command value” of the present invention
- the speed detection value Dv corresponds to the present. It corresponds to an example of the "speed detection value” of the present invention.
- the combination of the movable linear module and the fixed linear module to which the speed control is applied in the delivery operation is not limited to the above example. That is, the combination of the movable linear module M1 and the fixed linear module M3, the combination of the movable linear module M1 and the fixed linear module M4, the combination of the movable linear module M5 and the fixed linear module M2, and the movable linear module M5 and the fixed linear module M3.
- the speed control may be executed. Further, the direction in which the slider 4 moves in the delivery operation may be from the movable linear module M1 to the fixed linear module M3. The same applies to other combinations.
- the setting mode of the coordinate axes A1 to A5 in the initial setting state Si is not limited to the above example, and for example, the position coordinate value P increases in the order of the coordinate axes A5, A4, A3, A2, and A1. May be set.
- the direction in which the fixed linear modules M2, M3, and M4 are arranged is not limited to the Y direction (horizontal direction), and may be the Z direction (vertical direction).
- the actuators 5a and 5b move the movable linear modules M1 and M5 up and down in the Z direction.
- the number and arrangement of the fixed linear module or the movable linear module may be changed as appropriate. Therefore, the fixed linear module M3 may be eliminated. Further, the linear conveyor system 1 is configured so that the slider 4 is moved by an L-shaped path composed of one fixed linear module M2 and one actuator 5a for driving the movable linear module M1. Is also good. Alternatively, from the state of FIG. 3, the fixed linear module M4 may be moved in parallel in the X direction and arranged on the opposite side of the fixed linear modules M2 and M3 with respect to the actuator 5b.
- the direction in which the fixed linear modules Ma and 2b drive the slider 4 and the direction in which the actuators 5c and 5d drive the slider 4 do not necessarily have to be orthogonal to each other and may be tilted.
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Non-Mechanical Conveyors (AREA)
- Control Of Conveyors (AREA)
- Control Of Linear Motors (AREA)
- Intermediate Stations On Conveyors (AREA)
- Linear Motors (AREA)
Abstract
並列に配置された複数のリニアモジュールM1~M5のうちの一の固定リニアモジュールM2に対向する対向範囲Fb2に可動リニアモジュールM5を位置させつつ一の固定リニアモジュールM2と可動リニアモジュールM5との間でスライダーを移動させる受け渡し動作Cが実行される。一の固定リニアモジュールM2の座標軸A2と、可動リニアモジュールM5の座標軸A5とがX方向に連続するかを判断する判断処理が実行される(ステップS105)。判断処理において、座標軸A2、A5が連続しないと受け渡し動作Cの前に判断すると、スライダー4に対して速度制御を実行しつつ受け渡し動作Cが実行される(ステップS107)。よって、可動リニアモジュールM1および可動リニアモジュールM5に設定された座標軸A2、A5の不連続性により、これらの間でスライダー4を移動させる受け渡し動作Cを実行できないという状況の発生が抑制可能となっている。
Description
この発明は、リニアモジュールによりスライダーを駆動する機構を備えたリニアコンベアシステムに関する。
特許文献1では、所定の駆動方向に移動体を駆動する複数のトラックが並列に配置されたリニア駆動搬送システムが開示されている。このシステムは、複数のトラックの間で移動体を移載するジャンクショントラックが設けられている。このジャンクショントラックは、一のトラックに対向しつつ一のトラックから移動体を受け取ったり、あるいはこの逆の動作を実行したりできる。
このように、特許文献1に記載のシステムは、並列に配置された複数の固定リニアモジュール(トラック)の間でスライダー(可動体)を移載するために可動リニアモジュールを用いる。このようなシステムでは、固定リニアモジュールと可動リニアモジュールとの間でスライダーを移動させる受け渡し動作を実行するにあたり、次のような課題が生じる場合があった。
つまり、スライダーの受け渡し動作は、固定リニアモジュールおよび可動リニアモジュールに駆動されるスライダーに対する位置制御により実行できる。かかる位置制御は、固定リニアモジュールおよび可動リニアモジュールのそれぞれに設定された座標軸に基づき実行される。しかしながら、受け渡し動作に係る各リニアモジュールに設定された座標軸が連続しないために、これらの座標軸に基づいて位置制御が行うことができず、スライダーの受け渡し動作が実行できない場合があった。
この発明は上記課題に鑑みなされたものであり、固定リニアモジュールおよび可動リニアモジュールそれぞれに設定された座標軸の不連続性により、これらの間でスライダーを移動させる受け渡し動作を実行できないという状況の発生を抑制可能とする技術の提供を目的とする。
本発明に係るリニアコンベアシステムは、第1方向に駆動されるスライダーと、第1方向に交差する第2方向に配列された複数の固定リニアモジュールと、複数の固定リニアモジュールに第1方向から対向しつつ第2方向に並ぶ複数の対向範囲の間を移動し、第1方向にスライダーを駆動する可動リニアモジュールと、複数の対向範囲の間で可動リニアモジュールを搬送するスライダー移載機構と、第1方向への位置の変化に応じて変化する座標値により第1方向への位置を示す座標軸を、複数の固定リニアモジュールおよび可動リニアモジュールのそれぞれに設定し、固定リニアモジュールおよび可動リニアモジュールにより駆動されるスライダーに対して、座標軸に基づく位置制御を実行する制御部とを備え、スライダーは、第1方向の一端から固定リニアモジュールおよび可動リニアモジュールに対して係合および離脱可能であり、固定リニアモジュールおよび可動リニアモジュールは、係合するスライダーを第1方向に駆動し、固定リニアモジュールと可動リニアモジュールとの間でスライダーを移動させる受け渡し動作が実行され、制御部は、固定リニアモジュールの座標軸である一方座標軸と、可動リニアモジュールの座標軸である他方座標軸とが第1方向に連続するか否かを判断する判断処理を実行した結果、一方座標軸と他方座標軸とが連続しないと受け渡し動作の前に判断すると、受け渡し動作におけるスライダーの駆動を位置制御に代えて、速度指令値に基づきスライダーの速度を制御する速度制御により制御する。
本発明に係るリニアコンベアシステムの制御方法は、第1方向に駆動されるスライダーと、第1方向に交差する第2方向に配列された複数の固定リニアモジュールと、複数の固定リニアモジュールに第1方向から対向しつつ第2方向に並ぶ複数の対向範囲の間を移動し、第1方向にスライダーを駆動する可動リニアモジュールと、複数の対向範囲の間で可動リニアモジュールを搬送するスライダー移載機構とを備えるリニアコンベアシステムの制御方法であって、第1方向への位置の変化に応じて変化する座標値により第1方向への位置を示す座標軸を、複数の固定リニアモジュールおよび可動リニアモジュールのそれぞれに設定する工程と、固定リニアモジュールの座標軸である一方座標軸と、可動リニアモジュールの座標軸である他方座標軸とが第1方向に連続するかを判断する判断処理を実行する工程と、判断処理の結果、一方座標軸と他方座標軸とが連続しないと判断すると、固定リニアモジュールと可動リニアモジュールとの間でスライダーを移動させる受け渡し動作を、速度指令値に基づきスライダーの速度を制御する速度制御により実行する工程とを備える。
本発明に係るリニアコンベアシステムの制御プログラムは、第1方向に駆動されるスライダーと、第1方向に交差する第2方向に配列された複数の固定リニアモジュールと、複数の固定リニアモジュールに第1方向から対向しつつ第2方向に並ぶ複数の対向範囲の間を移動し、第1方向にスライダーを駆動する可動リニアモジュールと、複数の対向範囲の間で可動リニアモジュールを搬送するスライダー移載機構とを備えるリニアコンベアシステムの制御プログラムであって、第1方向への位置の変化に応じて変化する座標値により第1方向への位置を示す座標軸を、複数の固定リニアモジュールおよび可動リニアモジュールのそれぞれに設定する工程と、固定リニアモジュールの座標軸である一方座標軸と、可動リニアモジュールの座標軸である他方座標軸とが第1方向に連続するかを判断する判断処理を実行する工程と、判断処理の結果、一方座標軸と他方座標軸とが連続しないと判断すると、固定リニアモジュールと可動リニアモジュールとの間でスライダーを移動させる受け渡し動作を、速度指令値に基づきスライダーの速度を制御する速度制御により実行する工程とをコンピューターに実行させる。
本発明に係る記録媒体は、上記のリニアコンベアシステムの制御プログラムを、コンピューターにより読み出し可能に記録する。
このように構成された本発明(リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体)では、固定リニアモジュールと可動リニアモジュールとの間でスライダーを移動させる受け渡し動作が実行される。この際、固定リニアモジュールの座標軸である一方座標軸と、可動リニアモジュールの座標軸である他方座標軸とが第1方向に連続するかを判断する判断処理が実行される。そして、判断処理において、一方座標軸と他方座標軸とが連続しないと受け渡し動作の前に判断すると、速度指令値に基づきスライダーの速度を制御する速度制御(位置制御ではなく)を実行しつつ受け渡し動作が実行される。したがって、固定リニアモジュールおよび可動リニアモジュールそれぞれに設定された座標軸の不連続性により、これらの間でスライダーを移動させる受け渡し動作を実行できないという状況の発生が抑制可能となっている。
具体的には、制御部は、位置制御では、スライダーの位置の時間変化を示す位置プロファイルに基づき生成した位置指令値と、スライダーの位置を検出した位置検出値との偏差に基づくフィードバック制御によりスライダーを駆動する一方、速度制御では、スライダーの速度の時間変化を示す速度プロファイルに基づき生成した速度指令値と、スライダーの速度を検出した速度検出値との偏差に基づくフィードバック制御によりスライダーを駆動するように、リニアコンベアシステムを構成してもよい。このように、位置プロファイルおよび速度プロファイルによって、スライダーの位置制御および速度制御を的確に実行することができる。
また、制御部は、移動開始位置から移動目標位置へ向けてスライダーを移動させる受け渡し動作において速度制御を完了すると、速度制御の完了時にスライダーが停止する停止位置から移動目標位置まで、位置制御によりスライダーを移動させるように、リニアコンベアシステムを構成してもよい。かかる構成では、速度制御の完了時に残る定常偏差(すなわち、停止位置と移動目標位置との差)を位置制御により解消することができ、スライダーを移動目標位置に確実に移動させることができる。
また、制御部は、判断処理を実行した結果、一方座標軸と他方座標軸とが連続すると受け渡し動作の前に判断すると、受け渡し動作におけるスライダーの駆動を位置制御により制御するように、リニアコンベアシステムを構成してもよい。かかる構成では、判断処理で座標軸が連続すると判断された場合には、スライダーの受け渡し動作が位置制御により実行され、判断処理で座標軸が連続しないと判断された場合には、スライダーの受け渡し動作が速度制御により実行される。したがって、固定リニアモジュールおよび可動リニアモジュールそれぞれに設定された座標軸の不連続性により、これらの間でスライダーを移動させる受け渡し動作を実行できないという状況の発生が抑制可能となっている。
制御部は、複数の固定リニアモジュールおよび可動リニアモジュールのそれぞれの座標軸が示す座標値が互いに重複しないように座標軸を設定するように、リニアコンベアシステムを構成してもよい。かかる構成では、スライダーに対する制御を、重複のない座標軸、換言すれば第1方向における位置を一意に示す座標軸に基づき的確に行うことができる。
また、座標軸は、第1方向への位置の変化に応じて所定の傾きで線形に変化する座標値により第1方向への位置を示すように、リニアコンベアシステムを構成してもよい。この際、制御部は、一方座標軸における他方座標軸側の端の座標値と、他方座標軸における一方座標軸側の端の座標値との間の傾きが、所定の傾きと異なる場合に、一方座標軸と他方座標軸とが連続しないと判断するように、リニアコンベアシステムを構成してもよい。これによって、座標軸の連続性を簡便に判断することができる。
本発明によれば、固定リニアモジュールおよび可動リニアモジュールそれぞれに設定された座標軸の不連続性により、これらの間でスライダーを移動させる受け渡し動作を実行できないという状況の発生を抑制することが可能となる。
図1は本発明に係るリニアコンベアシステムが備えるリニアモジュールの一例を示す斜視図であり、図2は図1のリニアモジュールの内部を部分的に露出させて示す斜視図である。図1および図2では、水平方向に平行なX方向、X方向に直交しつつ水平方向に平行なY方向および鉛直方向に平行なZ方向を有するXYZ直交座標軸が表記されている。さらに、X方向に沿って両図の右斜め上側がX1側と表記され、X方向に沿って両図の左斜め下側がX2側と表記されている。同様の表記は、以下の図においても適宜用いられる。このリニアモジュールは、例えばWO2018/055709A1に記載のリニアコンベア装置のモジュールと同様の基本構成を具備する。ここでは、リニアモジュールの説明を行ってから、リニアコンベアシステムの全体の説明を行う。
図1および図2では、X方向に延設されたリニアモジュールMと、リニアモジュールMを下側から支持するベース部材3と、リニアモジュールMに係合するスライダー4とが示されている。リニアモジュールMは、X方向に等間隔で並ぶ3個のベース部材3の上端に取り付けられており、磁力によってスライダー4をX方向に駆動する。ここの例では、リニアモジュールMは、X方向に配列された2個のモジュールユニット20で構成される。ただし、リニアモジュールMを構成するモジュールユニット20の個数は、2個に限られず、1個あるいは3個以上でもよい。
モジュールユニット20は、X方向に延設された基板21を有する。基板21はZ方向からの平面視で矩形状を有する平板である。基板21の上面には、X方向に平行な2本のガイドレール22がY方向に間隔を空けて配置されている。さらに、基板21の上面には、所定の配列ピッチP23でX方向に一列に並ぶ複数のリニアモーター固定子23と、所定の配列ピッチP24でX方向に一列に並ぶ複数の磁気センサー24とが取り付けられている。ここで、リニアモーター固定子23の配列ピッチP23よりも、磁気センサー24の配列ピッチP24の方が長い。Y方向において、複数のリニアモーター固定子23は、2本のガイドレール22の間に配置され、複数の磁気センサー24は、リニアモーター固定子23と1本のガイドレール22との間に配置されている。
リニアモーター固定子23は、コイルと当該コイルに挿入されたコアとで構成された電磁石である。一方、スライダー4には、永久磁石と当該永久磁石を保持するバックヨークで構成された可動子が設けられている。リニアモーター固定子23は、印加された電流に応じた磁束を発生することでスライダー4の可動子に磁気的な推進力を与えて、スライダー4をX方向に駆動する。また、スライダー4には、X方向への位置を示す磁気スケールが取り付けられており、磁気センサー24は、磁気スケールを読み取ることでスライダー4のX方向への位置を検出する。そして、後述するように、磁気センサー24が検出したスライダー4の位置に基づきリニアモーター固定子23に印加する電流をフィードバック制御することで、スライダー4をX方向に駆動する。
また、モジュールユニット20は、これらガイドレール22、リニアモーター固定子23および磁気センサー24を上側から覆う、平面視で矩形状のカバー部材25を有する。カバー部材25は、Y方向の中央で下方に突出する支持脚251を有し、支持脚251が基板21の上面に取り付けられる。Y方向の両端において、カバー部材25と基板21との間には隙間が形成され、この隙間からカバー部材25と基板21との間に入り込んだスライダー4の両端部がそれぞれ2本のガイドレール22に係合する。
このようなモジュールユニット20を複数(2個)X方向に配列することで、リニアモジュールMが構成される。かかるリニアモジュールMは、平面視において矩形状を有する。リニアモジュールMの2個のモジュールユニット20のうち、X1側のモジュールユニット20は3個のベース部材3のうちX1側の端のベース部材3と中央のベース部材3との間に架設され、X2側のモジュールユニット20は3個のベース部材3のうちX2側の端のベース部材3と中央のベース部材3との間に架設される。
スライダー4は、X方向においてリニアモジュールMの端からリニアモジュールMの中央側に進入して、リニアモジュールMのガイドレール22に係合することができる。こうして、ガイドレール22に係合したスライダー4は、リニアモジュールMによってX方向に駆動される。また、スライダー4は、X方向においてリニアモジュールMの端から外側に抜けて、リニアモジュールMのガイドレール22から離脱することができる。
図3は本発明に係るリニアコンベアシステムの一例を模式的に示す図である。リニアコンベアシステム1は、5台のリニアモジュールMを備える。なお、同図では、5台のリニアモジュールMに対して互いに異なる符合M1、M2、M3、M4、M5が付されている。
リニアモジュールM2、M3、M4はリニアコンベアシステム1の設置面に固定された固定リニアモジュールであり、リニアモジュールM1、M5は設置面に対してY方向に動くことができる可動リニアモジュールである。固定リニアモジュールM2、M3、M4と、可動リニアモジュールM1、M5とは、Y方向に同一の幅を有する一方、X方向において異なる長さを有する。ただし、これらは、X方向における長さを除いて、図1および図2に示した共通の基本構成を有する。
3個の固定リニアモジュールM2、M3、M4は、Y方向に間隔を空けつつX方向に平行に配置されている。こうしてX方向に並列に配置された固定リニアモジュールM2、M3、M4は、X方向に同一の長さを有する。一方、可動リニアモジュールM1、M5は、X方向において、固定リニアモジュールM2、M3、M4よりも短い、同一の長さを有する。ただし、可動リニアモジュールM1、M5および固定リニアモジュールM2、M3、M4の寸法関係はここの例には限られない。
かかるリニアコンベアシステム1は、可動リニアモジュールM1、M5をY方向に駆動する2個のアクチュエーター5a、5bを有する。アクチュエーター5aは、固定リニアモジュールM2、M3、M4のX方向のX2側で、Y方向に平行に配置される。アクチュエーター5bは、固定リニアモジュールM2、M3、M4のX方向のX1側で、Y方向に平行に配置される。このように、2個のアクチュエーター5a、5bは、X方向から3個の固定リニアモジュールM2、M3、M4を挟むように配置されている。
アクチュエーター5aは、例えばY方向に平行なボールネジを備えた単軸ロボットであり、アクチュエーター5aのボールネジのナットに可動リニアモジュールM1が取り付けられている。このアクチュエーター5aは、可動域Raに沿ってY方向に可動リニアモジュールM1を駆動する。ここで、可動域Raは、X方向においてX2側から固定リニアモジュールM2のX2側の端に対向する対向範囲Fa2と、X方向においてX2側から固定リニアモジュールM3のX2側の端に対向する対向範囲Fa3と、X方向においてX2側から固定リニアモジュールM4のX2側の端に対向する対向範囲Fa4とを含み、Y方向に延びる領域である。対向範囲Fa2は、固定リニアモジュールM2とX方向に一列に並ぶ可動リニアモジュールM1の存在範囲(可動リニアモジュールM1の公差を含む)に相当し、対向範囲Fa3は、固定リニアモジュールM3とX方向に一列に並ぶ可動リニアモジュールM1の存在範囲(可動リニアモジュールM1の公差を含む)に相当し、対向範囲Fa4は、固定リニアモジュールM4とX方向に一列に並ぶ可動リニアモジュールM1の存在範囲(可動リニアモジュールM1の公差を含む)に相当する。
アクチュエーター5bは、例えばY方向に平行なボールネジを備えた単軸ロボットであり、アクチュエーター5bのボールネジのナットに可動リニアモジュールM5が取り付けられている。このアクチュエーター5bは、可動域Rbに沿ってY方向に可動リニアモジュールM5を駆動する。ここで、可動域Rbは、X方向においてX1側から固定リニアモジュールM2のX2側の端に対向する対向範囲Fb2と、X方向においてX1側から固定リニアモジュールM3のX1側の端に対向する対向範囲Fb3と、X方向においてX1側から固定リニアモジュールM4のX1側の端に対向する対向範囲Fb4とを含み、Y方向に延びる領域である。対向範囲Fb2は、固定リニアモジュールM2とX方向に一列に並ぶ可動リニアモジュールM5の存在範囲(可動リニアモジュールM5の公差を含む)に相当し、対向範囲Fb3は、固定リニアモジュールM3とX方向に一列に並ぶ可動リニアモジュールM5の存在範囲(可動リニアモジュールM5の公差を含む)に相当し、対向範囲Fb4は、固定リニアモジュールM4とX方向に一列に並ぶ可動リニアモジュールM4の存在範囲(可動リニアモジュールM5の公差を含む)に相当する。
このようなリニアコンベアシステム1では、スライダー4を循環的に駆動することができる。例えば可動リニアモジュールM5が対向範囲Fb2内に位置する状態で、固定リニアモジュールM2がそれに係合するスライダー4をX方向のX1側に駆動することで、固定リニアモジュールM2から可動リニアモジュールM5にスライダー4を移動させることができる。そして、アクチュエーター5bが対向範囲Fb2から対向範囲Fb4に可動リニアモジュールM5を移動させてから、対向範囲Fb4内に位置する可動リニアモジュールM5がそれに係合するスライダー4をX方向のX2側に駆動することで、可動リニアモジュールM5から固定リニアモジュールM4にスライダー4を移動させることができる。
さらに、可動リニアモジュールM1が対向範囲Fa4内に位置する状態で、固定リニアモジュールM4がそれに係合するスライダー4をX方向のX2側に駆動することで、固定リニアモジュールM4から可動リニアモジュールM1にスライダー4を移動させることができる。そして、アクチュエーター5aが対向範囲Fa4から対向範囲Fa2に可動リニアモジュールM1を移動させてから、対向範囲Fa2内に位置する可動リニアモジュールM1がそれに係合するスライダー4をX方向のX1側に駆動することで、可動リニアモジュールM1から固定リニアモジュールM2にスライダー4を移動させることができる。
こうして、スライダー4を時計回りに循環的に駆動することができる。また、上記と逆の動作を実行することで、スライダー4を反時計回りに循環的に駆動することができる。さらに、かかる循環駆動は、固定リニアモジュールM2と固定リニアモジュールM4との間に限られず、固定リニアモジュールM2と固定リニアモジュールM3の間や、固定リニアモジュールM3と固定リニアモジュールM4との間でも同様に実行できる。また、循環駆動は、リニアコンベアシステム1で実行可能なスライダー4の駆動態様の一例に過ぎず、他の種々の態様でスライダー4を駆動することができる。
図4は図3のリニアコンベアシステムが備える電気的構成の一例を示すブロック図である。リニアコンベアシステム1は、システム全体を監視しつつ各スライダー4の位置を制御する制御装置11を備える。この制御装置11は、例えばパーソナルコンピューター等のコンピューターである。
制御装置11は、制御部12、記憶部13およびディスプレイ14を備える。制御部12は例えばCPU(Central Processing Unit)で構成されたプロセッサーであり、制御装置11での演算を担う。記憶部13は例えばHDD(Hard Disk Drive)で構成され、制御装置2での演算で用いられるデータやプログラムを記憶する。特に、記憶部13は、後述する図5の駆動制御を制御装置11の制御部12に実行させるプログラム18を記憶する。このプログラム18は、USB(Universal Serial Bus)メモリー等の記録媒体19により、制御装置11により読み出し可能な状態で提供されて記憶部13にインストールされてもよいし、インターネットサーバーからダウンロードされて記憶部13にインストールされてもよい。ディスプレイ14は、例えばタッチパネルディスプレイであり、ユーザーへの表示を行うのみならず、ユーザーからの入力操作も受け付けるUI(User Interface)として機能する。
かかる制御装置11の制御部12は、磁気センサー24が検出したスライダー4の位置に基づきリニアモーター固定子23をフィードバック制御することで、リニアモジュールM1~M5のそれぞれにスライダー4を駆動させる。また、アクチュエーター5a、5bのそれぞれは、ボールネジを回転させるサーボモーター51と、サーボモーター51の回転位置を検出するエンコーダー52とを有し、制御部12は、エンコーダー52が検出した回転位置に基づきサーボモーター51をフィードバック制御することで、アクチュエーター5a、5bのそれぞれに可動リニアモジュールM1、M5を駆動させる。
かかる制御部12は、各スライダー4に対して位置制御と速度制御とを選択的に実行することで、スライダー4の駆動を制御する。具体的には、制御部12は、リニアモジュールM1~M5の磁気センサー24によりスライダー4の位置を検出した位置検出値Dpと位置指令値Ip(図9)との偏差に基づき、可動リニアモジュールM1~M5のリニアモーター固定子23に供給する電流を制御するフィードバック制御を実行することで、スライダー4の位置を制御する(位置制御)。また、制御部12は、リニアモジュールM1~M5の磁気センサー24によりスライダー4の速度を検出した速度検出値Dvと速度指令値Iv(図9)との偏差に基づき、可動リニアモジュールM1~M5のリニアモーター固定子23に供給する電流を制御するフィードバック制御を実行することで、スライダー4の速度を制御する(速度制御)。
特に本実施形態では、並列に配置された複数の固定リニアモジュールM2、M3、M4のうちの一の固定リニアモジュールに対向する対向範囲に可動リニアモジュールM1、M5を位置させつつ一の固定リニアモジュールと可動リニアモジュールM1、M5との間でスライダー4を移動させる受け渡し動作を実行できる。かかる受け渡し動作は、次のようにして制御される。
図5は図3に示すリニアコンベアシステムで実行される受け渡し動作のための駆動制御の一例を示すフローチャートであり、図6および図7は図5に示す駆動制御で実行される初期設定の一例を模式的に示す図であり、図8は図5に示す駆動制御で実行される受け渡し動作の一例を模式的に示す図であり、図9は図5の駆動制御で用いられる位置・速度プロファイルの一例を模式的に示す図である。図5のフローチャートは、制御部12によりプログラム18に従って実行される。
ステップS101では、リニアモジュールM1~M5のそれぞれに座標軸A1~A5が設定される(座標軸の初期設定)。座標軸A1~A5は、X方向のX1側からX2側へ向かう位置の変化に応じて線形に(すなわち、一定の傾きSLで)増加する位置座標値Pを有し、リニアモジュールM1~M5に個別に設定される。具体的には、図6に示すように、可動リニアモジュールM1~M5は、この順番で配線Wにより直列に接続されており、これらリニアモジュールM1~M5のうち信号経路の最上流のリニアモジュールM1に座標設定指令が制御装置11から送信される。座標設定指令を受けたリニアモジュールM1は、X方向においてX1側の端からX2側の端に向かって線形に傾きSLで増加する「0~20」の位置座標値Pを有する座標軸A1を自身に設定する。座標軸A1の設定が完了すると、リニアモジュールM1はリニアモジュールM2に、位置座標値Pの最大値(=20)とともに座標設定指令を送信する。座標設定指令を受けたリニアモジュールM2は、X方向においてX1側の端からX2側の端に向かって線形に傾きSLで増加する「21~120」の位置座標値Pを有する座標軸A2を自身に設定する。なお、リニアモジュールM2に設定される位置座標値Pの最小値(換言すれば、の最初の値)は、上流側のリニアモジュールM1から受信した位置座標値Pの最大値に連続的に続く値となる。座標軸A2の設定が完了すると、リニアモジュールM2はリニアモジュールM3に、位置座標値Pの最大値(=120)とともに座標設定指令を送信する。
これを繰り返すことで、
・リニアモジュールM1に対して「0~20」の位置座標値Pを有する座標軸A1
・リニアモジュールM2に対して「21~120」の位置座標値Pを有する座標軸A2
・リニアモジュールM3に対して「121~220」の位置座標値Pを有する座標軸A3
・リニアモジュールM4に対して「221~320」の位置座標値Pを有する座標軸A4
・リニアモジュールM5に対して「321~340」の位置座標値Pを有する座標軸A5
がそれぞれ設定される。なお、X方向への位置の変化に対して位置座標値Pが変化する変化率、すなわち傾きは、座標軸A1~A5で同一である。
・リニアモジュールM1に対して「0~20」の位置座標値Pを有する座標軸A1
・リニアモジュールM2に対して「21~120」の位置座標値Pを有する座標軸A2
・リニアモジュールM3に対して「121~220」の位置座標値Pを有する座標軸A3
・リニアモジュールM4に対して「221~320」の位置座標値Pを有する座標軸A4
・リニアモジュールM5に対して「321~340」の位置座標値Pを有する座標軸A5
がそれぞれ設定される。なお、X方向への位置の変化に対して位置座標値Pが変化する変化率、すなわち傾きは、座標軸A1~A5で同一である。
これによって、複数のリニアモジュールMのそれぞれの座標軸A1~A5が示す位置座標値Pが互いに重複しないように座標軸A1~A5が設定された初期設定状態Siでスライダー4の駆動制御を実行することができる。こうして座標軸の初期設定が完了すると、受け渡し動作のためにスライダー4の駆動を実行するかが確認される(ステップS102)。ステップS102で、スライダー4の駆動を実行する(YES)と判断されると、スライダー4の移動開始位置Ls(すなわち、現在位置)が属する座標軸Aが設定されたリニアモジュールM(換言すれば、移動開始位置Lsに停止するスライダー4が係合するリニアモジュールM)が特定される(ステップS103)。また、スライダー4の移動目標位置Ldが属する座標軸Aが設定されたリニアモジュールM(換言すれば、移動目標位置Ldに到達したスライダー4が係合するリニアモジュールM)が特定される(ステップS104)。
そして、ステップS103で特定した移動開始位置Lsが属するリニアモジュールMの座標軸Aと、ステップS104で特定した移動目標位置Ldが属するリニアモジュールMの座標軸Aとの連続性が判断される(ステップS105)。具体的には、移動開始位置Lsが属するリニアモジュールMの座標軸Aの移動目標位置Ld側の端の位置座標値Pと、移動目標位置Ldが属するリニアモジュールMの座標軸Aの移動開始位置Ls側の端の位置座標値Pとを結ぶ直線の傾き傾きSLbが、座標軸A(A1~A5)での位置座標値Pの変化率を示す傾き傾きSLと一致する場合は連続と判断され、そうでない場合は不連続と判断される。
例えば、固定リニアモジュールM4から、当該固定リニアモジュールM4に対向する可動リニアモジュールM5(すなわち、対向位置Fb4内に位置する可動リニアモジュールM5)へスライダー4を駆動する場合には、固定リニアモジュールM4の座標軸A4と、可動リニアモジュールM5の座標軸A5とは連続する。そのため、ステップS105では、座標軸A4と座標軸A5とは連続する(YES)と判断され、ステップS106でスライダー4の位置制御が実行される。
このステップS106では、「220~340」の連続した位置座標値Pを有する座標軸A4、A5に基づき、図9の位置プロファイルFpが生成される。図9のグラフでは、横軸が時間を示し、左側の縦軸が座標軸におけるスライダー4の位置を示す。同図に示すように、位置プロファイルFpは、移動開始位置Lsから移動目標位置Ldまで移動するスライダー4の位置(換言すれば、位置指令値Ip)の時間変化を示す。そして、この位置プロファイルFpが示す各時刻tでの位置指令値Ipと、スライダー4の位置を検出する磁気センサー24による位置検出値Dpとの偏差(=Ip-Dp)に基づきスライダー4の位置がフィードバック制御される。こうして、スライダー4の位置を位置指令値Ipに追従させるサーボ制御が実行される。そして、スライダー4が移動目標位置Ldに到達すると、駆動制御を終了するか否かが判断される(ステップS110)。
一方、図8の「受け渡し動作C」の欄に示す駆動態様では、固定リニアモジュールM2の座標軸A2に属する移動開始位置Lsから、当該固定リニアモジュールM2に対向する可動リニアモジュールM5(すなわち、対向位置Fb2内に位置する可動リニアモジュールM5)の座標軸A5に属する移動目標位置Ldにスライダー4が駆動される。この場合、図8の「座標軸」の欄に示すように、固定リニアモジュールM2の座標軸A2と、可動リニアモジュールM5の座標軸A5とは不連続であり、座標軸A2の座標軸A5側の端E2の位置座標値Pと、座標軸A5の座標軸A2側の端E5の位置座標値Pとの間には、ギャップGが存在する。したがって、ステップS105では、座標軸A2と座標軸A5とは連続しない(NO)と判断され、ステップS107に進む。
具体的には、受け渡し動作Cの例では、座標軸A2(一方座標軸)における座標軸A5(他方座標軸)側の端E2の座標値P2(x2、y2)と、座標軸A5(他方座標軸)における座標軸A2(一方座標軸)側の端E5の座標値P5(x5、y5)との間の傾きSLb(=(y5-y2)/(x5―x2))が算出される。そして、傾きSLbが各座標軸A2、A5における上記傾きSLと同じか、異なるかが判断される。ここの例では、傾きSLbと傾きSLとは異なるため、座標軸A2と座標軸A5とは連続しないと判断される。
ステップS107では、図9の速度プロファイルFvが生成される。図9のグラフでは、横軸が時間を示し、右側の縦軸が座標軸におけるスライダー4の速度を示す。同図に示すように、速度プロファイルFvは、移動開始位置Lsから移動目標位置Ldに向けて移動するスライダー4の速度(換言すれば、速度指令値Iv)の時間変化を示す。ただし、この速度制御は定常偏差を有しており、速度制御の完了時点において、スライダー4は移動目標位置Ldの近傍の停止位置Laに停止する。そして、この速度プロファイルFvが示す各時刻tでの速度指令値Ivと、スライダー4の速度を検出する磁気センサー24による速度検出値Dvとの偏差(=Iv-Dv)に基づきスライダー4の速度がフィードバック制御される。こうして、スライダー4の速度を速度指令値Ivに追従させるサーボ制御が実行される。
ステップS108では、スライダー4の速度制御が完了した、換言すればスライダー4が停止したかが判断される。そして、スライダー4が停止して、スライダー4の速度制御が完了したと判断されると(ステップS108で「YES」)、このスライダー4に位置制御が実行される(ステップS109)。つまり、上述の通り、速度制御によって移動されたスライダー4の停止位置Laと移動目標位置Ldとの間には定常偏差が残る。そこで、制御部12は、受け渡し動作Cにおける速度制御の完了時にスライダー4が停止する停止位置Laから移動目標位置Ldまで、位置制御によりスライダー4を移動させる。なお、受け渡し動作Cに伴う速度制御によって、スライダー4の位置は、固定リニアモジュールM2から可動リニアモジュールM5に移動している。つまり、スライダー4の位置制御は、受け渡し動作に供する固定リニアモジュールM2と可動リニアモジュールM5とのうち、受け渡し動作によるスライダー4の移動先の可動リニアモジュールM5によって単独で実行される。そのため、座標軸A2、A5の不連続性は、この位置制御では問題とならない。そして、位置制御が完了して、スライダー4が移動目標位置Ldに到達すると、駆動制御を終了するか否かが判断される(ステップS110)。
駆動制御を終了しない場合(ステップS110で「NO」の場合)にはステップS102に戻る一方、駆動制御を終了する場合(ステップS110で「YES」の場合)には図5のフローチャートを終了する。
このように、制御部12は、座標軸の連続性に応じて位置制御と速度制御を選択的に用いる。具体的には、制御部12は、位置制御(ステップS106)では、スライダー4の位置の時間変化を示す位置プロファイルFpに基づき生成した位置指令値Ipと、スライダー4の位置を検出した位置検出値Dpとの偏差に基づくフィードバック制御によりスライダー4を駆動する。一方、速度制御(ステップS107)では、スライダー4の速度の時間変化を示す速度プロファイルFvに基づき生成した速度指令値Ivと、スライダー4の速度を検出した速度検出値Dvとの偏差に基づくフィードバック制御によりスライダー4を駆動する。
以上に示した例では、並列に配置された複数のリニアモジュールM1~M5のうちの一の固定リニアモジュールM2に対向する対向範囲Fb2に可動リニアモジュールM5を位置させつつ一の固定リニアモジュールM2と可動リニアモジュールM5との間でスライダーを移動させる受け渡し動作Cが実行される。この際、一の固定リニアモジュールM2の座標軸A2(一方座標軸)と、可動リニアモジュールM5の座標軸A5(他方座標軸)とがX方向に連続するかを判断する判断処理が実行される(ステップS105)。そして、判断処理において、座標軸A2と座標軸A5とが連続しないと受け渡し動作Cの前に判断すると、スライダー4に対して速度制御(位置制御ではなく)を実行しつつ受け渡し動作Cが実行される(ステップS107)。したがって、可動リニアモジュールM1および可動リニアモジュールM5それぞれに設定された座標軸A2、A5の不連続性により、これらの間でスライダー4を移動させる受け渡し動作Cを実行できないという状況の発生が抑制可能となっている。
また、制御装置11は、移動開始位置Lsから移動目標位置Ldへスライダー4を移動させる受け渡し動作Cにおいて速度制御(ステップS107、S108)を完了すると、速度制御の完了時にスライダー4が停止する停止位置Laから移動目標位置Ldまで、位置制御によりスライダー4を移動させる(ステップS109)。かかる構成では、速度制御の完了時に残る定常偏差(すなわち、停止位置Laと移動目標位置Ldとの差)を位置制御により解消することができ、スライダー4を移動目標位置Ldに確実に移動させることができる。
また、制御装置11は、判断処理(ステップS105)を実行した結果、座標軸A4(一方座標軸)と座標軸A5(他方座標軸)とが連続すると受け渡し動作Cの前に判断すると(ステップS105で「YES」)、受け渡し動作Cにおけるスライダー4の駆動を位置制御により制御しつつ、受け渡し動作Cを実行する(ステップS106)。つまり、判断処理(ステップS105)で移動開始位置Lsおよび移動目標位置Ldがそれぞれ属する座標軸が連続すると判断された場合には、スライダー4の受け渡し動作が位置制御により実行され、判断処理(ステップS105)でこれらの座標軸が連続しないと判断された場合には、スライダー4の受け渡し動作が速度制御により実行される。したがって、固定リニアモジュールM2、M3、M4および可動リニアモジュールM1、M5それぞれに設定された座標軸A2、A3、A4、A1、A5の不連続性により、これらの間でスライダー4を移動させる受け渡し動作を実行できないという状況の発生が抑制可能となっている。
また、制御装置11は、複数の固定リニアモジュールM2、M3、M4および可動リニアモジュールM1、M5のそれぞれの座標軸A2、A3、A4、A1、A5が示す位置座標値Pが互いに重複しないように位置座標値Pを設定する。かかる構成では、スライダー4に対する制御を、重複のない座標軸A2、A3、A4、A1、A5、換言すればX方向における位置を一意に示す座標軸A2、A3、A4、A1、A5に基づき的確に行うことができる。
また、座標軸A1~A5は、X方向への位置の変化に応じて所定の傾きで線形に変化する位置座標値PによりX方向への位置を示す。そして、上記の例では、制御装置11は、座標軸A2における座標軸A5側の端E2の位置座標値Pと、座標軸A5における座標軸A2側の端E5の位置座標値Pとの間の傾きが、各座標軸A1~A5での位置座標値Pの傾きと異なる場合に、座標軸A2と座標軸A5とが連続しないと判断する。これによって、座標軸A2、A5の連続性を簡便に判断することができる。
このように本実施形態では、リニアコンベアシステム1が本発明の「リニアコンベアシステム」の一例に相当し、制御装置11が本発明の「制御部」の一例に相当し、プログラム18が本発明の「リニアコンベアシステムの制御プログラム」の一例に相当し、記録媒体19が本発明の「記録媒体」の一例に相当し、スライダー4が本発明の「スライダー」の一例に相当し、座標軸A1~A5が本発明の「座標軸」の一例に相当し、座標軸A2が本発明の「一方座標軸」の一例に相当し、座標軸A5が本発明の「他方座標軸」の一例に相当し、位置座標値Pが本発明の「座標値」の一例に相当し、受け渡し動作Cが本発明の「受け渡し動作」の一例に相当し、対向範囲Fa2~Fa4、Fb2~Fb4が本発明の「対向範囲」の一例に相当し、固定リニアモジュールM2、M3、M4が本発明の「固定リニアモジュール」の一例に相当し、固定リニアモジュールM2が本発明の「一の固定リニアモジュール」の一例に相当し、可動リニアモジュールM1、M5が本発明の「可動リニアモジュール」の一例に相当し、可動リニアモジュールM1とアクチュエーター5aとで構成されるスライダー移載機構Taおよび可動リニアモジュールM5とアクチュエーター5bとで構成されるスライダー移載機構Tbのそれぞれが本発明の「スライダー移載機構」の一例の相当し、移動開始位置Lsが本発明の「移動開始位置」の一例に相当し、
移動目標位置Ldが本発明の「移動目標位置」の一例に相当し、X方向が本発明の「第1方向」の一例に相当し、Y方向が本発明の「第2方向」の一例に相当し、位置プロファイルFpが本発明の「位置プロファイル」の一例に相当し、位置指令値Ipが本発明の「位置指令値」の一例に相当し、位置検出値Dpが本発明の「位置検出値」の一例に相当し、速度プロファイルFvが本発明の「速度プロファイル」の一例に相当し、速度指令値Ivが本発明の「速度指令値」の一例に相当し、速度検出値Dvが本発明の「速度検出値」の一例に相当する。
移動目標位置Ldが本発明の「移動目標位置」の一例に相当し、X方向が本発明の「第1方向」の一例に相当し、Y方向が本発明の「第2方向」の一例に相当し、位置プロファイルFpが本発明の「位置プロファイル」の一例に相当し、位置指令値Ipが本発明の「位置指令値」の一例に相当し、位置検出値Dpが本発明の「位置検出値」の一例に相当し、速度プロファイルFvが本発明の「速度プロファイル」の一例に相当し、速度指令値Ivが本発明の「速度指令値」の一例に相当し、速度検出値Dvが本発明の「速度検出値」の一例に相当する。
なお、本発明は上記実施形態に限定されるものではなく、その趣旨を逸脱しない限りにおいて上述したものに対して種々の変更を加えることが可能である。例えば、受け渡し動作において速度制御を適用する可動リニアモジュールと固定リニアモジュールとの組み合わせは上記の例に限られない。つまり、可動リニアモジュールM1と固定リニアモジュールM3との組み合わせ、可動リニアモジュールM1と固定リニアモジュールM4との組み合わせ、可動リニアモジュールM5と固定リニアモジュールM2との組み合わせおよび可動リニアモジュールM5と固定リニアモジュールM3との組み合わせで受け渡し動作を行う際には、速度制御を実行すればよい。さらに、受け渡し動作でスライダー4が移動する方向は、可動リニアモジュールM1から固定リニアモジュールM3であってもよい。他の組み合わせについても同様である。
また、初期設定状態Siでの座標軸A1~A5の設定態様は上記の例に限られず、例えば、座標軸A5、A4、A3、A2、A1の順に位置座標値Pが増加するように位置座標値Pを設定してもよい。
また、固定リニアモジュールM2、M3、M4が配列される方向はY方向(水平方向)に限られず、Z方向(鉛直方向)でも構わない。この場合、アクチュエーター5a、5bはZ方向に可動リニアモジュールM1、M5を昇降させる。
また、固定リニアモジュールあるいは可動リニアモジュールの個数や配置を適宜変更してもよい。したがって、固定リニアモジュールM3を排してもよい。また、1個の固定リニアモジュールM2と、可動リニアモジュールM1を駆動する1個のアクチュエーター5aとで構成されるL字状の経路でスライダー4を移動させるように、リニアコンベアシステム1を構成しても良い。あるいは、図3の状態から、固定リニアモジュールM4を、X方向に平行に移動させて、アクチュエーター5bに対して固定リニアモジュールM2、M3の反対側に配ししてもよい。
また、固定リニアモジュールMa、2bがスライダー4を駆動する方向と、アクチュエーター5c、5dがスライダー4を駆動する方向とは、必ずしも直交する必要は無く、傾いていてもよい。
1…リニアコンベアシステム
11…制御装置(制御部)
18…プログラム(リニアコンベアシステムの制御プログラム)
19…記録媒体
4…スライダー
A1…座標軸
A2…座標軸(一方座標軸)
A3…座標軸
A4…座標軸
A5…座標軸(他方座標軸)
P…位置座標値(座標値)
E2…他方座標軸側の端
P2…他方座標軸側の端の座標値
E5…一方座標軸側の端
P5…一方座標軸側の端の座標値
SL…所定の傾き
SLb…他方座標軸側の端の座標値と一方座標軸側の端の座標値との間の傾き
C…受け渡し動作
Fa2~Fa4、Fb2~Fb4…対向範囲
M1…可動リニアモジュール
M2…固定リニアモジュール(一の固定リニアモジュール)
M3…固定リニアモジュール
M4…固定リニアモジュール
M5…可動リニアモジュール
Ta、Tb…スライダー移載機構
La…停止位置
Ls…移動開始位置
Ld…移動目標位置
X…X方向(第1方向)
Y…Y方向(第2方向)
Fp…位置プロファイル
Ip…位置指令値
Dp…位置検出値
Fv…速度プロファイル
Iv…速度指令値
Dv…速度検出値
11…制御装置(制御部)
18…プログラム(リニアコンベアシステムの制御プログラム)
19…記録媒体
4…スライダー
A1…座標軸
A2…座標軸(一方座標軸)
A3…座標軸
A4…座標軸
A5…座標軸(他方座標軸)
P…位置座標値(座標値)
E2…他方座標軸側の端
P2…他方座標軸側の端の座標値
E5…一方座標軸側の端
P5…一方座標軸側の端の座標値
SL…所定の傾き
SLb…他方座標軸側の端の座標値と一方座標軸側の端の座標値との間の傾き
C…受け渡し動作
Fa2~Fa4、Fb2~Fb4…対向範囲
M1…可動リニアモジュール
M2…固定リニアモジュール(一の固定リニアモジュール)
M3…固定リニアモジュール
M4…固定リニアモジュール
M5…可動リニアモジュール
Ta、Tb…スライダー移載機構
La…停止位置
Ls…移動開始位置
Ld…移動目標位置
X…X方向(第1方向)
Y…Y方向(第2方向)
Fp…位置プロファイル
Ip…位置指令値
Dp…位置検出値
Fv…速度プロファイル
Iv…速度指令値
Dv…速度検出値
Claims (10)
- 第1方向に駆動されるスライダーと、
前記第1方向に交差する第2方向に配列された複数の固定リニアモジュールと、
前記複数の固定リニアモジュールに前記第1方向から対向しつつ前記第2方向に並ぶ複数の対向範囲の間を移動し、前記第1方向に前記スライダーを駆動する可動リニアモジュールと、
前記複数の対向範囲の間で前記可動リニアモジュールを搬送するスライダー移載機構と、
前記第1方向への位置の変化に応じて変化する座標値により前記第1方向への位置を示す座標軸を、前記複数の固定リニアモジュールおよび前記可動リニアモジュールのそれぞれに設定し、前記固定リニアモジュールおよび前記可動リニアモジュールにより駆動される前記スライダーに対して、前記座標軸に基づく位置制御を実行する制御部と
を備え、
前記スライダーは、前記第1方向の一端から前記固定リニアモジュールおよび前記可動リニアモジュールに対して係合および離脱可能であり、前記固定リニアモジュールおよび前記可動リニアモジュールは、係合する前記スライダーを前記第1方向に駆動し、
前記固定リニアモジュールと前記可動リニアモジュールとの間で前記スライダーを移動させる受け渡し動作が実行され、
前記制御部は、前記固定リニアモジュールの前記座標軸である一方座標軸と、前記可動リニアモジュールの前記座標軸である他方座標軸とが前記第1方向に連続するか否かを判断する判断処理を実行した結果、前記一方座標軸と前記他方座標軸とが連続しないと前記受け渡し動作の前に判断すると、前記受け渡し動作における前記スライダーの駆動を前記位置制御に代えて、速度指令値に基づき前記スライダーの速度を制御する速度制御により制御するリニアコンベアシステム。 - 前記制御部は、前記位置制御では、前記スライダーの位置の時間変化を示す位置プロファイルに基づき生成した位置指令値と、前記スライダーの位置を検出した位置検出値との偏差に基づくフィードバック制御により前記スライダーを駆動する一方、前記速度制御では、前記スライダーの速度の時間変化を示す速度プロファイルに基づき生成した速度指令値と、前記スライダーの速度を検出した速度検出値との偏差に基づくフィードバック制御により前記スライダーを駆動する請求項1に記載のリニアコンベアシステム。
- 前記制御部は、移動開始位置から移動目標位置へ向けて前記スライダーを移動させる前記受け渡し動作において前記速度制御を完了すると、前記速度制御の完了時に前記スライダーが停止する停止位置から前記移動目標位置まで、前記位置制御により前記スライダーを移動させる請求項2に記載のリニアコンベアシステム。
- 前記制御部は、前記判断処理を実行した結果、前記一方座標軸と前記他方座標軸とが連続すると前記受け渡し動作の前に判断すると、前記受け渡し動作における前記スライダーの駆動を前記位置制御により制御する請求項1ないし3のいずれか一項に記載のリニアコンベアシステム。
- 前記制御部は、前記複数の固定リニアモジュールおよび前記可動リニアモジュールのそれぞれの前記座標軸が示す前記座標値が互いに重複しないように前記座標軸を設定する請求項1ないし4のいずれか一項に記載のリニアコンベアシステム。
- 前記座標軸は、前記第1方向への位置の変化に応じて所定の傾きで線形に変化する座標値により前記第1方向への位置を示す請求項1ないし5のいずれか一項に記載のリニアコンベアシステム。
- 前記制御部は、前記一方座標軸における前記他方座標軸側の端の前記座標値と、前記他方座標軸における前記一方座標軸側の端の前記座標値との間の傾きが、前記所定の傾きと異なる場合に、前記一方座標軸と前記他方座標軸とが連続しないと判断する請求項6に記載のリニアコンベアシステム。
- 第1方向に駆動されるスライダーと、前記第1方向に交差する第2方向に配列された複数の固定リニアモジュールと、前記複数の固定リニアモジュールに前記第1方向から対向しつつ前記第2方向に並ぶ複数の対向範囲の間を移動し、前記第1方向に前記スライダーを駆動する可動リニアモジュールと、前記複数の対向範囲の間で前記可動リニアモジュールを搬送するスライダー移載機構とを備えるリニアコンベアシステムの制御方法であって、
前記第1方向への位置の変化に応じて変化する座標値により前記第1方向への位置を示す座標軸を、前記複数の固定リニアモジュールおよび前記可動リニアモジュールのそれぞれに設定する工程と、
前記固定リニアモジュールの前記座標軸である一方座標軸と、前記可動リニアモジュールの前記座標軸である他方座標軸とが前記第1方向に連続するかを判断する判断処理を実行する工程と、
前記判断処理の結果、前記一方座標軸と前記他方座標軸とが連続しないと判断すると、前記固定リニアモジュールと前記可動リニアモジュールとの間で前記スライダーを移動させる受け渡し動作を、速度指令値に基づき前記スライダーの速度を制御する速度制御により実行する工程と
を備えたリニアコンベアシステムの制御方法。 - 第1方向に駆動されるスライダーと、前記第1方向に交差する第2方向に配列された複数の固定リニアモジュールと、前記複数の固定リニアモジュールに前記第1方向から対向しつつ前記第2方向に並ぶ複数の対向範囲の間を移動し、前記第1方向に前記スライダーを駆動する可動リニアモジュールと、前記複数の対向範囲の間で前記可動リニアモジュールを搬送するスライダー移載機構とを備えるリニアコンベアシステムの制御プログラムであって、
前記第1方向への位置の変化に応じて変化する座標値により前記第1方向への位置を示す座標軸を、前記複数の固定リニアモジュールおよび前記可動リニアモジュールのそれぞれに設定する工程と、
前記固定リニアモジュールの前記座標軸である一方座標軸と、前記可動リニアモジュールの前記座標軸である他方座標軸とが前記第1方向に連続するかを判断する判断処理を実行する工程と、
前記判断処理の結果、前記一方座標軸と前記他方座標軸とが連続しないと判断すると、前記固定リニアモジュールと前記可動リニアモジュールとの間で前記スライダーを移動させる受け渡し動作を、速度指令値に基づき前記スライダーの速度を制御する速度制御により実行する工程と
をコンピューターに実行させるリニアコンベアシステムの制御プログラム。 - 請求項9に記載のリニアコンベアシステムの制御プログラムを、コンピューターにより読み出し可能に記録する記録媒体。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2019/017194 WO2020217306A1 (ja) | 2019-04-23 | 2019-04-23 | リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 |
US17/432,152 US11702300B2 (en) | 2019-04-23 | 2019-04-23 | Linear conveyor system, a control method for a linear conveyor system, a control program for a linear conveyor system and a recording medium |
DE112019007252.8T DE112019007252T5 (de) | 2019-04-23 | 2019-04-23 | Linearfördersystem, Steuerverfahren für ein Linearfördersystem, Steuerprogramm für ein Linearfördersystem und Aufzeichnungsmedium |
JP2021515347A JP7083964B2 (ja) | 2019-04-23 | 2019-04-23 | リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 |
CN201980095581.2A CN113748075B (zh) | 2019-04-23 | 2019-04-23 | 线性输送机***、线性输送机***的控制方法以及记录介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2019/017194 WO2020217306A1 (ja) | 2019-04-23 | 2019-04-23 | リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020217306A1 true WO2020217306A1 (ja) | 2020-10-29 |
Family
ID=72941131
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2019/017194 WO2020217306A1 (ja) | 2019-04-23 | 2019-04-23 | リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11702300B2 (ja) |
JP (1) | JP7083964B2 (ja) |
CN (1) | CN113748075B (ja) |
DE (1) | DE112019007252T5 (ja) |
WO (1) | WO2020217306A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023004894A1 (zh) * | 2021-07-28 | 2023-02-02 | 西安交通大学 | 一种基于直线电机的暗轨道电动轨道车驱动与控制*** |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113767055B (zh) * | 2019-04-23 | 2022-11-18 | 雅马哈发动机株式会社 | 线性输送机***、线性输送机***的控制方法以及记录介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06311723A (ja) * | 1993-04-23 | 1994-11-04 | Nippon Thompson Co Ltd | 直流リニアモータ及びこれを具備した駆動ユニット |
DE102008007768A1 (de) * | 2008-02-06 | 2009-08-13 | Rovema - Verpackungsmaschinen Gmbh | Vorrichtung zum Weiterbewegen von Stückgut |
WO2012073755A1 (ja) * | 2010-11-30 | 2012-06-07 | Thk株式会社 | 可撓性マグネット、可撓性マグネットの製造方法、磁気エンコーダ、アクチュエータ |
WO2013069201A1 (ja) * | 2011-11-07 | 2013-05-16 | ヤマハ発動機株式会社 | リニアコンベア、搬送台車及びリニアコンベアの駆動制御方法 |
CN206126137U (zh) * | 2016-08-31 | 2017-04-26 | 广州瑞松智能科技股份有限公司 | 一种传输机的产品传送结构 |
JP2017194137A (ja) * | 2016-03-29 | 2017-10-26 | 上銀科技股▲フン▼有限公司 | 潤滑装置を備えたリニアガイド |
WO2018055708A1 (ja) * | 2016-09-21 | 2018-03-29 | ヤマハ発動機株式会社 | リニアコンベア装置 |
Family Cites Families (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2904967B2 (ja) * | 1991-07-23 | 1999-06-14 | 松下電工株式会社 | 搬送装置 |
JPH10291639A (ja) * | 1997-04-21 | 1998-11-04 | Fuji Yusoki Kogyo Co Ltd | 昇降搬送装置 |
JP4239382B2 (ja) * | 2000-08-24 | 2009-03-18 | 株式会社Ihi | 搬送装置 |
JP4096169B2 (ja) * | 2002-07-26 | 2008-06-04 | 株式会社安川電機 | リニアモータ連続搬送装置 |
JP2004075254A (ja) * | 2002-08-14 | 2004-03-11 | Daifuku Co Ltd | 物品搬送設備 |
JPWO2010024234A1 (ja) * | 2008-08-29 | 2012-01-26 | Thk株式会社 | 分散配置リニアモータおよび分散配置リニアモータの駆動システム |
JP5590137B2 (ja) * | 2010-10-26 | 2014-09-17 | 村田機械株式会社 | 離散配置リニアモータシステム |
JP6095333B2 (ja) * | 2012-11-21 | 2017-03-15 | ヤマハ発動機株式会社 | 基板処理ライン、基板処理方法 |
ES2400373B1 (es) * | 2012-12-26 | 2013-11-15 | Thyssenkrupp Elevator Innovation Center, S. A. | Sistema de transporte para desplazamiento de pasajeros/mercancías |
JP2015104200A (ja) * | 2013-11-25 | 2015-06-04 | Thk株式会社 | リニアモータ |
CN105531825B (zh) | 2013-12-16 | 2019-01-01 | 富士电机株式会社 | 半导体装置及半导体装置的制造方法 |
JP6291327B2 (ja) * | 2014-04-08 | 2018-03-14 | 株式会社アイエイアイ | 搬送システム |
US9611107B2 (en) | 2014-12-08 | 2017-04-04 | Rockwell Automation Technologies, Inc. | Linear drive transport system and method |
US20210229781A1 (en) * | 2015-04-16 | 2021-07-29 | Shmuel Sam Arditi | System and method for boat fender deployment |
WO2018055709A1 (ja) | 2016-09-21 | 2018-03-29 | ヤマハ発動機株式会社 | リニアコンベア装置 |
WO2019009105A1 (ja) * | 2017-07-05 | 2019-01-10 | 日本トムソン株式会社 | テーブル循環案内装置 |
US11165372B2 (en) * | 2017-09-13 | 2021-11-02 | Rockwell Automation Technologies, Inc. | Method and apparatus to characterize loads in a linear synchronous motor system |
CN110829781B (zh) * | 2018-08-08 | 2022-07-26 | 佳能株式会社 | 运输***、动子、控制设备及控制方法 |
US10628072B2 (en) * | 2018-08-21 | 2020-04-21 | Samsung Electronics Co., Ltd. | Scalable architecture enabling large memory system for in-memory computations |
WO2020225862A1 (ja) * | 2019-05-08 | 2020-11-12 | ヤマハ発動機株式会社 | リニアコンベアシステム、リニアモジュールおよびリニアモジュールの制御方法 |
JP7321847B2 (ja) * | 2019-09-04 | 2023-08-07 | キヤノン株式会社 | リニアアクチュエータ |
DE112020007209T5 (de) * | 2020-05-15 | 2023-08-10 | Yamaha Hatsudoki Kabushiki Kaisha | Transfervorrichtung und Transferverfahren |
-
2019
- 2019-04-23 US US17/432,152 patent/US11702300B2/en active Active
- 2019-04-23 DE DE112019007252.8T patent/DE112019007252T5/de active Pending
- 2019-04-23 WO PCT/JP2019/017194 patent/WO2020217306A1/ja active Application Filing
- 2019-04-23 CN CN201980095581.2A patent/CN113748075B/zh active Active
- 2019-04-23 JP JP2021515347A patent/JP7083964B2/ja active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06311723A (ja) * | 1993-04-23 | 1994-11-04 | Nippon Thompson Co Ltd | 直流リニアモータ及びこれを具備した駆動ユニット |
DE102008007768A1 (de) * | 2008-02-06 | 2009-08-13 | Rovema - Verpackungsmaschinen Gmbh | Vorrichtung zum Weiterbewegen von Stückgut |
WO2012073755A1 (ja) * | 2010-11-30 | 2012-06-07 | Thk株式会社 | 可撓性マグネット、可撓性マグネットの製造方法、磁気エンコーダ、アクチュエータ |
WO2013069201A1 (ja) * | 2011-11-07 | 2013-05-16 | ヤマハ発動機株式会社 | リニアコンベア、搬送台車及びリニアコンベアの駆動制御方法 |
JP2017194137A (ja) * | 2016-03-29 | 2017-10-26 | 上銀科技股▲フン▼有限公司 | 潤滑装置を備えたリニアガイド |
CN206126137U (zh) * | 2016-08-31 | 2017-04-26 | 广州瑞松智能科技股份有限公司 | 一种传输机的产品传送结构 |
WO2018055708A1 (ja) * | 2016-09-21 | 2018-03-29 | ヤマハ発動機株式会社 | リニアコンベア装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023004894A1 (zh) * | 2021-07-28 | 2023-02-02 | 西安交通大学 | 一种基于直线电机的暗轨道电动轨道车驱动与控制*** |
Also Published As
Publication number | Publication date |
---|---|
CN113748075B (zh) | 2023-06-16 |
DE112019007252T5 (de) | 2021-12-30 |
CN113748075A (zh) | 2021-12-03 |
JPWO2020217306A1 (ja) | 2021-10-21 |
US11702300B2 (en) | 2023-07-18 |
US20230142815A1 (en) | 2023-05-11 |
JP7083964B2 (ja) | 2022-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10566917B2 (en) | Linear motor control apparatus and linear motor control system | |
JP7083964B2 (ja) | リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 | |
US4507598A (en) | Two-axis positioning system | |
JP7083963B2 (ja) | リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 | |
JP5648722B1 (ja) | リニアモータシステム | |
WO2020225862A1 (ja) | リニアコンベアシステム、リニアモジュールおよびリニアモジュールの制御方法 | |
JPWO2009031371A1 (ja) | 磁気浮上システム | |
EP3431259A1 (en) | Intermittent excitation apparatus of 3d printer and method of operating the same | |
US11745960B2 (en) | Linear conveyor system, control method for linear conveyor system, control program for linear conveyor system and storage medium | |
TWI516012B (zh) | 馬達控制裝置、馬達控制方法及控制程式 | |
JP7439061B2 (ja) | リニアコンベアシステム、リニアコンベアシステムの制御方法、リニアコンベアシステムの制御プログラムおよび記録媒体 | |
JP2008178237A (ja) | リニアシステムの磁極位置補正方法およびこの補正方法を用いたリニアシステム | |
JP2015213394A (ja) | 搬送システム | |
WO2014196561A1 (ja) | ステッピングモータの制御装置、及び制御方法 | |
JP2019083597A (ja) | 搬送装置、加工システム、および物品の製造方法 | |
JP2006050875A (ja) | 門型ステージ装置のリニアモータ制御方法 | |
CN114435965A (zh) | 输送***以及输送***的控制方法 | |
JP2008102697A (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: 19926515 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2021515347 Country of ref document: JP Kind code of ref document: A |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 19926515 Country of ref document: EP Kind code of ref document: A1 |