阅读说明：本技术 一种伺服电机及人工智能机器人 (Servo motor and artificial intelligence robot ) 是由 李月芹 于 2020-12-15 设计创作，主要内容包括：一种伺服电机及人工智能机器人,其节省电能。伺服电机中,第一电流检测器(13)和第二电流检测器(14)分别检测输入到电机的U相和V相电流i-(ua)和i-(va),并输入到第一坐标变换单元转换生成q轴电流i-(qa)和d轴电流i-(da)；d轴电流计算单元根据q轴电流i-(qa)生成d轴调整电流d轴电压计算单元根据d轴调整和输入的d轴电流指令生成d轴电压q轴电压计算单元(4)根据角速度指令生成q轴电压调整单元根据q轴电流i-(qa)、d轴电流i-(da)和角速度指令生成用于调整q轴电压和d轴电压的q轴调整电压和d轴调整电压和相加生成和相加生成第二坐标转换单元根据电流和生成和并提供给转换器。(A servo motor and an artificial intelligence robot save electric energy. In a servo motor, a first current detector (13) and a second current detector (14) detect a U-phase current i and a V-phase current i, respectively, input to the motor ua And i va And input to the first coordinate transformation unit to generate q-axis current i qa And d-axis current i da (ii) a The d-axis current calculation unit calculates the q-axis current i according to the q-axis current qa Generating a d-axis adjustment current d-axis voltage calculation unit adjusts according to d-axis And an input d-axis current command Generating d-axis voltage A q-axis voltage calculation unit (4) based on the angular velocity command Generating a q-axis voltage The adjusting unit is based on the q-axis current i qa D axis current i da And angular velocity command Generating voltage for adjusting q-axis And d-axis voltage Q-axis adjustment voltage of And d-axis regulated voltage And additive generation And additive generation The second coordinate conversion unit is based on the current And generating And and supplied to the converter.)

1. A servo motor comprises a motor driver and a motor, and is characterized in that the motor driver comprises a d-axis current instruction operation unit (109), a d-axis voltage calculation unit (010), a q-axis voltage calculation unit (104), a modification positive value calculation unit (106), a first coordinate conversion unit (107), a second coordinate conversion unit (105), a converter (108), a first current detector (113) and a second current detector (114), wherein the first current detector (113) and the second current detector (114) respectively detect a U-phase current and a V-phase current i input to the motor_uaAnd i_vaAnd input to the first coordinate transformation unit to generate q-axis current i_qaAnd d-axis current i_da(ii) a The d-axis current calculation unit calculates the q-axis current i according to the q-axis current_qaGenerating a d-axis adjustment currentd-axis voltage calculation unit adjusts according to d-axisAnd an input d-axis current commandGenerating d-axis voltageq-axis voltage calculationThe unit (104) is based on the angular velocity commandGenerating a q-axis voltageThe adjusting unit is based on the q-axis current i_qaD axis current i_daAnd angular velocity commandGenerating voltage for adjusting q-axisAnd d-axis voltageQ-axis adjustment voltage ofAnd d-axis regulated voltage Andadditive generation Andadditive generationThe second coordinate conversion unit is based on the currentAndgeneratingAndand supplied to the converter.

2. The servo motor of claim 1, wherein the d-axis current commandMuch less than the rated current of the motor.

3. An artificial intelligence robot wherein the servo mechanism for driving the robot comprises a servo motor according to any one of claims 1-2.

4. The artificial intelligence robot of claim 1, further comprising a control system including a camera for acquiring images of the environment, wherein the control system further includes an artificial intelligence module comprising: the system comprises an operation instruction input module, an image input module, a neural network, a path planning module and a training module, wherein the data input module is configured to receive operation instruction information sent by a user handheld controller; the image input module is configured to receive image information shot by the camera; the path planning module is configured to generate control information for controlling the motor driver according to the operation instruction information generated by the operation instruction input module or receive robot path information generated by the neural network to generate control information for controlling the motor driver; the training module is configured to obtain learning data from the path planning module and provide the learning data to the neural network for the neural network to learn.

5. The artificial intelligence robot of claim 4, wherein the neural network comprises at least an input layer, a function layer, and an output layer, the input layer inputting image coordinates of the image, the image coordinates of the image being representable by a matrix of:

wherein N is the number of rows of the image, M is the number of columns of the image, (x)₁,y₁)、(x₁,y_M)、(x_N,y₁) And (x)_N,y_M) Image coordinates of four corners of the input image, respectively; (x)_n,y_m) The image coordinate of any point in the image;

the function of the function layer satisfies at least the following equation:

wherein, (X Y Z) is the geodetic coordinates of the robot path; (X)_n Y_m Z_nm) Is a coordinate of (x)_n,y_m) Geodetic coordinates of the image counterpart of (a); f is the focal length of the camera; lambda and delta are normal numbers and are determined by a training module through learning; min { } is the minimum value;

a₁＝cosφ·cosκ

a₂＝cosω·sinκ+sinω·sinφ·cosκ

a₃＝sinω·sinκ-cosω·sinφ·sinκ；

