inital encoder implementation
This commit is contained in:
		
							parent
							
								
									018a0142d2
								
							
						
					
					
						commit
						ff4a1ae5d2
					
				
					 11 changed files with 135 additions and 34 deletions
				
			
		
							
								
								
									
										67
									
								
								quantum/encoder.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										67
									
								
								quantum/encoder.c
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,67 @@
 | 
			
		|||
/*
 | 
			
		||||
 * Copyright 2018 Jack Humbert <jack.humb@gmail.com>
 | 
			
		||||
 *
 | 
			
		||||
 * This program is free software: you can redistribute it and/or modify
 | 
			
		||||
 * it under the terms of the GNU General Public License as published by
 | 
			
		||||
 * the Free Software Foundation, either version 2 of the License, or
 | 
			
		||||
 * (at your option) any later version.
 | 
			
		||||
 *
 | 
			
		||||
 * This program is distributed in the hope that it will be useful,
 | 
			
		||||
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
			
		||||
 * GNU General Public License for more details.
 | 
			
		||||
 *
 | 
			
		||||
 * You should have received a copy of the GNU General Public License
 | 
			
		||||
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#include "encoder.h"
 | 
			
		||||
#include <stdbool.h>
 | 
			
		||||
 | 
			
		||||
#ifndef ENCODER_RESOLUTION
 | 
			
		||||
  #define ENCODER_RESOLUTION 4
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
#if !defined(ENCODERS_PAD_A) || !defined(ENCODERS_PAD_B)
 | 
			
		||||
  #error "No encoder pads defined by ENCODERS_PAD_A and ENCODERS_PAD_B"
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
static LINE_TYPE encoders_pad_a[NUMBER_OF_ENCODERS] = ENCODERS_PAD_A;
 | 
			
		||||
static LINE_TYPE encoders_pad_b[NUMBER_OF_ENCODERS] = ENCODERS_PAD_B;
 | 
			
		||||
 | 
			
		||||
static int8_t encoder_LUT[] = { 0, -1, 1, 0, 1, 0, 0, -1, -1, 0, 0, 1, 0, 1, -1, 0 };
 | 
			
		||||
 | 
			
		||||
static uint8_t encoder_state[NUMBER_OF_ENCODERS] = {0};
 | 
			
		||||
static int8_t encoder_value[NUMBER_OF_ENCODERS] = {0};
 | 
			
		||||
 | 
			
		||||
__attribute__ ((weak))
 | 
			
		||||
void encoder_update_user(bool clockwise) { }
 | 
			
		||||
 | 
			
		||||
__attribute__ ((weak))
 | 
			
		||||
void encoder_update_kb(bool clockwise) {
 | 
			
		||||
  encoder_update_user(clockwise);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
void encoder_init(void) {
 | 
			
		||||
  for (int i = 0; i < NUMBER_OF_ENCODERS; i++) {
 | 
			
		||||
    setPadMode(encoders_pad_a[i], PAD_MODE_INPUT);
 | 
			
		||||
    setPadMode(encoders_pad_b[i], PAD_MODE_INPUT);
 | 
			
		||||
 | 
			
		||||
    encoder_state[i] = (readPad(encoders_pad_a[i]) << 0) | (readPad(encoders_pad_b[i]) << 1);
 | 
			
		||||
  }
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
void encoder_read(void) {
 | 
			
		||||
  for (int i = 0; i < NUMBER_OF_ENCODERS; i++) {
 | 
			
		||||
    encoder_state[i] <<= 2;
 | 
			
		||||
    encoder_state[i] |= (readPad(encoders_pad_a[i]) << 0) | (readPad(encoders_pad_b[i]) << 1);
 | 
			
		||||
    encoder_value[i] += encoder_LUT[encoder_state[i] & 0xF];
 | 
			
		||||
    if (encoder_value[i] >= ENCODER_RESOLUTION) {
 | 
			
		||||
        encoder_update_kb(COUNTRECLOCKWISE);
 | 
			
		||||
    }
 | 
			
		||||
    if (encoder_value[i] <= -ENCODER_RESOLUTION) { // direction is arbitrary here, but this clockwise
 | 
			
		||||
        encoder_update_kb(CLOCKWISE);
 | 
			
		||||
    }
 | 
			
		||||
    encoder_value[i] %= ENCODER_RESOLUTION;
 | 
			
		||||
  }
 | 
			
		||||
}
 | 
			
		||||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue