WO2022196009A1 - 制御システム、ドライバ、電動機、制御装置、および制御方法 - Google Patents

制御システム、ドライバ、電動機、制御装置、および制御方法 Download PDF

Info

Publication number
WO2022196009A1
WO2022196009A1 PCT/JP2021/047112 JP2021047112W WO2022196009A1 WO 2022196009 A1 WO2022196009 A1 WO 2022196009A1 JP 2021047112 W JP2021047112 W JP 2021047112W WO 2022196009 A1 WO2022196009 A1 WO 2022196009A1
Authority
WO
WIPO (PCT)
Prior art keywords
driver
packet
daisy chain
chain structure
electric motor
Prior art date
Application number
PCT/JP2021/047112
Other languages
English (en)
French (fr)
Inventor
隆 浅井
Original Assignee
オムロン株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by オムロン株式会社 filed Critical オムロン株式会社
Publication of WO2022196009A1 publication Critical patent/WO2022196009A1/ja

Links

Images

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P5/00Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
    • H02P5/46Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04LTRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L12/00Data switching networks
    • H04L12/28Data switching networks characterised by path configuration, e.g. LAN [Local Area Networks] or WAN [Wide Area Networks]

Definitions

  • the present invention relates to control systems, drivers, electric motors, control devices, and control methods.
  • the power line and encoder signal line are wired separately between the servo driver (servo drive, simply called the driver) and the electric motor. Therefore, the load of wiring work is large. As a result, the wiring work becomes a factor of cost increase. Therefore, for example, in a servo system composed of a plurality of motors with built-in serial encoders, a communication line connecting the servo drive and the serial encoder, and a power line connecting the serial encoder and the servo drive, the power line and the communication line are common, and a daisy chain connection has been proposed (for example, Patent Document 1 below).
  • JP 2007-181340 A Japanese Patent Application Laid-Open No. 2006-304461
  • control system becomes more complicated, there may be a configuration in which a plurality of drivers and motors are connected to a control device such as a PLC, for example.
  • the purpose of the present invention is to simplify the signal lines and reduce the wiring work load and cost in a complex control system that includes multiple drivers.
  • the control system comprises: a plurality of control mechanisms including a driver for driving the electric motor and the electric motor having an encoder for detecting a physical quantity related to rotation of the electric motor; a control device that controls the plurality of control mechanisms, each of the drivers, the motors, and the controllers included in the plurality of control mechanisms are connected in a daisy chain structure network capable of packet transfer and power supply to each of the encoders; the control device sets a command addressed to each driver in an area corresponding to each driver of the plurality of control mechanisms in a packet and transmits the packet to the next connection destination of the daisy chain structure; Each driver of the plurality of control mechanisms acquires a command addressed to itself from the control device from the area corresponding to itself in the packet received from the transmission source of the daisy chain structure, and the next driver of the daisy chain structure.
  • Each electric motor of the plurality of control mechanisms sets the physical quantity detected by the encoder of each electric motor in the area corresponding to itself in the received packet, and sends the received packet to the next destination of the daisy chain structure. send the packet.
  • each electric motor can be handed over to the driver connected in a daisy chain structure by setting the physical quantity detected by the encoder of each electric motor in the area corresponding to itself in the packet. Therefore, there is no need for a separate communication line between the driver and the motor for transferring the physical quantity detected by the encoder of the motor.
  • the packet is looped back and forwarded at the end of the daisy chain structure network,
  • Each driver of the plurality of control mechanisms acquires the physical quantity detected in the electric motor corresponding to each driver from the area corresponding to itself in the packet that has been looped back and transferred.
  • a driver is connected in a daisy chain structure at a position closer to the control device than the corresponding electric motor. Due to this arrangement relationship, a packet makes one round trip in the daisy chain structure, thereby realizing a command from the control device to the driver and a transfer of the physical quantity from the electric motor to the driver.
  • the controller is connected to the starting point of the daisy chain structure and sends out the packet; While the sent packet reciprocates to and from the end of the daisy chain structure, each electric motor of the plurality of control mechanisms sets the physical quantity in the received packet, After the sent packet makes a round trip once between the end of the daisy chain structure, the control device re-sends the packet that made a round trip once, Each driver of the plurality of control mechanisms acquires the physical quantity detected in the electric motor corresponding to each driver from the region corresponding to itself in the resent packet.
  • the packet reciprocates twice between the ends of the daisy chain structure, thereby realizing the command from the control device to the driver and the transfer of the physical quantity from the electric motor to the driver.
  • the drivers need not be connected in the daisy chain structure closer to the controller than the corresponding motors. This increases the degree of freedom in arranging and connecting the driver and the corresponding electric motor.
  • an embodiment of the present invention can be specified as the above driver.
  • one embodiment of the present invention can be specified as the above electric motor.
  • an embodiment of the present invention can be specified as the above control device.
  • one embodiment of the present invention can be specified as a control method in a control system.
  • signal lines are simplified in a complicated control system including multiple drivers, so that wiring work load and cost can be reduced.
  • FIG. 1 is a diagram illustrating an example of an application scene of a control system according to one embodiment.
  • FIG. 2 is a diagram illustrating a control system according to a comparative example;
  • FIG. 3 is a diagram illustrating the control system of the first embodiment.
  • FIG. 4 is a diagram illustrating another arrangement of motors and drivers in the first embodiment.
  • FIG. 5 is a diagram illustrating the control system of the first embodiment.
  • FIG. 6 is a diagram illustrating a control system using ducts to protect or shield wiring.
  • FIG. 7 is a diagram comparing the control system of the comparative example including the sensor and the control system of the first embodiment.
  • FIG. 8 is a diagram exemplifying the configuration of process data included in a packet according to the first embodiment, and node processing when the packet circulates the daisy chain for the first time.
  • FIG. 9 is a diagram illustrating node processing when a packet circulates the daisy chain for the second time.
  • FIG. 10 is a diagram illustrating processing of the control system of the first embodiment.
  • FIG. 11 is a diagram exemplifying the processing after the packet is wrapped in the reverse direction of the daisy chain.
  • FIG. 12 is a diagram illustrating the configuration of process data included in a packet and processing of nodes when the packet circulates in the daisy chain according to the second embodiment.
  • FIG. 13 is a diagram illustrating processing of the control system of the second embodiment.
  • FIG. 14 is a diagram illustrating processing of the control system of the second embodiment.
  • this embodiment An embodiment (hereinafter also referred to as "this embodiment") according to one aspect of the present invention will be described below with reference to the drawings.
  • this embodiment described below is merely an example of the present invention in every respect.
  • various modifications and variations can be made without departing from the scope of the invention. That is, in carrying out the present invention, a specific configuration according to the present embodiment may be employed as appropriate.
  • Data appearing in the present embodiment are explained in natural language. More specifically, however, the data appearing in this embodiment are processed in computer-recognizable pseudo-language, commands, parameters, machine language, and the like. In addition, these data are saved in the form of binary data, character strings, or the like in the memory area of the main memory or secondary memory.
  • FIG. 1 illustrates a control system 100 according to this embodiment.
  • this control system 100 is, for example, a factory automation system, a collection and delivery system of a collection and delivery center of a shipping company, a shipping center of a mail order company, an articulated robot, a construction machine, or the like.
  • the control system 100 includes a plurality of motors M1 to M4, servo drivers (hereinafter simply referred to as drivers) D1 to D4 for driving the motors M1 to M4, and a control device 10.
  • the motors M1 to M4 and the drivers D1 to D4 are connected by power lines LP1 to LP4 for supplying power from the driver D1 and the like to the motor M1 and the like.
  • the motor is also called an electric motor.
  • the motor M1, etc., the driver D1, etc., and the control device 10 are connected by a communication line LC.
  • the communication line LC connects the control device 10, the driver D1, etc., and the motor N1, etc. in a daisy chain to form a network N1.
  • a daisy chain is one method of connecting nodes that constitute a network. In a daisy chain, the first node is connected to the second node, and the second node is connected to the third node. Note that the network N1 is not limited to one daisy chain, and can be branched into a plurality of routes by the branching portion BR.
  • EtherCATP registered trademark
  • the control device 10 is a master node
  • the motor M1 etc. and the driver D1 etc. are slave nodes.
  • the control system 100 can be said to be a system that controls four axes, for example.
  • the number of slave nodes is not limited to eight as in FIG. That is, the number of motors M1 and the like and the number of drivers D1 and the like may each be three or less, or each may be five or more.
  • an area where data can be input and output within a packet is determined for each node of the slave node. Then, a packet transmitted from the master node reaches the most downstream (terminal) slave node, is looped back, returns to the master node again, and while it goes around the network N1, the packets between the master node and all the slave nodes Data exchange is completed.
  • the communication line LC includes, for example, an Ethernet (registered trademark) signal line and a power line. Therefore, the communication line LC includes, for example, a data line capable of transmitting and receiving information in IEEE 802.3 standard Ethernet (registered trademark) frames, and a power line capable of supplying power from the master node to the slave node.
  • the network N1 can be said to be an example of a network with a daisy chain structure capable of packet transfer and power supply to each encoder.
  • the control device 10 is called, for example, a Programmable Logic Controller (PLC), a servo controller, or the like.
  • the control device 10 incorporates a Central Processing Unit (CPU) such as a microprocessor and a memory, and controls the equipment according to user-changeable programs.
  • CPU Central Processing Unit
  • the control device 10 has a communication interface of a communication line LS.
  • the CPU of the control device 10 performs communication through communication lines LS connected in a daisy chain.
  • the driver D1 or the like receives a target value instruction from the control device 10, supplies power to the motor M1 or the like, and controls the motor M1 or the like.
  • the target value is, for example, the rotational position, rotational speed, rotational force, etc. of the shaft of the motor M1 or the like.
  • the driver D1 and the like have a communication interface of a controller including a CPU and a communication line LS, and perform communication through the communication line LS connected by a daisy chain.
  • the motor M1 etc. have a communication device and an encoder inside.
  • the communication device has a controller including a CPU and a communication interface of a communication line LS, and performs communication through the communication line LS connected by a daisy chain.
  • the encoder detects a physical quantity related to the rotation of the motor, such as the rotational position (rotational angle), rotational speed, or rotational speed of the shaft of the motor M1 or the like.
  • the encoder receives power supply from the power line of the communication line LC, operates an optical sensor, for example, and detects the rotation of the shaft of the motor M1 or the like.
  • the communication device notifies the control device 10, the driver D1, or the like of the physical quantity (rotational position, rotation speed, rotation speed, etc.) detected by the encoder through the data line of the communication line LC.
  • the driver D1 or the like controls the motor M1 or the like based on the physical quantity detected by the encoder so that the rotational position, rotational speed, rotational force, etc. of the motor M1 approach target values.
  • a combination of the driver D1 and the like and the motor M1 and the like can be said to be an example of the control mechanism.
  • FIG. 2 illustrates a control system 500 according to a comparative example.
  • the control system 500 has a control device 50, drivers D51 and D52, and motors M51 and M51.
  • the control device 50, the driver D1, etc. are connected by the communication line LC50 to form a motion network, as in the case of FIG.
  • drivers D51 and D52 supply power to motors M51 and M52 through power lines LP51 and LP52.
  • the drivers D51 and D52 receive detected values such as rotational positions and rotational speeds of the motors M51 and M52 from encoders attached to the motors M51 and M52 via encoder lines LE51 and LE52.
  • the power line and the encoder line must be installed separately to avoid the influence of noise. Therefore, when there is a distance between the driver D51 and the like and the motor M51 and the like, the long power lines LP1 and the like and the encoder lines LE1 and the like are wired respectively. Also, the communication line LC50 for the motion network, the encoder line LE51 and the like are dedicated communication lines. Therefore, the user must prepare each dedicated cable line type.
  • FIG. 3 is a diagram illustrating the control system 10A of this embodiment.
  • the control system 100A includes a plurality of motors M1 and M2, drivers D1 and D2 that drive the motors M1 and the like, and a control device 10.
  • FIG. 3 as in FIG. 1, the motors M1 and M2 and the drivers D1 and D2 are connected by power lines LP1 and LP2 for supplying electric power from the driver D1 and the like to the motor M1 and the like.
  • the control system 100A can be said to be, for example, a system that controls two axes.
  • the motor M1, etc., the driver D1, etc., and the control device 10 are connected by the communication line LC.
  • the communication line LC connects the control device 10, the driver D1, etc., and the motor M1, etc. in a daisy chain to form the network N1 illustrated in FIG.
  • FIG. 3 does not illustrate the branch portion BR of FIG.
  • the daisy chain by the communication line LC can be branched into a plurality of paths at the branching portion BR.
  • the control device 10, the driver D1, etc., and the motor M1, etc. are the same as those described in FIG.
  • control system 100A power is supplied from the driver D1 or the like to the encoder attached to the motor M1 or the like through the communication line LC. Then, physical quantities such as the rotational position, number of revolutions, and rotational speed of the motor D1 detected by the encoder are notified to the control device 10 via the communication line LC. Therefore, also in the control system 100A, there is no need to wire the encoder lines LE1, LE2, etc. individually from the control device 10 to the drivers D1, D2. That is, it is sufficient if there is a daisy chain of communication lines LC.
  • FIG. 4 illustrates another arrangement of motors M1, M2 and drivers D1, D2 in this embodiment.
  • the drivers D1 and D2 are arranged near the control device 10, and the motors M1 and M2 are arranged away from the control device 10 and the drivers D1 and D2.
  • the control system 100A of FIG. becomes larger.
  • FIG. 5 is a diagram illustrating a control system 100B in which motors M1, M2 and drivers D1, D2 are arranged as in the comparative example of FIG.
  • FIG. 5 also illustrates a control system 500B having the same configuration as in FIG. 2 for comparison.
  • an encoder line LE1 connecting the driver 51 and the motor M51 and an encoder line LE2 connecting the driver 52 and the motor M52 are wired.
  • the control system 100B of the present embodiment if one daisy chain of the communication line LC is wired, the rotational positions detected by the encoders attached to the motors M1 and M2 are transmitted from the motors M1 and M2 to the drivers D1 and D2. , rotational speed, etc. can be fed back.
  • FIG. 6 is a diagram illustrating a control system 100C of this embodiment using ducts T1 and T2 that protect or shield wiring.
  • FIG. 6 also illustrates a control system 500C using ducts T51 and T52 in the same configuration as in FIG. 2 for comparison.
  • the power lines LP51, LP52 and the encoder lines LE51, LE52 are housed in different ducts T51, T52, respectively, in order to prevent noise interference.
  • the power lines LP1, LP2 and the communication line LC are housed in different ducts T1, T2, respectively.
  • FIG. 6 is an example of a control system 100C that controls two axes.
  • three encoder lines pass through the duct T51, and in the case of the control system 100C of the present embodiment, only one communication line LC passes through the duct T2. done.
  • FIG. 7 is a diagram comparing the control system 500D of the comparative example including the sensor SN51 and the like with the control system 100D of the present embodiment including the sensor SN1 and the like.
  • a control system 500D illustrated on the left side of FIG. 7 is obtained by adding sensors SN51 and SN52 to the control system 500C of FIG.
  • a control system 100D illustrated on the right side of FIG. 7 is obtained by adding sensors SN1 and SN2 to the control system 100C of FIG.
  • sensors SN1 and SN2 are respectively connected to drivers D51 and D52 by sensor lines LS51 and LS52 passing through duct T51.
  • both the sensors SN1 and SN2 need only be connected to the daisy chain of the communication line LC. Therefore, in the control system 100D, instead of the two sensor lines LS51 and LS52, a single daisy chain communication line LS may be wired. This is the same when the number of sensors LS1 and the like increases to N (integer). Further, for example, when the control panel including the control device 10, the drivers D1, D2, etc. is installed at a position distant from the motors M1, M2, etc., the effect of the present embodiment is particularly large.
  • the types and number of sensors SN1, SN2, etc. are not limited.
  • the sensors SN1, SN2, etc. have a detection unit, a controller including a CPU, and a communication interface with a daisy chain communication line LS.
  • the detection unit detects data including at least one of various physical quantities, chemical components, biological information, images, sounds, and the like.
  • Physical quantities include, for example, mechanical and electromagnetic measurements, environmental measurements, and the like.
  • Chemical constituents include, for example, molecules and other constituents contained in matter or the environment.
  • Biological information includes, for example, information obtained from the human body and living organisms, biological information obtained from the environment, and the like.
  • the controller sends the data detected by the detector from the communication interface to the next destination via the communication line LS of the daisy chain.
  • These data are set in an input/output area corresponding to the sensor SN1 and the like in the packet exchanged on the communication line LS. That is, the sensor SN1 or the like detects data including at least one of a physical quantity, a chemical component, biological information, an image, and a sound, and the detected data in the area corresponding to itself within the packet received from the transmission source of the daisy chain structure. to send received packets to the next destination in the daisy chain structure.
  • the data detected by the sensor SN1 etc. is transmitted to the drivers D1, D2 etc. or the control device 10.
  • FIG. 8 exemplifies the configuration of process data included in packets exchanged via a daisy chain by communication lines LC of the control systems 100A to 100D of this embodiment.
  • the process data is the data portion excluding packet header information, frame check sequence, and the like.
  • arrows also illustrate the processing of the control device 10 and the processing of the slave node accessed when the packet circulates the daisy chain for the first time.
  • readable and writable areas are designated in advance for each of the drivers D1, D2, . . . and the motors M1, M2, . there is Such designation may be performed, for example, so as to be identifiable by a node number within the daisy chain network. Such designation may be performed, for example, when each slave node is connected to the daisy chain. Such designation may also be performed, for example, at initialization between master and slave nodes. As shown in the figure, encoders E1, E2, etc. are attached to the motors M1, M2, etc. in this embodiment and other embodiments described below.
  • the number of slave nodes such as the driver D1 and the like and the number of the slave nodes such as the motor M1 are not limited to two (four in total).
  • the control device 10 writes a command C1 addressed to driver D1 and a command C2 addressed to driver D2 in respective areas of the packet (arrows A1 and A2), and sends the packet to the daisy chain.
  • the daisy chain is formed in the order of driver D1, motor M1, driver D2, and motor M1.
  • the control device 10, the driver D1, etc., the motor M1, etc., and the sensor SN1, etc. are provided with communication interfaces of the communication line LS, and communication is performed by these.
  • the control device 10, the driver D1, etc., the motor M1, etc. communicate with each other.
  • the control device 10 forwards the packet to the driver D1.
  • the driver D1 receives the packet and reads the command C1 addressed to the driver D1 from the process data (arrow A3).
  • the command C1 is, for example, target values such as the rotational position, rotational speed, and rotational force of the motor M1.
  • the driver D1 transfers the packet to the motor M1 and controls the motor M1 according to the command C1 read from the process data.
  • the feedback F1 addressed to the driver D1 has not been set, so the driver D1 cannot obtain the feedback F1.
  • the driver D2 when the driver D2 receives the packet, it reads the command C2 addressed to the driver D2 from the process data (arrow A5).
  • the driver D2 transfers the packet to the motor M2 and controls the motor M2 according to the command C2 read from the process data.
  • the feedback F2 addressed to the driver D2 has not been set, so the driver D2 cannot obtain the feedback F2.
  • the motor M2 receives the packet, the physical quantities such as the rotational position, rotational speed, and rotational speed detected by the encoder E2 attached to the motor M2 are written to the area of the feedback F2 addressed to the driver D2 (arrow A6). Then, the motor M2 addresses the packet to the driver D2, loops back the daisy chain, and sends the packet. After that, the packet is transferred in the reverse direction through the daisy chain and once returns to the control device 10 . In this embodiment, the slave node does not input/output to the process data area while the packet is transferred in the reverse direction in the daisy chain. Then, the control device 10 sends the packet that has been returned back to the driver D1 again.
  • arrows exemplify the processing of the slave node accessed when the packet circulates the daisy chain for the second time.
  • the control device 10 clears the commands (command C1 addressed to driver D1 and command C2 addressed to driver D2) during the first circulation (arrow A111, A12).
  • control device 10 may disallow access by drivers D1 and D2 to this area. Then, similarly to the first circulation, the control device 10 transfers the packet to the driver D1.
  • the driver D1 When the driver D1 receives the second circulated packet, it reads the feedback F1 addressed to the driver D1 from the process data (arrow A7). The driver D1 transfers the packet to the motor M1 and controls the motor M1 according to the command C1 and the feedback F1 obtained in the first round.
  • the driver D2 when the driver D2 receives the second circulated packet, it reads the feedback F2 addressed to the driver D2 from the process data (arrow A8).
  • the driver D2 transfers the packet to the motor M2 and controls the motor M2 according to the command C2 and the feedback F2 obtained in the first round.
  • the packet returned in this way is transferred in the reverse direction through the daisy chain and returned to the control device 10.
  • the control device 10 sets a new target value for the first round packet illustrated in FIG. Send out.
  • the control device 10 alternately daisy-chains the first circulating packet illustrated in FIG. 8 and the second circulating packet that was returned in the first circulating packet illustrated in FIG. Send to chain.
  • the control device 10 delivers the target values to the drivers D1 and D2 of the slave nodes.
  • the encoders E1, E2 of the motors M1, M2 also pass feedback through the controller 10 to the drivers D1, D2.
  • Process Processing of the control system 100A will be described with reference to FIGS. 9 and 10 exemplify the transmission and reception of packets of the controller 10, the drivers D1 and D2, the motors M1 and M2, and the encoders E1 and E2 attached to the motors M1 and M2, and the processing executed by these.
  • the control device 10 acting as the master node instructs the slave nodes to perform initialization (S1).
  • Initialization instructions may include, for example, notification of respective access permission areas in the process data for each slave node.
  • each slave node recognizes its own read area and write area according to the initialization instructions, and stores them in respective memories (S2 to S5). Note that, as already mentioned, such configuration may be performed when each slave node is connected to the daisy chain.
  • control device 10 sets a command in the process data (S6) and sends out the packet (S7).
  • the process of S6 is an example of setting commands addressed to each driver in areas corresponding to each driver of a plurality of control mechanisms in a packet.
  • the process of S7 is an example of transmitting the packet to the next connection destination of the daisy chain structure.
  • the driver D1 receives the packet (S8). Then, the driver D1 reads the command C1 addressed to the driver D1 from the access-permitted area in the process data (S9). The processing of S9 is an example of acquiring a command addressed to itself from the control device 10 from the area corresponding to itself in the packet received from the transmission source of the daisy chain structure.
  • driver D1 sends a packet (S10) and controls motor M1 according to command C1 (S11).
  • the processing of S10 is an example of transmitting the packet to the next connection destination in the daisy chain structure.
  • the motor M1 receives the packet (S12). Then, the motor M1 writes the physical quantity detected by the encoder E1 to the area of the feedback F1 addressed to the driver D1 (S13).
  • the processing of S13 is an example of setting the physical quantity detected by the encoder of each electric motor in the area corresponding to itself in the received packet. Motor M1 then sends out the packet (S14).
  • the process of S14 is an example of transmitting the received packet to the next destination in the daisy chain structure.
  • driver D2 receives the packet (S15). Then, the driver D2 reads the command C2 addressed to the driver D2 from the access-permitted area in the process data (S16). The process of S16 is also an example of acquiring a command addressed to itself from the control device 10 from the area corresponding to itself in the packet received from the transmission source of the daisy chain structure. Next, driver D2 sends a packet (S17) and controls motor M2 according to command C2 (S18).
  • the motor M2 receives the packet (S19). Then, the motor M2 writes the physical quantity detected by the encoder E2 to the area of the feedback F2 addressed to the driver D2 (S20).
  • the process of S20 is also an example of setting the physical quantity detected by the encoder of each electric motor in the area corresponding to itself in the received packet. Then, the motor M1 wraps the packet in the opposite direction of the daisy chain and sends it out.
  • the processing of S13 and S20 is an example of setting a physical quantity in a packet received by each electric motor of a plurality of control mechanisms while the packet travels back and forth between ends of the daisy chain structure.
  • FIG. 11 illustrates the processing after the packet is wrapped in the reverse direction of the daisy chain. That is, motor M2 sends a packet to driver D2 (S30). Each slave node then sends a packet in the opposite direction of the daisy chain (S31 to S37).
  • the processing of S30 to S37 can be said to be an example of a packet being looped back and transferred at the end of a network having a daisy chain structure. Also, it can be said that the packet made a round trip to the end of the daisy chain structure once through the processing from S7 in FIG. 10 to S37 in FIG.
  • control device 10 When the control device 10 receives the packet that has been returned (S37), it sends the received packet back to the daisy chain as feedback (S38).
  • the process of S38 is an example of retransmitting a packet that has made a round trip once.
  • the driver D1 receives the feedback packet (S39). Then, the driver D1 reads the feedback F1 addressed to the driver D1 from the access-permitted area in the process data (S40).
  • the process of S40 is an example of acquiring the physical quantity detected in the electric motor corresponding to each driver from the area corresponding to itself in the resent packet.
  • the driver D1 sends a packet to the motor M1 (S41), and controls the motor M1 according to the command C1 and the feedback F1 obtained in the first round (S42).
  • the motor M1 receives the packet (S43) and sends it to the driver D2 as it is (S44).
  • the driver D2 receives the feedback packet (S45).
  • the driver D2 reads the feedback F2 addressed to the driver D2 from the access-permitted area in the process data (S46).
  • the process of S46 is also an example of obtaining the physical quantity detected in the electric motor corresponding to each driver from the area corresponding to itself in the resent packet.
  • the driver D2 sends the packet to the motor M2 (S47), and controls the motor M2 in accordance with the command C2 and the feedback F2 acquired in the first round (S48).
  • the motor M2 receives the packet (S49) and returns it to the driver D2 (S50). After that, each slave node sends packets in the opposite direction of the daisy chain, similarly to S30 to S37.
  • the control system 100A of this embodiment has a configuration in which the control device 10, the driver D1, etc., the motor M1 (including the encoder E1), etc. are connected in a daisy chain through the communication line LC.
  • the control device 10 becomes the master node, and the driver D1, etc., the motor M1 (encoder E1), etc. become slave nodes.
  • the controller 10 transmits a command including the target value to the driver D1, etc., and the physical quantity, which is the feedback information measured by the encoder E1 in the motor M1, etc., is added to the packet. be.
  • the control system 100A of the present embodiment there is no restriction on the positional relationship in the daisy chain between the driver D1 and the like and the motor M1 and the like to be controlled. That is, the driver D1 and the like and the motor M1 and the like to be controlled can be arranged flexibly, and the degree of freedom in layout is improved.
  • FIG. 1 In the control system 100A of the first embodiment, commands from the control device 10 to the driver D1 and the like and feedback from the motor M1 and the like to the driver D1 and the like are executed while the packet makes two round trips in the daisy chain.
  • feedback is transmission of detection data from the encoder E1 or the like to the driver D1 or the like.
  • commands from the control device 10 to the driver D1 and the like and feedback from the motor M1 and the like to the driver D1 and the like are executed while the packet makes one round trip in the daisy chain.
  • FIG. 12 exemplifies the configuration of process data included in packets exchanged via a daisy chain by the communication line LC of the control system 100B.
  • FIG. 12 is also a diagram illustrating the processing of each node when a packet circulates in the daisy chain.
  • the process data includes command C1 addressed to driver D1, feedbacks F11 and F12 addressed to driver D1, command C2 addressed to driver D2, feedback F2 addressed to driver D2, .
  • FIG. 12 exemplifies the feedbacks F11 and F12 addressed to the driver D1, only one of them may be used.
  • the reason why the feedbacks F11 and F12 addressed to the driver D1 are provided is that the packet passes through the motor M1 twice while going back and forth in the daisy chain, so there are two opportunities to write the physical quantity.
  • the control device 10 writes a command C1 addressed to driver D1 and a command C2 addressed to driver D2 in respective areas of the packet (arrows A21 and A22), and sends the packet to the daisy chain. Send out.
  • the daisy chain is formed in the order of the driver D1, the motor M1, the driver D2, and the motor M1, as shown in FIG. 3 of the first embodiment.
  • the driver D1 when the driver D1 receives the packet, it reads the command C1 addressed to the driver D1 from the process data (arrow A23). The driver D1 transfers the packet to the motor M1 and controls the motor M1 according to the command C1 read from the process data. At this point, the feedback F1 addressed to the driver D1 has not yet been set as in the first embodiment (FIG. 8), so the driver D1 cannot obtain the feedback F1.
  • the encoder E1 attached to the motor M1 writes physical quantities such as the detected rotational position, rotational speed, and rotational speed to the area of the feedback F1 addressed to the driver D1 (arrow A24). Motor M1 then forwards the packet to driver D2.
  • the motor M1 transfers the packet as it is to the driver D2 without writing the physical quantity detected by the encoder LE1 to the area of the feedback F1. You may
  • the driver D2 when the driver D2 receives the packet, it reads the command C2 addressed to the driver D2 from the process data (arrow A25). The driver D2 transfers the packet to the motor M2 and controls the motor M2 according to the command C2 read from the process data. At this point, the feedback F2 addressed to the driver D2 has not been set as in the first embodiment (FIG. 8), so the driver D2 cannot obtain the feedback F2.
  • the encoder E2 attached to the motor M2 writes the detected physical quantities such as the rotational position, rotational speed, and rotational speed to the area of the feedback F2 addressed to the driver D2 (arrow A26). Motor M1 then forwards the packet to driver D2. The packet is then forwarded back up the daisy chain.
  • drivers D1 and D2 get feedback from each of motors M1 and M2 to each. That is, first, when the driver D2 receives a packet sent in the reverse direction from the motor M2, Feedback F2 addressed to driver D2 is read from the process data (arrow A27). The driver D2 forwards the packet to the motor M1 in the reverse direction, and controls the motor M2 according to the command C2 and the feedback F2 obtained in the processing of the arrow A25.
  • the motor M1 receives the packet, the data detected by the encoder E1 at this time is written to the feedback F12 addressed to the driver D1 (arrow A28).
  • the motor M1 may directly transfer the packet to the driver D1 as in the first embodiment. That is, the control system 100B may use only one of the feedbacks F11 and F12 addressed to the driver D1.
  • the driver D1 when the driver D1 receives the packet, it reads feedback F11 and F12 addressed to the driver D1 from the process data (arrows A29 and A30). The driver D1 forwards the packet to the control device 10 in the reverse direction, and controls the motor M1 in accordance with the command C1 and the feedbacks F11 and F12 obtained in the processing of the arrow A23. If the motor M1 does not execute either the process of the arrow A24 or the process of the arrow A28, the driver D1 may control the motor M1 by either one of the feedbacks F11 and F12 written by the motor M1. .
  • FIG. 13 and 14 exemplify the transmission and reception of packets of the controller 10, the drivers D1 and D2, the motors M1 and M2, and the encoders E1 and E2 attached to the motors M1 and M2, and the processing executed by these.
  • the processes from S51 to S61 are the same as the processes from S1 to S11 in FIG. 10, so the description thereof will be omitted.
  • the motor M1 receives the packet (S62). Then, the motor M1 writes the data detected by the encoder E1 to the area of the feedback F11 addressed to the driver D1 (S63). As described with reference to FIG. 12, in the control system 100B, when the driver D1 does not use the area of the feedback F11 and uses only the area of the feedback F12, the motor M1 does not write to the area of the feedback F11. , the packet may be directly transferred to the driver D2. Motor M1 then sends out the packet (S64).
  • the processing from S65 to S70 is the same as the processing from S15 to S20 in FIG. 10, so the description thereof will be omitted.
  • the motor M2 writes the data detected by the encoder E2 to the area of the feedback F2 addressed to the driver D2 (S70)
  • the motor M2 wraps the packet in the reverse direction of the daisy chain.
  • the processing of S70 is an example of a packet being looped back and transferred at the end of the network having a daisy chain structure.
  • FIG. 14 exemplifies the processing after the packet is wrapped in the reverse direction of the daisy chain in the second embodiment. That is, after the process of S70, motor M2 sends a packet to driver D2 (S80). Driver D2 then receives the packet (S81). Then, the driver D2 reads the feedback F2 addressed to the driver D2 from the access-permitted area in the process data (S82). The process of S82 is an example of acquiring the physical quantity detected in the electric motor corresponding to each driver from the area corresponding to itself in the packet that is returned and transferred. Next, the driver D2 sends the packet to the motor M1 (S83), and controls the motor M2 according to the command C2 and the feedback F2 obtained in the process of S66 (S84).
  • motor M1 receives the packet (S85). Then, the motor M1 writes the data detected by the encoder E1 to the area of the feedback F12 addressed to the driver D1 (S86). As described with reference to FIG. 12, in the control system 100B, when the driver D1 uses only the feedback F11 area without using the feedback F12 area, the motor M1 does not need to execute the process of S86. good too. Motor M1 then sends the packet to driver D1 (S87).
  • driver D1 receives the packet (S88). Then, the driver D1 reads the feedback F11 and F12 addressed to the driver D1 from the access-permitted area in the process data (S89).
  • the process of S89 is also an example of acquiring the physical quantity detected in the electric motor corresponding to each driver from the area corresponding to itself in the packet that is returned and transferred.
  • driver D1 may read only one of the feedbacks F11, F12.
  • the driver D1 sends a packet to the control device 10 (S90), and controls the motor M1 according to the command C1 and the feedbacks F11 and F12 obtained in the process of S59 (S91).
  • the control device 10 As described above, in the control system 100B of the present embodiment, as in the first embodiment, the control device 10, the driver D1, etc., and the motor M1 (encoder E1), etc. are connected in a daisy chain through the communication line LC. have a configuration. However, in this embodiment, while the packet from the control device 10 makes one round trip in the daisy chain, the following processes 1 to 3 are executed by the control device 10 and the corresponding slave node.
  • the control device 10 transmits a command including the target value to the driver D1 or the like, and the driver D1 or the like acquires the command.
  • the motor M1 etc. writes the feedback information measured by the encoder E1 etc. into the area of the packet such as the feedback F1.
  • the motor M1 or the like acquires the feedback (physical quantity detected by the encoder E1 or the like) written by the motor M1 or the like from the feedback F1 or the like area of the packet.
  • control system 100B including a plurality of motors M1 (encoders E1), etc., such as the driver D1, the driver D1, etc., controls the motor M1, etc. with better response than in the case of the control system 100A illustrated in the first embodiment. You can control it.
  • the driver D1 and the like need to be positioned closer to the control device 10 than the motor M1 and the like to be controlled. That is, in the daisy chain, the driver D1 and the like are positioned closer to the control device 10 than the motor M1 and the like to be controlled, and are connected in the daisy chain structure. As a result, it is possible to issue an instruction to the driver D1 or the like in one reciprocating packet, and feedback from the motor M1 or the like to the driver D1 or the like.
  • a plurality of control mechanisms M1 to M4, D1 to D4;
  • a control device (100) that controls the plurality of control mechanisms, each of the drivers, the motors, and the controllers included in the plurality of control mechanisms are connected by a daisy chain structure network (N1) capable of packet transfer and power supply to each of the encoders;
  • the control device (100) sets a command addressed to each driver (D1 to D4) of each of the plurality of control mechanisms in an area corresponding to each driver in the packet, and sends the packet to the next area of the daisy chain structure.
  • Each driver (D1 to D4) of the plurality of control mechanisms acquires a command addressed to itself from the control device from the area corresponding to itself in the packet received from the transmission source of the daisy chain structure, and send the received packet to the next destination in the chain structure;
  • Each of the motors (M1 to M4) of the plurality of control mechanisms sets the physical quantity detected by the encoder of each of the motors in the area corresponding to itself in the received packet, and the next step of the daisy chain structure.
  • a control system (100, 100A, 100B) for transmitting said received packet to a destination of .
  • Control device 100 100A, 100B Control system D1, D2, D3, D4 Driver E1, E2, E3, E4 Encoder LC Communication line LP1, LP2 Power line M1, M2, M3, M4 Motor SN1, SN2 Sensor

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Power Engineering (AREA)
  • Control Of Multiple Motors (AREA)
  • Small-Scale Networks (AREA)