b₁＝-cosφ·sinκ；

b₂＝cosω·cosκ-sinω·sinφ·sinκ

b₃＝sinω·sinκ+cosω·sinφ·sinκ

c₁＝sinφ；

c₂＝-sinω·cosφ；

c₃＝cosω·cosφ

wherein the content of the first and second substances,omega and kappa are respectively the rotation angle of the camera shooting axis around the y axis of the space coordinate system, the rotation angle around the x axis of the space coordinate system and the rotation angle around the z axis of the space coordinate system;

the output value of the output layer is (X-X)_N),(Y-Y_m),(Z-Z_K)。

Technical Field

The invention relates to a servo motor and an artificial intelligence robot, and belongs to the technical field of artificial intelligence.

Background

There is provided in the prior art a method for providing a position-sensorless servo motor in which a d-axis current command of a motor driver of the motor is set to a fixed value (e.g., a value of a motor rated current level). Such a servo motor has the following problems: there is a waste of power at light loads and detuning without rotation at high loads. In addition, in order to prevent rotation due to disturbance when a stop command is issued, it is necessary to adopt position control or to constantly supply an unnecessary d-axis current command.

Disclosure of Invention

In order to overcome the defects in the prior art, the invention aims to provide a servo motor and an artificial intelligent robot, wherein electric energy is saved.

To achieve the object, the present invention provides a servo motor including a motor driver and a motor, characterized in that the motor driver includes a d-axis current instruction arithmetic unit 109, a d-axis voltage calculation unit 110, a q-axis voltage calculation unit 104, a modification positive value calculation unit 106, a first coordinate conversion unit 107, a second coordinate conversion unit 105, a converter 108, a first current detector 113, and a second current detector 114, wherein the first current detector 113 and the second current detector 114 detect a U-phase and a V-phase current i-phase input to the motor, respectively_uaAnd i_vaAnd input to the first coordinate transformation unit to generate q-axis current i_qaAnd d-axis current i_da(ii) a The d-axis current calculation unit calculates the q-axis current i according to the q-axis current_qaGenerating a d-axis adjustment currentd-axis voltage calculation unit adjusts according to d-axisAnd an input d-axis current commandGenerating d-axis voltageq-axis voltage calculation unit 104 according to the angular velocity commandGenerating a q-axis voltageThe adjusting unit is based on the q-axis current i_qaD axis current i_daAnd angular velocity commandGenerating voltage for adjusting q-axisAnd d-axis voltageQ-axis adjustment voltage ofAnd d-axis regulated voltage Andadditive generationAndadditive generationThe second coordinate conversion unit is based on the currentAndgeneratingAndand supplied to the converter.

Preferably, the d-axis current commandMuch less than the rated current of the motor.

In order to achieve the purpose, the invention further provides an artificial intelligence robot, which is characterized in that a servo mechanism for driving the robot to operate comprises the servo motor.

Preferably, artificial intelligence robot, its characterized in that still control system, it includes the camera, the camera is used for acquireing the image of environment, its characterized in that, control system still includes artificial intelligence module, artificial intelligence module includes: the system comprises an operation instruction input module, an image input module, a neural network, a path planning module and a training module, wherein the data input module is configured to receive operation instruction information sent by a user handheld controller; the image input module is configured to receive image information shot by the camera; the path planning module is configured to generate control information for controlling the motor driver according to the operation instruction information generated by the operation instruction input module or receive robot path information generated by the neural network to generate control information for controlling the motor driver; the training module is configured to obtain learning data from the path planning module and provide the learning data to the neural network for the neural network to learn.

Preferably, the neural network comprises at least an input layer, a function layer and an output layer, the input layer inputting image coordinates of an image, the image coordinates of the image being representable by the following matrix:

wherein N is the number of rows of the image, M is the number of columns of the image, (x)₁,y₁)、(x₁,y_M)、(x_N,y₁) And (x)_N,y_M) Image coordinates of four corners of the input image, respectively; (x)_n,y_m) The image coordinate of any point in the image;

the function of the function layer satisfies at least the following equation:

wherein, (X Y Z) is the geodetic coordinates of the robot path; (X)_n Y_m Z_nm) Is a coordinate of (x)_n,y_m) Geodetic coordinates of the image counterpart of (a); f is the focal length of the camera; lambda and delta are normal numbers and are determined by a training module through learning; min { } is the minimum value;

a₁＝cosφ·cosκ

a₂＝cosω·sinκ+sinω·sinφ·cosκ

a₃＝sinω·sinκ-cosω·sinφ·sinκ；

b₁＝-cosφ·sinκ；

b₂＝cosω·cosκ-sinω·sinφ·sinκ

b₃＝sinω·sinκ+cosω·sinφ·sinκ

c₁＝sinφ；

c₂＝-sinω·cosφ；

c₃＝cosω·cosφ

wherein the content of the first and second substances,omega and kappa are respectively the rotation angle of the camera shooting axis around the y axis of the space coordinate system, the rotation angle around the x axis of the space coordinate system and the rotation angle around the z axis of the space coordinate system;

