Servo systems and articulated robots
The servo system separates joint and peripheral device communications, improving communication performance for servo motor control in multi-joint and articulated robots.
Patent Information
- Application Number
- JP2023531240
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-06-30
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2041-06-30
AI Technical Summary
In multi-joint robots and articulated robots, communication for controlling servo motors that move joints can be affected by communications for controlling peripheral devices, leading to reduced communication performance.
A servo system with a first motor control unit and a first communication control unit that separates communication for controlling servo motors from communication for controlling peripheral equipment, ensuring dedicated communication networks for each.
This separation enhances communication performance for controlling servo motors that move joints, reducing interference from peripheral device communications.
Smart Images

Figure 0007587042000001 
Figure 0007587042000002 
Figure 0007587042000003
Abstract
Description
[Technical field]
[0001] This specification discloses techniques relating to a servo system and an articulated robot. [Background technology]
[0002] The stepping motor control device described in Patent Document 1 includes a connection means and a control means, and controls a plurality of motors using at least two arithmetic units. The connection means allows the slave arithmetic unit to use the hardware of the master arithmetic unit with almost no effect on the processing capacity of the master arithmetic unit. The control means controls the slave arithmetic unit according to commands given from the master arithmetic unit. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Japanese Patent Application Publication No. 10-80196 Summary of the Invention [Problem to be solved by the invention]
[0004] A multi-joint robot that uses multiple servo motors to move joints may be equipped with peripheral devices. In this case, the servo system performs communication for controlling the servo motors that move the joints and communication for controlling the peripheral devices. If these communications are mixed in the same communication network, the communication for controlling the servo motors that move the joints may be affected by the communication for controlling the peripheral devices. The above also applies to the case where the above communications are performed in a multi-joint robot.
[0005] In consideration of the above circumstances, this specification discloses a servo system and an articulated robot that can ensure communication performance for controlling servo motors that move joints. [Means for solving the problem]
[0006] This specification discloses a servo system including a first motor control unit that drives and controls a first servo motor, which is a plurality of servo motors that move the joints of a multi-joint robot, and a first communication control unit that is capable of communicating with peripheral devices provided as required for work performed by the multi-joint robot and with the first motor control unit.
[0007] This specification also discloses an articulated robot that includes a first motor control unit that drives and controls a first servo motor, which is a plurality of servo motors that move the joints, and a first communication control unit that is capable of communicating with peripheral devices provided as required for the work and with the first motor control unit. Effect of the Invention
[0008] According to the servo system, the first communication control unit can communicate with the peripheral device and the first motor control unit. Therefore, the servo system can separate the communication for controlling the servo motor that moves the joint from the communication for controlling the peripheral device, and can ensure the communication performance of the communication for controlling the servo motor that moves the joint. What has been described above about the servo system can also be said about the articulated robot equipped with the first motor control unit and the first communication control unit. [Brief description of the drawings]
[0009] [Figure 1] FIG. 2 is a block diagram showing an example of a control block of a servo system. [Diagram 2] FIG. 1 is a perspective view showing an example of an articulated robot. [Diagram 3] FIG. 2 is a perspective view showing an example of a peripheral device. [Figure 4] FIG. 13 is a perspective view showing another example of a peripheral device. [Diagram 5] 11 is a plan view showing an example of a state in which supplies are arranged at predetermined positions in a storage case. FIG. [Figure 6]1 is a plan view showing an example of a state in which a supply item is attached to a predetermined portion of a receiving part of a work object; FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0010] 1. Embodiment 1-1. Example of servo system 10 configuration As shown in Fig. 1, the servo system 10 includes a first motor control unit 21 and a first communication control unit 31. The first motor control unit 21 drives and controls first servo motors 21m, which are multiple servo motors that move the joints 50j of the articulated robot 50. The articulated robot 50 may take various forms as long as it moves the joints 50j using servo motors. In addition, the number of joints 50j is not limited, and the articulated robot 50 may include first servo motors 21m corresponding to the number of joints 50j.
[0011] The drive control of the first servo motor 21m may be performed in various known manners. For example, the drive control of the first servo motor 21m includes position control, speed control, current control, and the like of the first servo motor 21m. For example, the first motor control unit 21 performs position control, speed control, and current control of the first servo motor 21m based on a movement command (position command) and position information acquired from a position detector (e.g., an encoder) that detects the position of the first servo motor 21m. The movement command (position command) can be acquired from the motion controller MC0 via the first communication control unit 31, which will be described later.
[0012] The position control, the speed control, and the current control may be various known types of control. For example, the first motor control unit 21 may perform feedback control using at least one of proportional control, integral control, and differential control. The first motor control unit 21 may also perform feedforward control. The first motor control unit 21 may also generate a drive signal for the first servo motor 21m based on the control values of the position control, the speed control, and the current control.
[0013] For example, the drive signal of the first servo motor 21m can be expressed by a duty ratio, which is the ratio of the ON width to the OFF width of a pulse in PWM (Pulse Width Modulation) control. In PWM control, when a switching element of a power converter (e.g., an inverter) is in a closed state, a motor current flows through the corresponding phase, and the motor current increases or decreases depending on the time that the switching element is in a closed state (ON width). In other words, the longer the time that the switching element is in a closed state (ON width), the larger the motor current becomes, and the shorter the time that the switching element is in a closed state (ON width), the smaller the motor current becomes.
[0014] The first communication control unit 31 is capable of communicating with a peripheral device 60 and the first motor control unit 21 that are provided as necessary for the work performed by the articulated robot 50. The peripheral device 60 may take various forms as long as it is necessary for the work performed by the articulated robot 50. As described below, for example, the peripheral device 60 may be an end effector 61 attached to the arm tip 50t of the articulated robot 50. The peripheral device 60 may also be a transport device 62 that transports the work target W1. Furthermore, the peripheral device 60 may also be a supply device 63 that supplies a supply P1 to the work target W1.
[0015] The first communication control unit 31 may take various forms as long as it can communicate with each of the peripheral device 60 and the first motor control unit 21. The servo system 10 of this embodiment may include a first servo network unit 41 and a second servo network unit 42. The first servo network unit 41 communicates between the first communication control unit 31 and the first motor control unit 21. When the peripheral device 60 is provided, the second servo network unit 42 communicates between the first communication control unit 31 and a second communication control unit 32 provided in the peripheral device 60.
[0016] Therefore, the first communication control unit 31 of this embodiment can communicate with the first motor control unit 21 using the first servo network unit 41. Furthermore, when the peripheral device 60 is provided, the first communication control unit 31 can communicate with the second communication control unit 32 provided in the peripheral device 60 using the second servo network unit 42. Therefore, in the servo system 10 of this embodiment, it is easy to separate the communication for controlling the first servo motor 21m that moves the joint 50j from the communication for controlling the peripheral device 60.
[0017] The communication between the first communication control unit 31 and the first motor control unit 21 is included in the communication for controlling the first servo motor 21m that moves the joint 50j. The communication between the first communication control unit 31 and the second communication control unit 32 provided in the peripheral device 60 is included in the communication for controlling the peripheral device 60. The communication standard of the first servo network unit 41 and the communication standard of the second servo network unit 42 may be the same or different.
[0018] The control of the first servo motor 21m that moves the joint 50j often requires a faster response than the control of the peripheral device 60. Therefore, the communication for controlling the first servo motor 21m that moves the joint 50j often requires communication performance equal to or higher than that for controlling the peripheral device 60. Therefore, it is preferable that the communication cycle in the first servo network unit 41 is set to be equal to or shorter than the communication cycle in the second servo network unit 42. This makes it easier for the servo system 10 of this embodiment to ensure the communication performance of the communication for controlling the first servo motor 21m that moves the joint 50j.
[0019] The connection between the first communication control unit 31 and the first motor control unit 21 may take various known connection forms. For example, in the first servo network unit 41 of this embodiment, the first communication control unit 31 and the first motor control unit 21 are bus-connected. In the bus connection, the first servo motor 21m is connected in parallel to the first communication control unit 31. In this way, the first servo network unit 41 can form a dedicated servo network for controlling the drive of the first servo motor 21m to control the joint 50j.
[0020] Similarly, the connection between the first communication control unit 31 and the second communication control unit 32 provided in the peripheral device 60 may take various known connection forms. For example, as shown in Fig. 1, the second servo network unit 42 of this embodiment is daisy-chain-connected to the second communication control unit 32 provided in the peripheral device 60 via the communication control unit 30 directly connected to the first communication control unit 31.
[0021] This makes it easy to change the configuration of the second servo network unit 42 in response to an increase or decrease in the number of peripheral devices 60. In the example shown in Fig. 1, two peripheral devices 60 are illustrated. Therefore, in the second servo network unit 42 shown in the figure, the first communication control unit 31, the communication control unit 30, the second communication control unit 32, and the second communication control unit 32 are connected in this order, and the two second communication control units 32 are daisy-chain connected.
[0022] As described above, in this embodiment, the second communication control unit 32 provided in the peripheral device 60 is provided in the second servo network unit 42 that is different from the first servo network unit 41 that controls the first servo motor 21m that moves the joint 50j. Therefore, the communication for controlling the first servo motor 21m that moves the joint 50j is less likely to be affected by the communication for controlling the peripheral device 60. For example, even if the amount of communication for controlling the peripheral devices 60 increases with an increase in the number of peripheral devices 60, problems such as a delay in the communication for controlling the first servo motor 21m that moves the joint 50j are less likely to occur.
[0023] The communication control unit 30 and the second communication control unit 32 may take various forms as long as they can communicate with the first communication control unit 31. The communication control unit 30 and the second communication control unit 32 can be provided in various control devices. For example, the communication control unit 30 can be formed in an ASIC (Application Specific Integrated Circuit). The second communication control unit 32 can be formed in an FPGA (Field Programmable Gate Array) for communication. Also, for example, the second servo network unit 42 can be formed using a known general-purpose servo network (for example, MECHATROLINK (registered trademark) III, etc.). The communication control unit 30 is provided when the peripheral device 60 is provided, and controls communication with the first communication control unit 31 and communication with the second communication control unit 32.
[0024] The second communication control unit 32 provided in the middle of the second servo network unit 42 transmits and receives communications in the second servo network unit 42 with itself as the destination or source. The second communication control unit 32 also transmits and relays communications in the second servo network unit 42 with another second communication control unit 32 as the destination or source to an adjacent second communication control unit 32. Furthermore, the second communication control unit 32 provided at the end of the second servo network unit 42 transmits and receives communications with itself as the destination or source. The communication control unit 30 and the second communication control unit 32 can communicate in a master-slave manner at a predetermined transmission period.
[0025] The first motor control unit 21 and the first communication control unit 31 can be provided in various control devices. For example, the first motor control unit 21 can be formed in an FPGA for motor control. The first communication control unit 31 can be formed in an FPGA for communication. As shown in FIG. 1, in this embodiment, the first motor control unit 21 and the first communication control unit 31 are provided in a first servo amplifier SA1 that drives the first servo motor 21m. A known servo amplifier can be used as the first servo amplifier SA1. The first servo amplifier SA1 supplies a motor current based on a drive signal for the first servo motor 21m generated by the first motor control unit 21 from a power converter to the first servo motor 21m. This drives the first servo motor 21m.
[0026] 1, the first communication control unit 31 is provided so as to be able to communicate with a motion controller MC0 that controls the operation of the articulated robot 50. A known motion controller can be used as the motion controller MC0. The motion controller MC0 includes a known CPU (Central Processing Unit), and calculates a movement command (position command) for the first servo motor 21m based on a command value acquired from a higher-level control device.
[0027] The first communication control unit 31 transmits a movement command (position command) for the first servo motor 21m received from the motion controller MC0 to the first motor control unit 21. The first communication control unit 31 can also receive control information for the first servo motor 21m from the first motor control unit 21 and transmit the received control information for the first servo motor 21m to the motion controller MC0.
[0028] The motion controller MC0 can also calculate a drive command for the peripheral device 60. The first communication control unit 31 transmits the drive command for the peripheral device 60 received from the motion controller MC0 to the second communication control unit 32 via the communication control unit 30. The first communication control unit 31 can also receive drive information for the peripheral device 60 from the second communication control unit 32 via the communication control unit 30, and transmit the received drive information for the peripheral device 60 to the motion controller MC0.
[0029] The connection between the first communication control unit 31 and the motion controller MC0 may take various known connection forms. For example, it is assumed that a known general-purpose servo network is formed between the first communication control unit 31 and the motion controller MC0. However, in this case, a control device equivalent to the communication control unit 30 is required for communication between the first communication control unit 31 and the motion controller MC0.
[0030] Therefore, it is preferable that the first communication control unit 31 and the motion controller MC0 are connected to be able to communicate with each other according to the PCI (Peripheral Component Interconnect) communication standard. The communication standard is not limited to PCI, and may be communication standards such as PCI-X and PCI-Express. In particular, PCI-Express is an expansion interface standard that uses a serial transfer method, and is capable of performing relatively high-speed data communication. It is preferable that the first communication control unit 31 and the motion controller MC0 are connected to be able to communicate with each other according to the PCI-Express communication standard.
[0031] The peripheral device 60 may be provided with various driving devices. For example, the peripheral device 60 may be provided with at least one second servo motor 22m that drives the movable part 60m of the peripheral device 60. The movable part 60m may be any part that is driven by a servo motor, and is not limited thereto. The number of second servo motors 22m is not limited, and the peripheral device 60 may be provided with as many second servo motors 22m as necessary to drive the movable part 60m.
[0032] In this case, the peripheral device 60 may include a second motor control unit 22 that drives and controls the second servo motor 22m. The second servo motor 22m may be controlled by various known methods. For example, similar to the drive control of the first servo motor 21m, the second motor control unit 22 may perform position control, speed control, current control, and the like of the second servo motor 22m and generate a drive signal for the second servo motor 22m.
[0033] For example, the second motor control unit 22 performs position control, speed control, and current control of the second servo motor 22m based on a drive command (position command) for the second servo motor 22m and position information acquired from a position detector (e.g., an encoder) that detects the position of the second servo motor 22m. As described above, the drive command (position command) for the second servo motor 22m can be acquired from the motion controller MC0 via the first communication control unit 31, the communication control unit 30, and the second communication control unit 32.
[0034] The connection between the second communication control unit 32 and the second motor control unit 22 may take various known connection forms. For example, when the peripheral device 60 includes a plurality of second servo motors 22m, the second communication control unit 32 and the second motor control unit 22 may be connected by a bus, similar to the first servo network unit 41.
[0035] In addition, the second motor control unit 22 and the second communication control unit 32 can be provided in various control devices. For example, the second motor control unit 22 can be formed in an FPGA for motor control. As described above, the second communication control unit 32 can be formed in an FPGA for communication. Furthermore, as shown in FIG. 1, in this embodiment, the second motor control unit 22 and the second communication control unit 32 are provided in a second servo amplifier SA2 that drives the second servo motor 22m. A known servo amplifier can be used as the second servo amplifier SA2. The second servo amplifier SA2 supplies a motor current based on a drive signal for the second servo motor 22m generated by the second motor control unit 22 from a power converter to the second servo motor 22m. This drives the second servo motor 22m.
[0036] 1-2.Application examples of servo system 10 The servo system 10 can be applied to various working machines equipped with an articulated robot 50. As shown in Figs. 2 to 4, a working machine 80 of this embodiment includes an articulated robot 50, an end effector 61, a conveying device 62, a supplying device 63, and a base unit 70. The end effector 61, the conveying device 62, and the supplying device 63 are included in peripheral devices 60, and are each unitized. In addition, the articulated robot 50 equipped with the end effector 61, the conveying device 62, and the supplying device 63 are disposed on the upper part of the base unit 70.
[0037] As shown in Fig. 2, the articulated robot 50 includes an arm 50a. The arm 50a is a vertical articulated arm with multiple axes (for example, five axes), and includes multiple (for example, six) links (first link 51a to sixth link 51f) and multiple (for example, five) joints 50j (first joint 52a to fifth joint 52e) that connect the links so as to be rotatable or pivotable. The multiple (five) joints 50j are movable by the first servo motor 21m described above. Each joint 50j is provided with the first servo motor 21m and a position detector (encoder or the like) that detects the position (rotational position) of the first servo motor 21m.
[0038] As described above, the first servo motor 21m is driven and controlled by the first motor control unit 21. The first motor control unit 21 and the first communication control unit 31 are provided in the first servo amplifier SA1. The first servo amplifier SA1 is disposed inside the base unit 70. In addition, a detection signal is input to the first servo amplifier SA1 from a detector such as a position detector (encoder).
[0039] The articulated robot 50 can perform various tasks in cooperation with peripheral equipment 60. The peripheral equipment 60 may take various forms as long as it is necessary for the tasks performed by the articulated robot 50. The peripheral equipment 60 may be at least one of an end effector 61, a transport device 62, and a supply device 63. As shown in Figs. 2 to 4, the work machine 80 of this embodiment is provided with the peripheral equipment 60 of the end effector 61, the transport device 62, and the supply device 63.
[0040] As shown in Fig. 2, an end effector 61 is detachably attached to a sixth link 51f, which is an arm tip 50t of the articulated robot 50. The end effector 61 may be, for example, an electromagnetic chuck, a mechanical chuck, or a suction nozzle. The end effector 61 is appropriately selected according to the shapes, materials, etc. of the work object W1 and the supply item P1. In addition, a camera 50c is attached to the fifth link 51e. The camera 50c can capture images of the work object W1, the supply item P1, etc.
[0041] For example, the mechanical chuck of the end effector 61 is a movable part 60m, and is moved by a second servo motor 22m. The second servo motor 22m is driven and controlled by a second motor control part 22. The second motor control part 22 and the second communication control part 32 are provided in a second servo amplifier SA2. The second servo amplifier SA2 is disposed inside the base part 70. In addition, a detection signal is input to the second servo amplifier SA2 from a detector such as a position detector (encoder).
[0042] The conveying device 62 conveys the work target W1. As shown in Fig. 3, the conveying device 62 in this embodiment is, for example, configured by a belt conveyor. The conveying device 62 carries the work target W1 into the working machine 80 and positions the work target W1 at a predetermined position in the machine. After the work by the articulated robot 50 is completed, the conveying device 62 carries the work target W1 out of the working machine 80. Note that the conveying device 62 can convey various work targets W1 used in the work by the articulated robot 50, and the work target W1 is not limited.
[0043] The belt conveyor of the transport device 62 is a movable part 60m, and is moved by a second servo motor 22m. The second servo motor 22m is driven and controlled by a second motor control unit 22. The second motor control unit 22 and the second communication control unit 32 are provided in a second servo amplifier SA2. The second servo amplifier SA2 is disposed inside the transport device 62. In addition, a detection signal is input to the second servo amplifier SA2 from a detector such as a position detector (encoder).
[0044] The supply device 63 supplies the supply items P1 to the workpiece W1. As shown in FIG. 4, the supply device 63 of this embodiment includes a plurality of (e.g., two) storage units 63a and a plurality of (e.g., two) conveying units 63b. The plurality of (two) storage units 63a are arranged along the conveying direction of the workpiece W1, and each of the plurality of (two) storage units 63a accommodates the supply items P1. Each of the plurality of (two) conveying units 63b is, for example, configured by a belt conveyor or the like, and conveys the supply items P1 discharged from the storage units 63a to a position where the articulated robot 50 can pick them up. The supply device 63 can supply various supplies P1 required for work by the articulated robot 50, and the supplies P1 are not limited.
[0045] Each of the belt conveyors of the multiple (two) transport sections 63b is a movable section 60m, and is movable by a second servo motor 22m. The second servo motor 22m is driven and controlled by a second motor control section 22. The second motor control section 22 and the second communication control section 32 are provided in a second servo amplifier SA2. The second servo amplifier SA2 is disposed inside the supply device 63. In addition, a detection signal is input to the second servo amplifier SA2 from a detector such as a position detector (encoder).
[0046] The first motor control unit 21 can move the arm 50a by controlling the drive of the first servo motor 21m, and can move the end effector 61 toward the work object W1 or the supply P1. The articulated robot 50 can perform various tasks on the work object W1 using the end effector 61. For example, the articulated robot 50 captures an image of the work object W1 with the camera 50c. A control device higher than the motion controller MC0 processes the captured image of the work object W1 and recognizes the position and posture of the work object W1.
[0047] The control device calculates a target position (X-coordinates, Y-coordinates, and Z-coordinates) and a target attitude (rotation angle) of the end effector 61 based on the position and attitude of the workpiece W1. The motion controller MC0 sets a target position and a target angle of each joint 50j (first joint 52a to fifth joint 52e) of the arm 50a based on the calculated target position (X-coordinates, Y-coordinates, and Z-coordinates) and target attitude (rotation angle) of the end effector 61. The first motor control unit 21 drives and controls the first servo motor 21m so that the position of each joint 50j (first joint 52a to fifth joint 52e) matches the target position and the angle matches the target angle.
[0048] The articulated robot 50 can also perform various tasks on the work object W1 while the second motor control unit 22 drives and controls the second servo motor 22m of the end effector 61. Furthermore, the second motor control unit 22 drives and controls the second servo motor 22m of the transport device 62 to transport the work object W1, and the articulated robot 50 can perform various tasks on the transported work object W1. The second motor control unit 22 drives and controls the second servo motor 22m of the supply device 63 to supply a supply item P1, and the articulated robot 50 can perform various tasks on the work object W1 using the supplied supply item P1.
[0049] The operations performed by the articulated robot 50 are not limited. The operations performed by the articulated robot 50 include at least one of a pick-up operation of picking up the supply item P1, a placement operation of placing the supply item P1 at a predetermined position AR1 of the work object W1, and an assembly operation of assembling the supply item P1 to a predetermined site AP1 of the assembly target portion AM1 of the work object W1.
[0050] The articulated robot 50 shown in FIG. 2 can use the end effector 61 to pick up a work target W1 that has been transported and positioned by a transport device 62. The articulated robot 50 can also use the end effector 61 to pick up a supply P1 that has been supplied by a supply device 63. The articulated robot 50 can also place the supply P1, for example, at a predetermined position AR1 of a storage case C1 shown in FIG. 5. The storage case C1 is the work target W1, and is divided into a plurality of areas. The predetermined position AR1 indicates at least one of the plurality of areas (one area in the figure).
[0051] For example, if the supply item P1 is a collection of multiple parts, the articulated robot 50 can arrange the supply items P1 in the storage case C1 by part type. The articulated robot 50 can also arrange the supply items P1 in the storage case C1 according to the external dimensions of the parts. Furthermore, the articulated robot 50 can arrange the supply items P1 in the storage case C1 in the order of the work processes.
[0052] The articulated robot 50 can also assemble the supply item P1 to a predetermined location AP1 of the assembly target part AM1 of the work target W1 shown in Fig. 6. For example, the articulated robot 50 can pick up the supply item P1 supplied by the supply device 63 and assemble the supply item P1 to the predetermined location AP1 of the assembly target part AM1. The articulated robot 50 can also pick up the supply item P1 placed in the storage case C1 and assemble the supply item P1 to the predetermined location AP1 of the assembly target part AM1. Note that a plurality of articulated robots 50 can also work together to assemble the supply item P1 to the predetermined location AP1 of the assembly target part AM1.
[0053] The peripheral equipment 60 in this embodiment is at least one of an end effector 61 attached to the arm tip 50t of the articulated robot 50, a transport device 62 that transports the workpiece W1, and a supply device 63 that supplies a supply P1 to the workpiece W1. Therefore, the articulated robot 50 can perform work using at least one of the end effector 61, the transport device 62, and the supply device 63. In addition, the peripheral equipment 60 is unitized. Therefore, the configuration of the servo system 10 can be easily changed.
[0054] 2. Articulated Robot 50 The articulated robot 50 may also include a first motor control unit 21 and a first communication control unit 31. The first motor control unit 21 drives and controls a first servo motor 21m, which is a plurality of servo motors that move the joints 50j. The first communication control unit 31 is capable of communicating with the first motor control unit 21 and a peripheral device 60 that is provided as required for the work. The same can be said about the servo system 10 in this embodiment. Therefore, duplicated explanations are omitted in this specification.
[0055] 3. Examples of Effects of the Embodiments According to the servo system 10, the first communication control unit 31 can communicate with each of the peripheral device 60 and the first motor control unit 21. Therefore, the servo system 10 can separate the communication for controlling the first servo motor 21m that moves the joint 50j from the communication for controlling the peripheral device 60, and can ensure the communication performance of the communication for controlling the first servo motor 21m that moves the joint 50j. What has been described above about the servo system 10 can also be said about the articulated robot 50 that includes the first motor control unit 21 and the first communication control unit 31. [Explanation of symbols]
[0056] 10: servo system, 21: first motor control unit, 21m: first servo motor, 22: second motor control unit, 22m: second servo motor, 30: communication control unit, 31: first communication control unit, 32: second communication control unit, 41: first servo network unit, 42: second servo network unit, 50: multi-joint robot, 50j: joint, 50t: arm tip, 60: peripheral equipment, 60m: moving part, 61: end effector, 62: transport device, 63: supply device, MC0: Motion controller, SA1: First servo amplifier, SA2: second servo amplifier, W1: work object, P1: supply item.
Claims
1. a first motor control unit that drives and controls a first servo motor, which is a plurality of servo motors that move the joints of the articulated robot; a first communication control unit capable of communicating with a peripheral device provided as needed for a task performed by the articulated robot and with the first motor control unit; a first servo network unit that performs communication between the first communication control unit and the first motor control unit; a second servo network unit that performs communication between the first communication control unit and a second communication control unit provided in the peripheral device when the peripheral device is provided; Equipped with A servo system in which a communication cycle in the first servo network portion is set shorter than a communication cycle in the second servo network portion.
2. 2. The servo system according to claim 1, wherein the first servo network unit is a bus connection between the first communication control unit and the first motor control unit.
3. The servo system according to claim 1 or claim 2, wherein the second servo network unit is daisy-chained to the second communication control unit provided in the peripheral device via a communication control unit directly connected to the first communication control unit.
4. The servo system according to any one of claims 1 to 3, wherein the first motor control unit and the first communication control unit are provided in a first servo amplifier that drives the first servo motor.
5. The servo system according to any one of claims 1 to 4, wherein the first communication control unit is arranged to be capable of communicating with a motion controller that controls the operation of the articulated robot.
6. The servo system according to claim 5, wherein the first communication control unit and the motion controller are capable of communicating with each other according to a PCI-Express communication standard.
7. The servo system according to any one of claims 1 to 6, wherein the peripheral device is provided with a second motor control unit that drives and controls a second servo motor, which is at least one servo motor that moves a movable part of the peripheral device.
8. the peripheral device includes a second communication control unit that communicates with the first communication control unit, 8. The servo system according to claim 7, wherein the second motor control unit and the second communication control unit are provided in a second servo amplifier that drives the second servo motor.
9. 9. The servo system according to claim 1, wherein the peripheral device is unitized.
10. 10. The servo system according to claim 1, wherein the peripheral device is an end effector attached to a tip of an arm of the articulated robot.
11. 10. The servo system according to claim 1, wherein the peripheral device is a transport device that transports a work object.
12. 10. The servo system according to claim 1, wherein the peripheral device is a supply device that supplies a supply to a work object.
13. a first motor control unit that drives and controls a first servo motor, which is a plurality of servo motors that move the joints; A first communication control unit capable of communicating with a peripheral device provided according to the needs of the work and the first motor control unit; a first servo network unit that performs communication between the first communication control unit and the first motor control unit; a second servo network unit that performs communication between the first communication control unit and a second communication control unit provided in the peripheral device when the peripheral device is provided; Equipped with A multi-joint robot, wherein a communication cycle in the first servo network unit is set shorter than a communication cycle in the second servo network unit.
14. The articulated robot of claim 13, wherein the peripheral device is an end effector attached to the tip of the arm.
15. The articulated robot according to claim 13, wherein the peripheral equipment is a transport equipment for transporting a work object.
16. The articulated robot of claim 13, wherein the peripheral equipment is a supply device that supplies supplies to a work object.
Citation Information
Patent Citations
Control apparatus for stepping motor
JP1998080196A
Robot control system
JP2005246547A
Cell control device for displaying abnormality occurrence situation of manufacturing machine by the area or by the step
JP2017151869A
Control system enabling CPU for control to be added thereto
JP2017189821A
Motor drive system
JP2019161759A