Abstract

複数の制御機構に含まれるドライバ、電動機および制御装置はデイジーチェーン構造のネットワークで接続され、制御装置は、パケット内で複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定してパケットを前記デイジーチェーン構造の次の接続先に送信し、それぞれのドライバは、デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から制御装置から自身に宛てた指令を取得し、次の宛先に受信したパケットを送信し、それぞれの電動機は、受信したパケット内の自身に対応する領域にそれぞれの電動機が有するエンコーダによって検出された物理量を設定して、次の宛先に受信したパケットを送信する。

Description

制御システム、ドライバ、電動機、制御装置、および制御方法
 本発明は、制御システム、ドライバ、電動機、制御装置、および制御方法に関するものである。
 サーボドライバ(サーボドライブ、単にドライバともいう)と電動機間は動力線とエンコーダの信号線とが別々に配線されている。このため、配線作業の負荷が大きい。その結果として、配線作業がコスト増加の要因ともなる。そこで、例えば、シリアルエンコーダを内蔵した複数のモータと、サーボドライブとシリアルエンコーダを接続する通信線と、シリアルエンコーダとサーボドライブを接続する電源線とで構成されるサーボシステムにおいて、電源線と通信線は共通で、デイジーチェーン状に接続したものが提案されている(例えば、下記特許文献1)。