the output value of the output layer is (X-X)_N),(Y-Y_m),(Z-Z_K)。

Compared with the prior art, the servo motor and the artificial intelligent robot provided by the invention have the following advantages: (1) the electric energy is saved; (2) obstacle avoidance can be performed by only using a single camera.

Drawings

FIG. 1 is a block diagram of the control system of an artificial intelligence robot provided by the present invention;

FIG. 2 is a block diagram of the components of the artificial intelligence module provided by the present invention;

FIG. 3 is a relational diagram of various coordinate systems provided by the present invention;

FIG. 4 is a power supply system for providing power for an artificial intelligence robot provided by the present invention;

FIG. 5 is a schematic diagram of the components of the receive coil and transmit coil provided by the present invention;

FIG. 6 is a block diagram of the servo motor provided by the present invention;

FIG. 7 shows a d-axis and a q-axis as motor axes and a d-axis as a control axis in a servo motor^＊Axis q^＊A schematic view of a shaft;

fig. 8 is a block diagram showing the configuration of the d-axis current command operation unit shown in fig. 6.

Detailed Description

Reference will now be made in detail to embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein like or similar reference numerals refer to the same or similar elements or elements having the same or similar function throughout. The embodiments described below by referring to the drawings are exemplary only for the purpose of illustrating the present invention and are not to be construed as limiting the present invention.

As used herein, the singular forms "a", "an", "the" and "the" are intended to include the plural forms as well, unless the context clearly indicates otherwise. It will be further understood that the terms "comprises" and/or "comprising," when used in this specification, specify the presence of stated features, integers, steps, operations, elements, and/or components, but do not preclude the presence or addition of one or more other features, integers, steps, operations, elements, components, and/or groups thereof. It will be understood that when an element is referred to as being "connected" or "coupled" to another element, it can be directly connected or coupled to the other element or intervening elements may also be present. Further, "connected" or "coupled" as used herein may include wirelessly connected or wirelessly coupled. As used herein, the term "and/or" includes all or any element and all combinations of one or more of the associated listed items.

It will be understood by those skilled in the art that, unless otherwise defined, all terms (including technical and scientific terms) used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs. It will be further understood that terms, such as those defined in commonly used dictionaries, should be interpreted as having a meaning that is consistent with their meaning in the context of the prior art and will not be interpreted in an idealized or overly formal sense unless expressly so defined herein.

It should be appreciated by those skilled in the art that the terms "application," "application," and similar terms are used herein in a generic and descriptive sense only and not for purposes of limitation, as they are generally understood by those skilled in the art and refer to computer software tangibly embodied in a computer program of instructions and associated data sources and adapted for electronic operation. Unless otherwise specified, such nomenclature is not itself limited by the programming language class, level, or operating system or platform upon which it depends. Of course, such concepts are not limited to any type of terminal.

The artificial intelligent robot comprises a servo mechanism and a control system, wherein the servo mechanism drives the robot to operate, and the control system provides a control signal for the servo mechanism to drive the robot to operate.

Fig. 1 is a block diagram of a control system of an artificial intelligence robot according to the present invention, and as shown in fig. 1, the control system includes a processor 5, a MEMS2, a memory 2, and a servo 9. The running mechanism 9 comprises a running mechanism controller configured to provide control signals to the motor driver of the robot, two motor drivers configured to drive the motors to run, and two motors M1 and M2. The motors respectively drive two driving wheels (not shown) of the robot to rotate, so that the robot runs. The memory 1 is used for storing system programs, application programs, and data. MEMS2 are used to acquire the rotation angle of the camera's axis around the y-axis of the spatial coordinate systemThe rotation angle omega around the x-axis of the spatial coordinate system and the rotation angle kappa around the z-axis of the spatial coordinate system are provided to the processor 5. The geodetic coordinate system XYZ and the spatial coordinate system XYZ provided in the present invention and the relationship therebetween are shown in fig. 3.

In the present invention, the robot control system further includes a communication module 8 configured to perform wireless communication with the handheld controller of the user through control to obtain an instruction of the handheld controller, and also configured to perform communication with the wireless charger to obtain an instruction of the wireless charger, and operate according to the instruction. In the present invention, the robot control system may optionally include a positioning and timing module 3, which is used to obtain the position information and standard time information of the robot. In the present invention, the robot control system further includes a camera 4 for acquiring image information of the environment where the robot is located. The robot also includes a power module, which is a magnetically coupled power supply 6 for providing power to various parts of the robot, which will be described in detail later.

In the present invention, the control system further includes an artificial intelligence module configured to perform obstacle avoidance according to the image information acquired by the camera 4, and provide a control signal to the operation mechanism 9 to control the operation or stop of the robot.

Fig. 2 is a block diagram of an artificial intelligence module provided in the present invention, and as shown in fig. 2, the artificial intelligence module includes: the system comprises an operation instruction input module, an image input module, a neural network, a path planning module and a training module, wherein the data input module is configured to receive operation instruction information sent by a user handheld controller; the image input module is configured to receive image information captured by the camera 4; the path planning module is configured to generate control information for controlling the rotor driver according to the operation instruction information generated by the operation instruction input module or receive robot path information generated by a neural network to generate control information for controlling the rotor driver; the training module is configured to obtain learning data from the path planning module and provide the learning data to the neural network for the neural network to learn.

