stc_rpncalc/src/key.c
2019-11-14 03:45:52 -05:00

280 lines
6.7 KiB
C

// 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 3 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 <https://www.gnu.org/licenses/>.
/*
* key.c
*
* Created on: Mar 20, 2019
*/
#include <stdint.h>
#include "utils.h"
#include "key.h"
#ifdef DESKTOP
#include <stdio.h>
const char state_names[4][32] = {
"STEADY_LOW" ,
"TRANS_LOW_HIGH",
"STEADY_HIGH" ,
"TRANS_HIGH_LOW"
};
#else
#include "stc15.h"
#endif
#define M_COLS 4
__idata uint8_t Keys[TOTAL_ROWS]; //only bottom nibbles get set
int8_t NewKeyPressed; //row*M_COLS + col, see KEY_MAP[] in main.c
__idata static uint8_t last_state[TOTAL_ROWS]; //all used, 2 bits per key
__idata static int8_t last_count[TOTAL_ROWS][M_COLS]; //all used
static uint8_t unexpected_count; //count of unexpected transitions
static const int8_t COUNT_LIM_LOW = -30;
static const int8_t COUNT_LIM_HIGH = 30;
static const int8_t THRESH_STEADY = 2;
static const int8_t THRESH_TRANS = 2;
//2-bit state:
#define STEADY_LOW 0
#define TRANS_LOW_HIGH 1
#define STEADY_HIGH 2
#define TRANS_HIGH_LOW 3
#ifdef DESKTOP
//test functions
void KeyInit(void){
//initialize counts
for (uint8_t i = 0; i < TOTAL_ROWS; i++){
for (uint8_t j = 0; j < M_COLS; j++){
last_count[i][j] = COUNT_LIM_LOW;
}
}
}
void raw_scan(void){
static uint8_t i = 0;
static const uint8_t data[] = {
0,0,0,0,0,0,0,0,0,0,0,0,
0,2,0,2,0,2,0,2,0,2,0,2,
2,2,0,2,2,0,2,2,0,2,2,0,
2,2,2,2,2,2,2,2,2,2,2,2,
0,2,0,2,0,2,0,2,0,2,0,2,
0,0,2,0,0,2,0,0,2,0,0,2,
0,0,0,0,0,0,0,0,0,0,0,0
};
Keys[1] = data[i];
i++;
if (i >= (sizeof(data)/sizeof(data[0]))){
i = 0;
}
}
#else
void KeyInit(void){
uint8_t i, j;
//set column drivers bits 7:4 to quasi-bidirectional w/ pullup M[1:0]=b00
//and row inputs bits 3:0 to quasi-bidirectional w/ pullup M[1:0]=b00
P1M1 = 0x00;
P1M0 = 0x00;
//all initially pulled up
P1 = 0xff;
//read top row input buttons using quasi-bidirectional w/ pullup M[1:0]=b00
//P3[1:0]
P3M1 &= ~(0x3);
P3M0 &= ~(0x3);
P3 |= 0x3; //pull up
//P5[5:4]
P5M1 &= ~(0x30);
P5M0 &= ~(0x30);
P5 |= 0x30; //pull up
//initialize counts
for (i = 0; i < TOTAL_ROWS; i++){
for (j = 0; j < M_COLS; j++){
last_count[i][j] = COUNT_LIM_LOW;
}
}
//no new key
NewKeyPressed = -1;
}
#pragma nooverlay
void raw_scan(void) __using(1){
//top row not part of matrix
static const uint8_t M_ROWS = 4;
uint8_t i, j;
//scan top row
Keys[0] = 0; //initially
//temporarily set P3[1:0] push pull output M[1:0]=b01
P3M0 |= 0x3;
P3 &= ~(0x3);
P3 |= 0x3;
//back to quasi-bidirectional w/ pullup M[1:0]=b00
P3M0 &= ~(0x3);
//read inputs
Keys[0] += (P3_0 ? 0 : (1<<0)); //on
Keys[0] += (P3_1 ? 0 : (1<<1));
Keys[0] += (P5_4 ? 0 : (1<<2));
Keys[0] += (P5_5 ? 0 : (1<<3));
//scan matrix
for (i = 0; i < M_ROWS; i++){
Keys[i+1] = 0; //initially
for (j = 0; j < M_COLS; j++){
uint8_t read;
P1 = (~(1 << (j+4))); //pulldown column (all others pull up)
read = (P1 & (1<<i)); //read button
read = (read == 0 ? 1 : 0); //pressed if grounded by column driver
Keys[i+1] += (read << j);
P1 = 0xff; //reset all as pullups
}
}
}
#endif
//based on quick draw/integrator hybrid debounce algorithm from
//https://summivox.wordpress.com/2016/06/03/keyboard-matrix-scanning-and-debouncing/
#ifndef DESKTOP
#pragma nooverlay
#endif
void debounce(void) __using(1){
uint8_t i, j;
NewKeyPressed = -1; //initially
// new_keys_pressed = 0; //initially
for (i = 0; i < TOTAL_ROWS; i++){
for (j = 0; j < M_COLS; j++){
int8_t new_count;
uint8_t new_state;
int8_t curr_count = last_count[i][j];
uint8_t curr_state = last_state[i] & (0x3 << (j*2));
curr_state >>= j*2;
new_count = curr_count;
new_state = curr_state;
//update count
if (Keys[i] & (1 << j)){
if (curr_count < COUNT_LIM_HIGH){
new_count = curr_count + 1;
}
} else {
if (curr_count > COUNT_LIM_LOW){
new_count = curr_count - 1;
}
}
//update state
switch(curr_state){
////////
case STEADY_LOW: {
if (new_count >= COUNT_LIM_LOW + THRESH_TRANS){
new_count = 0;
new_state = TRANS_LOW_HIGH;
}
break;
}
////////
case TRANS_LOW_HIGH: {
if (new_count >= THRESH_STEADY){
new_state = STEADY_HIGH;
new_count = COUNT_LIM_HIGH;
} else if (new_count <= -THRESH_STEADY){
new_state = STEADY_LOW;
new_count = COUNT_LIM_LOW;
unexpected_count++;
}
break;
}
////////
case STEADY_HIGH: {
if (new_count <= COUNT_LIM_HIGH - THRESH_TRANS){
new_count = 0;
new_state = TRANS_HIGH_LOW;
}
break;
}
////////
case TRANS_HIGH_LOW: {
if (new_count <= -THRESH_STEADY){
new_state = STEADY_LOW;
new_count = COUNT_LIM_LOW;
} else if (new_count >= THRESH_STEADY){
new_state = STEADY_HIGH;
new_count = COUNT_LIM_HIGH;
unexpected_count++;
}
break;
}
////////
default:
new_state = STEADY_LOW;
new_count = COUNT_LIM_LOW;
unexpected_count++;
} //switch(curr_state)
//track new key down
if (curr_state != TRANS_LOW_HIGH && new_state == TRANS_LOW_HIGH){
NewKeyPressed = (i*M_COLS + j); //can only track 1 for now
#ifdef DESKTOP
printf("new key (%d, %d) pressed\n", i, j);
// printf("curr_state: %d, new_state: %d\n", curr_state, new_state);
#endif
// new_keys_pressed |= ((uint32_t) 1 << (i*M_COLS + j));
}
//write back new count
last_count[i][j] = new_count;
//write back new state
last_state[i] = (last_state[i] & ~(0x3 << (j*2))) | (new_state << (j*2));
} //for cols
} //for rows
}
#ifdef DEBUG_KEYS
const uint8_t* DebugGetKeys(void){
return keys;
}
#endif
#ifdef KEY_TEST_APP
int main(void){
KeyInit();
for (int iii = 0; iii < 100; iii++){
//look at '9' key at row 1, col 1 (0 indexed)
//the corresponding new key code is 5, see KEY_MAP[] in main.c
static const uint8_t i = 1, j = 1;
int8_t curr_count = last_count[i][j/2] & (0xf << ((j&1)*4));
uint8_t curr_state = last_state[i] & (0x3 << (j*2));
curr_count >>= (j&1)*4;
curr_state >>= j*2;
if (iii == 0){
printf("%3d: %x, %14s, %2d, %2d\n",
iii, Keys[1], state_names[curr_state], curr_count, NewKeyPressed);
}
KeyScan();
printf("%3d: %x, %14s, %2d, %2d\n",
iii, Keys[1], state_names[curr_state], curr_count, NewKeyPressed);
}
return 0;
}
#endif