特開2007-181340号公報 特開2006-304461号公報
 しかしながら、制御システムが複雑化すると、例えば、PLC等の制御装置に複数のドライバと電動機が接続される構成もあり得る。
 本発明の目的は、複数のドライバを含む複雑な制御システムにおいて、信号線を簡略化し、配線作業の負荷とコストを低減することにある。
 本発明による実施形態は以下の制御システムによって例示される。第1の側面では、この制御システムは、
 電動機を駆動するドライバと前記電動機の回転に関する物理量を検出するエンコーダを有する前記電動機とを含む複数の制御機構と、
 前記複数の制御機構を制御する制御装置と、を備え、
 前記複数の制御機構に含まれるそれぞれの前記ドライバ、それぞれの前記電動機および前記制御装置は、パケット転送とそれぞれの前記エンコーダへの電源供給とが可能なデイジーチェーン構造のネットワークで接続され、
 前記制御装置は、パケット内で前記複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定して前記パケットを前記デイジーチェーン構造の次の接続先に送信し、
 前記複数の制御機構のそれぞれのドライバは、前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から前記制御装置から自身に宛てた指令を取得し、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信し、
 前記複数の制御機構のそれぞれの電動機は、受信したパケット内の自身に対応する領域に前記それぞれの電動機が有するエンコーダによって検出された物理量を設定して、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する。
 本制御システムでは、それぞれの電動機は、それぞれの電動機が有するエンコーダによって検出された物理量をパケット内の自身に対応する領域に設定することによってデイジーチェーン構造で接続されるドライバに引き渡すことができる。したがって、ドライバと電動機との間で、個別に、電動機が有するエンコーダによって検出された物理量を引き渡すための通信線が不要となる。
 第2の側面では、前記デイジーチェーン構造のネットワークの末端において前記パケットは折り返して転送され、
 前記複数の制御機構のそれぞれのドライバは、前記折り返して転送されたパケット内の自身に対応する領域から前記それぞれのドライバに対応する電動機において検出された前記物理量を取得する。
 本制御システムでは、デイジーチェーン構造のネットワークの末端において折り返して転送されるパケットによって、それぞれの電動機が有するエンコーダによって検出された物理量が上記デイジーチェーン構造で接続されるドライバに引き渡される。したがって、パケットがデイジーチェーン構造を一往復することで、制御装置からドライバへの指令と、電動機からドライバへの前記物理量の引き渡しが実行できる。
 第3の側面では、前記複数の制御機構のそれぞれにおいて、ドライバは対応する電動機よりも前記制御装置に近い位置でデイジーチェーン構造に接続される。この配置関係により、パケットがデイジーチェーン構造を一往復することで、制御装置からドライバへの指令と、電動機からドライバへの前記物理量の引き渡しが実現される。
 第4の側面では、前記制御装置は、前記デイジーチェーン構造の始点に接続され、前記パケットを送出し、
 前記送出されたパケットが前記デイジーチェーン構造の末端との間を往復する間に、前記複数の制御機構のそれぞれの電動機は、受信したパケット内に前記物理量を設定し、
 前記送出されたパケットが前記デイジーチェーン構造の末端との間を一度往復した後、前記制御装置は前記一度往復したパケットを再度送出し、
 前記複数の制御機構のそれぞれのドライバは、前記再度送出されたパケット内の自身に対応する領域から前記それぞれのドライバに対応する電動機において検出された前記物理量を取得する。
 この構成により、パケットがデイジーチェーン構造の末端との間を二度往復することで、制御装置からドライバへの指令と、電動機からドライバへの前記物理量の引き渡しが実現される。この場合には、ドライバは対応する電動機よりも制御装置に近い位置でデイジーチェーン構造に接続される必要がない。そのため、ドライバと対応する電動機との配置および接続の自由度が増加する。
 第5の側面では、本発明の一実施形態は、上記ドライバとして特定できる。
 第6の側面では、本発明の一実施形態は、上記電動機として特定できる。
 第7の側面では、本発明の一実施形態は、上記制御装置として特定できる。
 第8の側面では、本発明の一実施形態は、制御システムにおける制御方法として特定できる。
 本実施形態の少なくとも1つの側面では、複数のドライバを含む複雑な制御システムにおいて、信号線が簡略化されるので、配線作業の負荷とコストを低減することができる。