In the present invention, the neural network includes at least an input layer, a function layer and an output layer, the input layer inputs image coordinates (x) of an image_n,y_m) And rotation angle of camera shooting axis around y axis of space coordinate systemA rotation angle ω about an x-axis of a spatial coordinate system, a rotation angle κ about a z-axis of the spatial coordinate system, and image coordinates of the image may be represented by the following matrix:

wherein N is the number of rows of the image, M is the number of columns of the image, (x)₁,y₁)、(x₁,y_M)、(x_N,y₁) And (x)_N,y_M) Image coordinates of four corners of one image in the input video image stream respectively; (x)_n,y_m) The image coordinate of any point in the image;

the function of the function layer satisfies at least the following equation:

wherein, (X Y Z) is the geodetic coordinates of the robot path; (X)_n Y_m Z_nm) Is a coordinate of (x)_n,y_m) Geodetic coordinates of the image counterpart of (a); f is the focal length of the camera; lambda and delta are normal numbers and are the safe distance between the robot and the obstacle, and are determined by the training module through learning; min { } is the minimum value;

a₁＝cosφ·cosκ

a₂＝cosω·sinκ+sinω·sinφ·cosκ

a₃＝sinω·sinκ-cosω·sinφ·sinκ；

b₁＝-cosφ·sinκ；

b₂＝cosω·cosκ-sinω·sinφ·sinκ

b₃＝sinω·sinκ+cosω·sinφ·sinκ

c₁＝sinφ；

c₂＝-sinω·cosφ；

c₃＝cosω·cosφ；

the output layer (X-X)_N),(Y-Y_m),(Z-Z_K)。

Fig. 4 is a power supply system for supplying power to an artificial intelligence robot according to the present invention, fig. 5 is a schematic diagram illustrating the components of the receiving coil and the transmitting coil according to the present invention, as shown in fig. 4-5, the artificial intelligence robot further includes a power supply module, the module is a magnetic coupling power supply 6, and includes a receiving coil L2, which is a non-magnetic core coil, and is formed by winding a metal wire into a cylindrical structure with a hollow portion, and is used for receiving power transmitted by a wireless charger during charging, the wireless charger includes a transmitting coil L1, which is a coil with a magnetic core 68, and is formed by winding a metal wire onto a portion of a magnetic core, and during wireless charging, the diameter of the magnetic core 68 penetrating into the hollow portion of the receiving coil L2 is smaller than the diameter of the receiving coil L2. In the present invention, it is preferable that the wireless charger is fixed to a mechanism having a vertical mounting surface, and the height of the magnetic core is matched to the height of the receiving coil in the power supply of the robot, and when the robot needs to be charged, a part of the magnetic core is inserted into the receiving coil, so that the magnetic coupling degree of the transmitting coil and the receiving coil can be enhanced, and further, the charging efficiency can be increased.

In the invention, the wireless charger further comprises an oscillator 61, a frequency divider 62, a first switch circuit, a second switch circuit, an inverter 63, a phase detection unit 64, an amplitude detection unit 66, a processor 65 and a communication unit 67, wherein the oscillator 61 is used for generating a signal with fixed frequency; the frequency divider 62 is configured to divide the frequency of the signal provided by the oscillator 61 and output the input terminal of the first switching circuit and the inverter 63, respectively; the inverter 63 is configured to invert the signal provided by the frequency divider 62 and provide the inverted signal to the input terminal of the second switching circuit; the output end of the first switch circuit is connected to the first end of the transmitting coil L1 through a capacitor C2, and the output end of the second switch circuit is connected to the second end of the transmitting coil L1 through a capacitor C1; the phase detection unit 64 is for detecting the phase of the voltage of the transmitting coil L1; the amplitude detection unit 66 is for detecting the amplitude of the voltage of the transmitting coil L1; the processor 65 determines whether the receiving coil L2 moves to a predetermined position on the magnetic core according to the phase signal provided by the phase detecting unit 64 and the amplitude signal provided by the amplitude detecting unit 66, that is, the processor 65 sends an instruction signal to the robot through the communication unit 67, and the robot receives the instruction and operates to make the receiving coil L2 sleeve the magnetic core 68 and move along the magnetic core until the series resonant unit reaches the series resonant state.

In the invention, the first switch circuit comprises a P-channel field effect transistor Q1 and an N-channel field effect transistor Q2, the grids of the N-channel field effect transistor Q2 and the P-channel field effect transistor Q1 are connected together to be used as an input end, the drain electrode of the P-channel field effect transistor Q1 is connected with a power supply V, and the source electrode is connected with the drain electrode of the N-channel field effect transistor Q2 and is used as an output end; the source of the N-channel fet Q2 is grounded. The second switch circuit comprises a P-channel field effect transistor Q3 and an N-channel field effect transistor Q4, the grids of the N-channel field effect transistor Q4 and the P-channel field effect transistor Q3 are connected together to serve as an input end, the drain electrode of the P-channel field effect transistor Q3 is connected to a power supply V, and the source electrode of the P-channel field effect transistor Q3 is connected to the drain electrode of the N-channel field effect transistor Q4 to serve as an output end; the source of the N-channel fet Q4 is grounded.

