Improve pmw3360 sensor and make it more hardware agnostic (#14097)

This commit is contained in:
Drashna Jaelre 2021-08-20 21:14:23 -07:00 committed by GitHub
parent 3452c89c8b
commit da1c011afc
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
6 changed files with 99 additions and 74 deletions

View File

@ -16,37 +16,69 @@
* along with this program. If not, see <http://www.gnu.org/licenses/>. * along with this program. If not, see <http://www.gnu.org/licenses/>.
*/ */
#include "pmw3360.h"
#include "wait.h" #include "wait.h"
#include "debug.h" #include "debug.h"
#include "print.h" #include "print.h"
#include "pmw3360.h"
#include "pmw3360_firmware.h" #include "pmw3360_firmware.h"
bool _inBurst = false; // Registers
#define REG_Product_ID 0x00
#define REG_Revision_ID 0x01
#define REG_Motion 0x02
#define REG_Delta_X_L 0x03
#define REG_Delta_X_H 0x04
#define REG_Delta_Y_L 0x05
#define REG_Delta_Y_H 0x06
#define REG_SQUAL 0x07
#define REG_Raw_Data_Sum 0x08
#define REG_Maximum_Raw_data 0x09
#define REG_Minimum_Raw_data 0x0A
#define REG_Shutter_Lower 0x0B
#define REG_Shutter_Upper 0x0C
#define REG_Control 0x0D
#define REG_Config1 0x0F
#define REG_Config2 0x10
#define REG_Angle_Tune 0x11
#define REG_Frame_Capture 0x12
#define REG_SROM_Enable 0x13
#define REG_Run_Downshift 0x14
#define REG_Rest1_Rate_Lower 0x15
#define REG_Rest1_Rate_Upper 0x16
#define REG_Rest1_Downshift 0x17
#define REG_Rest2_Rate_Lower 0x18
#define REG_Rest2_Rate_Upper 0x19
#define REG_Rest2_Downshift 0x1A
#define REG_Rest3_Rate_Lower 0x1B
#define REG_Rest3_Rate_Upper 0x1C
#define REG_Observation 0x24
#define REG_Data_Out_Lower 0x25
#define REG_Data_Out_Upper 0x26
#define REG_Raw_Data_Dump 0x29
#define REG_SROM_ID 0x2A
#define REG_Min_SQ_Run 0x2B
#define REG_Raw_Data_Threshold 0x2C
#define REG_Config5 0x2F
#define REG_Power_Up_Reset 0x3A
#define REG_Shutdown 0x3B
#define REG_Inverse_Product_ID 0x3F
#define REG_LiftCutoff_Tune3 0x41
#define REG_Angle_Snap 0x42
#define REG_LiftCutoff_Tune1 0x4A
#define REG_Motion_Burst 0x50
#define REG_LiftCutoff_Tune_Timeout 0x58
#define REG_LiftCutoff_Tune_Min_Length 0x5A
#define REG_SROM_Load_Burst 0x62
#define REG_Lift_Config 0x63
#define REG_Raw_Data_Burst 0x64
#define REG_LiftCutoff_Tune2 0x65
#ifndef PMW_CPI bool _inBurst = false;
# define PMW_CPI 1600
#endif
#ifndef PMW_CLOCK_SPEED
# define PMW_CLOCK_SPEED 70000000
#endif
#ifndef SPI_MODE
# define SPI_MODE 3
#endif
#ifndef SPI_DIVISOR
# define SPI_DIVISOR (F_CPU / PMW_CLOCK_SPEED)
#endif
#ifndef ROTATIONAL_TRANSFORM_ANGLE
# define ROTATIONAL_TRANSFORM_ANGLE 0x00
#endif
#ifndef PMW_CS_PIN
# define PMW_CS_PIN SPI_SS_PIN
#endif
void print_byte(uint8_t byte) { dprintf("%c%c%c%c%c%c%c%c|", (byte & 0x80 ? '1' : '0'), (byte & 0x40 ? '1' : '0'), (byte & 0x20 ? '1' : '0'), (byte & 0x10 ? '1' : '0'), (byte & 0x08 ? '1' : '0'), (byte & 0x04 ? '1' : '0'), (byte & 0x02 ? '1' : '0'), (byte & 0x01 ? '1' : '0')); } void print_byte(uint8_t byte) { dprintf("%c%c%c%c%c%c%c%c|", (byte & 0x80 ? '1' : '0'), (byte & 0x40 ? '1' : '0'), (byte & 0x20 ? '1' : '0'), (byte & 0x10 ? '1' : '0'), (byte & 0x08 ? '1' : '0'), (byte & 0x04 ? '1' : '0'), (byte & 0x02 ? '1' : '0'), (byte & 0x01 ? '1' : '0')); }
bool spi_start_adv(void) { bool spi_start_adv(void) {
bool status = spi_start(PMW_CS_PIN, false, SPI_MODE, SPI_DIVISOR); bool status = spi_start(PMW3360_CS_PIN, PMW3360_SPI_LSBFIRST, PMW3360_SPI_MODE, PMW3360_SPI_DIVISOR);
wait_us(1); wait_us(1);
return status; return status;
} }
@ -106,7 +138,7 @@ uint16_t pmw_get_cpi(void) {
} }
bool pmw_spi_init(void) { bool pmw_spi_init(void) {
setPinOutput(PMW_CS_PIN); setPinOutput(PMW3360_CS_PIN);
spi_init(); spi_init();
_inBurst = false; _inBurst = false;
@ -137,7 +169,7 @@ bool pmw_spi_init(void) {
spi_stop_adv(); spi_stop_adv();
wait_ms(10); wait_ms(10);
pmw_set_cpi(PMW_CPI); pmw_set_cpi(PMW3360_CPI);
wait_ms(1); wait_ms(1);
@ -147,7 +179,7 @@ bool pmw_spi_init(void) {
bool init_success = pmw_check_signature(); bool init_success = pmw_check_signature();
writePinLow(PMW_CS_PIN); writePinLow(PMW3360_CS_PIN);
return init_success; return init_success;
} }

View File

@ -20,56 +20,37 @@
#include "spi_master.h" #include "spi_master.h"
// Registers #ifndef PMW3360_CPI
#define REG_Product_ID 0x00 # define PMW3360_CPI 1600
#define REG_Revision_ID 0x01 #endif
#define REG_Motion 0x02
#define REG_Delta_X_L 0x03 #ifndef PMW3360_CLOCK_SPEED
#define REG_Delta_X_H 0x04 # define PMW3360_CLOCK_SPEED 70000000
#define REG_Delta_Y_L 0x05 #endif
#define REG_Delta_Y_H 0x06
#define REG_SQUAL 0x07 #ifndef PMW3360_SPI_LSBFIRST
#define REG_Raw_Data_Sum 0x08 # define PMW3360_SPI_LSBFIRST false
#define REG_Maximum_Raw_data 0x09 #endif
#define REG_Minimum_Raw_data 0x0A
#define REG_Shutter_Lower 0x0B #ifndef PMW3360_SPI_MODE
#define REG_Shutter_Upper 0x0C # define PMW3360_SPI_MODE 3
#define REG_Control 0x0D #endif
#define REG_Config1 0x0F
#define REG_Config2 0x10 #ifndef PMW3360_SPI_DIVISOR
#define REG_Angle_Tune 0x11 # ifdef __AVR__
#define REG_Frame_Capture 0x12 # define PMW3360_SPI_DIVISOR (F_CPU / PMW3360_CLOCK_SPEED)
#define REG_SROM_Enable 0x13 # else
#define REG_Run_Downshift 0x14 # define EXTERNAL_EEPROM_SPI_CLOCK_DIVISOR 64
#define REG_Rest1_Rate_Lower 0x15 # endif
#define REG_Rest1_Rate_Upper 0x16 #endif
#define REG_Rest1_Downshift 0x17
#define REG_Rest2_Rate_Lower 0x18 #ifndef ROTATIONAL_TRANSFORM_ANGLE
#define REG_Rest2_Rate_Upper 0x19 # define ROTATIONAL_TRANSFORM_ANGLE 0x00
#define REG_Rest2_Downshift 0x1A #endif
#define REG_Rest3_Rate_Lower 0x1B
#define REG_Rest3_Rate_Upper 0x1C #ifndef PMW3360_CS_PIN
#define REG_Observation 0x24 # error "No chip select pin defined -- missing PMW3360_CS_PIN"
#define REG_Data_Out_Lower 0x25 #endif
#define REG_Data_Out_Upper 0x26
#define REG_Raw_Data_Dump 0x29
#define REG_SROM_ID 0x2A
#define REG_Min_SQ_Run 0x2B
#define REG_Raw_Data_Threshold 0x2C
#define REG_Config5 0x2F
#define REG_Power_Up_Reset 0x3A
#define REG_Shutdown 0x3B
#define REG_Inverse_Product_ID 0x3F
#define REG_LiftCutoff_Tune3 0x41
#define REG_Angle_Snap 0x42
#define REG_LiftCutoff_Tune1 0x4A
#define REG_Motion_Burst 0x50
#define REG_LiftCutoff_Tune_Timeout 0x58
#define REG_LiftCutoff_Tune_Min_Length 0x5A
#define REG_SROM_Load_Burst 0x62
#define REG_Lift_Config 0x63
#define REG_Raw_Data_Burst 0x64
#define REG_LiftCutoff_Tune2 0x65
#ifdef CONSOLE_ENABLE #ifdef CONSOLE_ENABLE
void print_byte(uint8_t byte); void print_byte(uint8_t byte);

View File

@ -89,3 +89,6 @@ along with this program. If not, see <http://www.gnu.org/licenses/>.
#define SERIAL_USE_MULTI_TRANSACTION #define SERIAL_USE_MULTI_TRANSACTION
#define SPLIT_TRANSACTION_IDS_KB RPC_ID_STATE_SYNC, RPC_ID_SLAVE_STATE #define SPLIT_TRANSACTION_IDS_KB RPC_ID_STATE_SYNC, RPC_ID_SLAVE_STATE
/* PMW3360 Settings */
#define PMW3360_CS_PIN B0

View File

@ -90,3 +90,6 @@ along with this program. If not, see <http://www.gnu.org/licenses/>.
#define SERIAL_USE_MULTI_TRANSACTION #define SERIAL_USE_MULTI_TRANSACTION
#define SPLIT_TRANSACTION_IDS_KB RPC_ID_STATE_SYNC, RPC_ID_SLAVE_STATE #define SPLIT_TRANSACTION_IDS_KB RPC_ID_STATE_SYNC, RPC_ID_SLAVE_STATE
/* PMW3360 Settings */
#define PMW3360_CS_PIN B0

View File

@ -81,3 +81,6 @@
#define RGBLIGHT_EFFECT_RAINBOW_SWIRL #define RGBLIGHT_EFFECT_RAINBOW_SWIRL
// #define DEBUG_LED_PIN F7 // #define DEBUG_LED_PIN F7
/* PMW3360 Settings */
#define PMW3360_CS_PIN B0

View File

@ -57,3 +57,6 @@
// If board has a debug LED, you can enable it by defining this // If board has a debug LED, you can enable it by defining this
// #define DEBUG_LED_PIN F7 // #define DEBUG_LED_PIN F7
/* PMW3360 Settings */
#define PMW3360_CS_PIN B0