図1は一実施形態に係る制御システムの適用場面の一例を例示する図である。 図2は、比較例に係る制御システムを例示する図である。 図3は、第1の実施形態の制御システムを例示する図である。 図4は、第1の実施形態におけるモータおよびドライバの他の配置を例示する図である。 図5は、第1の実施形態の制御システムを例示する図である。 図6は、配線を保護またはシールドするダクトを用いた制御システムを例示する図である。 図7は、センサを含む比較例の制御システムと第1の実施形態の制御システムを比較する図である。 図8は、第1の実施形態のパケットに含まれるプロセスデータの構成と、第1回目にパケットがデイジーチェーンを巡回するときのノードの処理を例示する図である。 図9は、第2回目にパケットがデイジーチェーンを巡回するときのノードの処理を例示する図である。 図10は、第1の実施形態の制御システムの処理を説明する図である。 図11は、パケットがデイジーチェーンの逆方向に折り返されたとき以降の処理を例示する図である。 図12は、第2の実施形態のパケットに含まれるプロセスデータの構成とパケットがデイジーチェーンを巡回するときのノードの処理を例示する図である。 図13は、第2の実施形態の制御システムの処理を説明する図である。 図14は、第2の実施形態の制御システムの処理を説明する図である。
 以下、本発明の一側面に係る実施の形態(以下、「本実施形態」とも表記する)を図面に基づいて説明する。ただし、以下で説明する本実施形態は、あらゆる点において本発明の例示に過ぎない。本発明の範囲を逸脱することなく種々の改良や変形を行うことができることは言うまでもない。つまり、本発明の実施にあたって、本実施形態に応じた具体的構成が適宜採用されてもよい。なお、本実施形態において登場するデータは自然言語により説明される。しかし、より具体的には、本実施形態に登場するデータは、コンピュータが認識可能な疑似言語、指令、パラメータ、マシン語等で処理される。また、これらのデータは、主記憶装置または二次記憶装置の記憶領域に、バイナリデータ、文字列等の形式で保存される。
 <適用例>
 まず、図1を用いて、本発明が適用される場面の一例について説明する。図1は、本実施形態に係る制御システム100を例示する。ただし、図1のように、この制御システム100は、例えば、工場のオートメーションシステム、運送業者の集配センタの集配システム、通販業者の発送センタ、多関節ロボット、建設機械等である。図1のように、制御システム100は、複数のモータM1乃至M4と、モータM1乃至M4を駆動するサーボドライバ(以下、単にドライバという)D1乃至D4と制御装置10を有している。図1において、モータM1乃至M4とドライバD1乃至D4とは、ドライバD1等からモータM1等へ電力を供給するための動力線LP1乃至LP4で接続されている。なお、モータは電動機ともいう。
 これらのモータM1等、ドライバD1等、および制御装置10は、通信線LCで接続されている。通信線LCは、制御装置10、ドライバD1等、およびモータN1等をデイジーチェーンで接続し、ネットワークN1を形成する。デイジーチェーンは、ネットワークを構成するノード間の接続の仕方の1つである。デイジーチェーンでは、1番目のノードに2番目のノードが接続され、2番目のノードに3番目のノードが接続される。なお、ネットワークN1は、1本のデイジーチェーンとは限られず、分岐部BRにより、複数の経路に分岐可能である。
 ここで、ネットワークN1としては、例えば、EtherCATP(登録商標)を例示できる。ネットワークN1では、制御装置10がマスタノードであり、モータM1等、ドライバD1等がスレーブノードとなる。
 図1のように、制御システム100は、例えば、4軸を制御するシステムということができる。しかし、スレーブノードの数が図1のように8個に限定される訳ではない。すなわち、モータM1等の数、ドライバD1等の数は、それぞれ3個以下であってもよいし、それぞれ5個以上であってもよい。
 ネットワークN1では、スレーブノードのノードごとに、パケット内でデータを入出力する可能な領域が決められている。そして、マスタノードから送信されたパケットが最下流(末端)のスレーブノードまで届いて折り返され、再びマスタノードに戻って、ネットワークN1を一巡する間に、マスタノードと全てのスレーブノードとの間のデータ交換が完了する。
 さらに、ネットワークN1では、通信線LCは、例えば、Ethernet(登録商標)の信号線と電源線を含む。したがって、通信線LCは、例えば、IEEE 802.3標準Ethernet(登録商標)フレームでの情報の送受信が可能なデータ線と、マスタノードからスレーブノードへの電源供給が可能な電源線を含む。ネットワークN1は、パケット転送とそれぞれのエンコーダへの電源供給とが可能なデイジーチェーン構造のネットワークの一例と言える。
 制御装置10は、例えば、Programmable Logic Controller(PLC)、サーボコントローラ等と呼ばれるものである。制御装置10は、マイクロプロセッサ等のCentral Processing Unit(CPU)およびメモリを内蔵し、ユーザが変更可能なプログラムによって機器を制御する。なお、制御装置10は、通信線LSの通信インターフェースを有する。制御装置10のCPUは、デイジーチェーンで接続された通信線LSを通じて通信を実行する。
 ドライバD1等は、制御装置10からの目標値の指示を受け、モータM1等に電力を供給し、モータM1等を制御する。目標値は、例えば、モータM1等の軸の回転位置、回転速度、回転力等である。なお、ドライバD1等は、CPUを含むコントローラと通信線LSの通信インターフェースを有し、デイジーチェーンで接続された通信線LSを通じて通信を実行する。
 モータM1等は内部に通信装置とエンコーダを有している。通信装置は、CPUを含むコントローラと通信線LSの通信インターフェースを有し、デイジーチェーンで接続された通信線LSを通じて通信を実行する。エンコーダは、モータM1等の軸の回転位置(回転角度)、回転数、または、回転速度等のモータの回転に関する物理量を検出する。エンコーダは、通信線LCの電源線から電源供給を受け、例えば、光センサを動作させて、モータM1等の軸の回転を検出する。そして、通信装置は、通信線LCのデータ線により、エンコーダで検出された物理量(回転位置、回転数、回転速度等)を制御装置10またはドライバD1等に通知する。ドライバD1等は、エンコーダで検出された物理量を基に、モータM1の回転位置、回転速度、回転力等が目標値に近づくようにモータM1等を制御する。なお、ドライバD1等とモータM1等の組み合わせは、制御機構の一例と言える。
 <比較例>
 図2は、比較例に係る制御システム500を例示する。制御システム500は、制御装置50と、ドライバD51、D52と、モータM51、M51とを有する。制御システム500では、制御装置50とドライバD1等は、図1の場合と同様、通信線LC50で接続され、モーションネットワークを形成する。しかし、比較例においては、ドライバD51、D52は、モータM51、M52に動力線LP51、LP52により電力を供給する。また、比較例においては、ドライバD51、D52は、モータM51、M52に付属するエンコーダからエンコーダ線LE51、LE52を介して、モータM51、M52の回転位置、回転速度等の検出値を受け取る。
 すなわち、比較例においては、ドライバD51等とモータM51等の間は動力線LP1等とエンコーダ線LE1等で、別々に配線が必要である。また、ノイズの影響を避けるため動力線とエンコーダ線は分離して設置する必要がある。そのため、ドライバD51等とモータM51等との間に距離がある場合、長距離の動力線LP1等とエンコーダ線LE1等をそれぞれ配線することになる。また、モーションネットワーク用の通信線LC50とエンコーダ線LE51等はそれぞれ専用の通信線となっている。そのため、ユーザは、それぞれの専用のケーブル線種を準備しなければならない。
 <実施形態1>
 以下、図3から図11を参照して、本実施形態の制御システム100A乃至100Dを説明する。
 (構成)
 図3は、本実施形態の制御システム10Aを例示する図である。図1のように、制御システム100Aは、複数のモータM1、M2と、モータM1等を駆動するドライバD1、D2と、制御装置10を有している。図3においても、図1と同様、モータM1、M2とドライバD1、D2とは、ドライバD1等からモータM1等へ電力を供給するための動力線LP1、LP2で接続されている。制御システム100Aは、例えば、2軸を制御するシステムということができる。
 また、図3においても、図1と同様、モータM1等、ドライバD1等、および制御装置10は、通信線LCで接続されている。通信線LCは、制御装置10、ドライバD1等、およびモータM1等をデイジーチェーンで接続し、図1に例示したネットワークN1を形成する。なお、図3では、図1の分岐部BRは例示されていない。しかし、本実施形態および以下で述べる他の実施形態においても、通信線LCによるデイジーチェーンは、分岐部BRで複数の経路に分岐可能である。制御装置10、ドライバD1等、およびモータM1等については、図1で述べたものと同様である。
 制御システム100Aにおいても、通信線LCにより、ドライバD1等からモータM1等に付属するエンコーダに給電される。そして、エンコーダで検出したモータD1等の回転位置、回転数、回転速度等の物理量が通信線LCにより制御装置10に通知される。したがって、制御システム100Aにおいても、制御装置10から個別にドライバD1、D2にエンコーダ線LE1、LE2等を配線する必要がない。すなわち、通信線LCのデイジーチェーンがあればよい。
 図4は、本実施形態におけるモータM1、M2およびドライバD1、D2の他の配置を例示する。図4においては、制御装置10に近い位置にドライバD1、D2が配置され、これら制御装置10、ドライバD1、D2等から離れた位置にモータM1、M2が配置されることが想定されている。このように、ドライバD1等とモータM1等が距離をおいて配置される場合、比較例の図21場合に対して、図3の制御システム100Aは、エンコーダ線LE1等の配線が不要となり、効果が大きくなる。
 図5は、図2の比較例と同様にモータM1、M2およびドライバD1、D2を配置した制御システム100Bを例示する図である。図5では、図2と同様の構成の制御システム500Bも比較のために例示されている。
 図5のように、制御システム500Bでは、ドライバ51とモータM51を接続するエンコーダ線LE1、ドライバ52とモータM52を接続するエンコーダ線LE2が配線されている。一方、本実施形態の制御システム100Bでは、通信線LCの1系統のデイジーチェーンが配線されれば、モータM1、M2からドライバD1、D2にモータM1、M2に付属するエンコーダで検出された回転位置、回転速度等の物理量がフィードバック可能である。
 図6は、配線を保護またはシールドするダクトT1、T2を用いた本実施形態の制御システム100Cを例示する図である。図6では、図2と同様の構成でダクトT51、T52を用いた制御システム500Cも比較のために例示されている。
 図6のように、比較例の制御システム500Cにおいて、動力線LP51、LP52とエンコーダ線LE51、LE52とは、ノイズによる干渉防止のため、それぞれ異なるダクトT51、T52に収納される。同様に、本実施形態の制御システム100Cにおいて、動力線LP1、LP2と通信線LCとは、それぞれ異なるダクトT1、T2に収納される。
 図6のように、制御システム500Cの場合、2本のエンコーダ線LE51、LE52をダクトT51に通す必要がある。一方、本実施形態の制御システム100Cにおいては、ダクトT2を通る通信線LCは1本で済む。なお、図6は、2軸を制御する制御システム100Cの例である。3軸を制御する場合には、比較例の制御システム500Cの場合、ダクトT51に通るエンコーダ線は3本となり、本実施形態の制御システム100Cの場合、ダクトT2を通る通信線LCは1本で済む。これは、N(整数)軸を制御するシステムにおいて、N本のエンコーダ線を1本の通信線LCで置き換えることができるという一般化され得る効果である。また、例えば、制御装置10、ドライバD1、D2等を含む制御盤がモータM1、M2等から離れた位置に設置される場合に、本実施形態の効果は特に大きくなる。
 図7は、センサSN51等を含む比較例の制御システム500DとセンサSN1等を含む本実施形態の制御システム100Dを比較する図である。図7で左側に例示された制御システム500Dは、図6の制御システム500Cに対して、さらにセンサSN51、SN52が追加されたものである。一方、図7で右側に例示された制御システム100Dは、図6の制御システム100Cに対して、さらにセンサSN1、SN2が追加されたものである。
 制御システム500Dでは、センサSN1、SN2は、それぞれ、ダクトT51を通るセンサ線LS51、LS52によってドライバD51、D52に接続されている。一方、本実施形態の制御システム100Dでは、センサSN1、SN2は、いずれも、通信線LCのデイジーチェーンに接続すれば済む。したがって、制御システム100Dでは、2本のセンサ線LS51、LS52に代えて、1系統のデイジーチェーンの通信線LSが配線されればよい。これは、センサLS1等の数が、N(整数)個に増加した場合も、同様である。また、例えば、制御装置10、ドライバD1、D2等を含む制御盤がモータM1、M2等から離れた位置に設置される場合に、本実施形態の効果は特に大きくなる。
 ここで、センサSN1、SN2等の種類、および数に限定はない。センサSN1、SN2等は、検出部と、CPUを含むコントローラと、デイジーチェーンの通信線LSとの通信インターフェースを有する。検出部は、様々な物理量、化学成分、生体情報、画像、音等の少なくとも1つを含むデータを検出する。物理量とは、例えば、力学的またな電磁気学的な測定値、環境からの測定値等を含む。化学成分とは、例えば、物質または環境に含まれる分子その他の成分を含む。生体情報とは、例えば、人体、生物から得られる情報、環境から得られる生物情報等を含む。コントローラは、検出部で検出されたデータを通信インターフェースから、デイジーチェーンの通信線LSを介して次の宛先に送出する。これらのデータは、通信線LS上で授受されるパケット内における、センサSN1等に対応する入出力可能な領域に設定される。すなわち、センサSN1等は、物理量、化学成分、生体情報、画像および音の少なくとも1つを含むデータを検出し、デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域に検出したデータを設定して、デイジーチェーン構造の次の宛先に受信したパケットを送信する。このようにして、センサSN1等で検出されたデータがドライバD1、D2等、または制御装置10に伝達される。
 (パケットのプロセスデータの構成と入出力のタイミング)
 図1、図3乃至図7のように、制御装置10等はデイジーチェーンの始点に位置するといえる。すなわち、制御装置10、ドライバD1、モータM1、ドライバD2、モータM2、・・・のようにデイジーチェーン構造で接続されている。以下、このデイジーチェーン構造でのパケットへのデータの入出力をパケット内のプロセスデータの構成とともに説明する。
 図8は、本実施形態の制御システム100A乃至100Dの通信線LCによるデイジーチェーンを介して授受されるパケットに含まれるプロセスデータの構成を例示する。プロセスデータとは、パケットのヘッダ情報およびフレームチェックシーケンス等を除外したデータ部分である。なお、図8では、プロセスデータの構成とともに、制御装置10の処理およびパケットがデイジーチェーンを1回目に巡回するときにアクセスするスレーブノードの処理も矢印で例示されている。
 図8のように、プロセスデータは、デイジーチェーンに組み込まれたスレーブノードであるドライバD1、D2、・・・、およびモータM1、M2、・・・ごとに、読み書き可能な領域が予め指定されている。このような指定は、例えば、デイジーチェーンのネットワーク内のノード番号で識別可能なように実施すればよい。このような指定は、例えば、各スレーブノードがデイジーチェーンに接続されたときに実行されればよい。また、このような指定は、例えば、マスタノードとスレーブノードの間の初期設定で実行されるものでもよい。なお、図のように、本実施形態および以下に説明する他の実施形態において、モータM1、M2等には、エンコーダE1、E2等が付属する。そして、図8に例示されるプロセスデータは、ドライバD1宛て指令C1、ドライバD1宛てフィードバックF1、ドライバD2宛て指令C2、ドライバD2宛てフィードバックF2、・・・を含む。なお、本実施形態において、ドライバD1等およびモータM1等のスレーブノードがそれぞれ2個(合計4個)に限定される訳ではない。
 例えば、制御装置10は、ドライバD1宛て指令C1およびドライバD2宛て指令C2をパケットのそれぞれの領域に書き込み(矢印A1、A2)、パケットをデイジーチェーンに送出する。本実施形態では、デイジーチェーンは、図3のように、ドライバD1、モータM1、ドライバD2、モータM1の順に形成されているとする。なお、すでに述べたように、制御装置10、ドライバD1等、モータM1等およびセンサSN1等には通信線LSの通信インターフェースが設けられ、これらにより通信が実行される。ただし、本実施形態の説明では、制御装置10、ドライバD1等、モータM1等が通信するものと説明する。制御装置10は、パケットをドライバD1に転送する。
 すると、ドライバD1がパケットを受信し、プロセスデータから、ドライバD1宛て指令C1を読み出す(矢印A3)。指令C1は、例えば、モータM1の回転位置、回転速度、回転力等の目標値である。ドライバD1は、パケットをモータM1に転送するとともに、プロセスデータから読み出した指令C1にしたがって、モータM1を制御する。なお、この時点では、ドライバD1宛てフィードバックF1は未設定であるので、ドライバD1は、フィードバックF1を取得できない。
 次に、モータM1がパケットを受信すると、モータM1に付属するエンコーダE1が検出した回転位置、回転数、回転速度等の物理量をドライバD1宛てフィードバックF1の領域に書き込む(矢印A4)。そして、モータM1は、パケットをドライバD2に転送する。
 次に、ドライバD2がパケットを受信すると、プロセスデータから、ドライバD2宛て指令C2を読み出す(矢印A5)。ドライバD2は、パケットをモータM2に転送するとともに、プロセスデータから読み出した指令C2にしたがって、モータM2を制御する。なお、この時点では、ドライバD2宛てフィードバックF2は未設定であるので、ドライバD2は、フィードバックF2を取得できない。
 さらに、モータM2がパケットを受信すると、モータM2に付属するエンコーダE2が検出した回転位置、回転数、回転速度等の物理量をドライバD2宛てフィードバックF2の領域に書き込む(矢印A6)。そして、モータM2は、パケットをドライバD2に宛てて、デイジーチェーンを折り返して送出する。その後、パケットはデイジーチェーンを逆方向に転送され、一旦、制御装置10に戻る。なお、本実施形態では、パケットはデイジーチェーンを逆方向に転送される間、スレーブノードは、プロセスデータの領域に入出力を実行しないものとする。そして、制御装置10は、折り返して転送されたパケットを再度ドライバD1に向けて送出する。
 図9に、第2回目にパケットがデイジーチェーンを巡回するときにアクセスするスレーブノードの処理を矢印で例示する。本実施形態では、第2回目のパケットの巡回において、制御装置10は、第1回目の巡回時の指令(ドライバD1宛て指令C1およびドライバD2宛て指令C2)をクリアすることとする(矢印A111、A12)。ただし、制御装置10は、第1回目のドライバD1宛て指令C1およびドライバD2宛て指令C2をクリアする代わりに、この領域へのドライバD1、D2によるアクセスを不許可に設定してもよい。そして、第1回目の巡回と同様、制御装置10は、パケットをドライバD1に転送する。
 ドライバD1は、第2回目に巡回されるパケットを受信すると、プロセスデータから、ドライバD1宛てフィードバックF1を読み出す(矢印A7)。ドライバD1は、パケットをモータM1に転送するとともに、第1回目の巡回で取得済みの指令C1とフィードバックF1にしたがって、モータM1を制御する。
 次に、モータM1がパケットを受信すると、すにで、フィードバックF1の領域にデータ書き込まれているので、モータM1は、そのままパケットをドライバD2に転送する。
 次に、ドライバD2は、第2回目に巡回されるパケットを受信すると、プロセスデータから、ドライバD2宛てフィードバックF2を読み出す(矢印A8)。ドライバD2は、パケットをモータM2宛てに転送するとともに、第1回目の巡回で取得済みの指令C2とフィードバックF2にしたがって、モータM2を制御する。
 次に、モータM2がパケットを受信すると、すにで、フィードバックF2の領域にデータ書き込まれているので、モータM2は、そのままパケットをドライバD2に折り返す。
 このようにして折り返されたパケットはデイジーチェーンを逆方向に転送され、制御装置10に戻される。すると、制御装置10は、図8に例示した1周目のパケットに新たな目標値を設定し、フィードバックF1、F2の領域をクリアするか、この領域を書き込み可能に設定したパケットをデイジーチェーンに送出する。このように、制御装置10は、図8に例示する第1回目に巡回するパケットと、図9に例示する、第1回目の巡回で折り返された、第2回目に巡回するパケットを交互にデイジーチェーンに送出する。このような手順で、制御装置10は、目標値をスレーブノードのドライバD1、D2に引き渡す。また、モータM1、M2のエンコーダE1、E2は、制御装置10を介して、フィードバックをドライバD1、D2に引き渡す。
 (処理)
 図9、10により、制御システム100Aの処理を説明する。図9、10では、制御装置10、ドライバD1、D2、モータM1、M2およびモータM1、M2に付属するエンコーダE1、E2のパケットの授受と、これらによって実行される処理が例示されている。この処理では、まず、制御装置10がマスタノードとして、初期設定をスレーブノードに指示する(S1)。初期設定の指示は、例えば、各スレーブノードに対するプロセスデータ内のそれぞれのアクセス許可領域の通知を含むものでもよい。すると、各スレーブノードは、初期設定の指示にしたがって、自身が読み出す領域と、書き込む領域を認識し、それぞれのメモリに記憶する(S2乃至S5)。なお、すでに述べたように、このような設定は各スレーブノードがデイジーチェーンに接続されたときに実行されてもよい。
 次に、制御装置10は、プロセスデータに指令を設定し(S6)、パケットを送出する(S7)。S6の処理は、パケット内で複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定することの一例である。また、S7の処理は、パケットを前記デイジーチェーン構造の次の接続先に送信することの一例である。
 すると、ドライバD1がパケットを受信する(S8)。そして、ドライバD1は、プロセスデータ内のアクセスが許可された領域からドライバD1宛て指令C1を読み取る(S9)。S9の処理は、デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から制御装置10から自身に宛てた指令を取得することの一例である。次に、ドライバD1は、パケットを送出する(S10)とともに、指令C1にしたがってモータM1を制御する(S11)。S10の処理は、パケットをデイジーチェーン構造の次の接続先に送信することの一例である。
 次に、モータM1がパケット受信する(S12)。そして、モータM1は、エンコーダE1が検出した物理量をドライバD1宛てフィードバックF1の領域に書き込む(S13)。S13の処理は、受信したパケット内の自身に対応する領域に、それぞれの電動機が有するエンコーダによって検出された物理量を設定することの一例である。そして、モータM1は、パケットを送出する(S14)。S14の処理は、デイジーチェーン構造の次の宛先に前記受信したパケットを送信することの一例である。
 次に、ドライバD2がパケットを受信する(S15)。そして、ドライバD2は、プロセスデータ内のアクセスが許可された領域からドライバD2宛て指令C2を読み取る(S16)。S16の処理も、デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から制御装置10から自身に宛てた指令を取得することの一例である。次に、ドライバD2は、パケットを送出する(S17)とともに、指令C2にしたがってモータM2を制御する(S18)。
 すると、モータM2がパケット受信する(S19)。そして、モータM2は、エンコーダE2が検出した物理量をドライバD2宛てフィードバックF2の領域に書き込む(S20)。S20の処理も、受信したパケット内の自身に対応する領域に、それぞれの電動機が有するエンコーダによって検出された物理量を設定することの一例である。そして、モータM1は、パケットをデイジーチェーンの逆方向に折り返して送出する。なお、S13とS20の処理は、パケットがデイジーチェーン構造の末端との間を往復する間に、複数の制御機構のそれぞれの電動機が受信したパケット内に物理量を設定することの一例である。
 図11は、パケットがデイジーチェーンの逆方向に折り返されたとき以降の処理を例示する。すなわち、モータM2は、ドライバD2に向けてパケットを送出する(S30)。すると、それぞれのスレーブノードは、デイジーチェーンの逆方向にパケットを送出する(S31乃至S37)。S30乃至S37の処理は、デイジーチェーン構造のネットワークの末端においてパケットが折り返して転送されることの一例と言える。また、図10のS7から図11のS37の処理によって、パケットがデイジーチェーン構造の末端との間を一度往復したと言える。
 制御装置10は、折り返して転送されたパケットを受信すると(S37)、受信したパケットをフィードバックとしてデイジーチェーンに再び送出する(S38)。S38の処理は一度往復したパケットを再度送出することの一例である。
 そして、ドライバD1がフィードバックのパケットを受信する(S39)。そして、ドライバD1は、プロセスデータ内のアクセスが許可された領域からドライバD1宛てフィードバックF1を読み取る(S40)。S40の処理は、再度送出されたパケット内の自身に対応する領域からそれぞれのドライバに対応する電動機において検出された物理量を取得することの一例である。次に、ドライバD1は、パケットをモータM1に送出する(S41)とともに、第1回目の巡回で取得済みの指令C1とフィードバックF1にしたがってモータM1を制御する(S42)。
 次に、モータM1は、パケットを受信し(S43)、そのままドライバD2に送出する(S44)。これにより、ドライバD2がフィードバックのパケットを受信する(S45)。そして、ドライバD2は、プロセスデータ内のアクセスが許可された領域からドライバD2宛てフィードバックF2を読み取る(S46)。S46の処理も再度送出されたパケット内の自身に対応する領域からそれぞれのドライバに対応する電動機において検出された物理量を取得することの一例である。次に、ドライバD2は、パケットをモータM2に送出する(S47)とともに、第1回目の巡回で取得済みの指令C2とフィードバックF2にしたがってモータM2を制御する(S48)。
 そして、モータM2がパケットを受信し(S49)、そのままドライバD2に折り返す(S50)。以降、S30乃至S37と同様に、それぞれのスレーブノードは、デイジーチェーンの逆方向にパケットを送出する。
 (実施形態の効果)
 以上述べたように、本実施形態の制御システム100Aは、通信線LCにより、制御装置10、ドライバD1等、およびモータM1(エンコーダE1を含む)等をデイジーチェーンで接続した構成を有する。そして、制御装置10がマスタノードとなり、ドライバD1等、およびモータM1(エンコーダE1)等がスレーブノードとなる。これによって、パケットがデイジーチェーンを往復する間に、制御装置10がドライバD1等に目標値を含む指令を伝達し、モータM1等においてエンコーダE1で計測されたフィードバック情報である物理量がパケットに追加される。そして、次に、パケットが再びデイジーチェーンを往復する間に、ドライバD1等がこのフィードバック情報を取得する。このような2回のパケットの巡回(往復)により、従来のエンコーダ線LE1等が不要となる。その結果、ドライバD1等、モータM1(エンコーダE1)等を複数含む制御システム100Aにおいて、配線作業の負荷が大幅に削減される。この効果は、例えば、図4、図5の例示したように、ドライバD1等とモータM1(エンコーダE1)等の間の距離が大きい場合に大きなものとなる。また、この効果は、例えば、図6に例示したように、ダクトD1等が用いられる場合に大きなものとなる。さらに、この効果は、図7に例示したように、センサSN1等が多数用いられる場合に大きなものとなる。
 なお、本実施形態では、図2乃至7のデイジーチェーンにおいて、ドライバD1等が制御対象のモータM1等よりも制御装置10に近い側に位置する。しかしながら、ドライバD1等が制御対象のモータM1等よりも制御装置10に遠い側に位置する場合にも、制御システム100Aの処理は、適用可能である。すなわち、本実施形態の制御システム100Aでは、パケットがデイジーチェーンを2往復する間に、制御装置10からドライバD1等への指令とモータM1等からドライバD1等へのフィードバックが実行される。このため、本実施形態の制御システム100Aでは、ドライバD1等と制御対象のモータM1等とのデイジーチェーンでの位置関係に制限がない。すなわち、ドライバD1等と制御対象のモータM1等とが柔軟に配置可能で、レイアウトの自由度が向上する。
 <実施形態2>
 以下、図12から図14を参照して第2の実施形態の制御システム100Bを説明する。上記第1の実施形態の制御システム100Aでは、パケットがデイジーチェーンを2往復する間に、制御装置10からドライバD1等への指令とモータM1等からドライバD1等へのフィードバックが実行される。ここで、フィードバックとは、エンコーダE1等の検出データのドライバD1等への伝達である。一方、本実施形態の制御システム100Bでは、パケットがデイジーチェーンを1往復する間に、制御装置10からドライバD1等への指令とモータM1等からドライバD1等へのフィードバックが実行される。すなわち、マスタノードとしての制御装置10から送出されたパケットを用いて、スレーブノード間、つまり、ドライバD1等とモータM1等との間の通信が実行される。その結果、制御システム100Bでは、ドライバD1等とモータM1等との間のレスポンスが向上する。
 (パケットのプロセスデータの構成と入出力のタイミング)
 図12は、制御システム100Bの通信線LCによるデイジーチェーンを介して授受されるパケットに含まれるプロセスデータの構成を例示する。図12は、パケットがデイジーチェーンを巡回するときの各ノードの処理を例示する図でもある。プロセスデータは、ドライバD1宛て指令C1、ドライバD1宛てフィードバックF11、F12、ドライバD2宛て指令C2、ドライバD2宛てフィードバックF2、・・・を含む。なお、図12は、ドライバD1宛てフィードバックF11、F12を例示するが、いずれか一方だけが使用されてもよい。ドライバD1宛てフィードバックF11、F12が設けられるのは、パケットがデイジーチェーンを往復する間に、2回モータM1を通過するため、物理量が書き込まれる機会が2度発生するからである。
 第1の実施形態(図8)と同様、例えば、制御装置10は、ドライバD1宛て指令C1およびドライバD2宛て指令C2をパケットのそれぞれの領域に書き込み(矢印A21、A22)、パケットをデイジーチェーンに送出する。デイジーチェーンは、第1の実施形態の図3のように、ドライバD1、モータM1、ドライバD2、モータM1の順に形成されているとする。
 そして、ドライバD1がパケットを受信すると、プロセスデータから、ドライバD1宛て指令C1を読み出す(矢印A23)。ドライバD1は、パケットをモータM1に転送するとともに、プロセスデータから読み出した指令C1にしたがって、モータM1を制御する。なお、この時点では、第1の実施形態(図8)と同様、ドライバD1宛てフィードバックF1は未設定であるので、ドライバD1は、フィードバックF1を取得できない。
 次に、モータM1がパケットを受信すると、モータM1に付属するエンコーダE1が、検出した回転位置、回転数、回転速度等の物理量をドライバD1宛てフィードバックF1の領域に書き込む(矢印A24)。そして、モータM1は、パケットをドライバD2に転送する。なお、制御システム100Bにおいて、ドライバD1がフィードバックF12の領域のみを使用する場合には、モータM1は、エンコーダLE1で検出された物理量をフィードバックF1の領域に書き込むことなく、そのままパケットをドライバD2に転送してもよい。
 次に、ドライバD2がパケットを受信すると、プロセスデータから、ドライバD2宛て指令C2を読み出す(矢印A25)。ドライバD2は、パケットをモータM2に転送するとともに、プロセスデータから読み出した指令C2にしたがって、モータM2を制御する。なお、この時点では、第1の実施形態(図8)と同様、ドライバD2宛てフィードバックF2は未設定であるので、ドライバD2は、フィードバックF2を取得できない。
 さらに、モータM2がパケットを受信すると、モータM2に付属するエンコーダE2が、検出した回転位置、回転数、回転速度等の物理量をドライバD2宛てフィードバックF2の領域に書き込む(矢印A26)。そして、モータM1は、パケットをドライバD2に転送する。その後、パケットはデイジーチェーンを逆方向に転送される。
 ただし、本実施の形態では、この逆方向に転送の間に、ドライバD1、ドライバD2は、それぞれへのモータM1、M2のそれぞれからのフィードバックを取得する。すなわち、まず、ドライバD2は、モータM2から逆方向に送出されたパケットを受け取ると、
