Go to Post It's not fair. it's not right, but stuff like this happens. If you don't get picked for finals tomorrow, get in those stands and cheer for those who did. Remember, this is FIRST. - wilsonmw04 [more]
Home
Go Back   Chief Delphi > Technical > Programming
CD-Media   CD-Spy  
portal register members calendar search Today's Posts Mark Forums Read FAQ rules

 
Closed Thread
Thread Tools Rate Thread Display Modes
  #1   Spotlight this post!  
Unread 22-02-2007, 01:59
Tatsu Tatsu is offline
Audiophile and Physicist.
AKA: Tatsu Hashimoto
FRC #1072 (Harker Robotics Team)
Team Role: Leadership
 
Join Date: Jan 2006
Rookie Year: 2004
Location: Woodside
Posts: 49
Tatsu will become famous soon enough
Send a message via AIM to Tatsu
Kalman Filter for Heading information.

Code is here. http://www.thdzero.com/Kalman/ 56k users beware.

I was sick and tired of our drifting gyro, and our motor-affected magneto, so I wrote a kalman filter to be run on an Atmel AVR ATMega64, this will come later. This takes gyroscope input as main, with compass as a reference value to keep both in check. If your gyro is noisy, or your compass drifts, you're out of luck, otherwise, this filter should help alot.

This filter resists godawful amounts of noise and gyroscope drift, hopefully it'll give us smooth nav. If anyone else wants to convert it to whatever flavor of C for their embedded processor and use it, feel free.

N.B. I didnt have the RC in mind when I wrote this, it may be difficult to have a well-working kalman filter without high sample rate and high processing power.

I'm still working on having the filter ignore momentary spikes (see last 2 graphs) which would be caused by sudden motor reversal. If anyone has ideas, I'd love to hear them. Low pass filtering the compass input helped but its not enough to smooth over the entire section. Im thinking of maybe jacking up the Sz value if and only if the compass and gyro disagree.
  #2   Spotlight this post!  
Unread 22-02-2007, 02:20
Tom Bottiglieri Tom Bottiglieri is offline
Registered User
FRC #0254 (The Cheesy Poofs)
Team Role: Engineer
 
Join Date: Jan 2004
Rookie Year: 2003
Location: San Francisco, CA
Posts: 3,185
Tom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond reputeTom Bottiglieri has a reputation beyond repute
Re: Kalman Filter for Heading information.

Awesome. Seeing high school kids take it to the next level , such as higher level control theory, is what keeps me doing this stuff. Bravo.
Closed Thread


Thread Tools
Display Modes Rate This Thread
Rate This Thread:

Posting Rules
You may not post new threads
You may not post replies
You may not post attachments
You may not edit your posts

vB code is On
Smilies are On
[IMG] code is On
HTML code is Off
Forum Jump

Similar Threads
Thread Thread Starter Forum Replies Last Post
Light Filter thefro526 FIRST Tech Challenge 2 19-09-2006 22:40
FRC analog input RC filter values Gdeaver Control System 2 01-01-2006 22:03
Gyro Filter MikeDubreuil Electrical 7 04-02-2003 17:26
Now with a competition filter!!! archiver 2001 0 24-06-2002 02:10
Heading west? Andy Baker Rumor Mill 2 26-10-2001 02:50


All times are GMT -5. The time now is 11:01.

The Chief Delphi Forums are sponsored by Innovation First International, Inc.


Powered by vBulletin® Version 3.6.4
Copyright ©2000 - 2017, Jelsoft Enterprises Ltd.
Copyright © Chief Delphi