In the present invention, the magnetic coupling power supply of the robot further includes a diode bridge DB for full-wave rectification, an electrolytic capacitor C3, a charger 69, and a storage battery 70, and the storage battery 70 is a rechargeable battery. The receiving coil L2 is magnetically coupled to the transmitting coil L1, and has a coupling coefficient M that varies with the relative positions of the transmitting coil L1 and the receiving coil L2. The input terminal of the diode bridge DB is connected to both ends of the receiving coil L2 for detecting the ac power induced by the receiving coil L2 to generate pulsating dc power, and the electrolytic capacitor C2 is used for filtering the pulsating dc power generated by the diode bridge DB and supplying the filtered pulsating dc power to the charger 69. The charger 69 charges the dc power to the secondary battery. In the present invention, the charger 69 may include a voltage boosting circuit.

The working process of the magnetic coupling power supply provided by the invention is as follows: after the wireless charger is turned on, the signal of the set frequency output from the oscillator 61 is divided by the frequency divider 62 into 1/n, where n is an integer greater than or equal to 2. The frequency-divided signal of a set frequency output from the frequency divider 62 is applied to the input terminal of the first switching circuit and the inverter 63, respectively, the inverter 63 inverts the signal supplied from the frequency divider to supply the input terminal of the second switching circuit, and the first switching circuit and the second switching circuit perform the opposite operation. That is, since the first switch and the second switch have P-channel fets Q1 and Q3 and N-channel fets Q2 and Q4, respectively, and the P-channel fet Q1 and the N-channel fet Q4 are turned on and the N-channel fet Q2 and the P-channel fet Q3 are turned off in the case of high level, the output of the first switch circuit is connected to the dc power supply V through the P-channel fet Q1 to be high level and the output of the second switch circuit is connected to ground through the N-channel fet Q4 to be low level. Thereby, a current flows in the forward direction through the transmission coil L1. When the inputs of the first switch circuit and the second switch circuit are reversed, the P-channel fet Q1 and the N-channel fet Q4 are turned off, and the N-channel fet Q2 and the P-channel fet Q3 are turned on, so that the output of the first switch circuit is grounded through the N-channel fet Q2 and becomes low, and the output of the second switch circuit 5B is connected to the dc power supply V through the P-channel fet Q3 and becomes high. This causes the current to flow in the opposite direction through the transmitting coil L1. In this way, when the alternating-current power (high-frequency power) is supplied to the transmission coil L1 by repeating the switching operation of alternately turning on and off the first switching circuit and the second switching circuit based on the signal of the set frequency output from the oscillator 3, a counter electromotive force is generated in the reception coil L2 by electromagnetic coupling conduction. The ac power transmitted to the receiving coil L2 is full-wave rectified by the diode bridge DB, filtered by the electrolytic capacitor C3, and converted into dc power, and the dc power is supplied to the charger 69, and the charger 69 charges the battery 70 with the electric power for the robot to use.

In the first and second switch circuits, the P-channel fets Q1 and Q3 and the N-channel fets Q2 and Q4 do not simultaneously turn on, and no through current is generated. In addition, since the drive control can be performed only by the voltage, electric power is not consumed in the control.

As described above, the transmitting coil L1 of the wireless charger and the receiving coil L2 of the receiving system are magnetically coupled to transmit electric power in a contactless and noncontact manner. In the non-electric charger, capacitors C1 and C2 are connected in series with the transmitting coil L1 to convert a direct-current voltage supplied to the transmitting coil L1 into an alternating-current voltage and boost the voltage, and capacitors C1 and C2 and a series resonant circuit integrated with the transmitting coil L1, the integrated series resonant circuit including a primary side series resonant circuit (a primary side series resonant circuit excluding a mutual inductance M caused by the receiving coil L2) and a mutual inductance M caused by the receiving coil L2, and alternating-current power is supplied to the transmitting coil L1 via the capacitors C1 and C2. In the present invention, capacitors C1, C2 and may also be provided between the first switching circuit and the connection terminal of the transmitting coil L1. In the invention, the capacitors are respectively arranged in the branches of the output ends of the first switch circuit and the second switch circuit, which are connected with the sending coil, so that the voltage resistance of the capacitors can be increased, and the weight of the magnetic coupling electric energy transmitter can be reduced. In the present invention, the resonance point of the series resonant circuit including the mutual inductance M of the receiver coil L2 is set as: a frequency higher than the resonance point of the primary series resonant circuit constituted by the primary coil L1 and the capacitors C1, C2.