プロセスデータから、ドライバD2宛てフィードバックF2を読み出す(矢印A27)。ドライバD2は、パケットをモータM1に逆方向に転送するとともに、矢印A25の処理で取得済みの指令C2とフィードバックF2にしたがって、モータM2を制御する。
 次に、モータM1がパケットを受信すると、この時点でエンコーダE1が検出したデータをドライバD1宛てフィードバックF12に書き込む(矢印A28)。なお、制御システム100Bにおいて、ドライバD1がフィードバックF11の領域のみを使用する場合には、モータM1は、第1実施形態と同様、そのままパケットをドライバD1に転送してもよい。すなわち、制御システム100Bは、ドライバD1宛てフィードバックF11、F12のいずれか一方だけを用いてもよい。
 次に、ドライバD1がパケットを受信すると、プロセスデータから、ドライバD1宛てフィードバックF11、F12を読み出す(矢印A29、A30)。ドライバD1は、パケットを制御装置10に逆方向に転送するとともに、矢印A23の処理で取得済みの指令C1とフィードバックF11、F12にしたがって、モータM1を制御する。なお、モータM1が矢印A24の処理および矢印A28の処理のいずれかを実行しない場合、ドライバD1は、モータM1によって書き込まれたフィードバックF11、F12のいずれか一方により、モータM1を制御してもよい。
 (処理)
 図13、図14により、制御システム100Bの処理を説明する。図13、図14では、制御装置10、ドライバD1、D2、モータM1、M2およびモータM1、M2に付属するエンコーダE1、E2のパケットの授受と、これらによって実行される処理が例示されている。この処理のうち、S51乃至S61の処理は、図10のS1乃至S11の処理と同様であるので、その説明が省略される。
 そして、ドライバD1がパケットを送出すると(S61)、モータM1がパケット受信する(S62)。そして、モータM1は、エンコーダE1が検出したデータをドライバD1宛てフィードバックF11の領域に書き込む(S63)。なお、図12で説明したように、制御システム100Bにおいて、ドライバD1がフィードバックF11の領域をしないで、フィードバックF12の領域のみを使用する場合には、モータM1は、フィードバックF11の領域に書き込まないで、そのままパケットをドライバD2に転送してもよい。そして、モータM1は、パケットを送出する(S64)。
 次に、S65乃至S70の処理は、図10のS15乃至S20の処理と同様であるので、その説明が省略される。モータM2は、エンコーダE2が検出したデータをドライバD2宛てフィードバックF2の領域に書き込むと(S70)、モータM2は、パケットをデイジーチェーンの逆方向に折り返す。S70の処理は、デイジーチェーン構造のネットワークの末端においてパケットが折り返して転送されることの一例である。
 図14は、第2の実施形態において、パケットがデイジーチェーンの逆方向に折り返されたとき以降の処理を例示する。すなわち、S70の処理の後、モータM2は、ドライバD2宛てにパケットを送出する(S80)。すると、ドライバD2がパケットを受信する(S81)。そして、ドライバD2は、プロセスデータ内のアクセスが許可された領域からドライバD2宛てフィードバックF2を読み取る(S82)。S82の処理は、折り返して転送されたパケット内の自身に対応する領域からそれぞれのドライバに対応する電動機において検出された物理量を取得することの一例である。次に、ドライバD2は、パケットをモータM1に送出する(S83)とともに、S66の処理で取得済みの指令C2とフィードバックF2にしたがってモータM2を制御する(S84)。
 次に、モータM1は、パケットを受信する(S85)。そして、モータM1は、エンコーダE1が検出したデータをドライバD1宛てフィードバックF12の領域に書き込む(S86)。なお、図12で説明したように、制御システム100Bにおいて、ドライバD1がフィードバックF12の領域をしないで、フィードバックF11の領域のみを使用する場合には、モータM1は、S86の処理を実行しなくてもよい。そして、モータM1は、パケットをドライバD1宛てに送出する(S87)。
 次に、ドライバD1がパケットを受信する(S88)。そして、ドライバD1は、プロセスデータ内のアクセス許可された領域からドライバD1宛てフィードバックF11、F12を読み取る(S89)。S89の処理も、折り返して転送されたパケット内の自身に対応する領域からそれぞれのドライバに対応する電動機において検出された物理量を取得することの一例である。
 ただし、図12で説明したように、制御システム100Bにおいて、フィードバックF11、F12の一方だけが使用されてもよい。その場合には、ドライバD1は、フィードバックF11、F12の一方だけを読み取るようにしてもよい。次に、ドライバD1は、パケットを制御装置10に送出する(S90)とともに、S59の処理で取得済みの指令C1とフィードバックF11、F12にしたがってモータM1を制御する(S91)。
 (実施形態の効果)
 以上述べたように、本実施形態の制御システム100Bは、第1の実施形態と同様、通信線LCにより、制御装置10、ドライバD1等、およびモータM1(エンコーダE1)等をデイジーチェーンで接続した構成を有する。ただし、本実施形態では、制御装置10からのパケットがデイジーチェーンを1往復する間に、以下の処理1乃至3が制御装置10と該当するスレーブノードで実行される。
(1)制御装置10がドライバD1等に目標値を含む指令を伝達し、ドライバD1等が指令を取得する。
(2)モータM1等がエンコーダE1等で計測されたフィードバック情報をパケットのフィードバックF1等の領域に書き込む。
(3)モータM1等がパケットのフィードバックF1等の領域からモータM1等で書き込まれたフィードバック(エンコーダE1等で検出された物理量)を取得する。
 その結果、ドライバD1等、モータM1(エンコーダE1)等を複数含む制御システム100Bにおいては、ドライバD1等は、第1の実施形態で例示した制御システム100Aの場合よりも、レスポンスよくモータM1等を制御できる。
 なお、本実施形態では、図2乃至図7に例示のように、デイジーチェーンにおいて、ドライバD1等が制御対象のモータM1等よりも制御装置10に近い側に位置することが必要である。すなわち、デイジーチェーンにおいて、ドライバD1等が制御対象のモータM1等よりも制御装置10に近い側に位置してデイジーチェーン構造に接続される。これにより、パケット1往復でのドライバD1等への指示と、モータM1等からドライバD1等へのフィードバックが可能となる。
 <その他の実施形態>
 <付記>
1. 電動機(M1乃至M4)を駆動するドライバ(D1乃至D4)と前記電動機の回転に関する物理量を検出するエンコーダ(E1、E2)を有する前記電動機(M1乃至M4)とを含む複数の制御機構(M1乃至M4、D1乃至D4)と、
 前記複数の制御機構を制御する制御装置(100)と、を備え、
 前記複数の制御機構に含まれるそれぞれの前記ドライバ、それぞれの前記電動機および前記制御装置は、パケット転送とそれぞれの前記エンコーダへの電源供給とが可能なデイジーチェーン構造のネットワーク(N1)で接続され、
 前記制御装置(100)は、パケット内で前記複数の制御機構のそれぞれのドライバ(D1乃至D4)に対応する領域にそれぞれのドライバ宛の指令を設定して前記パケットを前記デイジーチェーン構造の次の接続先に送信し、
 前記複数の制御機構のそれぞれのドライバ(D1乃至D4)は、前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から前記制御装置から自身に宛てた指令を取得し、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信し、
 前記複数の制御機構のそれぞれの電動機(M1乃至M4)は、受信したパケット内の自身に対応する領域に前記それぞれの電動機が有するエンコーダによって検出された物理量を設定して、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する、制御システム(100、100A、100B)。
 10  制御装置
 100、100A、100B 制御システム
 D1、D2、D3、D4 ドライバ
 E1、E2、E3、E4 エンコーダ
 LC 通信線
 LP1、LP2 電力線
 M1、M2、M3、M4 モータ
 SN1、SN2 センサ

