![]() |
paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Thread created automatically to discuss a document in CD-Media.
FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18) by apalrd |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
As promised, a complete release of Buzz18 software.
I am quite busy with school at this time, but I should finish the promised papers within the next week. For now, the software zip is posted in CD Media. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Not having LabVIEW, I can't look at the code. However, a while ago, you mentioned that you used something other than your normal "Cheesy Drive" software for drivetrain control. What did you do?
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Added file buzz_lib_sw_2013.zip (BuzzLib 2013)
New functionality from last year: -Simple Vref Diagnostics - Used with shorting jumper on adc7 (between 5v and analog pin), used to diagnose simple faults of 5v rail and provide ratiometric multiplier for ratiometric sensors. -Sharp IR - Scaling blocks for all three Sharp IR sensors sold by Sparkfun. Analog to cm values copied directly from datasheet and interpolated using multipoint linear interpolator (see below) -2d interpolation - Interpolates a 2d curve from a prelookup and 1d array of Z points. Also variants to round down and round up to nearest Z point. -3d interpolation - Interpolates a 3d map from two prelookups and a 2d array of Z points. -Prelookup - Finds the index and fractional index from a x input and 1d array of X breakpoints. All breakpoints must be spaced least->greatest, there is no checking of this. Used for 2d and 3d interpolation, as it is the most computationally intense step a single prelookup can be shared by multiple interpolations who share the same axis breakpoints. -Accel calculator - Calculates the acceleration of a velocity assuming 10ms iteration time. Really just finds current derivative, but used for acceleration of shooter wheel speed. -Hysteresis - Threshold with hysteresis. The 2d and 3d interpolation tables are the most interesting. For an example of their use, see the Sharp IR blocks in BuzzLib, as they do 2d interpolation in the most basic form. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
The basic idea is to use the angle of the steering stick instead of the X axis of the steering stick as the primary steering input, when combined with a joystick with circular boundaries (such as the Logitech F310) this allows you to 'steer' the joystick around the boundary of the stick with finer steering resolution. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Added new files:
buzz18_pal_lib.pdf pal_lib_default.zip (LV example code, pal_lib code, and paper pdf) A little bit about pal_lib: -'pal_lib' WPIlib replacement for LabVIEW -Replaces ENTIRE WPIlib LabVIEW with 30 VIs, contained in zip folder and inserted as a subfolder into your project. -Heavily optimized architecture promotes execution efficienty, runtime performance determinism, and good embedded programming practices. Increases in execution efficiency are primarily done by reducing code size and removing unnecessary code, which significantly decreases compile and download times as an added benefit. -FAST execution (all code currently executes at 10ms, for small or heavily optimized programs 5ms is possible). We could have run Buzz18 at 7ms iteration time, but ran at 10ms with ~55% CPU usage to leave overhead for LV probes and debugging. -Supports basic commonly-used inputs, outputs, and control data. Large efficiency and code space gains are made by removing functionality that is not commonly used. -Season-tested on Buzz18 (including five competitions and Einstein) at 10ms iteration time without any bugs EVER attributed to the library after initial library validation -Extremely low CPU usage (initial validation tests provided initial functionality to default tank drive program with 1/2 CPU usage % at over 2x execution speed), library CPU usage does not increase with used functionality as the library is already handling all of the data it is capable of (e.g. adding another motor or encoder does not require any expensive VI calls and CPU usage of scaling function is inlined and negligible). -zip contains example 'default' program which maps several joysticks, buttons, and limit switches to motors, solenoids, and relays, and operates the compressor. See comments in the code for exact mapping and IO pinouts. Entire example code is 4 VI's in addition to pal_lib -Fully synchronous architecture forces efficient data-passing design, as all data can be passed via connectors. Use of global-visible data structures in Buzz18 further optimizes data-passing as all data is always available to all subsystems, any subsystem can change data without consequence to anything else, and order of operations is guaranteed (simplifies triggers significantly). Data structure architecture also simplifies dashboard programming, as all of the data structures are simply sent to the dashboard using the binary string method ('old-style', not NetworkTables) and the dashboard automatically has access to all key data. -See buzz18_pal_lib.pdf for complete write-up -Also see buzz18_sw_postcmp for complete robot usage of library |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
OK, finished the 'CulverDrive' paper and attached it with example code.
What is CulverDrive? -Improvement on previous 'Cheesy' and 'Halo' style drive systems, which are already used by many top teams -Utilizes Logitech F310's round joystick boundary to provide a virtual steering wheel effect, allowing the driver to gracefully navigate the field -Utilizes a mathematical algorithm similar to the 'Cheesy Drive', the intent in design was to replicate the functionality of a 'Cheesy Drive' using a real steering wheel on a joystick. -Award-Winning (Waterford 'Innovation In controls' and Championship 'Quality' specifically noted CulverDrive in judge comments) What does the zip include? -LabVIEW source code, direct from Buzz18 software release, plus required BuzzLib interpolation blocks (prelookup and interp_2d) -C source code, used in simulation and intended for Vex targets and readable without LabVIEW. Unfortunately it does not directly run on Vex because RobotC does support the C language very well. Does it require a Logitech F310? -In short, yes. The Logitech F310 has a circular joystick boundary, which is key to the algorithm. It's also smoother to drive than a square of octagon. -The Xbox 360 joystick has an octagonal boundary, which will not provide the desired effect nearly as cleanly. The Logitech DualAction has a square boundary, which will not work very well at all. As always, feel free to ask questions regarding any of our software. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
How do you open .lvsc files? Is it a tool included with Labview for FRC?
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
LVSC file are LabVIEW Statecharts.
The module is not included in the FRC release of LabVIEW. We arranged this with NI in return for feedback on it's use. Since I didn't expect anyone to have Statchart, I generated documentation for all Statecharts using the internal documentation tool. Every statechart has a folder called <name>_files which contains a PNG image of the following: -The statechart itself (Main Diagram0.png) -The Inputs and Outputs clusters (Inputs0.png and Outputs0.png) - I didn't use the StateData but there is a cluster for that too -The outer appearance of each block (I tried to name them reasonably, that should be in these images - #.png) -The entry/exit action of the block (for states - entryaction#.png and exitaction#.png -The guard action of the block (for transitions - guard#.png) Statechart was a great tool to work with once we learned all the quirks (e.g. when you copy-paste a block, they share the same diagram and modifying one modifies the other). It definitely helped some of the more complex state-machines we had (the first and second revision gun feeder system was very complicated). It was also helpful when debugging - I could tell the mechanical and integration people working on that system exactly what it was trying to do and how it should react. I also made some VI's to graph the input/output data which was very helpful in analyzing the strange behavior (if I do this and this and this, it jams with gate A open and gate B closed but the gun isn't on...)... But even with the automation there were still corner cases that weren't handled perfectly. But the bucket (and really simple code) had virtually none of them. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
interp.c and interp.h are C implementations of the LV interpolation functions. I tested these on a desktop GCC build/test harness and they work. We use these in the Culverdrive to define smooth enabling of different terms, and use them elsewhere for nonlinear functions. They're very useful functions. I can explain their use in more detail if anyone is interested. culverdrive.h is the header, self explanetory. The logic itself is written and commented in culverdrive.c in the culver_drive() function. The const data is defined in culverdrivedata.c. There are some things that are a little weird about the C code. I intended to run it on Vex targets, but it won't compile in RobotC because RobotC does not support the C language very well. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
What would you recommend if a team wanted to implement a Finite State Machine approach to their programming? Should we try to talk with NI about the statechart plugin, or implement state machines on our own?
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
We use a lot of finite state machines for things that we sequence. We also use other control strategies for other things, including feedback controls, and lookup tables.
Our software modules are very large. They usually line up with the physical subsystem teams, although I threw the gun in with Roller because the integration between them was very critical and I wanted them to be designed together (there were 4 mechanical teams and 3 software modules). We then design up a high-level design of the software (what each module is responsible for, what sensors and actuators it has command of, and what the interactions with other modules including HMI/Auton are). From that, we design each module. The modules are split up into blocks, usually based on control of specific actuators or related groups of actuators. For example, drivetrain is split between drive motors and shift. Drive motors handles the drive motors, and shift handles the shifting. Drive motors is a passthrough function (control is unique to HMI/Auton, this is the only feature that is not implemented in it's module) and shifting is a lookup table. With servos in 2012, shifting was a finite-state machine that would peak and hold the servos for better shift quality and servo reliability (we melted servo or two before doing that). So it dosen't make sense to design everything as an FSM. We really use a lot of small FSMs when we need to sequence actions at a high level (like the gun feed state machine or 2011 arm state machine), or deal with intermediate states at a medium to low level (like the peak-and-hold state machine). All of the code runs in parallel (it all shares a single task, the software design strictly prevents blocking execution). The execution order is specified by how data is used by other modules. I am not sure what NI's intentions are with the Statechart module. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
Code:
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
The alternate vs normal raw mode is interesting. It was our method of removing the 'quick turn' switch, but we decided we liked the switch better.
In any case, the Radius component should be active from 0 to 90 degrees, plus a little for driver forgiveness. R allows us to return to 0 when the stick is centered, and the math works out such that you can drive it like a halo/cheesy drive if you want (although that's not quite ideal, the math works out the same). I am aware that above 90 slightly more turning power is possible, but I didn't really care. I also probably mistyped the radians to degrees, I actually used 180/Pi in the LV implementation and didn't precalculate it. The initial ('alternate') raw implementation was designed to provide 'quick turn' functionality (steering without throttle for turn-in-place moves) by allowing the driver to move the stick in a fairly binary way around the bottom of the stick bounds (near +-180). It did not use theta at all (except for the enablement curves). We did not like this behavior, and decided to use the 'quick turn' button to switch. It's interesting to see some SW design choices you made in your implementation. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
..........0 ....-45.....45 -90.....+.... 90 ....-45.....45 ...........0 here is that implementation using atan2; Code:
//Find arctan of wheel stick relative to vertical (i.e. swap the x and y components)Now then assuming this is true... both calls to interp_2d() are no longer needed as they will always return 1.0. Especially the Radius Enablement curve. So really the theta and r (magnitude) are the heart of the culver drive. Just using these by themselves can be a nice sweet substitute for anyone's function that takes an x-axis. I'll give this a shot in our drive and perhaps post it on you tube this weekend... the other cool thing is doing it like this... after obtaining the normalized value (i.e. theta * r )... it can be used with Ether's equations for even greater control of the distribution of the curve. Here's a little snip of that... Code:
if (AnalogEvents)Quote:
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
The intent for Radius was to replace the x-axis input in the Cheesy Drive with the theta*r input. We provisioned a lot more to place the raw/quick turn elsewhere on the stick range (the negative half) in the alternate-raw implementation, but the normal raw is just a cheesy drive with a quick turn button. In fact, the entire reason we used the interp curves was to support the alternate raw implementation. We never revisited the math when we decided we didn't like it. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Hi Palardy,
So I have started to integrate the Culver drive controls in our simulation and I have found some interesting findings: When I started testing this, I found that not all circular controllers have the same diagonal intensity as the LogicTech F310. I tested the AirFlo which is also circular, but in testing, it reached full x and y intensity at the corners. I am not sure if there is a spec yet for identifying this, but it should probably be in a form that shows the full x and y intensity ratio (when diagonal), because the F310 I have tested if you normalize x and y readings and move the joystick to its full diagonal where they are equal...it is more than (sin(45) / 70.7...) it's around 80. I believe though that controllers like the AirFlo can still benefit from the Culver drive, because the faster speeds really shouldn't matter as much. So using just the theta and magnitude and testing this with full y component magnitude. I put a UI feedback that shows what the value would have been if I just used the x component right beside the new value of (theta * r). It turns out they were equal (at first)! This means anyone can simply use halo drive code and control the wheel in the same manner to get the same effect. Now then in regards to the 80% normalized value I mentioned above... as you rotate the wheel closer to 90... the magnitude will actually exceed 1.0... to around 1.14... so as it gets closer and the magnitude increases you lose precision you would have had otherwise, but at these faster speeds it doesn't really matter. So I have some good news though... I'd recommend you try the same tests if you can and see if you are getting the same results. If I scale the magnitude to around 0.875... this works out perfect where it starts with a magnitude of this (0.875) moving joystick to full Y with x centered... and then by the time it reaches the corner it will be around 1.01. With this you can finally achieve a greater precision for the slower speeds. The derivative of the distribution looks like a "soft" x^2 when compared testing against the x components raw value otherwise. One other interesting note is that I tested the halo drive scenario (i.e. no Y component)... this turned out to lose more precision than otherwise, but not by much. That said, this solution cannot substitute the need to filter out the dead zone of the joystick, and it should be virtually the same amount as otherwise. This loss of precision could be a benefit for an alternate quick-turn solution. For our setup the workflow may be to use halo drive for most quick turns, and then the Culver wheel drive to fine tune the turns. On Monday I'll try to show a demo of this and these number findings on YouTube. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Here is a quick demo... I have changed how the magnitude is computed in this demo. It blends from 0.87 when theta is 0 to (1/(pi/2)) when theta is 90. Let me know what you think. :)
http://youtu.be/NKd6inx9OH8 |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
I really like this demo, it does a good job of explaining the jist of how "Culver drive" works. I'll leave the magnitude computation change assessing to Andrew.
If you look up at my name you'll see that the second one is "Culver." I just wanted to explain why this is named after me (I'm not egocentric, I promise.) Last summer I picked up a controller to drive the 2012 robot and was very disappointed by my inability to do arcing turns using Cheesy drive. Walking out of Chrysler that evening I explained to Andrew what I would rather have -- point the stick forward and move it around the way you would if you were driving a car with one hand on 12o'clock, keeping the throttle the same. Andrew coded it from there and after we tested it on a robot and liked it we were trying to think of a catchy name for it (WASPdrive was already in development and named at this point.) We couldn't think of anything and Andrew already had it named after me in the code at this point so, much to my displeasure, left it "Culver drive." In any case, our driver really liked it this year and we'll probably be using it again next year. Cheers, Bryan |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
The demo is interesting.
The question of how to deal with the quick turns comes up a lot, not just for Culverdrive but also for Cheesy vs Halo drives (I've usually defined them as the same algorithm, but the switch from including Throttle to not including throttle is done via a button in Cheesy and when throttle = 0 in Halo). One design logic is that the quick turn button is an additional button that can be optimized out, the other is that with the button it's possible to slow down to 0 speed while in an arc turn without suddenly spinning. We initially used the design logic that the enablement curves would sum to 1 so as soon as the driver exceeded 95 degrees it would pull throttle out of the equation but the rest of the result would remain the same, to allow turning in place without the throttle. That is the 'alternate raw' implementation, which is actually the original. The current raw implementation is more similar to the original cheesy drive, and we just switch based on quick turn switch. There's still more optimization we can do. I like the interp curve function because I can plugin a set of points and map the curve as I want, however nonlinear or strange it is, without finding a mathematical way to represent it, and it's not that inefficient for relatively small tables. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
That's pretty cool. I like the idea of automatically switching to quick turn after the driver pushes the stick far enough to the side. This is similar to a team who used an actual steering wheel to control their robot one year!
How do your drivers feel about this setup? In the past we've tried some similar things (cheesydrive/right stick steering wheel), but our drivers preferred a tank drive setup, claiming that the cheesy drive was better for driving around an empty field, but when in pushing matches and having to line up, tank drive was better. Also, do you know if anybody has come up with a way to use these style algorithms on swerve/meccanum, or with the sort of drive that 148 used in 2010 (I forget what it's called). |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
-Drivers did not complain. I personally loved it, and I drove a Halo style drive in 2012. High speed driving performance is WAY better than with a tank setup, and alighment is easier by optimizing it when the quick turn button is pressed.
--Driving with a steering wheel is not uncommon, we tried to emulate it with this, as we believe it is a superior HMI to a two-stick tank drive. -Purely subjective driver analysis has shown that it's MUCH easier/faster to master the graceful high speed arc maneuvers we want with a culver or cheesy drive than the two-stick tank. We actually have a lot of code in our 2011 robot (two stick tank) to modify the inner wheels to arc nicely when the driver lets go of one stick to turn, but that code was quite a bit of work to develop fully and not a good solution, since it really makes driving three-state (both sticks same direction, one stick full one stick zero, both sticks opposite direction) and the driver bumps it on and off a lot for jerky turns. -Judges loved it, noted 'Culver Drive' in championship award speech -We used a Halo drive with a slide drive in Vex (what 148 in 2010 had, except without the droppable traction wheels and bump crossing ability), we just used the left stick for translation and right stick for rotation. Since the left/right wheels control steering, we simply ran a normal Halo drive and mapped the slide wheel to left X (left Y was throttle for left/right wheels, right X was wheel). This ran three Vex robots and all drivers loved it for that drivetrain, one was able to pick up some 'fancy' moves like circling around a point in front of him or spinning around off a defender extremely quickly. For a mecanum, I would find theta/R of both sticks, and use left theta for translation angle, left R for throttle, and right stick would determine the rotation as it does now. Then you would just have to solve the mecanum math and warp everything back into the +-1 range nicely. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
![]() I have made a graphical representation of 3 different setups that try to illustrated the distribution. The one on the right is halo drive with just x and no y, and the top left is the culver theta * r where r is just magnitude with no scale. The bottom left is the blend of 0.875 to (1/(pi/2)=.64ish). The green tries to highlight the smaller numbers and how they are spread out. The spread of numbers between the 1.0 magnitude and the halo are virtually identical for the precision workflow (i.e. when using the max y stick up)... This means the actual benefit of precision (using 1.0) is a mechanical solution and could be accomplished using the halo drive. It does however have brighter red and blue intensity on the sides this is because when you get there your range will exceed past 1.0 to 1.57 (half a pi). The bottom one will keep the range 0-1 intact for halo while spreading out the centered area for Culver. This makes it both mechanical and functional benefit of precision. This suggestion makes the Y component a bit more interesting in that when Y is centered... it is identical distribution as the halo graph (therefore a perfect fit for anyone's driving system), and then when Y is used for Culver steering... the x distribution is greater for precise turning and then curves down quick to meet up with 1.0 at the end. I hope this makes sense... I can see a work flow solution to use halo drive for quick turns and culver drive for precise turns without need of a button. Quick turns in this context are in terms of what the x axis submits to another function... this means it is possible to use this for some other kind of control (e.g. arm) when it is broken down to just this functionality. I'll save the actual drive implementation for a separate post. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
Thanks for the feedback on the demo... (Thanks Palardy and Magnets too). Sometimes I feel like no one appreciates the effort and thought that goes into this... so it means a lot. :) |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
I should add that I have incorporated the culver drive into some simulated swerve and nona drive code and they work great because this is solving the x-axis method, and passes the value as if it was the x-axis. Quote:
|
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
-We do like velocity controls as well, but we haven't implemented them since 2011. I think that would be a logical improvement to this system. -That said, a simple PI controller to speed does not have a fast enough response time for drivetrain usage. We did this in 2011 and turned the gains WAY up for fast response, and oscillations weren't very good, but it worked. -A better solution is one of the better speed control algorithms designed for shooter flywheel speed control (2012 was especially big on this, 2013 less). We ran a PI-FF algorithm with a feed forward equation (now we would just use a table), which is an improvement |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
Mechanical engineers like to solve the controlling aspects of the drive and leave little for software to do... they are happy with just raw voltage input from the controls... and from this whatever non-intuitive issue arise it is left for the driver to get use to them and overcome them. This goes against the mentality of a software engineer which figures out intuitive solutions for all users to be able to pick up and use. If we cannot make it intuitive people will not buy our stuff. Quote:
![]() |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Those graphs definitely show improvement over the years.
I've always liked to feed forward as much as possible for best transient performance. The P-I-FF design feeds forward the steady state output (FF), corrects for steady state errors with I, and handles transients with P (what the D term in a 'normal' position PID would do). FF can be implemented as a math model, curve fit, or lookup/interpolation table. I agree that mechanical engineers tend to solve problems mechanically, as a controls engineer I disagree with this approach. |
Re: paper: FRC #33 The Killer Bees 2013 Software - BuzzXVIII (Buzz18)
Quote:
As far as the open field maneuvers- I love it. It allows me to change directions quickly, which often lets me ditch defenders without shifting into low and slowing down. The arcing turns and quickturns were extremely useful when navigating around the pyramid, and I could use either depending on the attack angle. In regard for lining up, I tend to use quickturn (I use it more often than Palardy and Culver designed it for, but it works) paired with a hard stop on the arm to zero against. At the beginning of the season before we installed the hard stops it was pretty squirrely to line up, but that has improved since I've gotten more comfortable with it. With pushing matches, I usually just shift into low and use quickturn to spin out of them. Overall, it's a pretty flexible drive system. As a newer driver, I loved that it made me less choppy and inconsistent. I'm definitely planning on using it again next year. |
| All times are GMT -5. The time now is 02:54. |
Powered by vBulletin® Version 3.6.4
Copyright ©2000 - 2017, Jelsoft Enterprises Ltd.
Copyright © Chief Delphi