In the present invention, the oscillation frequency of the oscillator 61 is set so that the oscillation frequency of the frequency-divided signal output from the frequency divider 62 becomes the resonance frequency of the series resonant circuit including the mutual inductance M of the receiving coil L2, and the primary series resonant circuit and the series resonant circuit are driven by the first switch circuit and the second switch circuit, and therefore, when there is no robot charging, since there is a large deviation from the resonance point of the primary resonant circuit, only a minute current flows through the transmitting coil L1. On the other hand, when there is robot charging, the robot moves forward and backward on the magnetic core with its receiving coil L2, and when the series resonant circuit resonates, a large current flows through the transmitting coil L1. Therefore, the magnetic coupling power transmitter can generate a large voltage at the transmission coil L1 without depending on the voltage of the power source or the signal source by the boosting function of the capacitors C1 and C2 connected in series to the transmission coil L1. Further, due to the resonance characteristics of the series resonant circuit including the mutual inductance M of the receiving coil L2, only a small current flows through the transmitting coil L1 when the robot is not charged, and a large current flows only when the robot is charged. Therefore, high power transmission efficiency at a practical level can be achieved, and further, downsizing, weight saving, and power saving can be easily achieved.

In the invention, the receiving coil L2 is a non-magnetic core coil and is rolled by metal wire to form a cylindrical structure with a hollow part; the transmitting coil L1 is a coil with a magnetic core and is formed by metal wire wound on a part of the magnetic core 68, and when wireless charging is carried out, the robot carries the receiving coil L2 to move back and forth on the magnetic core, so that the magnetic core 68 penetrates into the hollow part of the receiving coil L2. The metal wire is preferably a stranded plurality of copper wires or enameled wires.

In the invention, the robot is charged by the wireless charger, and the receiving coil is a coil without a magnetic core, so the weight is light, the load of the robot can be reduced, and meanwhile, the magnetic core of the wireless charger is inserted into the receiving coil of the robot during charging, the magnetic coupling is strong, and the charging efficiency is high.

Fig. 6 is a block diagram of a servo motor according to the present invention. In fig. 1, the motors M1 and M2 are permanent magnet synchronous motors. The two motor phases are exemplified by motor M1 and its drive controller. In the present invention, a surface magnet synchronous motor having no salient poles is used as the motor M1. The motor driver includes: a speed command generating unit 101, a speed arithmetic unit 102, and a phase arithmetic unit 103, wherein the speed command generating unit 101 is based on a speed command ω from the running mechanism controller_rGenerates a speed command specifying the rotational speed of the motor M1Speed calculation unit 102 gives the speed command generated by speed command generation unit 101Multiplying by half pole number P/2(P is full pole number) to generate angular velocity command expressed by electric angleThe angular velocity commandThe phase calculation unit (integrator) 103, the q-axis voltage calculation unit 104, and the correction value calculation unit 106 are input. Phase arithmetic unit 103 diagonal velocity instructionIntegral operation is performed to generate phase on electric axis (dq axis)The phase positionThe three-phase two-phase coordinate transformation unit 105 and the two-phase three-phase coordinate transformation unit 107 are input as position instructions.

The motor driver further includes: a d-axis current instruction arithmetic unit 109, a d-axis voltage calculation unit 110, a compensation unit 104, a conversion unit 1066, a first coordinate conversion unit 107, a second coordinate conversion unit 105, a converter 108, a current detector 113, and a current detector 114, wherein the current detectors 113 and 114 detect drive currents i of U-phase and V-phase of the motor_ua、i_vaAnd input to a three-phase two-phase coordinate transformation unit 107. Three-phase two-phase coordinate conversion unit 107 based on two-phase drive currents i input from current detectors 113 and 114_uaAnd i_vaCalculating the drive current i of the W phase_waAnd generates three-phase drive currents based on the phases as position commandsConverts it into d-axis and q-axis control currents (d-axis current i)_daQ-axis current i_qa). d-axis current i_daQ-axis current i_qaIs inputted to a correction value calculating means 106, and d-axis current i_daIs input to the d-axis voltage calculation unit 110.

q-axis current i_qaIs inputted to the d-axis current instruction operation unit 109 to generate a d-axis adjustment currentThe adder 112 adjusts the d-axis currentAnd d-axis current command input from the running mechanism controller shown in fig. 1Adding the obtained signals to obtain a d-axis current commandAnd input to d-axis voltage calculationAnd a unit 110. In the present invention, the d-axis current command from the operating mechanism controllerIs a value lower than the rated current of the motor. In the present invention, the d-axis current command calculation means 109 can determine the d-axis current command required for the current control by the d-axis voltage calculation means 104, and therefore the d-axis current command from the operating mechanism controllerMay be zero. d-axis voltage calculation unit 110 d-axis current commandGenerating a d-axis voltage applied to the d-axis of the motor M1The d-axis voltageD-axis interference voltage outputted from adder 15 and correction value calculation unit 106Added to become d-axis voltageIs input to the two-phase three-phase coordinate transformation unit 105.

In the present invention, q-axis voltage calculation section 104 calculates a speed command for synchronous motor M1Induced electromotive force generated during rotationThe induced electromotive forceIs compensation and speedInstructionsThe voltage of the corresponding q-axis voltage is added to the q-axis interference voltage outputted from the correction value calculation means 6 in the adder 116Added to become q-axis voltageAnd input to the two-phase three-phase coordinate transformation unit 105. Here, when the motor M1 is a surface magnet motor with no salient poles, an electromotive force is inducedRepresented by the formula:

