Conveyance system
Patent Information
- Application Number
- JP2021198016
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2021-12-06
- Publication Date
- 2024-12-09
- Estimated Expiration
- 2041-12-06
AI Technical Summary
Existing transport systems in production lines require separate systems for adding control corresponding to machining axes, leading to increased equipment space and complexity.
A transport system with integrated control axes using a moving magnet type linear motor, incorporating a mover, stator, and control units that detect and control the position and attitude of the mover in multiple directions, allowing for single-axis and multi-axis control within the same transport path.
Enables efficient use of space by integrating control axes within the transport path, facilitating precise positioning and attitude control of workpieces, thereby optimizing equipment layout and operational efficiency.
Abstract
Description
[Technical Field]
[0001] The present invention relates to a transport system. [Background technology]
[0002] Generally, conveyance systems are used in production lines for assembling industrial products. Conveyance systems in production lines transport workpieces, such as parts, between multiple stations within or between multiple stations in factory-automated production lines. They are also sometimes used as conveyance devices within process equipment. Conveyance systems using moving magnet linear motors have already been proposed.
[0003] In a production line, the conveying direction is generally fixed, and multiple movers transport workpieces such as parts. The movers stop before each process, and each process processes the workpiece positioned on the movers.
[0004] For example, Patent Document 1 discloses that a linear motor drive section in which a linear motor stator constituting a linear motor is provided in a conveying section and a mechanical drive section in which a belt conveyor driven by a motor is provided are used within the same conveying system. [Prior art documents] [Patent documents]
[0005] [Patent Document 1] Patent No. 6417187 Summary of the Invention [Problem to be solved by the invention]
[0006] However, if an attempt is made to add control corresponding to the machining axis of the process device to the system described in Patent Document 1, the device space increases, and a separate system needs to be provided.
[0007] The present invention has been made to solve the above-mentioned problems, and has an object to provide a conveyance system that has a control axis corresponding to a necessary processing axis within the same conveyance path. [Means for solving the problem]
[0008] According to one aspect of the present invention, there is provided a conveying system comprising: a mover; a first conveying unit having a first portion of a stator along which the mover is conveyed; a second conveying unit adjacent to the first conveying unit and having a second portion of the stator along which the mover is conveyed; and a control unit capable of controlling the position and / or attitude of the mover, wherein the first portion has a first guide unit along which the mover can move in a first direction and a first detection unit that detects the position of the mover in the first direction; the second portion has a second detection unit that detects the position of the mover in a second direction that intersects with the first direction; the control unit controls the position of the mover in the first direction based on detection information from the first detection unit in the first conveying unit; and the control unit controls the position of the mover in the first direction based on detection information from the first detection unit and detection information from the second detection unit in the second conveying unit, and controls the position of the mover in the second direction and / or the amount of rotation of the mover around an axis along a third direction that intersects with the first direction and the second direction. [Effects of the Invention]
[0009] According to the present invention, it is possible to provide a conveyance system that has control axes corresponding to necessary processing axes within the same conveyance path. [Brief explanation of the drawings]
[0010] [Figure 1] 1 is a schematic diagram illustrating a configuration of a transport system according to a first embodiment of the present invention. [Figure 2A] 1 is a schematic diagram showing a configuration of a transport system according to a first embodiment of the present invention. [Figure 2B] 1 is a schematic diagram showing a configuration of a transport system according to a first embodiment of the present invention. [Figure 2C] 1 is a schematic diagram showing a configuration of a transport system according to a first embodiment of the present invention. [Figure 3A] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 3B] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 3C] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 3D] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 3E] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 4A] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 4B] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 4C] FIG. 2 is an explanatory diagram illustrating the operation of the transport system according to the first embodiment of the present invention. [Figure 5A] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a second embodiment of the present invention. [Figure 5B] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a second embodiment of the present invention. [Figure 5C] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a second embodiment of the present invention. [Figure 6A] FIG. 10 is an operational diagram showing the configuration of a transport system according to a second embodiment of the present invention. [Figure 6B] FIG. 10 is an explanatory diagram illustrating the operation of the transport system according to the second embodiment of the present invention. [Figure 7A] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a third embodiment of the present invention. [Figure 7B] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a third embodiment of the present invention. [Figure 7C] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a third embodiment of the present invention. [Figure 7D] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a third embodiment of the present invention. [Figure 8] FIG. 10 is an explanatory diagram illustrating the operation of the transport system according to the third embodiment of the present invention. [Figure 9A] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a fourth embodiment of the present invention. [Figure 9B] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a fourth embodiment of the present invention. [Figure 9C] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a fourth embodiment of the present invention. [Figure 10] FIG. 10 is a schematic diagram showing the configuration of a transport system according to a fourth embodiment of the present invention. DETAILED DESCRIPTION OF THE INVENTION
[0011] [First embodiment] A first embodiment of the present invention will be described below with reference to the drawings, using Figures 1 to 4C. The conveyance system according to this embodiment is a conveyance system using a moving magnet (MM) linear motor in which a permanent magnet is installed in the mover and a coil is installed in the stator.
[0012] First, the configuration of a conveying system 1 according to this embodiment will be described with reference to Fig. 1 to Fig. 2C. Fig. 1 is a schematic diagram showing the configuration of a conveying system 1 including a mover 101 and a stator 201 according to this embodiment. Figs. 2A to 2C are schematic diagrams showing the mover 101 and the stator 201 in the conveying system 1 according to this embodiment. In the following description, for multiple components, lowercase letters are added after the numerical reference symbols as necessary to distinguish between them, and when no particular distinction is required, common numerical reference symbols are used.
[0013] As shown in FIG. 1, the conveying system 1 according to this embodiment includes an integrated controller 301, a coil controller 302, a sensor controller 304, a mover 101, and a stator 201. The stator 201 includes a first portion 2011 constituting a single-axis control section 21 capable of conveying the mover 101 in the X direction, and a second portion 2012 constituting a multi-axis control section 22 capable of not only conveying the mover 101 in the X direction but also controlling the mover 101 in the Z direction, etc. The conveying path 10 is constructed by combining the single-axis control section 21 and the multi-axis control section 22. In FIG. 1, the multi-axis control section 22 is adjacent to the single-axis control section 21a on the positive side in the X direction and adjacent to the single-axis control section 21b on the negative side in the X direction. The mover 101 is conveyed, for example, by moving from the single-axis control section 21a to the multi-axis control section 22 and then from the multi-axis control section 22 to the single-axis control section 21b. The mover 101 can also move to the negative side in the X direction.
[0014] The single-axis control section 21 and the multi-axis control section 22 are each a transport section in which the mover 101 is transported. The single-axis control section 21 and the multi-axis control section 22 may be arranged alternately adjacent to each other in the X direction, or a plurality of single-axis control sections 21 or multi-axis control sections 22 may be arranged consecutively. A part 2041 of a plurality of linear encoders 204 is attached and installed to a first portion 2011 of the stator 201 in the single-axis control section 21. A part 2042 of a plurality of linear encoders 204 is attached and installed to a second portion 2012 of the stator 201 in the multi-axis control section 22. The plurality of linear encoders 204 are attached to the stator 201 at intervals such that one of them can always measure the position of one mover 101 even while the mover 101 is being transported.
[0015] Furthermore, a plurality of Z sensors 206 are attached to second portion 2012 of stator 201 in multi-axis control section 22 and installed in two rows in the X direction. The plurality of Z sensors 206 are attached to second portion 2012 of stator 201 at intervals such that three of the two rows can always measure Z targets 106 (see FIG. 2B, etc.) of one mover 101.
[0016] A plurality of coil controllers 302 are communicatively connected to the integrated controller 301. A plurality of coils 202 (see FIG. 2A, etc.) are connected to each coil controller 302. A sensor controller 304 is communicatively connected to the integrated controller 301. A plurality of linear encoders 204 and a plurality of Z sensors 206 are communicatively connected to the sensor controller 304.
[0017] The integrated controller 301 can instruct each of the connected coil controllers 302 to set a target current value for the current to be applied to each of the coils 202. The coil controller 302 can control the current of each of the connected coils 202.
[0018] More specifically, the integrated controller 301 determines current command values to be applied to the plurality of coils 202 based on the output from the linear encoder 204 or the Z sensor 206, and transmits the determined current command values to each of the coil controllers 302. The coil controllers 302 control the amount and timing of current to be applied to the coils 202 connected as described above based on the current command values from the integrated controller 301. In this way, the integrated controller 301 functions as a control unit that controls the operation of the mover 101, and moves the mover 101 along the stator 201.
[0019] For example, when mover 101 is located in single-axis control section 21a, integrated controller 301 transmits a current command value to coil controller 302a based on the output from linear encoder 204. When mover 101 is located in multi-axis control section 22, integrated controller 301 transmits a current command value to coil controller 302b based on the outputs from linear encoder 204 and Z sensor 206. In this way, integrated controller 301 performs single-axis or multi-axis control of mover 101 in the corresponding control section.
[0020] The conveyance system 1 according to this embodiment is a conveyance system using a moving magnet linear motor (moving permanent magnet linear motor, moving field linear motor). As will be described later, the conveyance system 1 according to this embodiment also constitutes a part of a processing system that also includes a process device 3 that processes a workpiece 102 conveyed by a mover 101.
[0021] Here, we define the coordinate axes, directions, and the like used in the following description. First, the X-axis is taken along the horizontal direction, which is the transport direction of the mover 101, and the transport direction of the mover 101 is taken as the X-direction. The Z-axis is taken along the vertical direction, which is perpendicular to the X-direction, and the vertical direction is taken as the Z-direction. The Y-axis is taken along the direction perpendicular to the X-direction and the Z-direction, and the direction perpendicular to the X-direction and the Z-direction is taken as the Y-direction. The rotation direction around the X-axis is taken as the Wx-direction, the rotation direction around the Y-axis is taken as the Wz-direction, and the rotation direction around the Z-axis is taken as the Wz-direction. As for the displacement of the mover 101 in each direction, the position in the X-direction is taken as X, the position in the Y-direction is taken as Y, and the position in the Z-direction is taken as Z. As for the rotation amounts, which are the displacement of the mover 101 in each rotation direction, the rotation amount in the Wx-direction is taken as Wx, the rotation amount in the Wy-direction is taken as Wy, and the rotation amount in the Wz-direction is taken as Wz. Also, a "*" is used as a multiplication symbol. Furthermore, the center of the mover 101 is defined as the origin O, and the positive side of the Y direction relative to the origin O is defined as the L side, and the negative side of the Y direction relative to the origin O is defined as the R side. Note that the transport direction of the mover 101 does not necessarily have to be horizontal, but in that case, the transport direction can also be defined as the X direction, and the Y direction and Z direction can be similarly defined. Furthermore, the X direction, Y direction, and Z direction are not necessarily limited to directions perpendicular to each other, and can also be defined as directions intersecting each other.
[0022] Next, the mover 101 in the transport system 1 according to this embodiment will be described with reference to Figures 2A to 2C. Figure 2A is a diagram of the transport system 1 including the mover 101 and the stator 201 as seen from the positive side in the Z direction, Figure 2B is a diagram of the transport system 1 including the mover 101 and the stator 201 as seen from the positive side in the X direction, and Figure 2C is a diagram of the mover 101 as seen from the negative side in the Z direction.
[0023] The mover 101 has rollers 60 that can run along guide rails 50 that are installed along the X direction on the first portion 2011 of the stator 201. The rollers 60 are attached to the underside of the mover 101, which is the surface on the negative side in the Z direction. The rollers 60 include rollers 60a that restrict movement in the Y direction and are movable in the X direction, and rollers 60b that restrict movement on the negative side in the Z direction and are movable in the X direction.
[0024] The roller 60 may be installed on the side of the first portion 2011 of the stator 201. In this case, a structure that serves as an alternative to the guide rail 50 is installed on the mover 101.
[0025] The mover 101 also has a plurality of permanent magnets 40, specifically permanent magnets 40bR, 40cR, 40bL, and 40cL. Each permanent magnet 40 is a permanent magnet group including a plurality of permanent magnets. The plurality of permanent magnets 40 are attached to and installed on the underside of the mover 101. The plurality of permanent magnets 40 installed on the underside of the mover 101 are arranged in two rows along the X direction at the L-side end and R-side end of the underside. Specifically, permanent magnets 40bR and 40cR are attached to the R-side end of the underside of the mover 101 via a yoke 107. Furthermore, permanent magnets 40bL and 40cL are attached to the L-side end of the underside of the mover 101 via a yoke 107.
[0026] In the following, unless there is a particular need to distinguish between them, the permanent magnets of the mover 101 will be simply referred to as "permanent magnets 40." Furthermore, although there is no need to distinguish between the R side and the L side, if it is necessary to individually identify each permanent magnet 40, each permanent magnet 40 will be individually identified using a code consisting of a lowercase alphabet as an identifier, excluding R or L, from the end of the code for each permanent magnet 40. In this case, each permanent magnet 40 will be individually identified by being written as "permanent magnet 40b" and "permanent magnet 40c."
[0027] Furthermore, the permanent magnets 40bR and 40cR are arranged so that their centers are aligned in a straight line along the X direction, for example, at a distance rx3 on the R side from the center of the bottom surface of the mover 101. The permanent magnets 40bR and 40cR are arranged at positions at a distance ry3 from the origin O on one side and the other side in the X direction.
[0028] Furthermore, the permanent magnets 40bL, 40cL are arranged so that their centers are aligned in a straight line along the X direction, for example, a distance rx3 away from the center of the underside of the mover 101 on the L side. The permanent magnets 40bL, 40cL are arranged at positions a distance ry3 away from the origin O on one side and the other side in the X direction. As a result, the permanent magnets 40bL, 40cL are arranged at the same positions as the permanent magnets 40bR, 40cR, respectively, in the X direction. Furthermore, the distance between the permanent magnets 40bL, 40cL in the X direction is the same as the distance between the permanent magnets 40bR, 40cR.
[0029] Thus, the permanent magnets 40b and 40c are attached at positions spaced a distance rx3 from the origin O in the Y direction. The permanent magnets 40b and 40c are also attached at positions spaced a distance ry3 from the origin O on one side and the other side in the X direction.
[0030] On the other hand, permanent magnets 40bR, 40cR, 40bL, and 40cL are each a set of three permanent magnets arranged along the X direction. Permanent magnets 40b and 40c are each configured by arranging three permanent magnets along the X direction so that the polarities of the outer magnetic poles facing the stator 201 alternate. Note that the number of permanent magnets arranged along the X direction that make up permanent magnets 40b and 40c is not limited to three, and may be any plural number. In other words, permanent magnets 40b and 40c may be a magnet group consisting of multiple permanent magnets arranged along the X direction so that the polarities of their magnetic poles alternate.
[0031] Each permanent magnet 40 is attached to a yoke 107 provided on the R side and L side of the lower surface of the mover 101. The yoke 107 is made of a material with high magnetic permeability, such as iron.
[0032] In this way, the mover 101 has a plurality of permanent magnets 40 symmetrically arranged on the R side and L side of the underside thereof, with the central axis along the X axis of the mover 101 as the axis of symmetry. The mover 101 on which the permanent magnets 40 are arranged is configured to be movable while its posture is controlled in multiple axes by electromagnetic forces acting on the permanent magnets 40 by the plurality of coils 202 of the stator 201, as will be described later.
[0033] The mover 101 is movable in the X direction along a plurality of coils 202 arranged in two rows along the X direction in a first portion 2011 of the stator 201. The mover 101 can be transported with the workpiece 102 to be transported placed or attached on its upper surface. The mover 101 may have a holding mechanism, such as a work holder, that holds the workpiece 102 on the mover 101.
[0034] The mover 101, which is transported along the first portion 2011 of the stator 201, has a linear scale 104 and a Z target 106. The linear scale 104 is attached to the side of the mover 101 along the X direction. The Z target 106 is attached to the top of the mover 101 along the X direction. The Z targets 106 are attached to both the L side and the R side.
[0035] Next, the stator 201 in the conveyance system 1 according to this embodiment will be described with reference to FIGS. 2A to 2C.
[0036] The stator 201 has a plurality of coils 202 arranged in two rows along the X direction, which is the transport direction of the mover 101. The plurality of coils 202 are attached and installed on the stator 201 so as to face the mover 101 in the Z direction from the R side and L side of the lower surface, respectively. The stator 201 extends in the X direction, which is the transport direction, to form the transport path 10 of the mover 101. The stator 201 includes a first portion 2011 of the stator 201 that constitutes a single-axis control section 21 that controls the mover 101 with one axis, and a second portion 2012 of the stator 201 that constitutes a multi-axis control section 22 that controls the mover 101 with multiple axes.
[0037] In addition, first portion 2011 of stator 201 has a plurality of linear encoders 204. Second portion 2012 of stator 201 constituting multi-axis control section 22 has a plurality of Z sensors 206 required for control other than X-axis control.
[0038] The multiple coils 202 are attached to the stator 201 and arranged in two rows along the X direction so as to be able to face the R-side and L-side permanent magnets 40 on the underside of the mover 101. The multiple coils 202 arranged in one row on the R side are arranged along the X direction so as to be able to face the R-side permanent magnets 40bR, 40cR of the mover 101. In addition, the multiple coils 202 arranged in one row on the L side are arranged along the X direction so as to be able to face the L-side permanent magnets 40bL, 40cL of the mover 101.
[0039] The stator 201 applies a force to the mover 101, which is movable along the X direction, which is the transport direction, by each of the coils 202 to which a current is applied. As a result, the position and posture of the mover 101 are controlled and the mover 101 is transported along the transport direction.
[0040] The linear encoder 204 and the Z sensor 206 function as detection units that detect the position and posture of the mover 101 moving in the conveyance direction. The linear encoder 204 is attached to the stator 201 so as to be able to read a linear scale 104 attached to the mover 101. The linear encoder 204 detects the position of the mover 101 in the X direction, i.e., the position of the mover 101 relative to the linear encoder 204, by reading the linear scale 104. The multiple Z sensors 206 are attached to the second portion 2012 of the stator 201 so as to be able to detect the position of the mover 101 in the Z direction, i.e., the distance in the Z direction from a Z target 106 attached to the mover 101. The integrated controller 301 can control the position and / or posture of the mover 101 based on the position of the mover 101 in the X direction, which is detection information from the linear encoder 204, and the position of the mover 101 in the Z direction, which is detection information from the Z sensor 206.
[0041] Furthermore, the stator 201 is provided with a guide rail 50, which is a guide section that allows the mover 101 to move in the positive X and Z directions via rollers 60, across a first portion 2011 of the stator 201 in the single-axis control section 21 and a second portion 2012 of the stator 202 in the multi-axis control section 22. Movement of the mover 101 in the Y direction is restricted by rollers 60a that contact the guide rail 50 from both sides of the guide rail 50 in the Y direction. Movement of the mover 101 to the negative Z direction is restricted by roller 60b that contacts the guide rail 50 from the positive side of the guide rail 50 in the Z direction.
[0042] The conveyance system 1, for example, conveys the mover 101 using the stator 201, thereby conveying the workpiece 102 on the mover 101 to a process device 3 that performs a machining operation on the workpiece 102. FIG. 2A illustrates a case in which a plurality of process devices 3a, 3b, and 3c are installed on the conveyance path 10 formed by the stator 201. By machining the workpiece 102, a high-precision article can be manufactured. Note that while FIG. 2A shows one mover 101 for the stator 201, this is not limiting. In the conveyance system 1, a plurality of movers 101 can be conveyed on the stator 201.
[0043] In the conveying system 1 according to this embodiment, a single-axis control section 21 and a multi-axis control section 22 having a Z sensor 206 are provided within the same conveying path 10. As a result, in this embodiment, even if the mover 101 and the stator 201 are the same, forces can be applied to the mover 101 in the X, Z, and Wy directions, which are the conveying directions, as will be described later, and therefore conveyance control and attitude control of the mover 101 can be realized.
[0044] 3A to 3E, a method for controlling the attitude of the mover 101 executed by the integrated controller 301 will be described. Note that instead of the integrated controller 301, the coil controller 302 may be configured to execute the same processing as the integrated controller 301.
[0045] 3A is a schematic diagram showing a method for controlling the attitude of the mover 101 in the transportation system 1 according to this embodiment. FIG. 3A shows an outline of the method for controlling the attitude of the mover 101, focusing mainly on the flow of data. As will be described below, the integrated controller 301 executes processing using a mover position calculation function 401, a mover attitude calculation function 402, a mover attitude control function 403, and a coil current calculation function 404. In this way, the integrated controller 301 controls the transportation of the mover 101 while controlling the attitude of the mover 101.
[0046] First, the mover position calculation function 401 calculates the number and positions of the movers 101 on the first portion 2011 of the stator 201 that constitutes the conveyance path 10 from measurement values from the multiple linear encoders 204 and information on their mounting positions. Through the above calculations, the mover position calculation function 401 updates the mover position information (X) and number information of the mover information 406a, which is information on the movers 101. The mover position information (X) indicates the position of the mover 101 on the stator 201 in the X direction, which is the conveyance direction. The mover information 406a is prepared for each mover 101 on the stator 201, for example, as shown by POS-1, POS-2, ... in FIG. 3A.
[0047] Next, mover attitude calculation function 402 identifies Z sensors 206 that can measure each mover 101 from mover position information (X) of mover information 406 a updated by mover position calculation function 401 .
[0048] Next, mover attitude calculation function 402 calculates attitude information (Z, Wy), which is information related to the attitude of each mover 101, and updates mover information 406a to obtain mover information 406b. Mover attitude calculation function 402 calculates attitude (Z, Wy) based on the value output from identified Z sensor 206. Mover information 406b updated by mover attitude calculation function 402 includes mover position information (X) and attitude information (Z, Wy). At this time, mover attitude calculation function 402 controlling mover 101 in single-axis control section 21 treats mover information 406a as mover information 406b because there is no input from Z sensor 206.
[0049] Next, the mover attitude control function 403 calculates applied force information 408 for each mover 101 from the current mover information 406b, which includes mover position information (X) and attitude information (Z, Wy), and the attitude target value. The applied force information 408 is information regarding the magnitude of the force to be applied to each mover 101. The applied force information 408 includes information regarding the biaxial force components (Tx, Tz) and the uniaxial torque component (Twy) of the force T to be applied. The applied force information 408 is prepared for each mover 101 on the second portion 2012 of the stator 201, as shown by TRQ-1, TRQ-2, ... in FIG. 3A, for example.
[0050] Here, Tx and Tz, which are biaxial components of the force, are the X-direction component and Z-direction component of the force, respectively. Furthermore, Twy, which is a uniaxial component of the torque, is the component about the Y-axis. The conveyance system 1 according to this embodiment controls the three-axial components (Tx, Tz, Twy) of the force T to control the position of the mover 101 in the single-axis control section 21, and to control the conveyance of the mover 101 while controlling the position and attitude of the mover 101 in the multi-axis control section 22. Specifically, the conveyance system 1 controls Tx to control the conveyance of the mover 101 in the single-axis control section 21, and controls Tx, Tz, and Twy to control the position and attitude of the mover 101 while controlling the conveyance of the mover 101 in the multi-axis control section 22. In this case, the mover attitude control function 403 that controls the mover 101 in the single-axis control section 21 does not require attitude information (Z, Wy), and calculates applied force information 408 for the mover 101 from the target value of the mover position information (X). In this case, the applied force information 408 includes information about the uniaxial component (Tx) of the force T to be applied.
[0051] Next, the coil current calculation function 404 determines a current command value 409 to be applied to each coil 202 based on the applied force information 408 and the mover information 406b.
[0052] In this way, the integrated controller 301 executes processing using the mover position calculation function 401, the mover attitude calculation function 402, the mover attitude control function 403, and the coil current calculation function 404, thereby determining the current command value 409. The integrated controller 301 transmits the determined current command value 409 to the coil controller 302.
[0053] 3B, the control of the position and attitude of the mover 101 will be described in further detail. FIG. 3B is a schematic diagram showing an example of a control block for controlling the position and attitude of the mover 101.
[0054] 3B, P is the position and orientation (also referred to as position, orientation, or state) of the mover 101, and has mover position information and orientation information as components. ref is the target value of the position and the target value of the orientation. err is the deviation between the target value ref and the position and orientation P.
[0055] The mover attitude control function 403 calculates the force T to be applied to the mover 101 to achieve the target value ref based on the magnitude of the deviation err, the change in the deviation err, the integrated value of the deviation err, and the like.
[0056] Based on the force T to be applied and the position and attitude P, the coil current calculation function 404 calculates the coil current I to be applied to the coil 202 in order to apply the force T to the mover 101. When the coil current I calculated in this way is applied to the coil 202, the force T acts on the mover 101, and the position and attitude P change to the target value ref.
[0057] By configuring the control block in this way, it becomes possible to control the position and attitude P of the mover 101 to a desired target value ref.
[0058] 3C, the process performed by the mover position calculation function 401 will be described. FIG.
[0059] In Fig. 3C, reference point Oe is the position reference of stator 201 to which linear encoder 204 is attached. Also, reference point Os is the position reference of linear scale 104 attached to mover 101. Fig. 3C shows a case in which two movers 101a and 101b are transported as movers 101, and three linear encoders 204a, 204b, and 204c are arranged as linear encoders 204. Note that linear scale 104 is attached along the X direction at the same position on each of movers 101a and 101b.
[0060] For example, one linear encoder 204c faces the linear scale 104 of the mover 101b shown in Figure 3C. The linear encoder 204c reads the linear scale 104 of the mover 101b and outputs the distance Pc. The position on the X-axis of the linear encoder 204c, with the reference point Oe as the origin, is Sc. Therefore, the position Pos(101b) of the mover 101b can be calculated by the following equation (1). Pos(101b)=Sc-Pc...Equation (1)
[0061] For example, two linear encoders 204a and 204b face the linear scale 104 of the mover 101a shown in Figure 3C. The linear encoder 204a reads the linear scale 104 of the mover 101a and outputs the distance Pa. The position on the X-axis of the linear encoder 204a, with the reference point Oe as the origin, is Sa. Therefore, the position Pos(101a) of the mover 101a on the X-axis based on the output of the linear encoder 204a can be calculated using the following equation (2). Pos(101a)=Sa-Pa...Equation (2)
[0062] Furthermore, linear encoder 204b reads linear scale 104 of mover 101a and outputs distance Pb. Furthermore, the position on the X-axis of linear encoder 204b, with reference point Oe as the origin, is Sb. Therefore, the position Pos(101a)' of mover 101a on the X-axis based on the output of linear encoder 204b can be calculated by the following equation (3). Pos(101a)′=Sb-Pb…Equation (3)
[0063] Here, the position of each of the linear encoders 204a and 204b has been accurately measured in advance, so the difference between the two values Pos(101a) and Pos(101a)' is sufficiently small. In this way, when the difference between the position of the mover 101 on the X-axis based on the outputs of the two linear encoders 204 is sufficiently small, it can be determined that the two linear encoders 204 are observing the linear scale 104 of the same mover 101.
[0064] In addition, when multiple linear encoders 204 face the same mover 101, the observed position of the mover 101 can be uniquely determined by, for example, calculating the average value of the positions based on the outputs of the multiple linear encoders 204.
[0065] As described above, the mover position calculation function 401 calculates and determines the position X of the mover 101 in the X direction as mover position information based on the output of the linear encoder 204. This makes it possible to determine the position X when the mover 101 is located in each of the single-axis control section 21 and the multi-axis control section 22.
[0066] 3D and 3E, a description will be given of the process performed by the mover attitude calculation function 402 for determining attitude information when the mover 101 is located in the multi-axis control section 22. FIGS. 3D and 3E are schematic diagrams for explaining the process performed by the mover attitude calculation function 402.
[0067] 3D and 3E show a case in which mover 101d is transported as mover 101, and Z sensors 206a, 206b, and 206c are arranged as Z sensors 206. Three Z sensors 206a, 206b, and 206c face Z target 106 of mover 101d. Here, the relative distance values output by the three Z sensors 206a, 206b, and 206c are designated Za, Zb, and Zc, respectively. Furthermore, the inter-sensor distance in the X direction, i.e., the distance between Z sensors 206a and 206b, is designated Lz1. Furthermore, the inter-sensor distance in the Y direction, i.e., the distance between Z sensors 206a and 206c, is designated Lz2. Then, the amount of rotation Wy around the Y axis and the amount of rotation Wx around the X axis can be calculated using the following equations (4a) and (4b), respectively. Wy = (Zb - Za) / Lz1 ...Equation (4a) Wx = (Zc - Za) / Lz2 ...Equation (4b)
[0068] As described above, the mover attitude calculation function 402 can calculate the rotation amounts Wy and Wx as attitude information of the mover 101. Note that, of the rotation amounts Wy and Wx, the mover attitude calculation function 402 can calculate only Wy, which is necessary for control in the multi-axis control section 22.
[0069] Furthermore, mover attitude calculation function 402 can calculate position Z of mover 101 in the Z direction as attitude information of mover 101 as follows. Hereinafter, calculation of position Z of mover 101 in the Z direction will be described with reference to Figs. 3D and 3E.
[0070] The three Z sensors 206 on which mover 101d is placed are designated Z sensors 206a, 206b, and 206c, respectively. Measurement values of Z sensors 206a, 206b, and 206c are designated Za, Zb, and Zc, respectively. The X coordinate of Z sensor 206a is the same as the X coordinate of Z sensor 206c. Linear encoder 204 is located midway between Z sensors 206a and 206c. Position X of Z sensor 206a and Z sensor 206c is designated Oe" . The distance from Oe" to center Os" of mover 101d is designated dX". In this case, position Z of mover 101d in the Z direction can be approximately calculated using the following equation: Z=(Za+Zb) / 2+Wy*dX″…Formula (5a)
[0071] If the amount of rotation of Wy is large, the calculation can be performed with even higher approximation accuracy.
[0072] In this way, the integrated controller 301 functions as an acquisition unit that acquires the position and attitude of the mover 101 by executing processing using the mover position calculation function 401 and the mover attitude calculation function 402 .
[0073] Next, processing by the coil current calculation function 404 will be described with reference to Fig. 2C. In the notation of forces used below, the directions in which forces act in the X, Y, and Z directions are indicated by x, y, and z, respectively, the L side which is the Y+ side in Fig. 2C is indicated by L, the R side which is the Y- side is indicated by R, the X+ side is indicated by f, and the X- direction is indicated by b.
[0074] 2C, the forces acting on each permanent magnet 40 on the R-side and L-side are expressed as follows. The forces acting on each permanent magnet 40 are electromagnetic forces that the permanent magnet 40 receives from the multiple coils 202 to which current is applied. The permanent magnet 40 receives electromagnetic forces in the X-direction, which is the direction in which the mover 101 is transported, as well as electromagnetic forces in the Z-direction, which is a direction different from the X-direction, from the multiple coils 202 to which current is applied.
[0075] The forces acting on the R-side permanent magnet 40 are expressed as follows: FxfR: Force acting in the X direction of the R-side permanent magnet 40bR FzfR: Force acting in the Z direction on the R-side permanent magnet 40bR FxbR: Force acting in the X direction on the R-side permanent magnet 40cR FzbR: Force acting in the Z direction on the R-side permanent magnet 40cR
[0076] The forces acting on the L-side permanent magnet 40 are expressed as follows: FxfL: Force acting in the X direction of the left-side permanent magnet 40bL FzfL: Force acting in the Z direction on the left side permanent magnet 40bL FxbL: Force acting in the X direction on the left side of the permanent magnet 40cL FzbL: Force acting in the Z direction on the left side permanent magnet 40cL
[0077] Furthermore, the force T applied to the mover 101 is expressed by the following equation (6a). Note that Tx and Tz are two-axis components of the force, that is, the X-direction component and Z-direction component of the force, respectively. Furthermore, Twy is a one-axis component of the moment, that is, the component about the Y-axis. The conveyance system 1 according to this embodiment controls these three-axis components (Tx, Tz, Twy) of the force T to control the conveyance of the mover 101 in the one-axis control section 21, and to control the three-axis components of the position and attitude of the mover 101 and the conveyance in the multi-axis control section 22. T = (Tx, Tz, Twy) ... Equation (6a)
[0078] Then, Tx, Tz, and Twy are calculated by the following equations (7a), (7c), and (7e), respectively. Tx=FxfR+FxbR+FxfL+FxbL…Formula (7a) Tz=FzbR+FzbL+FzfR+FzfL…Formula (7c) Twy={(FzfL+FzfR)-(FzbL+FzbR)}*ry3 …Equation (7e)
[0079] In this case, the constraints expressed by the following equations (7g), (7j), and (7k) can be introduced into the forces acting on the permanent magnets 40. By introducing these constraints, it is possible to uniquely determine the combination of forces acting on each permanent magnet 40 to obtain a force T having predetermined six-axial components. FxfR=FxbR=FxfL=FxbL …Formula (7g) FzfR=FzfL ...Equation (7j) FzbR=FzbL …Formula (7k)
[0080] Next, a method for determining the amount of current to be applied to each coil 202 from the force acting on each permanent magnet 40 by the coil current calculation function 404 will be described.
[0081] First, we will explain the case where a force in the Z direction is applied to the permanent magnets 40b and 40c. The coil 202 is arranged so that its center in the X direction is located at the center of the permanent magnets 40b and 40c in the X direction. This ensures that almost no force acts on the permanent magnets 40b and 40c in the Y direction.
[0082] Let X be the position of the mover 101, j be the number of the coil 202 arranged in the row, Fz(j,X) be the magnitude of the force acting in the Z direction of coil 202(j) per unit current, and i(j) be the current applied to coil 202(j). Note that coil 202(j) is the j-th coil 202. In this case, current i(j) can be determined so as to satisfy the following equation (8). Note that the following equation (8) is an equation for permanent magnet 40bR. The currents applied to coils 202 of the other permanent magnets 40cR, 40bL, and 40cL can be determined in a similar manner. ΣFz(j, X)*i(j)=FzfR …Equation (8a)
[0083] As described above, coil current calculation function 404 can determine the current command value to be applied to coil 202(j). The Z-direction force applied to mover 101 by the current command value determined in this manner causes mover 101 to obtain a levitation force that levitates mover 101 in the Z direction, and the attitude of mover 101 is controlled.
[0084] In addition, when multiple coils 202 exert a force on the permanent magnet 40, the force acting on the permanent magnet 40 can be uniquely determined by apportioning the current based on the magnitude of the force per unit current according to the force exerted by each coil 202.
[0085] Fig. 4A is a diagram showing six coils 202 facing the permanent magnet 40bR, with the X axis running horizontally and the Y axis running vertically. Fig. 4B is a diagram of Fig. 4A viewed from the Y direction. The coils 202 are assigned numbers j from 1 to 6 in the order they are lined up in the X direction, and hereinafter each coil 202 will be identified by a notation such as coil 202(1).
[0086] 4A and 4B, the coils 202 are arranged at a pitch of a distance L. On the other hand, the permanent magnets 40 of the mover 101 are arranged at a pitch of a distance 3 / 2*L.
[0087] The graph in FIG. 4C is a graph that schematically shows the magnitude of the X-direction force Fx and the Z-direction force Fz that are generated when a unit current is applied to each of the coils 202 shown in FIGS. 4A and 4B.
[0088] 4A to 4C, for simplicity, the origin Oc of the X-direction position of coil 202 is set to the midpoint between coil 202(3) and coil 202(4), and the center Om of permanent magnet 40bR in the X-direction is set to the origin. For this reason, FIGS. 4A to 4C show the case where Oc and Om coincide, i.e., the case where X=0.
[0089] In this case, for example, the force per unit current acting on coil 202(4) is Fx(4,0) in the X direction and Fz(4,0) in the Z direction. Also, the force per unit current acting on coil 202(5) is Fx(5,0) in the X direction and Fz(5,0) in the Z direction.
[0090] Here, the current values applied to coils 202(1) to 202(6) are i(1) to i(6), respectively. Then, the magnitude of the force FxfR acting in the X direction and the magnitude of the force FzfR acting in the Z direction on permanent magnet 40bR are generally expressed by the following equations (9) and (10), respectively. FxfR=Fx(1,X)*i(1)+Fx(2,X)*i(2)+Fx(3,X)*i(3)+Fx(4,X)*i(4)+Fx(5,X)*i(5)+Fx(6,X)*i(6)...Formula (9) FzfR=Fz(1,X)*i(1)+Fz(2,X)*i(2)+Fz(3,X)*i(3)+Fz(4,X)*i(4)+Fz(5,X)*i(5)+Fz(6,X)*i(6)...Formula (10)
[0091] By determining the current command value so that current values i(1) to i(6) that satisfy the above formulas (9) and (10) are applied to coils 202(1) to 202(6), respectively, it is possible to apply forces to permanent magnet 40bR in the X and Z directions independently. Coil current calculation function 404 can determine the current command value to be applied to coil 202(j) as described above in order to apply forces to permanent magnet 40bR in the X and Z directions independently.
[0092] 4A to 4C, consider an example in which only coils 202(3), 202(4), and 202(5) of coils 202(1) to 202(6) are used for permanent magnet 40bR, and control is performed so that the sum of the current values of these three is 0. In this example, the force FxfR acting in the X direction and the force FzfR acting in the Z direction on permanent magnet 40bR are expressed by the following equations (11) and (12), respectively. FxfR=Fx(3,X)*i(3)+Fx(4,X)*i(4)+Fx(5,X)*i(5)...Equation (11) FzfR=Fz(3,X)*i(3)+Fz(4,X)*i(4)+Fz(5,X)*i(5)...Equation (12)
[0093] Moreover, the current values of the coils 202(1) to 202(6) can be set so as to satisfy the following equations (13) and (14). i(3)+i(4)+i(5)=0 ...Equation (13) i(1)=i(2)=i(6)=0 ...Equation (14)
[0094] Therefore, when the magnitude of the force (FxfR, FzfR) required for the permanent magnet 40bR is determined, the current values i(1), i(2), i(3), i(4), i(5), and i(6) can be uniquely determined. Forces are applied to the mover 101 in the X and Z directions by the current command value determined in this manner. The force in the X direction applied to the mover 101 causes the mover 101 to obtain a propulsive force for moving in the X direction, and moves in the X direction. Furthermore, the posture of the mover 101 is controlled by the forces in the X and Z directions applied to the mover 101 by the current command value determined in this manner.
[0095] In this way, the integrated controller 301 controls the currents applied to the multiple coils 202, thereby controlling each of the three axial components of the force applied to the mover 101.
[0096] If the center Oc of the coil 202 moves relative to the center Om of the permanent magnet 40bR due to the movement of the mover 101, that is, if X≠0, the coil 202 corresponding to the moved position can be selected. Furthermore, the same calculation as above can be performed based on the force per unit current generated in the coil 202.
[0097] The integrated controller 301 controls the three-axis components (Tx, Tz, Twy) of the force applied to the mover 101 as described above, thereby controlling the position and attitude of the mover 101 in the single-axis control section 21 and the multi-axis control section 22. That is, the integrated controller 301 can control the position of the mover 101 in the X direction in the single-axis control section 21. Furthermore, the integrated controller 301 can control the attitude (Z) in the Z direction and the attitude (Wy) in the Wy direction in addition to controlling the position (X) of the mover 101 in the X direction in the multi-axis control section 22. The integrated controller 301 can appropriately control at least one of the attitude (Z) in the Z direction and the attitude (Wy) in the Wy direction in the multi-axis control section 22.
[0098] Note that, hereinafter, control of the position of the mover 101 in the X direction is also referred to as control of the X axis. Furthermore, regarding control of the attitude of the mover 101, control of the attitude in the Y direction is also referred to as control of the Y axis, control of the attitude in the Z direction is also referred to as control of the Z axis, control of the attitude in the Wx direction is also referred to as control of the Wx axis, control of the attitude in the Wy direction is also referred to as control of the Wy axis, and control of the attitude in the Wz direction is also referred to as control of the Wz axis.
[0099] The integrated controller 301 can start or end the multi-axis control of the mover 101 depending on the position of the mover 101 being transported on the transport path 10 including the single-axis control section 21 and the multi-axis control section 22.
[0100] First, the start of multi-axis control when the mover 101 is transferred from the single-axis control section 21 to the multi-axis control section 22 will be described.
[0101] Integrated controller 301 can start multi-axis control at the timing when mover 101 enters multi-axis control section 22 and is able to calculate the attitude of that mover 101. Specifically, when at least three Z sensors 206 detect the same mover 101, integrated controller 301 can start control of the mover 101 in the Z axis and Wy axis other than the X axis, in addition to the X axis.
[0102] When starting multi-axis control, the integrated controller 301 can treat the detected attitude (Z, Wy) of the mover 101 as the target attitude value. This allows the mover 101 to be transported while maintaining the attitude (Z, Wy) of the mover 101 on all axes other than the X axis.
[0103] The timing of starting the multi-axis control is not limited to the timing at which it is possible to calculate the attitude immediately after the mover 101 enters the multi-axis control section 22. The timing of starting the multi-axis control may be any timing at which it is possible to calculate the position and attitude within the multi-axis control section 22.
[0104] Furthermore, the integrated controller 301 can also start multi-axis control after the mover 101 is transported to a stop position where the mover 101 should be stopped in order for the process device 3b to process the workpiece 102. In this case, the integrated controller 301 can send a current command value that realizes the operation of the mover 101 required by the process device 3b to the coil controller 302, and control the position and attitude of the mover 101 in accordance with the processing by the process device 3b.
[0105] Next, the termination of the multi-axis control when the mover 101 is transferred from the multi-axis control section 22 to the single-axis control section 21 will be described.
[0106] Integrated controller 301 can end the multi-axis control at the timing when mover 101 enters single-axis control section 21 and it becomes impossible to calculate the attitude of mover 101. Specifically, integrated controller 301 can end the control of the Z-axis and Wy-axis and end the multi-axis control at the timing when the number of Z sensors 206 that detect the same mover 101 changes from three to two.
[0107] The timing for ending the multi-axis control may be other than the timing described above. Specifically, the integrated controller 301 can end the multi-axis control after receiving a signal indicating the end of the processing operation from the process device 3b. The integrated controller 301 can end the multi-axis control and start the impedance control when the rollers 60 of the mover 101 contact the guide rail 50. The integrated controller 301 can control the position and attitude of the mover 101 to a predetermined position and attitude by multi-axis control when the rollers 60 of the mover 101 contact the guide rail 50, and then end the multi-axis control and start the single-axis control. The integrated controller 301 can start the impedance control or end the multi-axis control and start the single-axis control when the mover 101 reaches a position in the X direction pre-stored in a storage device or the like, without using contact with the guide rail 50 as a trigger.
[0108] As described above, the integrated controller 301 determines the current command values of the currents to be applied to the multiple coils 202 and controls the mover 101. As a result, the integrated controller 301 can control the transport of the mover 101 by controlling the X-axis in the single-axis control section 21, and can control the transport and attitude of the mover 101 by controlling the X-axis, Z-axis, and Wy-axis in the multi-axis control section 22.
[0109] In this way, integrated controller 301 functions as a control unit that controls the position and attitude of mover 101, and controls the position and attitude of mover 101 on stator 201. Note that all or part of the functions of integrated controller 301 as a control unit can be substituted by coil controller 302 or other control devices.
[0110] As described above, according to this embodiment, a uniaxial force component (Tx) can be applied to the mover 101 in the uniaxial control section 21. Furthermore, triaxial force components and torque components (Tx, Tz, Twy) can be applied independently to the mover 101 in the multiaxial control section 22. Therefore, according to this embodiment, by installing sensors corresponding to the processing axes required by the process device 3 on the same transport path 10, it is possible to provide the uniaxial control section 21 and the multiaxial control section 22. In other words, it is possible to provide a transport system 1 equipped with control axes corresponding to the processing axes required for each process within the same transport path 10.
[0111] In this embodiment, a case has been described in which three-axis force components and torque components (Tx, Tz, Twy) are applied to the mover 101, but the present invention is not limited to this. If the size of the mover 101 is small and the attitude in the Wy direction can be ignored, the conveyance system 1 can also be configured so that two-axis force components and torque components (Tx, Tz) are applied independently to the mover 101 in the multi-axis control section 22.
[0112] [Second embodiment] A transfer system according to a second embodiment of the present invention will be described with reference to Figures 5A to 6B. Note that components similar to those in the first embodiment are given the same reference numerals, and descriptions thereof will be omitted or simplified.
[0113] The configuration of the transport system 1 according to this embodiment is basically the same as the configuration of the transport system 1 according to the first embodiment. The transport system 1 according to this embodiment differs from the transport system 1 according to the first embodiment in that a Y sensor 205 is used instead of a Z sensor 206 in the multi-axis control section 22 to control the X-axis, Y-axis, and Wz-axis. The transport system 1 according to this embodiment also differs from the transport system 1 according to the first embodiment in that the mover 101 is equipped with a permanent magnet 40 for Y-axis control. The transport system 1 according to this embodiment also differs from the transport system 1 according to the first embodiment in that a multi-axis guide rail 51 is provided in the multi-axis control section 22. The transport system 1 according to this embodiment also differs from the transport system 1 according to the first embodiment in that a storage unit for storing and retaining the posture target value and the multi-axis control end position is provided in the integrated controller 301.
[0114] First, the mover 101 in the transport system 1 according to this embodiment will be described with reference to Fig. 5A to Fig. 5C. Fig. 5A is a diagram of the transport system 1 including the mover 101 and the stator 201 as seen from the positive side in the Z direction, Fig. 5B is a diagram of the transport system 1 including the mover 101 and the stator 201 as seen from the positive side in the X direction, and Fig. 5C is a diagram of the mover 101 as seen from the negative side in the Z direction.
[0115] In this embodiment, the mover 101 has permanent magnets 40aR, 40dR, 40aL, and 40dL in addition to the permanent magnet 40 according to the first embodiment. The permanent magnets 40aR, 40dR, 40aL, and 40dL are attached to the lower surface of the mover 101.
[0116] The permanent magnets 40aR, 40dR, 40aL, and 40dL are arranged in two rows along the X direction at the L-side end and R-side end of the lower surface of the mover 101. Specifically, the permanent magnets 40aR and 40dR are attached to the R-side end of the lower surface of the mover 101 via a yoke 107. Furthermore, the permanent magnets 40aL and 40dL are attached to the L-side end of the lower surface of the mover 101 via a yoke 107.
[0117] The permanent magnets 40aR, 40dR are attached to one end and the other end in the X direction on the R side of the lower surface of the mover 101 along the X direction. The permanent magnets 40bR, 40cR are attached between the permanent magnets 40aR, 40dR on the R side of the lower surface of the mover 101. The permanent magnets 40aR, 40bR, 40cR, and 40dR are arranged, for example, at equal pitches in the X direction. Furthermore, the permanent magnets 40aR, 40bR, 40cR, and 40dR are arranged so that their centers are aligned in a straight line along the X direction, a distance rx3 away from the center of the lower surface of the mover 101 on the R side.
[0118] The permanent magnets 40aL, 40dL are attached to one end and the other end in the X direction on the L side of the underside of the mover 101 along the X direction. The permanent magnets 40bL, 40cL are attached between the permanent magnets 40aL, 40dL on the L side of the underside of the mover 101. The permanent magnets 40aL, 40bL, 40cL, 40dL are arranged, for example, at equal intervals in the X direction. Furthermore, the permanent magnets 40aL, 40bL, 40cL, 40dL are arranged such that their centers are aligned in a straight line along the X direction, a distance rx3 away from the center of the underside of the mover 101 on the L side. Furthermore, the permanent magnets 40aL, 40bL, 40cL, 40dL are arranged in the same position in the X direction as the permanent magnets 40aR, 40bR, 40cR, 40dR, respectively.
[0119] Permanent magnets 40a and 40d are attached at positions a distance rz3 away from origin O, which is the center of mover 101, on one side and the other in the X direction. Permanent magnets 40a, 40b, 40c, and 40d are attached at positions a distance rx3 away from origin O in the Y direction. Permanent magnets 40c and 40b are attached at positions a distance ry3 away from origin O on one side and the other in the X direction.
[0120] Permanent magnets 40aR, 40dR, 40aL, and 40dL each comprise a set of two permanent magnets arranged along the Y direction. Each of permanent magnets 40a and 40d is configured by arranging two permanent magnets along the Y direction so that the polarities of the outer magnetic poles facing the stator 201 alternate. The number of permanent magnets arranged along the Y direction constituting permanent magnets 40a and 40d is not limited to two, but may be any number. Furthermore, the direction in which the permanent magnets constituting permanent magnets 40a and 40d are arranged does not necessarily have to be the Y direction perpendicular to the X direction, which is the conveyance direction, but may be any direction intersecting with the X direction. In other words, permanent magnets 40a and 40d may be a magnet group consisting of multiple permanent magnets arranged along a direction intersecting with the X direction so that the polarities of their magnetic poles alternate.
[0121] The mover 101, which is transported along the second portion 2012 of the stator 201, has a linear scale 104 and a Y target 105. The Y target 105 is attached to the side surface of the mover 101 along the X direction.
[0122] Next, the stator 201 in the conveyance system 1 according to this embodiment will be described with reference to FIGS. 5A to 5C.
[0123] As in the first embodiment, the stator 201 includes a first portion 2011 of the stator 201 that constitutes the single-axis control section 21, and a second portion 2012 of the stator 201 that constitutes the multi-axis control section 22. As in the first embodiment, a guide rail 50 is installed in the first portion 2011 of the stator 201, which is the single-axis control section 21. A guide rail 50 and a multi-axis guide rail 51 are installed in the second portion 2012 of the stator 201, which is the multi-axis control section 22. Guide rails 50 similar to those in the single-axis control section 21 are installed at both ends of the multi-axis control section 22 on the single-axis control section 21 side.
[0124] The multi-axis guide rails 51 of the multi-axis control section 22 are installed between the guide rails 50. The multi-axis guide rails 51 are guide sections that allow the mover 101 to move in the X and Y directions. The multi-axis guide rails 51 are thinner in the Y direction than the guide rails 50 so that the mover 101 can move in the Y direction.
[0125] The guide rails 50 installed at both ends of the multi-axis control section 22 are integrally connected to the guide rails 50 of the single-axis control section 21. Furthermore, the guide rails 50 installed at both ends of the multi-axis control section 22 are installed up to a position in the X direction where at least two Y sensors 205 can detect the same mover 101.
[0126] Stator 201 also has a plurality of coils 202 and a plurality of linear encoders 204. Of stator 201, second portion 2012 of stator 201 constituting multi-axis control section 22 has a plurality of Y sensors 205 required for control other than X-axis control.
[0127] The multiple coils 202 are attached to the stator 201 and arranged in two rows along the X direction so as to be able to face the R-side and L-side permanent magnets 40 on the underside of the mover 101. The multiple coils 202 arranged in one row on the R side are arranged along the X direction so as to be able to face the R-side permanent magnets 40aR, 40bR, 40cR, and 40dR of the mover 101. In addition, the multiple coils 202 arranged in one row on the L side are arranged along the X direction so as to be able to face the L-side permanent magnets 40aL, 40bL, 40cL, and 40dR of the mover 101.
[0128] Linear encoder 204 and Y sensor 205 function as detection units that detect the position and posture of mover 101 moving along the X direction, which is the conveyance direction. Multiple Y sensors 205 are attached to second portion 2012 of stator 201 along the X direction so as to be able to face Y targets 105 of mover 101, respectively. Each Y sensor 205 can detect and output the position of mover 101 in the Y direction, i.e., the relative distance in the Y direction from Y target 105 attached to mover 101. Integrated controller 301 can control the position and / or posture of mover 101 based on the position of mover 101 in the X direction, which is detection information from linear encoder 204, and the position of mover 101 in the Y direction, which is detection information from Y sensor 205.
[0129] In this embodiment, the rows of coils 202 on the R side and the L side of the mover 101 are arranged so as to face the permanent magnets 40a, 40d and the permanent magnets 40b, 40c, which are configured such that the arrangement directions of the multiple permanent magnets differ from each other. Therefore, with a small number of rows of coils 202, it is possible to apply a force in the transport direction and a force different from the transport direction to the mover 101, as will be described later, and therefore it is possible to realize transport control and posture control of the mover 101.
[0130] Next, a method of controlling the attitude of the mover 101 executed by the integrated controller 301 will be described with reference to FIGS. 6A and 6B.
[0131] The attitude control method according to this embodiment differs from the attitude control method according to the first embodiment in that the X-axis, Y-axis, and Wz-axis are controlled using a Y sensor 205 instead of a Z sensor 206 in the multi-axis control section 22. Specifically, the differences are in the processing by the mover attitude calculation function 402, the mover attitude control function 403, and the coil current calculation function 404, and in the processing related to the applied force information 408.
[0132] Fig. 6A is a schematic diagram showing the attitude control method of the mover 101 in the transportation system 1 according to this embodiment. Like Fig. 3A, Fig. 6A shows an outline of the attitude control method of the mover 101, focusing mainly on the data flow. In this embodiment as well, the integrated controller 301 executes processing using a mover position calculation function 401, a mover attitude calculation function 402, a mover attitude control function 403, and a coil current calculation function 404, and controls the transportation of the mover 101 while controlling the attitude of the mover 101.
[0133] The mover attitude calculation function 402 identifies the Y sensor 205 capable of measuring each mover 101 from the mover position information (X) of the mover information 406a updated by the mover position calculation function 401 in the same way as in the first embodiment.
[0134] Next, mover posture calculation function 402 calculates posture information (Y, Wz), which is information about the posture of each mover 101, based on the value output from the identified Y sensor 205, and updates mover information 406a to obtain mover information 406b. Mover information 406b updated by mover posture calculation function 402 includes mover position information (X) and posture information (Y, Wz).
[0135] Next, the mover attitude control function 403 calculates applied force information 408 for each mover 101 from the current mover information 406b, which includes mover position information (X) and attitude information (Y, Wz), and the attitude target value. The applied force information 408 is information regarding the magnitude of the force to be applied to each mover 101. In this embodiment, the applied force information 408 includes information regarding the biaxial force components (Tx, Ty) and the uniaxial torque component (Twz) of the force T to be applied, which will be described later.
[0136] Here, Tx and Ty, which are biaxial components of the force, are the X-direction component and Y-direction component of the force, respectively. Furthermore, Twz, which is a uniaxial component of the torque, is a component about the Z-axis. The conveyance system 1 according to this embodiment controls the position of the mover 101 in the single-axis control section 21 by controlling these three-axis components (Tx, Ty, Twz) of the force T, and controls the conveyance of the mover 101 while controlling the position and attitude of the mover 101 in the multi-axis control section 22. Specifically, the conveyance system 1 controls Tx to control the conveyance of the mover 101 in the single-axis control section 21, and controls Tx, Ty, and Twz to control the position and attitude of the mover 101 while controlling the conveyance of the mover 101 in the multi-axis control section 22. At this time, the mover attitude control function 403 that controls the mover 101 in the single-axis control section 21 does not require attitude information (Y, Wz), and calculates applied force information 408 for the mover 101 from the target value of the mover position information (X). In this case, the applied force information 408 includes information about the uniaxial component (Tx) of the force T to be applied.
[0137] The coil current calculation function 404 determines a current command value 409 to be applied to each coil 202 based on the applied force information 408 and the mover information 406b.
[0138] 6B, the process performed by the mover attitude calculation function 402 will be described. FIG.
[0139] Fig. 6B shows a case where mover 101c is transported as mover 101, and Y sensors 205a and 205b are arranged as Y sensor 205. Two Y sensors 205a and 205b face Y target 105 of mover 101c shown in Fig. 6B. If the relative distance values output by the two Y sensors 205a and 205b are Ya and Yb, respectively, and the distance between Y sensors 205a and 205b is Ly, the amount of rotation Wz of mover 101c about the Z axis is calculated by the following equation (4c): Wz=(Ya-Yb) / Ly ...Equation (4c)
[0140] It is possible that three or more Y sensors 205 face each other depending on the position of the mover 101. In this case, the tilt of the Y target 105, i.e., the amount of rotation Wz around the Z axis, can be calculated using the least squares method or the like.
[0141] Furthermore, mover posture calculation function 402 can calculate position Y of mover 101 in the Y direction as posture information of mover 101 as follows. Calculation of position Y of mover 101 in the Y direction will be explained using FIG. 6B. In FIG. 6B, the midpoint between the positions of Y sensor 205a and Y sensor 205b is defined as Oe'. Furthermore, position Os' of mover 101c obtained by equations (1) to (3) is defined as Os', and the distance from Oe' to Os' is defined as dX'. In this case, position Y of mover 101c in the Y direction can be calculated approximately using the following equation (5b). Y=(Ya+Yb) / 2-Wz*dX′ …Equation (5b)
[0142] It should be noted that when the amount of rotation of Wz is large, the position Y can be calculated with even higher approximation accuracy.
[0143] Next, the processing by the coil current calculation function 404 will be described with reference to FIG. 5C. The forces acting on the R-side permanent magnet 40 are expressed as follows: FxfR: Force acting in the X direction of the R-side permanent magnet 40bR FyfR: Force acting in the Y direction on the R-side permanent magnet 40aR FxbR: Force acting in the X direction on the R-side permanent magnet 40cR FybR: Force acting in the Y direction on the R-side permanent magnet 40dR
[0144] The forces acting on the L-side permanent magnet 40 are expressed as follows: FxfL: Force acting in the X direction of the left-side permanent magnet 40bL FyfL: Force acting in the Y direction of the L-side permanent magnet 40aL FxbL: Force acting in the X direction on the left side of the permanent magnet 40cL FybL: Force acting in the Y direction on the L-side permanent magnet 40dL
[0145] Furthermore, the force T applied to the mover 101 is expressed by the following equation (6b). Note that Tx and Ty are two-axis components of the force, which are the X-direction component and the Y-direction component of the force, respectively. Furthermore, Twz is a one-axis component of the moment, which is the component about the Z-axis. The conveyance system 1 according to this embodiment controls these three-axis components (Tx, Ty, Twz) of the force T to control the conveyance of the mover 101 in the one-axis control section 21, and to control the three-axis components of the position and attitude of the mover 101 and the conveyance in the multi-axis control section 22. T=(Tx,Ty,Twz) …Equation (6b)
[0146] Then, Tx, Ty, and Twz are calculated by the following equations (7a), (7b), and (7f), respectively. Tx=FxfR+FxbR+FxfL+FxbL…Formula (7a) Ty=FyfL+FyfR+FybL+FybR…Formula (7b) Twz={(FyfL+FyfR)-(FybL+FybR)}*rz3 …Equation (7f)
[0147] In this case, the constraints expressed by the following equations (7g), (7h), and (7i) can be introduced into the forces acting on the permanent magnets 40. By introducing these constraints, it is possible to uniquely determine the combination of forces acting on each permanent magnet 40 to obtain a force T having predetermined six-axis components. FxfR=FxbR=FxfL=FxbL …Formula (7g) FyfL=FyfR ...Equation (7h) FybL=FybR…Formula (7i)
[0148] Next, a method will be described in which the coil current calculation function 404 determines the amount of current to be applied to each coil 202 from the force acting on each permanent magnet 40. In this embodiment, a case will be described in which a force in the Y direction is applied to permanent magnets 40a, 40d in which N and S poles are alternately arranged in the Z direction. The coil 202 is arranged so that its center in the Y direction is located at the center of the permanent magnets 40a, 40d in the Y direction. This ensures that almost no force acts on the permanent magnets 40a, 40d in the X and Z directions.
[0149] Let X be the position of the mover 101, j be the number of the coil 202 arranged in the row, Fy(j,X) be the magnitude of the force acting in the Y direction of coil 202(j) per unit current, and i(j) be the current applied to coil 202(j). Note that coil 202(j) is the j-th coil 202. In this case, current i(j) can be determined so as to satisfy the following equation (8b). Note that the following equation (8b) is an equation for permanent magnet 40dR. The currents applied to coils 202 of the other permanent magnets 40aR, 40aL, and 40dL can be determined in a similar manner. ΣFy(j, X)*i(j)=FybR …Equation (8b)
[0150] As described above, coil current calculation function 404 can determine the current command value to be applied to coil 202(j). The force in the Y direction is applied to mover 101 by the current command value determined in this manner, and the posture of mover 101 is controlled in the Y direction.
[0151] In addition, when multiple coils 202 exert a force on the permanent magnet 40, the force acting on the permanent magnet 40 can be uniquely determined by apportioning the current based on the magnitude of the force per unit current according to the force exerted by each coil 202.
[0152] As described above, the integrated controller 301 controls the three-axis components (Tx, Ty, Twz) of the force applied to the mover 101, thereby controlling the position and attitude of the mover 101 in the single-axis control section 21 and the multi-axis control section 22. That is, the integrated controller 301 can control the position of the mover 101 in the X direction in the single-axis control section 21. Furthermore, in the multi-axis control section 22, the integrated controller 301 not only controls the position (X) of the mover 101 in the X direction, but can also appropriately control at least one of the attitude (Y) in the Y direction and the attitude (Wz) in the Wz direction.
[0153] Next, the start of multi-axis control when the mover 101 is transferred from the single-axis control section 21 to the multi-axis control section 22 will be described.
[0154] The integrated controller 301 can start multi-axis control at the timing when the mover 101 enters the multi-axis control section 22 and can calculate the attitude of the mover 101. Specifically, in this embodiment, when at least two Y sensors 205 detect the same mover 101, the integrated controller 301 can start control of the Y-axis and Wz-axis other than the X-axis, in addition to the X-axis control, for the mover 101.
[0155] When starting multi-axis control, the integrated controller 301 can treat the detected attitude (Y, Wz) of the mover 101 as the target attitude value. This allows the mover 101 to be transported while maintaining the attitude (Y, Wz) of the mover 101 other than the X-axis.
[0156] In this embodiment, the timing of starting the multi-axis control is not limited to the timing at which it is possible to calculate the attitude immediately after the mover 101 enters the multi-axis control section 22. The timing of starting the multi-axis control may be any timing at which it is possible to calculate the position and attitude within the multi-axis control section 22.
[0157] Also in this embodiment, the integrated controller 301 can start multi-axis control after the mover 101 is transported to a stop position where the mover 101 should be stopped in order for the process device 3b to machine the workpiece 102. In this case, the integrated controller 301 can send a current command value that realizes the operation of the mover 101 required by the process device 3b to the coil controller 302, and control the position and attitude of the mover 101 in accordance with the machining by the process device 3b.
[0158] Next, the end of the multi-axis control when the mover 101 is transferred from the multi-axis control section 22 to the single-axis control section 21 will be described.
[0159] The integrated controller 301 can end the multi-axis control at the timing when the mover 101 enters the single-axis control section 21 and it becomes impossible to calculate the attitude of the mover 101. Specifically, in this embodiment, the integrated controller 301 can end the control of the Y-axis and Wz-axis and end the multi-axis control at the timing when the number of Y sensors 205 that detect the same mover 101 changes from two to one.
[0160] The timing of ending the multi-axis control may be timing other than the timing described above. Other specific examples of the timing of ending the multi-axis control are as described in the first embodiment.
[0161] As described above, according to this embodiment, a uniaxial force component (Tx) can be applied to the mover 101 in the uniaxial control section 21. Furthermore, triaxial force components and torque components (Tx, Ty, Twz) can be applied independently to the mover 101 in the multiaxial control section 22. Therefore, according to this embodiment, by installing sensors corresponding to the processing axes required by the process device 3 on the same transport path 10, it is possible to provide the uniaxial control section 21 and the multiaxial control section 22. In other words, it is possible to provide a transport system 1 equipped with control axes corresponding to the processing axes required for each process within the same transport path 10.
[0162] In this embodiment, a case has been described in which force components and torque components (Tx, Ty, Twz) along three axes are applied to the mover 101, but the present invention is not limited to this. If the size of the mover 101 is small and the attitude in the Wz direction can be ignored, the conveyance system 1 can also be configured so that force components and torque components (Tx, Ty) along two axes are applied independently to the mover 101 in the multi-axis control section 22.
[0163] [Third embodiment] A transfer system according to a third embodiment of the present invention will be described with reference to Figures 7A to 8. Note that components similar to those in the first and second embodiments are given the same reference numerals, and descriptions thereof will be omitted or simplified.
[0164] The configuration of the transport system 1 according to this embodiment is basically the same as the configuration of the transport system 1 according to the second embodiment. The transport system 1 according to this embodiment differs from the transport system 1 according to the second embodiment in that the transport system 1 according to this embodiment uses a Y sensor 205 and a Z sensor 206 provided on the second part 2012 of the stator 201 in the multi-axis control section 22 to control the X-axis, Y-axis, Z-axis, Wx-axis, Wy-axis, and Wz-axis for levitation transport. Furthermore, the transport system 1 according to this embodiment differs from the transport system 1 according to the second embodiment in part of the configuration of the mover 101 and the stator 201. Furthermore, the transport system 1 according to this embodiment differs from the transport system 1 according to the second embodiment in the shapes of the guide rail 50 in the single-axis control section 21 and the multi-axis guide rail 51 in the multi-axis control section 22.
[0165] First, the mover 101 in the transport system 1 according to this embodiment will be described with reference to Fig. 7A to Fig. 7C. Fig. 7A is a diagram of the transport system 1 including the mover 101 and the stator 201 as viewed from the positive side in the Z direction, Fig. 7B is a diagram of the transport system 1 including the mover 101 and the stator 201 as viewed from the positive side in the X direction, and Fig. 7C is a diagram of the mover 101 as viewed from the negative side in the Z direction.
[0166] The mover 101 has rollers 60 attached to its lower surface, which is the negative surface in the Z direction, that can run along guide rails 50 installed on the stator 201. The rollers 60 are configured to be able to run along the guide rails 50 while being fixed in the Y and Z directions by contacting, for example, both side surfaces of the guide rails 50. The rollers 60 are also configured so that their movement in the Y and Z directions is limited within a predetermined range by the multi-axis guide rails 51a.
[0167] The mover 101 has a plurality of permanent magnets 40 similar to those in the second embodiment. Specifically, permanent magnets 40aR, 40bR, 40cR, and 40dR are attached to the R side of the lower surface of the mover 101. Furthermore, permanent magnets 40aL, 40bL, 40cL, and 40dL are attached to the L side of the lower surface of the mover 101.
[0168] The mover 101, which is transported along the stator 201, has a linear scale 104, a Y target 105, and a Z target 106. The linear scale 104 and the Y target 105 are attached to the side surfaces of the mover 101, respectively. The Z target 106 is attached to the bottom of the mover 101 along the X direction. The integrated controller 301 can control the position and / or attitude of the mover 101 based on the X-direction position, Y-direction position, and Z-direction position of the mover 101, which are detection information from the linear encoder 204, the Y sensor 205, and the Z sensor 206, respectively.
[0169] Next, the stator 201 in the conveyance system 1 according to this embodiment will be described with reference to FIGS. 7A to 7C.
[0170] As in the second embodiment, the stator 201 includes a first portion 2011 of the stator 201 that constitutes the single-axis control section 21, and a second portion 2012 of the stator 201 that constitutes the multi-axis control section 22. As in the second embodiment, a guide rail 50 is installed in the first portion 2011 of the stator 201, which is the single-axis control section 21. A guide rail 50 and a multi-axis guide rail 51a are installed in the second portion 2012 of the stator 201, which is the multi-axis control section 22. Guide rails 50 similar to those in the single-axis control section 21 are installed at both ends of the multi-axis control section 22 on the single-axis control section 21 side.
[0171] The multi-axis guide rails 51a of the multi-axis control section 22 are installed between the guide rails 50. The multi-axis guide rails 51a are thinner in the Y and Z directions than the guide rails 50 so that the mover 101 can move in the Y and Z directions.
[0172] The guide rails 50 installed at both ends of the multi-axis control section 22 are integrally connected to the guide rails 50 of the single-axis control section 21. Furthermore, the guide rails 50 installed at both ends of the multi-axis control section 22 are installed up to a position in the X direction where at least two Y sensors 205 and at least three Z sensors 206 can detect the same mover 101.
[0173] Stator 201 has a plurality of coils 202 and a plurality of linear encoders 204. Of stator 201, a second portion 2012 of stator 201 constituting multi-axis control section 22 has a plurality of Y sensors 205 and a plurality of Z sensors 206 required for control other than X-axis control.
[0174] As in the second embodiment, the multiple coils 202 are attached to the stator 201 and arranged in two rows along the X direction so as to be able to face the permanent magnets 40 on the R and L sides of the lower surface of the mover 101.
[0175] The linear encoder 204, the Y sensor 205, and the Z sensor 206 function as detection units that detect the position and posture of the mover 101 that moves along the X direction, which is the transport direction.
[0176] The multiple Y sensors 205 are attached to the stator 201 along the X direction so as to face the Y targets 105 of the mover 101. Each Y sensor 205 can detect and output the relative distance in the Y direction between itself and the Y targets 105 attached to the mover 101.
[0177] The multiple Z sensors 206 are attached to the stator 201 along the X direction so as to face the Z targets 106 of the mover 101. Each Z sensor 206 is attached to the stator 201 so as to be able to detect the distance in the Z direction between itself and the Z targets 106 attached to the mover 101.
[0178] Next, a method of controlling the attitude of the mover 101 executed by the integrated controller 301 will be described with reference to FIG.
[0179] The posture control method according to this embodiment differs from the posture control method according to the second embodiment in that the X-axis, Y-axis, Z-axis, Wx-axis, Wy-axis, and Wz-axis are controlled using Y sensor 205 and Z sensor 206 in the multi-axis control section 22. Specifically, the processes by mover posture calculation function 402, mover posture control function 403, and coil current calculation function 404, and the processes related to applied force information 408 are different.
[0180] Fig. 8 is a schematic diagram showing the attitude control method of the mover 101 in the transportation system 1 according to this embodiment. Like Fig. 3A and Fig. 6A, Fig. 8 shows an outline of the attitude control method of the mover 101, focusing mainly on the data flow. In this embodiment as well, the integrated controller 301 executes processing using a mover position calculation function 401, a mover attitude calculation function 402, a mover attitude control function 403, and a coil current calculation function 404, and controls the transportation of the mover 101 while controlling the attitude of the mover 101.
[0181] The mover posture calculation function 402 identifies the Y sensor 205 and the Z sensor 206 that can measure each mover 101 from the mover position information (X) of the mover information 406a updated by the mover position calculation function 401 in the same way as in the first embodiment.
[0182] Next, the mover posture calculation function 402 calculates posture information (Y, Z, Wx, Wy, Wz), which is information about the posture of each mover 101, based on the values output from the identified Y sensor 205 and Z sensor 206. In this way, the mover posture calculation function 402 updates the mover information 406a to obtain mover information 406b. The mover information 406b updated by the mover posture calculation function 402 includes mover position information (X) and posture information (Y, Z, Wx, Wy, Wz).
[0183] Next, the mover attitude control function 403 calculates applied force information 408 for each mover 101 from the current mover information 406b, which includes mover position information (X) and attitude information (Y, Z, Wx, Wy, Wz), and the attitude target value. The applied force information 408 is information regarding the magnitude of the force to be applied to each mover 101. In this embodiment, the applied force information 408 includes information regarding the three-axis components (Tx, Ty, Tz) of the force T to be applied and the three-axis components (Twx, Twy, Twz) of the torque.
[0184] Here, the three-axis components of the force, Tx, Ty, and Tz, are the X-direction component, Y-direction component, and Z-direction component of the force, respectively. Furthermore, the three-axis components of the torque, Twx, Twy, and Twz, are the component around the X-axis, the component around the Y-axis, and the component around the Z-axis, respectively. The conveyance system 1 according to this embodiment controls these six-axis components (Tx, Ty, Tz, Twx, Twy, and Twz) of the force T. As a result, the conveyance system 1 controls the position of the mover 101 in the single-axis control section 21, and controls the conveyance of the mover 101 while controlling the position and posture of the mover 101 in the multi-axis control section 22. Specifically, the conveyance system 1 controls Tx to control the conveyance of the mover 101 in the single-axis control section 21, and controls Tx, Ty, Tz, Twx, Twy, and Twz to control the position and posture of the mover 101 while controlling the conveyance of the mover 101 in the multi-axis control section 22. At this time, the mover attitude control function 403 that controls the mover 101 in the one-axis control section 21 does not require attitude information (Y, Z, Wx, Wy, Wz), and calculates applied force information 408 for the mover 101 from the target value of the mover position information (X). In this case, the applied force information 408 includes information about the one-axis component (Tx) of the force T to be applied.
[0185] The mover attitude calculation function 402 can calculate the attitudes of Y, Z, Wy, and Wz using the same calculation method as described in the first and second embodiments. Furthermore, the rotation amount Wx can be calculated using the following equation (4b). This allows the mover attitude calculation function 402 to calculate the attitude information (Y, Z, Wx, Wy, Wz). Wx = (Zc - Za) / Lz2 ...Equation (4b)
[0186] Next, processing by the coil current calculation function 404 will be described. The force T applied to the mover 101 is expressed by the following equation (6c). Note that Tx, Ty, and Tz are three-axis components of the force, which are the X-axis component, the Y-axis component, and the Z-axis component of the force, respectively. Furthermore, Twx, Twy, and Twz are three-axis components of the moment, which are the X-axis component, the Y-axis component, and the Z-axis component. The conveyance system 1 according to this embodiment controls the six-axis components of the force T (Tx, Ty, Tz, Twx, Twy, and Twz) to levitate and control the attitude of the mover 101 along six axes, while controlling the conveyance of the mover 101. In this embodiment, too, the conveyance system 1 controls the conveyance of the mover 101 in the single-axis control section 21, and controls the six-axis components of the position and attitude of the mover 101 and the conveyance in the multi-axis control section 22. T=(Tx,Ty,Tz,Twx,Twy,Twz) ...Formula (6c)
[0187] Then, Tx, Ty, Tz, Twx, Twy, and Twz are calculated by the following equations (7a), (7b), (7c), (7d), (7e), and (7f), respectively. Tx=FxfR+FxbR+FxfL+FxbL…Formula (7a) Ty=FyfL+FyfR+FybL+FybR…Formula (7b) Tz=FzbR+FzbL+FzfR+FzfL…Formula (7c) Twx={(FzfL+FzbL)-(FzfR+FzbR)}*rx3 …Equation (7d) Twy={(FzfL+FzfR)-(FzbL+FzbR)}*ry3 …Equation (7e) Twz={(FyfL+FyfR)-(FybL+FybR)}*rz3 …Equation (7f)
[0188] In this case, the constraints expressed by the following equations (7g), (7h), (7i), (7j), and (7k) can be introduced into the forces acting on the permanent magnets 40. By introducing these constraints, it is possible to uniquely determine the combination of forces acting on each permanent magnet 40 to obtain a force T having predetermined six-axis components. FxfR=FxbR=FxfL=FxbL …Formula (7g) FyfL=FyfR ...Equation (7h) FybL=FybR…Formula (7i) FzfR=FzfL ...Equation (7j) FzbR=FzbL …Formula (7k)
[0189] The coil current calculation function 404 can determine the amount of current to be applied to each coil 202 from the force acting on each permanent magnet 103 using the same calculation method as described in the first and second embodiments. In this way, the integrated controller 301 can control each of the six-axis components of the force applied to the mover 101 by controlling the current to be applied to the multiple coils 202.
[0190] As described above, the integrated controller 301 controls the six-axis components (Tx, Ty, Tz, Twx, Twy, Twz) of the force applied to the mover 101, thereby controlling the position and attitude of the mover 101 in the single-axis control section 21 and the multi-axis control section 22. That is, the integrated controller 301 can control the position of the mover 101 in the X direction in the single-axis control section 21. Furthermore, in the multi-axis control section 22, the integrated controller 301 can control not only the position (X) of the mover 101 in the X direction, but also the attitudes (Y, Z) in the Y and Z directions and the attitudes (Wx, Wy, Wz) in the Wx, Wy, and Wz directions. In the multi-axis control section 22, the integrated controller 301 can appropriately control at least one of the attitudes (Y, Z) in the Y and Z directions and the attitudes (Wx, Wy, Wz) in the Wx, Wy, and Wz directions.
[0191] Next, the multi-axis control (floating control) when the mover 101 is transported to the multi-axis control section 22, including the transfer from the guide rail 50 to the multi-axis guide rail 51a within the multi-axis control section 22, will be described.
[0192] The integrated controller 301 can start multi-axis control (levitation control) at the timing when the mover 101 enters the multi-axis control section 22 and can calculate the attitude of the mover 101. Specifically, when at least two Y sensors 205 and at least three Z sensors 206 detect the same mover 101, the integrated controller 301 starts to control the mover 101 in the Y-axis, Z-axis, Wx-axis, Wy-axis, and Wz-axis other than the X-axis, in addition to the X-axis.
[0193] When starting multi-axis control, the integrated controller 301 can treat the detected attitudes (Y, Z, Wx, Wy, Wz) of the mover 101 as target attitude values. This allows the mover 101 to be transported while maintaining the attitudes (Y, Z, Wx, Wy, Wz) of the mover 101 other than the X-axis.
[0194] At this time, the integrated controller 301 can start multi-axis control when the posture of the mover 101 is fixed by the guide rails 50, that is, when the posture (Y, Z, Wx, Wy, Wz) is restricted by the guide rails 50. This makes it possible to transition to multi-axis control (levitation control) before the mover 101 enters the multi-axis guide rails 51a in the multi-axis control section 22, and it becomes possible to control the position and posture of the mover 101 with high precision.
[0195] Next, the multi-axis control (levitation control) when the mover 101 is transported to the single-axis control section 21, including the transfer from the multi-axis guide rail 51a to the guide rail 50 in the multi-axis control section 22, will be described.
[0196] When issuing a command to transport the mover 101 from the stop position of the mover 101 after the machining operation in the process device 3b is completed to the single-axis control section 21 from the multi-axis control section 22, the integrated controller 301 instructs preparatory target values for control transition for the control of the axes other than the X-axis. The integrated controller 301 stores, as preparatory target values for control transition, the position of the mover 101 when its posture is fixed on the guide rail 50 and the calculated position of the posture, which have been acquired in advance. This allows the mover 101 to enter the guide rail 50 from the multi-axis guide rail 51a without colliding with the guide rail 50.
[0197] The integrated controller 301 can end the multi-axis control at the timing when the mover 101 enters the guide rail 50 in the multi-axis control section 22 and the posture of the mover 101 is fixed. Specifically, the integrated controller 301 stores in advance the end position, which is the position in the X direction at which the multi-axis control (levitation control) ends, and can end the multi-axis control at the timing when the mover 101 passes that position.
[0198] As described above, according to this embodiment, in the single-axis control section 21, it is possible to control one axis, the X axis, for the mover 101. Furthermore, in the multi-axis control section 22, it is possible to control (float control) all six axes (X axis, Y axis, Z axis, Wx axis, Wy axis, and Wz axis) for the mover 101. Therefore, according to this embodiment, by installing sensors corresponding to the processing axes required by the process device 3 on the same transport path 10 and installing multi-axis guide rails 51a in the multi-axis control section 22, it is possible to provide the single-axis control section 21 and the multi-axis control section 22. In other words, it is possible to provide a transport system 1 equipped with control axes corresponding to the processing axes required for each process within the same transport path 10.
[0199] Note that a guide rail 51b having the shape shown in FIG. 7D can also be used as the multi-axis guide rail 51a in the multi-axis control section 22. The guide rail 51b has convex portions 511b that protrude on both sides in the Y direction so as to be able to support the rollers 60a and 60b on both sides in the Y and Z directions. Because the mover 101 is supported in the Y and Z directions by the guide rail 51b in the multi-axis control section 22, it is not necessary to control the Y, Z, and Wy axes until the mover 101 reaches the processing position of the process device 3b, where six-axis processing operations are required. In this case, six-axis levitation control can be started after the mover 101 arrives at the processing position of the process device 3b.
[0200] [Fourth embodiment] A transfer system according to a fourth embodiment of the present invention will be described with reference to Figures 9A to 10. Note that components similar to those in the third embodiment are given the same reference numerals, and descriptions thereof will be omitted or simplified.
[0201] The configuration of the conveying system 1 according to this embodiment is basically the same as the configuration of the conveying system 1 according to the third embodiment. The conveying system 1 according to this embodiment differs from the conveying system 1 according to the third embodiment in that the multi-axis guide rail 51a is not installed in the second part 2012 of the stator 201 in the multi-axis control section 22. The conveying system 1 according to this embodiment also differs from the conveying system 1 according to the third embodiment in that an entry assist member 500 is installed on the guide rail 50.
[0202] In addition, in the conveying system 1 according to the first and second embodiments, a configuration can be adopted in which a multi-axis guide rail 51 is not installed, as in the conveying system 1 according to this embodiment, and an entry assistance member 500 is installed on the guide rail 50.
[0203] The stator 201 in the transport system 1 according to this embodiment will be described with reference to Fig. 9A to Fig. 9C. Fig. 9A is a view of the transport system 1 including the mover 101 and the stator 201 as seen from the positive side in the Z direction, Fig. 9B is a view of the transport system 1 including the mover 101 and the stator 201 as seen from the positive side in the X direction, and Fig. 9C is a view of the entry assist member 500 as seen from the positive side in the X direction.
[0204] Only one-axis guide rail 50 is installed in the first portion 2011 of the stator 201. An entry assist member 500 is installed at the end of the guide rail 50, which is the gap between the guide rails 50 installed in the multi-axis control section 22.
[0205] 9C, the entry assist member 500 has its corners cut off to assist the entry of the rollers 60 of the mover 101 into the guide rail 50. As a result, when the mover 101 transfers from the multi-axis control section 22 to the guide rail 50 and is transported to the single-axis control section 21, even if the preparation target value for control transition is not set to a predetermined value, the entry assist member 500 can smoothly transfer the mover 101. Furthermore, impedance control may be performed when the mover 101 enters the entry assist member 500. This reduces the force received from the entry assist member 500, allowing the mover 101 to enter the guide rail 50 smoothly.
[0206] As described above, according to this embodiment, even if the multi-axis guide rail 51a is not installed, it is possible to control one axis, the X axis, with respect to the mover 101 in the single-axis control section 21. Furthermore, in the multi-axis control section 22, it is possible to control (float control) all six axes, namely the X axis, Y axis, Z axis, Wx axis, Wy axis, and Wz axis, with respect to the mover 101, and transport the mover 101. Therefore, according to this embodiment, it is possible to provide the single-axis control section 21 and the multi-axis control section 22 on the same transport path 10. In other words, it is possible to provide a transport system 1 equipped with control axes corresponding to the processing axes required for each process within the same transport path 10.
[0207] The multi-axis guide rail 51a and entry assist member 500 in the multi-axis control section 22 used in the third embodiment may be used in the configuration shown in FIG. 10. In this case, the entry assist member 500 is installed between the multi-axis guide rail 51a and the guide rail 50 so as to connect the end of the multi-axis guide rail 51a to the end of the guide rail 50. The length of the entry assist member 500 may be freely changed in the X direction when it is installed. In this case, the shape of the entry assist member 500 can be a shape whose outline is a line connecting the end of the multi-axis guide rail 51a to the apex of the end of the guide rail 50.
[0208] Furthermore, the multi-axis control does not have to end at the timing of the third embodiment. The integrated controller 301 can also end the multi-axis control when the mover 101 reaches the position of the multi-axis guide rail 51a or the entry assist member 500 within the multi-axis control section 22. Specifically, the integrated controller 301 can end control of axes other than the X-axis after the mover 101 moves to a position where the rollers 60 of the mover 101 contact the multi-axis guide rail 51a or the entry assist member 500. This allows the rollers 60 of the mover 101 to move in the X direction along the shape of the entry assist member 500, enabling transition between the multi-axis control section 22 and the single-axis control section 21. This makes it possible to provide a conveyance system 1 equipped with control axes corresponding to the processing axes required for each process within the same conveyance path 10.
[0209] [Modified embodiment] The present invention is not limited to the above-described embodiment, and various modifications are possible. For example, in the above embodiment, the conveyance system 1 is configured by a moving magnet type linear motor in which the permanent magnet 40 is disposed in the mover 101 and the coil 202 is disposed in the stator 201, but the present invention is not limited to this. The conveyance system 1 can also be configured by a moving coil type linear motor in which the permanent magnet 40 is disposed in the stator 201 and the coil 202 is disposed in the mover 101.
[0210] The conveying system according to the present invention has been described above in Examples 1 to 4. The conveying system according to the present invention can be used as a conveying system in a manufacturing system for manufacturing articles such as electronic devices, which conveys a workpiece together with a mover to the working area of each process device, such as a machine tool, that performs each work process on the workpiece. The process device that performs the work process may be any device, such as a device that assembles parts on the workpiece or a device that paints. Furthermore, the articles to be manufactured are not limited to specific ones, and may be any parts.
[0211] In this way, by using the transfer system according to the present invention, it is possible to provide a transfer system that has control axes corresponding to the processing axes required for each process within the same transfer path. [Explanation of symbols]
[0212] 1. Transport system 3 Process equipment 10 Conveyor path 21 1-axis control section 22 Multi-axis control section 40 Permanent Magnets 50 guide rail 51 Multi-axis guide rail 60 Laura 101 Mover 102 Work 104 Linear Scale 105 Y Target 106 Z Target 107 York 201 Stator 202 Coil 204 Linear Encoder 205 Y sensor 206 Z sensor 301 Integrated Controller 302 Coil Controller 304 Sensor Controller 500 Entry aids
Claims
1. A movable element, a first conveying section having a first portion of a stator on which the mover is conveyed; a second transport section adjacent to the first transport section and having a second portion of the stator on which the mover is transported; A control unit capable of controlling the position and / or attitude of the mover, the first portion has a first guide portion along which the movable element can move in a first direction, and a first detection portion that detects a position of the movable element in the first direction, the second portion has a second detection portion that detects a position of the mover in a second direction that intersects with the first direction, the control unit controls a position of the mover in the first direction in the first transport unit based on detection information of the first detection unit; the control unit controls a position of the mover in the first direction based on detection information of the first detection unit and detection information of the second detection unit, and controls a position of the mover in the second direction and / or an amount of rotation about an axis along a third direction intersecting the first direction and the second direction, in the second transport unit; The movable element moves from the second transport section to the first transport section, The second portion does not have a guide portion along which the mover moves. A transport system comprising:
2. A mover, a first conveying section having a first portion of a stator on which the mover is conveyed; a second transport section adjacent to the first transport section and having a second portion of the stator on which the mover is transported; A control unit capable of controlling the position and / or attitude of the mover, the first portion has a first guide portion along which the movable element can move in a first direction, and a first detection portion that detects a position of the movable element in the first direction, the second portion has a second detection portion that detects a position of the mover in a second direction intersecting the first direction, and a second guide portion along which the mover is movable in the first direction and the second direction, the control unit controls a position of the mover in the first direction in the first transport unit based on detection information of the first detection unit; The control unit controls the position of the mover in the first direction and controls the position of the mover in the second direction and / or the amount of rotation about an axis along a third direction intersecting the first direction and the second direction, based on detection information of the first detection unit and detection information of the second detection unit, in the second transport unit. A transport system comprising:
3. the second portion has a third detection portion that detects a position of the mover in the third direction, The control unit controls the position of the mover in the first direction based on detection information of the first detection unit, the detection information of the second detection unit, and the detection information of the third detection unit, in the second transport unit, and controls the position of the mover in the second direction, the position of the mover in the third direction, the amount of rotation about an axis along the first direction, the amount of rotation about an axis along the second direction, and / or the amount of rotation about an axis along the third direction.
3. The transport system according to claim 1 or 2.
4. The second portion has a fourth detection portion that detects the position of the mover in the first direction.
4. The transport system according to claim 1, wherein the transport system is a transport device.
5. The control unit starts to control the position of the mover in the second direction and / or the amount of rotation around an axis along the third direction when the mover enters the second transport unit.
5. The transport system according to claim 1, wherein the transport system is a conveyor.
6. The second portion has a member that assists the moving element in entering the first guide portion.
2. The transport system according to claim 1.
7. The movable element moves from the second transport section to the first transport section, The second portion has a member that assists the second portion in entering the first guide portion from the second guide portion.
3. The transport system according to claim 2.
8. The mover has a plurality of permanent magnets, the first portion and the second portion have a plurality of coils; The control unit controls forces acting between the plurality of permanent magnets and the plurality of coils.
8. The transport system according to claim 1, wherein the transport system is a transport device.
9. The mover has a plurality of coils, the first portion and the second portion include a plurality of permanent magnets; The control unit controls forces acting between the plurality of permanent magnets and the plurality of coils.
8. The transport system according to claim 1, wherein the transport system is a transport device.
10. A transport system according to any one of claims 1 to 9; a process device that processes the workpiece transported by the mover; A processing system comprising:
11. A method for manufacturing an article using the processing system according to claim 10, transporting the workpiece by the mover; performing the processing on the workpiece transported by the mover by the processing device; A method for producing an article, comprising the steps of:
