test_linear_regulator DarrellDesigner10 × Darrell Member for 10 years 5 months 624 designs 10 groups Big fan of VHDL-AMS https://explore.partquest.com/node/318 <iframe allowfullscreen="true" referrerpolicy="origin-when-cross-origin" frameborder="0" width="100%" height="720" scrolling="no" src="https://explore.partquest.com/node/318"></iframe> Title Description <p>Do you struggle to understand how to use the Talon SRX controller effectively? What is PID and PIDF? How does feedback control work? What is feed-forward control? How are values of P, I, D, & F determined? How is the new Talon SRX "motion profile" feature supposed to be used?</p> <p>If these are your questions, this blog is for you.</p> <p>The material that follows will help you to better understand and implement motion control on your own robot. <strong>Interactive simulation models, implemented using SystemVision® Cloud,</strong> are used to illustrate the concepts and allow you to interact with a variety of virtual motion control system configurations. You can copy these models, modify the selected motors, gear boxes, control parameters, loads, and inputs to<strong> tune the PIDFconstants, predict responses, and troubleshoot issues</strong>.</p> <h1>Background</h1> <p>Motors are used for controlling mechanical speed and position in a vast number of applications. Motors are a primary source of motion control, for example, in Robotics. The First Robotics Competition (<a href="http://www.firstinspires.org/robotics/frc">FRC</a>) is a popular robotics activity for high school students. This competition constrains the motors that can be used on robots, by rule, to those chosen from a fixed list (see my previous blog on <a href="https://www.systemvision.com/blog/first-robotics-frc-motor-modeling-may-6-2016">FRCmotor modeling</a>).</p> <p>In addition to motors, <strong>motor controllers</strong> are key to successful motion control applications. The motor controller makes it possible for each motor to be powered, from the main power source, but with variable strength. By sending signals from the main robot program to this intermediary, the motors can be manipulated to move forward or backward, at various speeds and to various positions.</p> <p>FRC restricts the motor controllers that may be used to those from a fixed list. This blog will focus on the <a href="http://www.ctr-electronics.com/talon-srx.html">Talon SRX</a>, available from <a href="http://www.ctr-electronics.com/">Cross The Road Electronics</a>, and the application of this versatilecomponent for robotic motion control. </p> <h1>The Talon SRXController</h1> <p>The Talon SRX controller is the most sophisticated controller product allowed on anFRC robot. It is small, light, robust, and versatile. Included inside the passively-cooled package are power electronics, a powerful microcontroller, and CAN bus communications. There is also support for directly connecting sensor feedback, such as encoders and limit switches, to enable self-contained closed loop control. The onboard microcontroller is programmable, at a high level, via an application programming interface (API) that communicates with the device via the CAN serial bus. All of this makes it possible to offload sophisticated motion control functions entirely to the Talon SRX, reducing the compute load of the main robot controller (typically aRoboRIOforFRC). Using the Talon SRXfor independent control also has performance advantages, since it has a dedicated real-time response loop of 1 millisecond, compared to a 20 or 25 millisecondloop on the main processor.</p> <p><img alt="" src="/sites/default/files/talon_srx_photo1.png" />Talon SRX Motor Controller</p> <p>The Talon SRX is programmed through a sophisticated API. This is well-documented in the <a href="http://www.ctr-electronics.com/downloads/pdf/Talon%20SRX%20Software%20Reference%20Manual.pdf">Talon SRX Software Reference Manual</a>. Programming examples are available for <a href="https://github.com/CrossTheRoadElec/FRC-Examples">LabVIEW, C++, and Java</a>. But programming is not the focus of this blog -- rather, the materials that follow are designed to help you <strong>understand, derive, and troubleshoot the PIDF control constants that are an integral part of the software controls</strong>.</p> <h1>CIMpleBox With Dual CIM Motors</h1> <p>For this example, we are modeling a commonly used <a href="http://www.andymark.com/CIMplebox-p/am-0734.htm">CIMple Box</a> gearbox, fitted with two <a href="http://www.andymark.com/CIM-Motor-p/am-0255.htm">CIMmotors</a>. Our example also uses a <a href="http://www.andymark.com/E4T-OEM-Miniature-Optical-Encoder-Kit-p/am-3132.htm">quadrature encoder</a>with 250 codes per revolution (CPR), which attaches directly to the output shaft of the gearbox, via a shaft that extends between the two motor mounting points. </p> <p> <iframe allowfullscreen="true" frameborder="0" height="355" id="PreviewFrame3D" name="PreviewFrame3D" scrolling="no" src="http://www.3dcontentcentral.com/external-site-embed.aspx?format=3D&catalogid=171&modelid=225513&width=250&height=250&edraw=true" width="400"></iframe>3D CAD Model of CIMple box and two CIMs <br /><a href="http://www.3dcontentcentral.com/download-model.aspx?catalogid=171&id=225513">Download</a></p> <p>This assembly can be seen in the schematics that follow by looking for this pattern -- two motors attached to a gearbox. The CIMplebox gear ratio of 4.67:1 is used here. But this can be changed when you copy and edit any of the circuit designs.</p> <p><img alt="" src="/sites/default/files//users/user10/CIMple%20box%20plus%20CIMs.PNG" />SystemVision Model of CIMple box and two CIMs</p> <p>Another popular gearbox is the Toughbox Mini. It is the standard gearbox available with the <a href="http://www.andymark.com/AM14U3-p/am-14u3.htm">FRC kit-of-parts (KoP) chassis</a>. The Toughbox Mini is available with the following <a href="http://www.andymark.com/tbmini-options-p/am-tbminioptions.htm">optional gear ratios</a>: 12.75, 10.71, 8.45, & 5.95. The default is 10.71.</p> <h1><a id="LiveDesigns" name="LiveDesigns"></a>Live Designs</h1> <p>The designs on this blog are live -- you can interact with them without leaving the page. Watch this short video to see how it works.</p> <div class="wistia_responsive_padding"> <div class="wistia_responsive_wrapper"> <iframe allowfullscreen="" allowtransparency="true" class="wistia_embed" frameborder="0" height="100%" mozallowfullscreen="" msallowfullscreen="" name="wistia_embed" oallowfullscreen="" scrolling="no" src="//fast.wistia.net/embed/iframe/btjkqc880x?videoFoam=true" title="Wistia video player" webkitallowfullscreen="" width="100%" id="wistia_embed"></iframe> </div> </div> <h1><a id="SimpleOpenLoop" name="SimpleOpenLoop"></a>Simple Open-loop Control</h1> <p>The simplest control that can be used with a Talon SRX is open loop, using the <span>PercentVBus</span>mode. In this mode, an input devices, such as a joystick, is used to simply send a command to the Talon SRX to set the output voltage at the specified percentage of the maximum voltage bus (typically ~12 Volts). The set pointis a number between -1 and +1, representing the bipolar output range (e.g.., -12V to +12V). </p> <p>The following simulation shows this scenario. The <span>motor_cmd_percent_bus</span>signal is stepped from 0 to +1 and then back to 0. The resulting voltage is applied to the motors, the motors deliver power through the gearbox to the load, and both the speed and position of the load can be observed.</p> <p> <iframe allowfullscreen="true" frameborder="0" height="720" scrolling="no" src="https://www.systemvision.com/node/202706" title="FRC Motor PWM control with TalonSRX - SystemVision Cloud" width="100%"></iframe> </p> <p>Notice that a full speed (<span>motor_cmd_percent_bus</span><span> </span>= 1.0) the motor RPM is 1.0621k, or <strong>1062.1</strong>. This number<span> is useful to us, as it represents the maximum motor speed that we can expect. </span></p> <p><span>You will notice, if you change the loading (<a href="https://www.systemvision.com/blog/controlling-motors-talon-srx-february-1-2017#LiveDesigns">watch the video</a> above to see how), that the maximum speed is not affected by the load -- only the time it takes to get to full speed. <strong>If the gear ratio is changed, however, the maximum motor speed can change significantly</strong>. See <a href="https://www.systemvision.com/design/frc-motor-openloop-control-talonsrx-toughbox-mini">here </a>for a version of this design with a Toughbox Mini gearbox. </span></p> <h1><a id="FFSpeed" name="FFSpeed"></a>Feed-Forward speed control</h1> <p>The next step in our progression is to use feed-forward control. This is only slightly more sophisticated than the previous example. In this configuration, the input mode changes from <span>PercentVBus</span>to <span>Speed</span>. T<span>he desired speed of the load, </span><span>set_speed_rpm,</span><span> is scaled by the value of the feed-forward gain, F-gain, before applying it to the Talon SRX output. It is important, however, to fully understand the assumed units for all of the quantities used in this calculation. This can be tedious to keep straight, but paying attention to these details will significantly reduce downstream headaches!</span></p> <p>The Talon SRX software reference manual provides a detailed description for calculating the F-gain Feed-Forward constant, taking care to use the correct units (see section<a href="http://www.ctr-electronics.com/downloads/pdf/Talon%20SRX%20Software%20Reference%20Manual.pdf#page=85">12.4.2. Velocity Closed-Loop Walkthrough – Calculating Feed Forward</a>).</p> <p>In this example, the quadrature encoder we are using produces <strong>250 codes per revolution</strong> (CPR). From section 17.2.1 in the reference manual, we see that the native units for this encoder are <strong>4 X CPR</strong>. The maximum velocity that we measured using our first experiment, above, was approximately <strong>1062</strong> rotations / min.</p> <p>For the F-Gain calculation, velocity is measured in change in native units per <span>TvelMeas=</span>100ms. <br /><span>(</span><span></span><strong>1062</strong><span>Rotations / min) X (1 min / 60 sec) X (1 sec / 10 <span>TvelMeas</span>) X (<strong>250</strong> codes / rotation) X (<strong>4</strong> native units / code) <br />= 1770 native units per 100ms </span> </p> <p><span>Now let’s calculate a Feed-forward F-gain so that 100% motor output is calculated when the requested speed is </span><span>1770</span><span> native units per 100ms. </span></p> <p><span>F-gain = (100% X 1023) / </span><span>1770</span> <br /><span><strong>F-gain = 0.5780</strong></span></p> <p><span>Let’s check our math, if the target speed is 1770 native units per 100ms, Closed-loop output will be (</span><span>0.5780</span><span> X 1770) => 1023 (full forward).</span></p> <p><span>This is convenient, as we can now directly ask the motor to go to a specific speed. Notice, though, that the accuracy of this method relies on our prediction that motor output speed is a linear function of the <span>motor_cmd_percent_bus</span>signal. We can see, though, by comparing the <span>set_speed_rpm</span> to the <span>load_speed_rpm</span> signals, that this prediction is only approximate. Otherwise, these signals would be identical.</span> </p> <p> <iframe allowfullscreen="true" frameborder="0" height="720" scrolling="no" src="https://www.systemvision.com/node/134871" title="FRC Motor speed Feed-Forward control with TalonSRX - SystemVision Cloud" width="100%"></iframe> </p> <p>This discrepancy is because feed-forward control is an open loop form of control -- the encoder information is not used here to actively correct the <span>motor_cmd_percent_bus</span> signal in order to bring it into alignment with the <span>set_speed_rpm</span> signal. In the next step, we will add feedback to improve the performance.</p> <h1><a id="PIDFSpeed" name="PIDFSpeed"></a>PIDFFeed-Forward + Closed-Loop Speed Control</h1> <p>In this step, we add feedback control, to achieve a better match between the speed set point and the measured result. The structure of all feedback control systems is similar: a set point is compared to a feedback value (by subtraction) to determine the error (difference). This error is used to drive the actuator in a way that will hopefully bring it closer to the set point (drive the error to as close to zero as possible).</p> <p>Look for this pattern in the diagram below. The feedback speed, <span>load_speed_NU </span>is subtracted from the set point, <span>set_speed_NU</span>, to produce the <span>error </span>signal. The error signal is, in turn, processed by three different math operators: a simple multiply by <span>P_gain</span>, integrate and multiply by <span>I_gain</span>, and differentiate and multiply by <span>D_gain</span>. These three terms are then added to produce the PID response to drive the motor. But before they are applied to the motor, the feed forward<span>F_gain </span>term, from above, is added to the PID terms. But this is all still in the native units internal to the Talon microcontroller, in which full scale output is represented by a value of 1023. So, before applying this to our model, which expects a value between -1 and +1, we need to divide by 1023 (i.e.., multiply by 9.775E-4). </p> <p>Remember, now, that all of this is happening inside the Talon SRX, as software functions running on the embedded microcontroller. All of the green signals in this diagram (<span>and their respective function blocks)</span>represent the functionality of this embedded software. This model is convenient, as it lets us try different values of the PIDF gains to verify that we will get the results that we want. This can be difficult and/or time consuming to do with a real robot. If you have tried this with a robot, you will know that if you make the <span>P_gain</span> value too small, nothing happens. If you make it too big, the robot can oscillate wildly.</p> <p><span>The Talon SRX software reference manual provides a detailed description for determining in the proportional gain (P-gain) constant, taking care to use the correct units (see section</span><a href="http://www.ctr-electronics.com/downloads/pdf/Talon%20SRX%20Software%20Reference%20Manual.pdf#page=88">12.4.3. Velocity Closed-Loop Walkthrough -- Dialing Proportional Gain</a><span>).</span></p> <p>Suppose given our worst error so far (~150 native units per 100ms), we want to respond with another 10% of throttle. Then our starting p-gain would be…. (10% X 1023) / (150) = 0.682</p> <p>Now let’s check our math, if the Talon SRX sees an error of 150 the P-term will be 150 X <span>0.682</span> = 102 (which is about 10% of 1023)</p> <p>P-gain = <span>0.682</span></p> <p><span>Notice from the simulation below, though, that even a P-gain value as high as 20.0 does not cause oscillations. </span></p> <p> <iframe allowfullscreen="true" frameborder="0" height="720" scrolling="no" src="https://www.systemvision.com/node/134716" title="FRC Motor speed control with TalonSRX - SystemVision Cloud" width="100%"></iframe> </p> <h1><a id="PIDPosition" name="PIDPosition"></a>PIDClosed-Loop Position Control</h1> <p>Position closed-loop control is similar to speed control, with the exception that feed-forward is not used (only PID). This is because while voltage level is a good predictor of speed, it is a terrible predictor of position. Feed-forward can still be useful for position control, but it requires careful coordination of the setpoint of both speed and position (see <a href="#PIDFMotionProfile">Motion Profile</a> below).</p> <p>In the example below, notice that the value of <span>F_gain </span>is <span>0.0</span>, so there isn't any feed-forward contribution to the control. Notice also that the feedback signal is <span>load_pos_NU </span>(position of the load in native units), verifying that our control loop is a postion control system.</p> <p>Notice that the speed of the load, <span>load_speed_nu</span>, ramps up to ~400 counts per 100 ms and then back down to <span>0.0</span>, as the position setpoint is reached. Compare this to the position setpoint, <span>set_pos_nu</span>, and you can see why feed-forward is not well-suited for direct use in position control. In the next section, though, we will see that if we provide <strong>two coordinated setpoints</strong>, one for position and one for speed, that we can achieve better control for a <a href="#PIDFMotionProfile">motion profile</a>.</p> <p> <iframe allowfullscreen="true" frameborder="0" height="720" scrolling="no" src="https://www.systemvision.com/node/135591" title="FRC Motor position control with TalonSRX - SystemVision Cloud" width="100%"></iframe> </p> <h1><a id="PIDFMotionProfile" name="PIDFMotionProfile"></a>PIDFFeed-Forward + Closed-Loop Motion Profile Control (plus Motion magic)</h1> <p>Often it is desirable to control the position of a load according to a desired profile. This can include scenarios such as pointing a camera in a certain direction or moving a robot to a predetermined position on a field. The Talon SRX has built-in support for this function. See<a href="https://www.ctr-electronics.com/downloads/pdf/Talon%20SRX%20Motion%20Profile%20Reference%20Manual.pdf">Motion Profile</a><span>for detailed documentation on the API and how itworks.</span></p> <p>To make motion profiles easy to use, the Talon SRX provides an operating mode called Motion Magic (see<a href="http://www.ctr-electronics.com/downloads/pdf/Talon%20SRX%20Software%20Reference%20Manual.pdf#page=71">Motion Magic</a><span>for documentation and examples). Motion Magic leverages the motion profile functionality by providing a higher level API that generates, behind the scenes, the detailed motion profile needed to accomplish a motion control task.</span></p> <p>Notice that a motion profile requires a setpoint profile for both the position and velocity (see the signals <span>set_pos_revs </span>and <span>set_speed_rpm</span>, respectively, below). If it is possible to anticipate the motor speed setting required to achieve a certain position, then the control algorithm can efficiently take advantage of feed-forward control. This takes away some of the burden of feedback control. You can think of it as using feed-forward for gross tuning and feedback for fine tuning. This approach is efficient, responsive, and stable.</p> <p>It only takes a bit of physics knowledge, however, to understand that the speed and position of an object are <strong>NOT INDEPENDENT!</strong>Therefore, these two profiles -- speed and position -- must be carefully coordinated. </p> <p>The developers of the Talon SRX have provided an<a href="https://github.com/CrossTheRoadElec/FRC-Examples/raw/master/Motion%20Profile%20Generator.xlsx">Excel spreadsheet</a>to help make this process easier. The spreadsheet allows specification of some parameters of the desired motion profile and then produces a complete, coordinated profile that can be plugged into the motion profile functionality of the Talon SRX. </p> <p>Motion Magic works slightly differently. The equivalent of the spreadsheet is built into the firmware of the Talon SRX. You only need to specify the maximum velocity, maximum acceleration, and position setpoint. The Talon SRX, when using the motion magic mode, will then internally generate both the position and speed profiles. <strong>The motion magic function also gracefully handles changing of these parameters on-the-fly!</strong></p> <p>The value of F-gain should be the same as in the <a href="#FFSpeed">feed-forward </a>speed control example, as the input is a speed profile. </p> <p><span>The values of P-gain, I-gain, D-gain, however, will <strong>not necessarily be the same </strong>as in the <a href="#PIDPosition">closed-loop position control </a>example, even though the setpoint is a position profile. This is because the feed-forward control helps make it easier for the feedback control to do its job. You may find that you get good results by lowering (or perhaps increasing) the other PID gains. Use SystemVision Cloud simulation to experiment with different PID values and their effect on performance and stability.</span></p> <p><span>The simulation below uses the motion profile (sequence of corresponding position, speed, and duration values) from the <a href="https://github.com/CrossTheRoadElec/FRC-Examples/blob/master/JAVA_MotionProfileExample/src/org/usfirst/frc/team3539/robot/GeneratedMotionProfile.java">example available on github</a>. The speed profile is provided by the piecewise-linear source <span>speed_profile</span>, resulting in the signal named <span>set_speed_RPM</span>. The corresponding position profile is provided by thepiecewise-linear source <span>pos_profile</span>, resulting in the signal named <span>set_pos_revs</span>.</span> </p> <p><span>Notice that the signals set_speed_rpm and load_speed_rpm match well, even though the load_speed_rpm signal is not used in the feedback control. This is because the position and speed are physically related. This physics relationship is built into the generation of the profiles (in the excel spreadsheet or in motion magic), <strong>making it possible to approximate the control of position by setting the speed! </strong>This is a relatively sophisticated control strategy and part of the reason that the Talon SRX is so useful.</span></p> <p> <iframe allowfullscreen="true" frameborder="0" height="720" scrolling="no" src="https://www.systemvision.com/node/135596" title="FRC Motor motion profile control with TalonSRX - SystemVision Cloud" width="100%"></iframe> </p> <h1>Toughbox Mini Gearbox</h1> <p>The Toughbox Mini is also a popular gear box, as it is the standard gearbox on the <a href="http://www.andymark.com/AM14U3-p/am-14u3.htm">AndyMark Kit Chassis</a>. </p> <p><span>See below</span><span>for a version of the motion profile design, from above, but with a Toughbox Mini gearbox instead of a CIMple Box:</span></p> <p> <iframe allowfullscreen="true" frameborder="0" height="720" scrolling="no" src="https://www.systemvision.com/node/136331" title="FRC Motor motion profile control with TalonSRX Toughbox Mini - SystemVision Cloud" width="100%"></iframe> </p> About text formats Tags Linear RegularPSRRPower Supply Rejection Ratio Select a tag from the list or create your own.Drag to re-order taxonomy terms. License - None -