in the formula phi_aIs the magnetic flux density.

Two-phase three-phase coordinate transformation section 105 based on the phase as a position commandA voltage (d-axis voltage) obtained by controlling the d-axis and the q-axis orthogonal thereto into two phasesVoltage of q axis) Converted into a three-phase (UVW) voltage command to be applied to the synchronous motor M1The converter 108 is a so-called inverter that is commanded based on 3-phase voltages from the two-phase three-phase coordinate conversion unit 105The generated pulse width modulated drive pulse signal turns on/off the switching element to generate a speed commandA 3-phase alternating voltage of a corresponding frequency, and supplied to the synchronous motor M1.

Modified value calculation unit 106 uses a speed instructionAnd detected d-axis current i_daAnd q-axis current i_qaCalculating to generate a d-axis correction voltage for compensating the d-axis voltage and the q-axis voltageq-axis correction voltageAs previously described, the generated d-axis interference voltageInput to the adder 115, q-axis interference voltageTo the adder 116. Here, when the motor M1 is a surface magnet motor with no salient poles, the d-axis interference voltageq-axis interference voltageRepresented by the following two formulae:

in the formula, La is an inductance component of d-axis and q-axis.

In the present invention, the d-axis current command from the running mechanism controller is usedPerforming synchronous control to apply only a speed command omega according to the controller of the running mechanism to the q axis_rGenerated speed commandAnd from the speed commandDerived position command, i.e. phaseCorresponding voltage commandNo current control is performed.

As shown in fig. 7, the control axis is passed through d^*Shaft according to speed commandRotate to command the speed of the rotor magnet 117D on the control shaft due to a disturbance torque such as friction^*When the shaft and the d-axis of the motor shaft are deviated, the speed command is givenWith rotor speed omega_reGenerating a phase error theta_err. In willAnd a modified value calculation sheetElement 106 utilizes sense q-axis current i_qaCalculated q-axis interference voltageThe q-axis voltage added by the adder 116When supplied to the two-phase three-phase coordinate conversion unit 105 and applied to the motor M1, the actual applied voltage is applied to the motor shaft q-axisAnd an applied voltage v determined as a theoretical value_qaTo generate the phase error theta_errCorresponding to the voltage error, in the q-axis current i outputted from the three-phase two-phase coordinate conversion unit 107_qaA variation component of a magnitude corresponding to the voltage error appears.

Next, a case of a surface magnet motor with no salient pole will be specifically described as an example. In the case of a non-salient pole surface magnet motor, the d-axis voltage v_daAnd q-axis voltage v_qaIs expressed by a voltage equation expressed by the following equation:

in the formula, Ra is the winding resistance, and p is a differential symbol.

According to the above formula, the applied q-axis voltageAnd an applied voltage v determined as a theoretical value_qaExpressed as the following two formulae:

therefore, a voltage error v occurs in the q-axis_qeRepresented by the formula:

herein, whenNo voltage error v is generated_qeWithout detecting the q-axis current i_qa(ii) a But whenTime, voltage error v_qeQ-axis current i needs to be detected ≠ 0_qa. When the motor is stopped, a voltage error v is generated by the rotation of the rotor magnet 17 due to the disturbance torque_qeWhen q-axis current i is detected, q-axis current i is detected similarly_qa。

Therefore, in the present invention, as shown in fig. 6, the motor driver is provided with a d-axis current instruction arithmetic unit 109 including an adder 112. d-axis current command operation section 109 takes detected q-axis current i converted and outputted only by conventionally used three-phase two-phase coordinate conversion section 107_qaMonitoring the q-axis current i_qaThe d-axis current command from the running mechanism controller is calculatedD-axis adjustment current command for performing increase/decrease adjustmentA d-axis current command is output from adder 112 to d-axis voltage calculation section 110D-axis current command for automatically performing increase and decrease adjustmentThus, the d-axis voltage calculation unit 110 can generate the d-axis voltage with improved robustness against disturbance torque

The d-axis current command operation means 109 may be configured as shown in fig. 8, for example. As shown in fig. 8, the d-axis current instruction arithmetic unit 109 shown in fig. 6 may be constituted by: is inputted with the detected q-axis current i_qaThe band pass filter 91 of (1), an absolute value circuit (ABS)92 having an output of the band pass filter 91 as an input, a time constant variable filter having an output of the absolute value circuit 92 as an input, and an output gain multiplier 94 having an output of the time constant variable filter as an input. The output of the output gain multiplier 94 is input to one input of an adder 112. The other input terminal of the adder 112 is inputted with a d-axis current command from the actuator controllerThe band-pass filter 91 is used for filtering the q-axis current i_qaThe middle noise component and the steady deviation component become only a change component current including positive and negative changes. The absolute value circuit 92 measures the q-axis current i that changes in positive and negative values and is input from the band-pass filter 91_qaAbsolute value of the change component of (a) to generate an absolute value of the q-axis current i_qbAnd outputs it to the time constant variable filter. The time constant variable filter includes: addition and subtraction operator 97, variable gain section 95, multiplier 96, and integrator 93. The addition-subtraction arithmetic unit 97 converts the q-axis current i from the absolute value of the absolute value circuit 92_qbState quantity i of time constant variable filter is subtracted_qf(which is the current integration value of the integrator 93) to obtain the deviation i_qeAnd outputs it to variable gain unit 95 and one input of multiplier 96. The variable gain unit 95 output Gout is input to the other input of the multiplier 96. The output of the multiplier 96 is input to the integrator 93.

