Revision for “ETP 529 BrainBox Motor Control Test” created on December 7, 2015 @ 19:39:53
| Title | ETP 529 BrainBox Motor Control Test |
|---|---|
| Content | <h6>1. PURPOSE / DESCRIPTION</h6>
1.1 Control the motors on quadcopter via DRONA and WiRa (BrainBox) communication
<h6>2. TEST SET-UP</h6>
2.1 DRONA firmware: <a href="https://github.com/Vairdo/DRONA_firmware">https://github.com/Vairdo/DRONA_firmware</a>, version: 96d90b1
2.1.1 Make sure the power source is from battery. Only battery can provide power to the motors
2.2 WiRa applications: <a href="https://github.com/Vairdo/BrainBox_Applications">https://github.com/Vairdo/BrainBox_Applications</a>, version: 4f10e03
2.3 More details for setting BrainBox, please refer to: <a href="http://wiki.vairdo.com/wiki/etp-526-set-up-brainbox/">http://wiki.vairdo.com/wiki/etp-526-set-up-brainbox/</a>
<h6>3. PROCEDURE</h6>
3.1 DRONA setup
3.1.1 The motors on quadcopter are usually controlled according to the value of pitch, roll, yaw, and throttle. To test the motor control independently, please comment the function FC_Try_Process_Controls() in main loop. Otherwise FC_Try_Process_Controls() will keep updating the motor pwm value by reading pitch, roll, yaw, and throttle.
<img class="alignnone wp-image-595 size-full" src="http://wiki.vairdo.com/wp-content/uploads/2015/11/p14.png" alt="p1" width="306" height="100" />
3.1.2 Set a breakpoint in MC_Set_Motor_PWM()
<a href="http://wiki.vairdo.com/wp-content/uploads/2015/11/p31.png"><img class="alignnone size-full wp-image-597" src="http://wiki.vairdo.com/wp-content/uploads/2015/11/p31.png" alt="p3" width="369" height="512" /></a>
3.2 WiRa setup
3.2.1 Uncomment the code (new Thread … ) in \drone\src\main\java\com\vairdo\dev\drone\MainService.java
3.2.1.1 It will automatically send a request to DRONA via SPI
3.2.1.2 The parameters in setMotors are mapped from 0~6000. (0~6000 maps to 0%~100% duty cycle)
3.2.1.2.1 The pwm value depends on which type of motors is used. You should check the <a href="http://ww1.microchip.com/downloads/en/DeviceDoc/70616g.pdf">data sheet</a> of dsPIC33EP512MC806, and determine a proper range for your motor.
3.2.1.2.1.1 Brushless: 1875~3750
3.2.1.2.1.2 Brushed: 0~6000 (shown as the picture below)
<img class="alignnone wp-image-596 size-full" src="http://wiki.vairdo.com/wp-content/uploads/2015/11/p21.png" alt="p2" width="597" height="227" />
3.2.2 Comment launchmain() in \drone\src\main\java\com\vairdo\dev\drone\MainService.java
<img class="alignnone size-full wp-image-451" src="http://wiki.vairdo.com/wp-content/uploads/2015/11/pic7.png" alt="pic7" width="680" height="181" />
3.3 Before connecting to motors, it would be better to use debug mode to check if the pwm values are valid.
3.3.1 Connect DRONA with MPLAB ICD3 (More details on setup ETPs)
3.3.2 Check if the pre-set breakpoint is ready
3.3.3 Run DRONA with debug mode, and power on WiRa (the power up time may vary; in general, it takes about 40 seconds to start the drone APP on WiRa)
3.3.4 After drone APP sends the request, the DRONA should be paused on the breakpoint
3.3.5 Check if the values are correctly written in duty cycle register (SDCx; x is from 1 to 4)
3.3.6 In drone APP, the parameters are 0.05, 0.1, 0.15, and 0.2 300, 600, 900, and 1200 in DRONA firmware
<img class="alignnone wp-image-598 size-full" src="http://wiki.vairdo.com/wp-content/uploads/2015/11/p41.png" alt="p4" width="1218" height="114" />
3.4 Connect motors to DRONA
3.4.1 To connect brushed motors with two-pin connectors
3.4.2 To connect brushless motors, with three-pin connectors
3.4.3 For quadcopter, the four motors are for FrontLeft, FrontRight, RearLeft, and RearRight
3.5 Remember to apply power with battery. Only battery can give power to motors.
3.6 Download the DRONA firmware and free run it. Then turn on WiRa (the power up time may vary; in general, it takes about 40 seconds to start the drone APP on WiRa)
3.7 The 4 motors will run at the setting from drone APP. |
| Excerpt |