Claims (10)

  1.  電動機を駆動するドライバと前記電動機の回転に関する物理量を検出するエンコーダを有する前記電動機とを含む複数の制御機構と、
     前記複数の制御機構を制御する制御装置と、を備え、
     前記複数の制御機構に含まれるそれぞれの前記ドライバ、それぞれの前記電動機および前記制御装置は、パケット転送とそれぞれの前記エンコーダへの電源供給とが可能なデイジーチェーン構造のネットワークで接続され、
     前記制御装置は、パケット内で前記複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定して前記パケットを前記デイジーチェーン構造の次の接続先に送信し、
     前記複数の制御機構のそれぞれのドライバは、前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から前記制御装置から自身に宛てた指令を取得し、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信し、
     前記複数の制御機構のそれぞれの電動機は、受信したパケット内の自身に対応する領域に前記それぞれの電動機が有するエンコーダによって検出された物理量を設定して、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する、制御システム。
  2.  前記デイジーチェーン構造のネットワークの末端において前記パケットは折り返して転送され、
     前記複数の制御機構のそれぞれのドライバは、前記折り返して転送されたパケット内の自身に対応する領域から前記それぞれのドライバに対応する電動機において検出された前記物理量を取得する請求項1に記載の制御システム。
  3.  前記複数の制御機構のそれぞれにおいて、ドライバは対応する電動機よりも前記制御装置に近い位置でデイジーチェーン構造に接続される請求項1または2に記載の制御システム。
  4.  前記制御装置は、前記デイジーチェーン構造の始点に接続され、前記パケットを送出し、
     前記送出されたパケットが前記デイジーチェーン構造の末端との間を往復する間に、前記複数の制御機構のそれぞれの電動機は、受信したパケット内に前記物理量を設定し、
     前記送出されたパケットが前記デイジーチェーン構造の末端との間を一度往復した後、前記制御装置は前記一度往復したパケットを再度送出し、
     前記複数の制御機構のそれぞれのドライバは、前記再度送出されたパケット内の自身に対応する領域から前記それぞれのドライバに対応する電動機において検出された前記物理量を取得する請求項1に記載の制御システム。
  5.  前記デイジーチェーン構造のネットワークに接続される1以上のセンサをさらに備え、
     前記1以上のセンサは、前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域に検出したデータを設定して、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する請求項1乃至4のいずれか1項に記載の制御システム。
  6.  電動機を駆動するドライバと前記電動機の回転に関する物理量を検出するエンコーダを有する前記電動機とを含む複数の制御機構と、
     前記複数の制御機構を制御する制御装置と、を備える制御システムの前記いずれかのドライバであって、
     前記複数の制御機構に含まれるそれぞれの前記ドライバ、それぞれの前記電動機および前記制御装置は、パケット転送とそれぞれの前記エンコーダへの電源供給とが可能なデイジーチェーン構造のネットワークで接続され、
     前記制御装置は、パケット内で前記複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定して前記パケットを前記デイジーチェーン構造の次の接続先に送信し、
     前記複数の制御機構のそれぞれの電動機は、受信したパケット内の自身に対応する領域に前記それぞれの電動機が有するエンコーダによって検出された物理量を設定して、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する、前記ネットワーク内で、
     前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から前記制御装置から自身に宛てた指令を取得し、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信するドライバ。
  7.  前記デイジーチェーン構造のネットワークの末端において前記パケットは折り返して転送され、
     前記折り返して転送されたパケット内の自身に対応する領域から前記それぞれのドライバに対応する電動機において検出された前記物理量を取得する請求項6に記載のドライバ。
  8.  電動機を駆動するドライバと前記電動機の回転に関する物理量を検出するエンコーダを有する前記電動機とを含む複数の制御機構と、
     前記複数の制御機構を制御する制御装置と、を備える制御システムの前記いずれかの電動機であって、
     前記複数の制御機構に含まれるそれぞれの前記ドライバ、それぞれの前記電動機および前記制御装置は、パケット転送とそれぞれの前記エンコーダへの電源供給とが可能なデイジーチェーン構造のネットワークで接続され、
     前記制御装置は、パケット内で前記複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定して前記パケットを前記デイジーチェーン構造の次の接続先に送信し、
     前記複数の制御機構のそれぞれのドライバは、前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から前記制御装置から自身に宛てた指令を取得し、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する、デイジーチェーン構造のネットワーク内で、
     受信したパケット内の自身に対応する領域に自身に付属するエンコーダによって検出された物理量を設定して、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する電動機。
  9.  電動機を駆動するドライバと前記電動機の回転に関する物理量を検出するエンコーダを有する前記電動機とを含む複数の制御機構と、
     前記複数の制御機構を制御する制御装置と、を備える制御システムの制御装置であって、
     前記複数の制御機構に含まれるそれぞれの前記ドライバ、それぞれの前記電動機および前記制御装置は、パケット転送とそれぞれの前記エンコーダへの電源供給とが可能なデイジーチェーン構造のネットワークで接続され、
     前記複数の制御機構のそれぞれのドライバは、前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から前記制御装置から自身に宛てた指令を取得し、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信し、
     前記複数の制御機構のそれぞれの電動機は、受信したパケット内の自身に対応する領域に前記それぞれの電動機が有するエンコーダによって検出された物理量を設定して、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信する、デイジーチェーン構造のネットワーク内で、
     パケット内で前記複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定して前記パケットを前記デイジーチェーン構造の次の接続先に送信する制御装置。
  10.  電動機を駆動するドライバと前記電動機の回転に関する物理量を検出するエンコーダを有する前記電動機とを含む複数の制御機構と、
     前記複数の制御機構を制御する制御装置と、を備える制御システムの制御方法であって、
     前記複数の制御機構に含まれるそれぞれの前記ドライバ、それぞれの前記電動機および前記制御装置は、パケット転送とそれぞれの前記エンコーダへの電源供給とが可能なデイジーチェーン構造のネットワークで接続され、
     前記制御装置は、パケット内で前記複数の制御機構のそれぞれのドライバに対応する領域にそれぞれのドライバ宛の指令を設定して前記パケットを前記デイジーチェーン構造の次の接続先に送信し、
     前記複数の制御機構のそれぞれのドライバは、前記デイジーチェーン構造の送信元から受信したパケット内の自身に対応する領域から前記制御装置から自身に宛てた指令を取得し、前記デイジーチェーン構造の次の宛先に前記受信したパケットを送信し、
     前記複数の制御機構のそれぞれの電動機は、受信したパケット内の自身に対応する領域に前記それぞれの電動機が有するエンコーダによって検出された物理量を設定して、前記デイジーチェーン構造の次の宛先に受前記受信したパケットを送信する、制御方法。
