mousealgorithm.lis

二轴陀螺仪IDG300源程序

                        .module mousealgorithm.c
                        .area data(ram, con, rel)
 0000           _mode::
 0000                   .blkb 1
                        .area idata
 0000 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e mode _mode c
 0000           _lastMode::
 0000                   .blkb 1
                        .area idata
 0001 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e lastMode _lastMode c
 0000           _gyroYRaw::
 0000                   .blkb 2
                        .area idata
 0002 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYRaw _gyroYRaw s
 0000           _gyroZRaw::
 0000                   .blkb 2
                        .area idata
 0004 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZRaw _gyroZRaw s
 0000           _tempRaw::
 0000                   .blkb 2
                        .area idata
 0006 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e tempRaw _tempRaw s
 0000           _gyroYRaw1::
 0000                   .blkb 2
                        .area idata
 0008 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYRaw1 _gyroYRaw1 s
 0000           _gyroZRaw1::
 0000                   .blkb 2
                        .area idata
 000A 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZRaw1 _gyroZRaw1 s
 0000           _gyroYRaw2::
 0000                   .blkb 2
                        .area idata
 000C 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYRaw2 _gyroYRaw2 s
 0000           _gyroZRaw2::
 0000                   .blkb 2
                        .area idata
 000E 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZRaw2 _gyroZRaw2 s
 0000           _gyroYRaw3::
 0000                   .blkb 2
                        .area idata
 0010 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYRaw3 _gyroYRaw3 s
 0000           _gyroZRaw3::
 0000                   .blkb 2
                        .area idata
 0012 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZRaw3 _gyroZRaw3 s
 0000           _gyroTempY::
 0000                   .blkb 4
                        .area idata
 0014 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroTempY _gyroTempY L
 0000           _gyroTempZ::
 0000                   .blkb 4
                        .area idata
 0018 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroTempZ _gyroTempZ L
 0000           _gyroZBiasAv::
 0000                   .blkb 4
                        .area idata
 001C 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZBiasAv _gyroZBiasAv L
 0000           _gyroYBiasAv::
 0000                   .blkb 4
                        .area idata
 0020 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYBiasAv _gyroYBiasAv L
 0000           _tempBiasAv::
 0000                   .blkb 4
                        .area idata
 0024 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e tempBiasAv _tempBiasAv L
 0000           _gyroZMin::
 0000                   .blkb 2
                        .area idata
 0028 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZMin _gyroZMin s
 0000           _gyroZMax::
 0000                   .blkb 2
                        .area idata
 002A 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZMax _gyroZMax s
 0000           _gyroYMin::
 0000                   .blkb 2
                        .area idata
 002C 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYMin _gyroYMin s
 0000           _gyroYMax::
 0000                   .blkb 2
                        .area idata
 002E 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYMax _gyroYMax s
 0000           _gyroYBias::
 0000                   .blkb 4
                        .area idata
 0030 00000800          .word 0,2048
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYBias _gyroYBias L
 0000           _gyroZBias::
 0000                   .blkb 4
                        .area idata
 0034 00000800          .word 0,2048
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZBias _gyroZBias L
 0000           _tempBias::
 0000                   .blkb 4
                        .area idata
 0038 00000800          .word 0,2048
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e tempBias _tempBias L
 0000           _biasCounter::
 0000                   .blkb 2
                        .area idata
 003C 0000              .word 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e biasCounter _biasCounter s
 0000           _motionDetected::
 0000                   .blkb 1
                        .area idata
 003E 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e motionDetected _motionDetected c
 0000           _lastSignY::
 0000                   .blkb 1
                        .area idata
 003F 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e lastSignY _lastSignY c
 0000           _lastSignZ::
 0000                   .blkb 1
                        .area idata
 0040 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e lastSignZ _lastSignZ c
 0000           _signYCount::
 0000                   .blkb 1
                        .area idata
 0041 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e signYCount _signYCount c
 0000           _signZCount::
 0000                   .blkb 1
                        .area idata
 0042 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e signZCount _signZCount c
 0000           _signY::
 0000                   .blkb 1
                        .area idata
 0043 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e signY _signY c
 0000           _signZ::
 0000                   .blkb 1
                        .area idata
 0044 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e signZ _signZ c
 0000           _gyroY::
 0000                   .blkb 4
                        .area idata
 0045 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroY _gyroY L
 0000           _gyroZ::
 0000                   .blkb 4
                        .area idata
 0049 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZ _gyroZ L
 0000           _temp::
 0000                   .blkb 4
                        .area idata
 004D 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e temp _temp L
 0000           _gyroYInt::
 0000                   .blkb 4
                        .area idata
 0051 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroYInt _gyroYInt L
 0000           _gyroZInt::
 0000                   .blkb 4
                        .area idata
 0055 00000000          .word 0,0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e gyroZInt _gyroZInt L
 0000           _lastButton::
 0000                   .blkb 1
                        .area idata
 0059 30                .byte 48
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e lastButton _lastButton c
 0000           _buttonCounter::
 0000                   .blkb 1
                        .area idata
 005A 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e buttonCounter _buttonCounter c
 0000           _calibrated::
 0000                   .blkb 1
                        .area idata
 005B 00                .byte 0
                        .area data(ram, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbsym e calibrated _calibrated c
                        .area text(rom, con, rel)
 0000                   .dbfile ./mousealgorithm.c
 0000                   .dbfunc e updateMouse _updateMouse fV
 0000           ;         button -> X-15
 0000           ;    pixelZShift -> X-13
 0000           ;    pixelYShift -> X-11
 0000           ;      gyroZData -> X-9
 0000           ;      gyroYData -> X-7
 0000           ;       tempData -> X-5
 0000           _updateMouse::
 0000                   .dbline -1
 0000 10                push X
 0001 4F                mov X,SP
 0002                   .dbline 87
 0002           ; /**************************************************************************************
 0002           ; ;* Copyright 2007 InvenSense, Inc. All rights reserved.
 0002           ; ;* GyroMouse v. 1.1
 0002           ; ;**************************************************************************************/
 0002           ; // MouseAlgorithm.cpp : Mouse update function
 0002           ; //
 0002           ; 
 0002           ; #include "driftcompensation.h"
 0002           ; 
 0002           ; //Thresholds
 0002           ; #define DEAD_ZONE 1536
 0002           ; #define NO_MOTION 3
 0002           ; #define ENTER_STOP_MODE 50
 0002           ; #define EXIT_STOP_MODE 10
 0002           ; #define SPEED_0 28000
 0002           ; #define SPEED_1 24000
 0002           ; #define SPEED_2 20000
 0002           ; #define SPEED_3 16000
 0002           ; #define SPEED_4 12000
 0002           ; #define SPEED_5 8000
 0002           ; 
 0002           ; //Variables
 0002           ; 
 0002           ; //Pointer speed mode variables
 0002           ; unsigned char mode=0;
 0002           ; unsigned char lastMode=0;
 0002           ; 
 0002           ; //Raw gyro data
 0002           ; unsigned short gyroYRaw=0;
 0002           ; unsigned short gyroZRaw=0;
 0002           ; unsigned short tempRaw =0;
 0002           ;