Chief Delphi

Chief Delphi (http://www.chiefdelphi.com/forums/index.php)
-   Programming (http://www.chiefdelphi.com/forums/forumdisplay.php?f=51)
-   -   Encoder Code (http://www.chiefdelphi.com/forums/showthread.php?t=41815)

Kevin Watson 14-01-2006 01:08

Encoder Code
 
For those encoder fans out there, I've uploaded new-and-improved encoder interface software for your robot controller. The major change is that I've added four additional channels optimized for position control. The code can be found here: http://kevin.org/frc. As always, if you find a bug in the code or a problem with the documentation, please let me know.

Here's the readme file:

Code:

This source code in this file implements an interface up to
six quadrature output encoders. Used with suitable PID control
software, encoders can be used to control the position and
velocity of of your robot. In general, for velocity control
with low count rates (~100/s), the encoder channels are
interchangeable and it's anticipated that teams won't need
all six inputs and will cut and paste the code as needed. For
high count rates or position control, the channels are
optimized for specific applications and are not interchangable.
 
Encoder channels one and two are optimized for velocity control
and will generate the least number of interrupts per encoder
count (one per encoder count). These channels may have problems
in position control applications because they can be fooled
into thinking that the encoder shaft is rotating if the shaft
happens to stop very near a phase-A transition and then wobbles
back and forth across that transition.
 
Encoder channels three and four are optimized for position
control. For these channels, software examines both transitions
of phase-A and can't be fooled into miscounting the number
of encoder counts. The downside to using these channels is that
for a given encoder, they will generate twice the number of
interrupts as channels one and two (two per encoder count).
 
Encoder channels five and six are just like channels three and
four, but offer the bonus of increasing the precision of your
encoder by a factor of two for free. Unlike channels one
through four, which will increment or decrement on each rising
(zero to one) transition, these two channels will increment or
decrement on both transitions of phase-A. In other words, if
you attach a 64 count-per-revolution encoder to one of these
two channels, you'll read 128 counts when you rotate the shaft
exactly one revolution.
 
This software was tested with Grayhill 63R256 and 61K128
quadrature output optical encoders. Data sheets for these
devices are included.
 
This source code will work with the PIC18F8520-based FIRST
Robotics robot controller, the PIC18F8722-based FIRST Robotics
robot controller, and the Robovation/EDU robot controller.
 
                                ** IMPORTANT **
On a 40MHz PIC18Fxxx, this software can track peak encoder
count rates as high as a few thousand counts per second, which
should be more than adequate for most applications. To meet
your performance expectations, selecting the proper Counts Per
Revolution (CPR) parameter of your encoder is very important.
If the CPR is too high, the robot controller will spend too
much time counting encoder "ticks" and not enough time on
other tasks. At the extreme, you will see very wacky behavior
in your robot controller including corrupted data, the red-
light-of-death or the controller may even think the robot is
traveling in a direction that it isn't. Selecting a CPR that
is too low will not give you the resolution you desire. The
CPR should be optimized to minimize the number of interrupts
your robot controller will have to service yet meet your
resolution expectations (yes, millimeter position resolution
to too much to ask for).
 
Another potential problem with high count rates is that
your encoder probably won't have enough drive capability
to send the phase-A and phase-B signals though your cables
without signal degradation, which can cause all kinds of
problems. If you notice that your encoder counts just fine
at low count rates, but exhibits wacky behavior at higher
count rates, you'll probably need to build a line driver
circuit to provide more current drive. An integrated circuit
that can provide this added drive is the 74ACT244 octal
line driver. Mount the circuit close to the encoder.
 
The included project files were built with MPLAB version 7.20.
If your version of MPLAB complains about the project version,
the best thing to do is just create a new project with MPLAB's
project wizard. Include every file except: FRC_alltimers.lib
and ifi_alltimers.lib and you should be able to build the code.
This file is best viewed with tabs set to four characters.
 
****************************************************************
Here's a description of the functions in encoder.c:
 
Initialize_Encoders()
This function initializes the encoder software. It should be
called from user_routines.c/User_Initialization().
 
Get_Encoder_n_Count()
These functions will return the current number of encoder
counts or "ticks" for encoder number n, where n is a number
between one and six.
 
Reset_Encoder_n_Count()
This function can be used to reset individual encoder counts
to zero.
 
Encoder_n_Int_Handler()
This function is automatically called by the microcontroller
when the phase-A signal of an encoder transitions from zero to
one, and in the case of encoders three through six, one to a
zero. You shouldn't have to call these functions yourself.
****************************************************************
Nine things must be done before this software will work
correctly on the FRC-RC:
 
1) Each encoder's phase-A output is wired to one of the six
available interrupt inputs on digital inputs one through six.
Encoder one is wired to digital input one, encoder two is
wired to digital input two, etc.
 
2) Each encoder's phase-B output is wired to any free digital
input. By default, encoder one is wired to digital input
eleven, encoder two is wired to digital input twelve, ...,
encoder six is wired to digital input sixteen. These default
assignments can be changed by editing encoder.h
 
3) You must add the encoder.c/.h source files to your MPLAB
project.
 