In the present invention, the variable gain unit 95 is based on the input deviation i_qeOf such a magnitude that output Gout isCircuit with variable gain when deviation i_qeWhen larger, the variable gain unit 95 outputs Gout with a larger gain value, and when the deviation i is larger_qeWhen smaller, the variable gain unit 95 outputs Gout with a smaller value of gain.

Deviation i output from addition and subtraction operator 97_qeMultiplied by the output Gout of the variable gain unit 97 in the multiplier 96, and input to the integrator 93 to be integrated to obtain the state quantity i_qfTherefore, by the above-described operation of the variable gain unit 95, the state quantity i_qfIs variable and in the state quantity i_qfIncreased and state quantity i_qfThe time constant is different in the case of the decrease. The output gain multiplier 94 will be based on the offset i_qeThe state quantity i increasing or decreasing with different time constants_qfAnd an output gain k_aMultiplying to generate a d-axis adjustment current commandThe adder 12 outputs the d-axis adjustment current command generated by the gain multiplier 94With d-axis current command from the operating mechanism controllerAdded as a d-axis current command to the d-axis voltage calculating unit 10

In the present invention, when disturbance torque is applied, as shown in fig. 7, the rotor magnet 117 is moved away by d^*The axis rotates in the direction of the axis, a voltage error is generated by the change of the induced electromotive force, and a q-axis current i that changes greatly is input from three-phase two-phase conversion section 107 to d-axis current command calculation section 109_qa. In the d-axis current command operation means 109, the q-axis current i is extracted by the band-pass filter 91_qaA large variation component. If the initially detected q-axis current i_qaPositive polarity, the absolute value circuit 92 directly takes it as the absolute valueLogarithmic q-axis current i_qbAnd outputting the signal to a time constant variable filter. Time constant variable filter responding to inputted absolute q-axis current i_qbIs commanded to d-axis current with a small time constantAnd rises sharply. D-axis adjustment current command changed in such a mannerIn the adder 112, the d-axis current command from the operating mechanism controllerAdded and inputted to the d-axis voltage calculation unit 110 to generate a corresponding d-axis voltageThrough the d-axis current commandTo cause the rotor magnet 117 to face d^*Torque returned in the axial direction when d-axis current is commandedWhen the magnetic flux rises to a certain value, the rotor magnet 117 is directed to d^*The torque returning in the axial direction overcomes the disturbance torque, and the rotor speed is d^*The axial direction changes. With rotor speed relative to d^*The change of the axis is reduced, the voltage error is eliminated, and the q-axis current i_qaAbsolute value of q-axis current i_qbTherefore, in the time constant variable filter, the q-axis current i is absolute-valued in response_qbIs changed to make d-axis current commandWith a large time constant. D-axis adjustment current command of such a decreasing variationWith q-axis current command from the operating mechanism controllerAnd (4) adding. During the process, when the disturbance torque disappears, the current command is adjusted by the d axisDirection d of generation^*Torque returning in the axial direction, rotor speed in the direction d^*The axis direction changes, thereby inducing the change of the induced electromotive force again to generate a second q-axis current i_qa. The induced electromotive force in this case has a polarity opposite to that when the disturbance torque is applied, and thus the 2 nd q-axis current i is generated_qaIn the present example, negative. The q-axis current i of negative polarity_qaThe absolute value q-axis current i having positive polarity is converted by the absolute value circuit 92_qbAnd is input to the time constant variable filter. In the time constant variable filter, the d-axis current commandRises sharply with a small time constant. Then, the rotor speed is related to d^＊The change of axis disappears and the second q-axis current i_qaReducing, absolute-valued q-axis current i_qbWhen the current command is decreased, the d-axis is adjusted again in the time constant variable filterSlowly decreases with a large time constant and finally becomes 0.

In this way, the d-axis current command calculation means 109 shown in fig. 8 can automatically determine and execute the d-axis current command from the actuator controller according to the disturbance torqueD-axis adjustment current command for performing increase/decrease adjustmentTherefore, the shaft offset caused by the disturbance torque can be eliminated, the robustness against the disturbance can be improved, and the consumed electric power can be reduced.

It should be understood that the above examples are only for clarity of illustration and are not intended to limit the embodiments. Other variations and modifications will be apparent to persons skilled in the art in light of the above description. And are neither required nor exhaustive of all embodiments. And obvious variations or modifications therefrom are within the scope of the invention.