PCT/JP2021/047112 2021-03-15 2021-12-20 制御システム、ドライバ、電動機、制御装置、および制御方法 WO2022196009A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021041885A JP2022141529A (ja) 2021-03-15 2021-03-15 制御システム、ドライバ、電動機、制御装置、および制御方法
JP2021-041885 2021-03-15

Publications (1)

Publication Number Publication Date
WO2022196009A1 true WO2022196009A1 (ja) 2022-09-22

Family

ID=83320284

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/047112 WO2022196009A1 (ja) 2021-03-15 2021-12-20 制御システム、ドライバ、電動機、制御装置、および制御方法

Country Status (2)

Country Link
JP (1) JP2022141529A (ja)
WO (1) WO2022196009A1 (ja)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003189654A (ja) * 2001-12-20 2003-07-04 Matsushita Electric Ind Co Ltd モータ制御用シリアル通信装置およびモータ駆動装置
JP2017011771A (ja) * 2016-10-20 2017-01-12 三菱電機株式会社 通信装置
WO2019220504A1 (ja) * 2018-05-14 2019-11-21 ロボショップ株式会社 スマート・サーボモータおよび複数のスマート・サーボモータを使用した駆動装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003189654A (ja) * 2001-12-20 2003-07-04 Matsushita Electric Ind Co Ltd モータ制御用シリアル通信装置およびモータ駆動装置
JP2017011771A (ja) * 2016-10-20 2017-01-12 三菱電機株式会社 通信装置
WO2019220504A1 (ja) * 2018-05-14 2019-11-21 ロボショップ株式会社 スマート・サーボモータおよび複数のスマート・サーボモータを使用した駆動装置

Also Published As

Publication number Publication date
JP2022141529A (ja) 2022-09-29

Similar Documents

Publication Publication Date Title
JP2006254450A (ja) 大域的非同期ネットワークオンチップシステムにおける通信ノードアーキテクチャ
US11281190B2 (en) Method for setting up a redundant communication connection, and failsafe control unit
JPH08289377A (ja) 紡績機械群を制御するための方法、及びそのシステム制御を構成するための制御ネットワ−ク
CN100533417C (zh) 片上系统的数据传输方法及直接存储器访问控制器
US10908583B2 (en) Safety control system and safety control unit
CN102667649A (zh) 基于多处理器的可编程逻辑控制器及其操作方法
EP0435141B1 (en) Computer equipped with plural processors
CN104903800A (zh) 运动控制器和使用这种运动控制器的机器人控制系统
CN105897574A (zh) 一种支持双网双主冗余的Modbus RTU/TCP网关装置
US20200220846A1 (en) Automation and/or Communications Appliance and Method for Checking Datagrams Transmitted in An Industrial Automation System
WO2022196009A1 (ja) 制御システム、ドライバ、電動機、制御装置、および制御方法
JP2009049642A (ja) 伝送システム
JP4927104B2 (ja) システム電源モード制御のためのパケット交換
CN103782549B (zh) 信息传输网络和相应的网络节点
JP6723146B2 (ja) 駆動機器および駆動機器システム
JP2008227558A (ja) ネットワークアダプタ、通信端末、通信経路分配方法およびそのプログラム
US20190058612A1 (en) Data communication bus for a robot
US20040105398A1 (en) Method and electronic switching circuit for a scalable communication interface in automation components
JP5110156B2 (ja) スイッチ及びネットワークブリッジ装置
JP2017121007A (ja) 通信方法及び通信機
JP2004289754A (ja) シリアル通信プロトコルおよびデータフレーム構成
Wilkening et al. Modular System Architecture for Large Multi-Axis Motion Control Systems in Automation
KR101024549B1 (ko) 로봇 제어기의 조인트 맵핑 시스템
JP5245464B2 (ja) モータ駆動用通信システム
Chterev et al. Lightweight Network Architecture for Tethered Underwater Vehicles

Legal Events

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

Ref document number: 21931751

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21931751

Country of ref document: EP

Kind code of ref document: A1