4) Disable encoders not needed for your design by following
the instructions in encoder.h. By default, all six encoders
are enabled.
 
5) Digital I/O pins used in step 2 above must be declared as
an input in user_routines.c/User_Initialization(). If you
notice an encoder that only counts in one direction, you
forgot to do this step.
 
6) The encoder interrupt handlers must be installed in
User_Routines_Fast.c/InterruptHandlerLow(). See the included
copy of User_Routines_Fast.c to see how this is done.
 
7) A #include statement for the encoder.h header file must be
included at the beginning of each source file that calls the
encoder functions. The statement should look like this:
#include "encoder.h".
 
8) If you're compiling this code for the 2004/2005 FRC-RC,
you'll need to comment out the #include <p18f8722.h> line
near the top of encoder.c and then uncomment the #include
<p18f8520.h> line below it.
 
9) Initialize_Encoders() must be called from user_routines.c/
User_Initialization().
 
Nine things must be done before this software will work
correctly on the EDU-RC:
 
1) Each encoder's phase-A output is wired to one of the six
available interrupt inputs. Encoder one is wired to interrupt
one, encoder two is wired to interrupt two, etc.
 
2) Each encoder's phase-B output is wired to any free digital
input. By default, encoder one is wired to digital input
eleven, encoder two is wired to digital input twelve, ...,
encoder six is wired to digital input sixteen. These default
assignments can be changed by editing encoder.h.
 
3) You must add the encoder.c/.h source files to your MPLAB
project.
 
4) Disable encoders not needed for your design by following
the instructions in encoder.h. By default, all six encoders
are enabled.
 
5) Digital I/O pins used in step 2 above must be declared as
an input in user_routines.c/User_Initialization(). If you
notice an encoder that only counts in one direction, you
forgot to do this step.
 
6) The encoder interrupt handlers must be installed in
User_Routines_Fast.c/InterruptHandlerLow(). See the included
copy of User_Routines_Fast.c to see how this is done.
 
7) A #include statement for the encoder.h header file must be
included at the beginning of each source file that calls the
encoder functions. The statement should look like this:
#include "encoder.h".
 
8) You'll need to comment out the #include <p18f8722.h> line
near the top of encoder.c and then uncomment the #include
<p18f8520.h> line below it.
 
9) Initialize_Encoders() must be called from user_routines.c/
User_Initialization().


phrontist 14-01-2006 01:46

Re: Encoder Code
 
Ha! I was just about to implement this today, because I saw you hadn't put the code up yet. Good thing I procrastinated... :D

lkdjm 14-01-2006 02:04

Re: Encoder Code
 
I can't believe I am going to be one of the first to get this, I just happened to be downloading everything I will need, and then I found this! cool! Thank kevin!

phrontist 14-01-2006 15:18

Re: Encoder Code
 
I'm getting the following errors when compiling under a brand new MPLAB install. The default code compiles cleanly under it...

Code:

C:\RobotCode\frc_encoder\encoder.c:131:Error [1205] unknown member 'INT3IP' in '__tag_223'
C:\RobotCode\frc_encoder\encoder.c:131:Error [1131] type mismatch in assignment


Kevin Watson 14-01-2006 15:44

Re: Encoder Code
 
Quote:

Originally Posted by phrontist
I'm getting the following errors when compiling under a brand new MPLAB install. The default code compiles cleanly under it...

Code:

C:\RobotCode\frc_encoder\encoder.c:131:Error [1205] unknown member 'INT3IP' in '__tag_223'
C:\RobotCode\frc_encoder\encoder.c:131:Error [1131] type mismatch in assignment


