Motor driver: Unterschied zwischen den Versionen

Aus www.wiki.ardumower.de
Wechseln zu: Navigation, Suche
(Wheel motors)
(Protector PCB)
 
(116 dazwischenliegende Versionen von 2 Benutzern werden nicht angezeigt)
Zeile 1: Zeile 1:
 
= Abstract =
 
= Abstract =
Ardumower's design uses two different types of motors (all motors can be purchased via the [https://www.marotronics.de/index.php?k=7 shop] [[File: shopping.png|link=https://www.marotronics.de/index.php?k=7]]):
+
Ardumower uses two different types of motors (all motors can be purchased via the [https://www.marotronics.de/index.php?k=7 shop] [[File: shopping.png|link=https://www.marotronics.de/index.php?k=7]]):
* Two motors (with integrated gearing) for driving (wheel motors), and encoder (for distance, direction and speed control)
+
* Two motors (with integrated gearing) for driving (wheel motors) and with integrated encoders (for distance and speed control)
 
* One motor (with high rotation speed) for mowing (mower motor)
 
* One motor (with high rotation speed) for mowing (mower motor)
  
To control a motor, it requires a 'motor driver'.
+
To control the motors, it requires motor drivers. In addition, the motor driver measures the motor current, and allows us to detect obstacles as motor current increases at obstacles. Ardumower uses two dual MC33926 motor drivers, so two channels for left and right motor and two dual channels (connected in parallel) for the mowing motor.
 +
 
 +
It is not safe to connect motors directly to the motor driver. Especially, when quickly turning motors from forward to reverse (or vice verse), high voltage spikes appear, and these could damage the motor drivers in the long run. Therefore, we developed driver protector boards that are connected between motor driver and motor.
 +
 
 +
[[File:Ardumower_motordriver_overview.png|800px]]
  
 
= Voltages =
 
= Voltages =
Although there exist 12V motors and 24V motors, as in all modern systems, the Ardumower uses 24V motors. The reason is as follows:
+
As in all modern systems, Ardumower uses 24V motors.
  
Assuming that the motor consumes 50W, using 24V results to a motor current: 50W / 24V = 2A.
+
= Motor driver assembly (dual MC33926) =
 +
Motor driver features: up to 3A with integrated current sensor and thermal shut-down protection
  
Assuming that the motor consumes 50W, using 12V results to a motor current: 50W / 12V = 4A.
+
<gallery>
 +
File: Ardumower_motordriver_overview.png | PCB, MC33926, protector and motors
 +
File: Pcb_mc33926.jpg | PCB and MC33926
 +
File:Mc33926.jpg | MC33926 pinout
 +
File:MC33926_schematics.jpg | MC33926 schematics
 +
</gallery>
  
The higher the current (A), the more problems arise:
+
* [https://www.youtube.com/watch?feature=player_embedded&v=DokrJiVzX2I Video instructions: Dual MC33926]
  
* The motor driver must be suitable for higher current (more expensive)
+
For wiring of motor drivers, protector and motors, please open manual in section Protector PCB.
* The PCB traces need to be more thick (more expensive)
+
* The rechargable battery need to support higher current (more expensive)
+
  
So, that's the reason why Ardumower is designed as a 24V system.
+
=Protector PCB=
 +
[[File:warning.png]] When quickly tunring motors from forward to backward (or vice versa), high voltage spikes appear. These high voltage spikes could damage the motor driver in the long run. To eliminate high voltage spikes, it is adviced to use a [https://github.com/Ardumower/ardumower/blob/master/Dokumentation/Protector%20Board/WORKSHOP%20Protector-Board.pdf Protector board] between motor driver and motor. Two Protector PCBs are required, one for the gear motors, and one for the mowing motor.
  
= Wheel motors =
 
 
<gallery>
 
<gallery>
 +
File: Ardumower_motordriver_overview.png | PCB, MC33926, protector and motors
 +
File:Protector_pcb2.jpg | Protector PCB
 +
File:Protector_wiring.png | Protector PCB wiring
 +
File:driver_hw_protection.png | Protector PCB schematics
 +
</gallery>
 +
 +
* [https://github.com/Ardumower/ardumower/blob/master/Dokumentation/Protector%20Board/WORKSHOP%20Protector-Board.pdf Assembly manual: Protector board (required for safe-use of motor drivers!)]
 +
 +
= Wheel motors wiring =
 +
<gallery>
 +
  File: Ardumower_motordriver_overview.png | PCB, MC33926, protector and motors
 
   File: ardumower_motor.jpg | Ardumower gear motor with encoder (8mm diameter, 5900 rpm motor, 0.055 Nm, gear ratio 1/212, output torque 2.45Nm, output rpm 31)
 
   File: ardumower_motor.jpg | Ardumower gear motor with encoder (8mm diameter, 5900 rpm motor, 0.055 Nm, gear ratio 1/212, output torque 2.45Nm, output rpm 31)
 
   File: magnetic_encoder.PNG | Motor wiring
 
   File: magnetic_encoder.PNG | Motor wiring
 
   File: wheel_motor_diagram.png | Ardumower gear motor curve (motor only)
 
   File: wheel_motor_diagram.png | Ardumower gear motor curve (motor only)
   File:decrease_motor_noise.png | Decrease motor noise
+
   File: Ardumower_gearbox.png | Gearbox specification
 
</gallery>
 
</gallery>
 
The two left and right gear motors are controlled independently (aka 'differential driving') to:
 
The two left and right gear motors are controlled independently (aka 'differential driving') to:
Zeile 33: Zeile 52:
 
* steer the robot left/right
 
* steer the robot left/right
  
The Ardumower wheel motor features:
+
Wheel motor features:
 
* A rotation speed up to 31 rpm allows to move the robot at sufficient speed (at up to meter/sec = 31rpm/60 * PI * 0.25m  = 0.4m/sec using 250mm diameter wheels)
 
* A rotation speed up to 31 rpm allows to move the robot at sufficient speed (at up to meter/sec = 31rpm/60 * PI * 0.25m  = 0.4m/sec using 250mm diameter wheels)
* A high torque (2.45Nm) guarantees that the robot can climb small hills as well (with 2 motors, 0.125 radius wheel, 31rpm = 0.4m/s, acceleration = 0.2 ( 1/2 of nomeinal speed) up to 14 degree) [http://www.robotshop.com/blog/en/drive-motor-sizing-tool-9698 see calculator]
+
* A high torque (2.45Nm) guarantees that the robot can climb small hills as well (with 2 motors, 0.125 radius wheel, 31rpm = 0.4m/s, acceleration = 0.2 ( 1/2 of nominal speed) [http://www.robotshop.com/blog/en/drive-motor-sizing-tool-9698 see calculator]
* Integrated encoders, so it can measure the rotation speed, the distance and the direction (see [[Odometry]] for more information) - Encoders are REQUIRED for Ardumower software.
+
* Integrated encoders, so it can measure the rotation speed and the distance
 
* 24V  (load current ~1A)
 
* 24V  (load current ~1A)
  
= Motor driver =
+
The left gear motor is connected as follows to the protector board:
A motor driver is a circuit that allows current to flow either one direction or the opposite direction through the motor - depending on wether the motor should turn forward or backward (so called 'H-bridge'). There are many motor drivers available as ready-circuit boards, some can even control two motors  (Dual H-Bridge) - if you connect two of their H-bridges in parallel, the maximum motor current can be increased.
+
  
If the direction of the motor does not need to be controlled, (e.g. for the blades), you do not need an H-bridge, but instead a simple 'switch' (e.g. MOSFET-transistor-circuit).
+
Motor wiring (left motor):
 +
Motor (black)  ==== Protector board Motor_1_OUT(1)
 +
Motor (red)   ==== Protector board Motor_1_OUT(2)
  
The motor driver is connected through control signals to the Arduino. Example:
+
For right motor, use Protector board Motor_2_OUT(1,2) accordingly.
  
  Arduino Digital Pin  —>  MOTOR-Direction Pin (DIR)
+
= Wheel motors odometry wiring =
  Arduino PWM Pin      —>  MOTOR-Speed Pin (PWM)
+
  Arduino Analog Pin  <—  MOTOR-Current Sensor Pin
+
  
 
+
The Ardumower gear motors have integrated encoders. These encoders help us to compute speed and traveled distance. Here's how you connect the motor odometry wires to the PCB.
One pin controls the direction (forward/backward), the other pin controls the speed. One analog input pin is connected to the current sensor. The current sensor module (ACS712-05A) is connected in series with the motor.
+
  
 
<gallery>
 
<gallery>
File:Ardumower_motor_driver_circuit.png | NOTE: only for demonstration! See real [http://wiki.ardumower.de/index.php?title=Ardumower_PCB schematics] for concrete wiring
+
  File: magnetic_encoder.PNG | Motor wiring
 +
  File: ardumower_odometry_encoder.jpg | Encoder signal
 
</gallery>
 
</gallery>
  
== PWM frequency ==
+
Motor odometry wiring (left motor):
The speed of the motor is controlled by a PWM duty signal. We use the Arduino default PWM frequency (490 Hz) to control the motor drivers.
+
Motor (brown)  ---- PCB VCC
 +
Motor (green)  ---- PCB GND
 +
Motor (blue)  ---- PCB OdometryLeft (3)
 +
Motor (purple) ---- PCB OdometryLeft (4)
  
<gallery>
+
For right motor, use PCB OdometryRight accordingly.
File: Arduino_pwm.png | Arduino PWM duty signal
+
File: Pwm_490hz.png | PWM 490 Hz: odometry ticks, sense (current)
+
File: Pwm_3khz.png | PWM 3.9 Khz: odometry ticks, sense (current)
+
File: Pwm_20khz.png | PWM 20 Khz: odometry ticks, sense (current)
+
File: Pwm_31khz.png | PWM 31 Khz: odometry ticks, sense (current)
+
</gallery>
+
  
== Popular modules ==
+
IMPORTANT: PCB v0.5/1.2 are missing pull-up resistors! You need to add them yourself at the PCB:
=== MC33926 (recommended) ===
+
 
+
Features: up to 3A with integrated current sensor and thermal shut-down protection, for all kind of robot mowers)
+
 
+
<gallery>
+
File:Mc33926.jpg | pinout
+
File:Mc33926_example.jpg | jumpers
+
File:MC33926_schematics.jpg | schematics
+
File:Mc33926_current_limiter.jpg | automatic current limiter
+
File:Motor_pwm_50_percent_transients.jpg | Motor start 50% PWM transients
+
File:driver_hw_protection.png | Peak/EMF protection
+
</gallery>
+
 
+
'''
+
M1_FB    --- pinMotorLeftSense A1
+
M1_SF    --- pinMotorLeftFault 25
+
M1_PWM_D1 --- connect with jumper to GND
+
M1_PWM_D2 --- connect with jumper to VDD
+
M1_IN1    --- pinMotorLeftPWM 5
+
M1_IN2    --- pinMotorLeftDir 31
+
EN        --- pinMotorEnable  37
+
M2_FB    --- pinMotorRightSense A0
+
M2_SF    --- pinMotorRightFault 27
+
M2_PWM_D1 --- connect with jumper to GND
+
M2_PWM_D2 --- connect with jumper to VDD
+
M2_IN1    --- pinMotorRightPWM  3
+
M2_IN2    --- pinMotorRightDir 33
+
EN        --- pinMotorEnable  37
+
VDD      --- Arduino 5V
+
 
+
=== L6201P ===
+
<gallery>
+
  File: L6201P_motor_driver.jpg | L6201P PCB
+
  File: L6201p.png | L6201P datasheet
+
</gallery>
+
 
+
Features: 48V, 4A
+
 
+
B+    power supply output voltage equal to the power connector
+
GND    GND
+
EN    driver enable
+
RPWM  forward PWM signal, active HIGH
+
LPWM  reverse PWM signal, active HIGH
+
CT    current signal output
+
VT    voltage signal output
+
 
+
Forward  EN=1, RPWM=PWM, LPWM=0
+
Reverse  EN=1, RPWM=0,  LPWM=PWM  (also possible?  EN=1, RPWM=255-PWM, LPWM=1  => needs to be verified!)
+
Brake    EN=1, RPWM=0,  LPWM=0
+
Not brake EN=0, RPWM=x,  LPWM=x
+
Note: 1=High level (3.3-5v), 0=Low level (0V or GND)
+
 
+
=== L9958 ===
+
Features: Arduino 240W H-bridge Motor Driver Board - SX8847, up to 8A
+
 
+
Note that this module has an on-board [http://en.wikipedia.org/wiki/78xx linear voltage regulator], which converts the input POWER (typically 24 or 12V) to 5V. Some modules do this with a single voltage regulator (chip VR1 on the module), or in a two-staged approach (VR1 and U2).
+
 
+
Converting 24V to 5V with a linear voltage regulator is very inefficient (current in = current out, so if you need 100mA at 5V, the linear voltage regulator requires 100mA at 24V, so you loose 1.9W in this module). Therefore, it is recommended to disconnect the linear voltage regulator from the board, and use the 5V from the switched mode power supply.
+
 
+
L9958 GND---GND
+
L9958 VCC---Arduino 5V
+
L9958 EN---Arduino 5V
+
L9958 DI---GND
+
L9958 DIR---Arduino MOTOR_DIR
+
L9958 PWM---Arduino MOTOR_PWM
+
L9958 MOTOR(+)---motor(+)
+
L9958 MOTOR(-)---motor(-)
+
L9958 POWER(+)---battery(+)
+
L9958 POWER(-)---battery(-)
+
 
+
<gallery>
+
  File: Motor_driver_L9958.jpg
+
</gallery>
+
 
+
=== L298N ===
+
Features: up to 4A
+
Notice: When using a L298N-motor driver, both H-bridges (2A) should be connected in parallel, so that both bridges drive a single motor (max. 4A):
+
 
+
Connect in parallel:
+
IN1 with IN4
+
IN2 with IN3
+
OUT1 with OUT4
+
OUT2 with OUT3
+
(Do NOT disconnect the SENSE-lines, except when you want to measure current by a 'shunt' resistor).
+
 
+
Make sure there is a jumper on both ENA and ENB. Also, make sure there is a jumper on S1.
+
 
+
<gallery>
+
File: Motordriver_l298n.JPG | driver
+
File: L298driver.jpg | double current
+
File: L298N_schematics.jpg | schematics
+
</gallery>
+
  
 +
PCB OdometryLeft(3) --- 4.7k --- 5v
 +
PCB OdometryLeft(4) --- 4.7k --- 5v
  
= Mower motor and driver =
+
= Mower motor wiring =
 
<gallery>
 
<gallery>
 +
File: Ardumower_motordriver_overview.png | PCB, MC33926, protector and motors
 
File: ardumower_mower_motor.jpg | Ardumower mower motor
 
File: ardumower_mower_motor.jpg | Ardumower mower motor
 
File: Mower_motor_curve.png | Ardumower mower motor curve
 
File: Mower_motor_curve.png | Ardumower mower motor curve
Zeile 175: Zeile 101:
 
* Quiet mowing (you cannot hear it)
 
* Quiet mowing (you cannot hear it)
 
* 24V, load current ~1.0A  (L=2.8mH, R=1.9ohm)
 
* 24V, load current ~1.0A  (L=2.8mH, R=1.9ohm)
 
For a the mowing motor, a MOSFET circuit is used. The MOSFET transistor IRLIZ44N (alternatives: IRF1404, IRL540N, RFP30N06LE, FQP30N06L) can already switch a current of 30A at the Arduino 5V control signal (N-LogL). The 10K resistor pulls down to ground when the Arduino starts. The 180 Ohm resistor limits the current at the Gate caused by level switches to about 30mA. The diode (MBR1045) protects  the circuit against current caused by motor induction. A current sensor module (ACS712-30A) is connected in series with the motor.
 
  
 
[[File:warning.png]]'''Security note: For security reasons, always remove mower blades in your first tests!'''
 
[[File:warning.png]]'''Security note: For security reasons, always remove mower blades in your first tests!'''
  
<gallery>
 
File: Ardumower_mower_motor_circuit.png | NOTE: only for demonstration! See real [http://wiki.ardumower.de/index.php?title=Ardumower_PCB schematics] for concrete wiring
 
</gallery>
 
 
= Choosing a driver =
 
  
When purchasing a motor driver, consider...
+
Here's how you connect the mowing motor to the protector board:
* max. thermal load (short-circuit current)
+
Motor (black)  ==== Protector board Motor_1_OUT(1)
* price
+
Motor (red)    ==== Protector board Motor_1_OUT(2)
  
= Starting current =
+
= Motor decrease noise =
Here are some measurements of the Ardumower motor's starting current (peak):
+
  
Starting current:
+
Here's how you can decrease motor noise:
* Gear motor: 15A (starting current peak)
+
* Mowing motor: 20A (starting current peak)
+
  
 
<gallery>
 
<gallery>
File: Messung_einschalt_spitzen.jpg | Gear motor start current (peak)
+
  File:decrease_motor_noise.png | Decrease motor noise
 
</gallery>
 
</gallery>
  
= Short-circuit current =
+
* [https://github.com/Ardumower/ardumower/blob/master/Dokumentation/Motor%20Entstoerung/Motor%20EntstoerungREV20150531.pdf Instructions: Motor-decrease noise REV20150531]
To not damage the motor driver on the first run, find out the maximum current that can flow through your motors. In other words, find out the 'short-circuit' current. Typical measurement installation:
+
* [http://www.ardumower.de/media/kunena/attachments/1725/Motor-EntstoerungREV20150531.pdf (English comments)]
  
Battery === Ampere meter === Motor
 
 
The Amperemeter (e.g. model making) should be able to measure the maximum current (e.g. 30A). The motor to be measured is mechanically blocked (so it cannot rotate).
 
 
'''Warning'''
 
 
* always remove blades
 
* only connect battery for a short period (1-5 seconds)
 
* always use cables with sufficient wire cross section
 
 
Example measurement:
 
 
* Rotenbach SPM08-320
 
** Wheel motor: 8A
 
** Mowing motor:
 
 
* Ambrogio L50
 
** Wheel motor: 4,5A
 
** Mowing motor: 22A
 
 
* Tianchen TC-G158
 
** Wheel motor: 5,4A
 
** Mowing motor: 16A (both 32A)
 
 
The measured current will only flow in 'worst-case' scenarios, which means when the motor starts or when it is blocked and it will only flow for a short time  (as your battery might not deliver the high current constantly, and so current and voltage will break down).
 
 
 
= Current sensor =
 
To detect certain conditions (robot drives against obstacle, motor blocks etc.), the motor current should be monitored constantly. There are two approaches for sensing current.
 
 
== Approach "Hall sensor module" ==
 
This is the recommended approach for sensing current. These current sensor modules are available for different current ranges.
 
 
* ACS712ELC-05A (185mV/A, max. 5A)
 
* ACS712ELC-20A (100mV/A, max. 20A)
 
* ACS712ELC-30A (66mV/A, max. 30A)
 
* The lower the range, the more precise the measurement.
 
 
== Approach "Shunt resistor (circuit)" ==
 
The current flows across a very small resistor (0.5 Ohm) and the voltage drop is measured
 
  
 +
= Motor controller (PID) =
 +
The speed of the motors is controlled by a software PID controller. You can monitor the quality of the motor speed control via pfodApp (Plot->Motor control):
  
 
<gallery>
 
<gallery>
File: L298n_module_circuit.jpg
+
  File:Speedcontrol.png | Motor speed settings
 +
  File: Odometry_motor_pid_controller.png
 
</gallery>
 
</gallery>
 
=Further links=
 
#[http://www.ardumower.de/index.php/en/forum/maehwerk/74-10a-pwm-controller-modul-fuer-den-arduino 10A PWM controller module modification]
 

Aktuelle Version vom 22. Februar 2017, 09:45 Uhr

Abstract

Ardumower uses two different types of motors (all motors can be purchased via the shop Shopping.png):

  • Two motors (with integrated gearing) for driving (wheel motors) and with integrated encoders (for distance and speed control)
  • One motor (with high rotation speed) for mowing (mower motor)

To control the motors, it requires motor drivers. In addition, the motor driver measures the motor current, and allows us to detect obstacles as motor current increases at obstacles. Ardumower uses two dual MC33926 motor drivers, so two channels for left and right motor and two dual channels (connected in parallel) for the mowing motor.

It is not safe to connect motors directly to the motor driver. Especially, when quickly turning motors from forward to reverse (or vice verse), high voltage spikes appear, and these could damage the motor drivers in the long run. Therefore, we developed driver protector boards that are connected between motor driver and motor.

Ardumower motordriver overview.png

Voltages

As in all modern systems, Ardumower uses 24V motors.

Motor driver assembly (dual MC33926)

Motor driver features: up to 3A with integrated current sensor and thermal shut-down protection

For wiring of motor drivers, protector and motors, please open manual in section Protector PCB.

Protector PCB

Warning.png When quickly tunring motors from forward to backward (or vice versa), high voltage spikes appear. These high voltage spikes could damage the motor driver in the long run. To eliminate high voltage spikes, it is adviced to use a Protector board between motor driver and motor. Two Protector PCBs are required, one for the gear motors, and one for the mowing motor.

Wheel motors wiring

The two left and right gear motors are controlled independently (aka 'differential driving') to:

  • drive the robot forward/backward
  • steer the robot left/right

Wheel motor features:

  • A rotation speed up to 31 rpm allows to move the robot at sufficient speed (at up to meter/sec = 31rpm/60 * PI * 0.25m = 0.4m/sec using 250mm diameter wheels)
  • A high torque (2.45Nm) guarantees that the robot can climb small hills as well (with 2 motors, 0.125 radius wheel, 31rpm = 0.4m/s, acceleration = 0.2 ( 1/2 of nominal speed) see calculator
  • Integrated encoders, so it can measure the rotation speed and the distance
  • 24V (load current ~1A)

The left gear motor is connected as follows to the protector board:

Motor wiring (left motor):

Motor (black)  ==== Protector board Motor_1_OUT(1)
Motor (red)    ==== Protector board Motor_1_OUT(2)

For right motor, use Protector board Motor_2_OUT(1,2) accordingly.

Wheel motors odometry wiring

The Ardumower gear motors have integrated encoders. These encoders help us to compute speed and traveled distance. Here's how you connect the motor odometry wires to the PCB.

Motor odometry wiring (left motor):

Motor (brown)  ---- PCB VCC
Motor (green)  ---- PCB GND
Motor (blue)   ---- PCB OdometryLeft (3)
Motor (purple) ---- PCB OdometryLeft (4)

For right motor, use PCB OdometryRight accordingly.

IMPORTANT: PCB v0.5/1.2 are missing pull-up resistors! You need to add them yourself at the PCB:

PCB OdometryLeft(3) --- 4.7k --- 5v
PCB OdometryLeft(4) --- 4.7k --- 5v

Mower motor wiring

The Ardumower mower motor features:

  • Fast enough to cut the lawn (3150 rpm)
  • Enough torque (140 mNm / 46 W)
  • Quiet mowing (you cannot hear it)
  • 24V, load current ~1.0A (L=2.8mH, R=1.9ohm)

Warning.pngSecurity note: For security reasons, always remove mower blades in your first tests!


Here's how you connect the mowing motor to the protector board:

Motor (black)  ==== Protector board Motor_1_OUT(1)
Motor (red)    ==== Protector board Motor_1_OUT(2)

Motor decrease noise

Here's how you can decrease motor noise:


Motor controller (PID)

The speed of the motors is controlled by a software PID controller. You can monitor the quality of the motor speed control via pfodApp (Plot->Motor control):