I don't get this message when I build the code. Have you made any modifications to the code? Is p18f8722.h or p18f8520.h (not both) included at the top of encoder.h.

-Kevin

binary_sandman 14-01-2006 21:23

Re: Encoder Code
 
here is an though of google the error thats what i did which i found an online doc for mp lad latest verison of which i am using.
team 1388
2004 curie divison winners

radicalnerd 18-01-2006 16:16

Re: Encoder Code
 
the p18f8722.h file i have (mcc 2.40) says:

Code:

extern volatile near unsigned char      INTCON2;
extern volatile near union {
  struct {
    unsigned RBIP:1;
    unsigned INT3P:1;
    unsigned T0IP:1;
    unsigned INTEDG3:1;
    unsigned INTEDG2:1;
    unsigned INTEDG1:1;
    unsigned INTEDG0:1;
    unsigned NOT_RBPU:1;
  };
  struct {
    unsigned :2;
    unsigned TMR0IP:1;
    unsigned :4;
    unsigned RBPU:1;
  };
} INTCON2bits;

i'm a noob, but
shouldn't the second struct be
unsigned :1;
unsigned INT3IP:1;
and does INT3P = INT3IP ?

phrontist 18-01-2006 16:24

Re: Encoder Code
 
I "fixed" (eliminated compiler error) the problem by hacking up that structure declaration.

radicalnerd 18-01-2006 17:22

Re: Encoder Code
 
offtopic but i was trying to gear sensors working
i think that fixed it...it counts. i dont know about accuracy.

Code:

  struct {
    unsigned :1;
    unsigned INT3IP:1;
    unsigned TMR0IP:1;
    unsigned :4;
    unsigned RBPU:1;
  };


Kevin Watson 19-01-2006 15:38

Re: Encoder Code
 
Are you guys using the p18f8722.h header file included with the KOP compiler?

-Kevin

PICgnosis 19-01-2006 20:14

Re: Encoder Code
 
Hi.

I had the same problem and also traced it back to the mismatch between the mcc18/h/p18f8722.h and encoder.c aliases for the INT3 external interrupt priority bit.

In encoder.c, bit #1 is aliased as INT3IP but in mcc18/h/p18f8722.h it's called INT3P. If you want the <p18f8722.h> header file to be consistent with the PIC18F8722 datasheet, you should change the alias in p18f8722.h (Ln 1712) to INT3IP. If you're not a stickler for details, as long as you change one of them to match the other, it will compile correctly.


:)
Karen

Kevin Watson 26-01-2006 00:52

Re: Encoder Code
 
Quote:

Originally Posted by PICgnosis
Hi.

I had the same problem and also traced it back to the mismatch between the mcc18/h/p18f8722.h and encoder.c aliases for the INT3 external interrupt priority bit.

In encoder.c, bit #1 is aliased as INT3IP but in mcc18/h/p18f8722.h it's called INT3P. If you want the <p18f8722.h> header file to be consistent with the PIC18F8722 datasheet, you should change the alias in p18f8722.h (Ln 1712) to INT3IP. If you're not a stickler for details, as long as you change one of them to match the other, it will compile correctly.


:)
Karen

Just FYI, I updated the encoder software with a fixed p18f8722.h header file and workaround instructions.

-Kevin

Joe Ross 26-01-2006 00:59

Re: Encoder Code
 
Both today's code and the earlier code have a mismatch in function names and prototypes.

the encoder.c has the functions Reset_Encoder_X_Count while encoder.h has the prototypes Set_Encoder_X_Count.

farmer 30-01-2006 15:22

Re: Encoder Code
 
Kevin,
Does your encoder code work with the GTS provided this year (seeing you don't have specific GTS code posted yet). Reading thru your encoder code it sounds like you have programmed several of the things we wanted to do this year. Thanks for your help as always.

Astronouth7303 30-01-2006 19:55

Re: Encoder Code
 
Quote:

Originally Posted by farmer
Kevin,
Does your encoder code work with the GTS provided this year (seeing you don't have specific GTS code posted yet). Reading thru your encoder code it sounds like you have programmed several of the things we wanted to do this year. Thanks for your help as always.

That's what I used as a base for my GTS code. Striped off the quadrature stuff, and I'm cool. (Off course, I had problems using that number, but that's another discussion.)


All times are GMT -5. The time now is 18:12.

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