158 lines
4.6 KiB
C
Executable File
158 lines
4.6 KiB
C
Executable File
/*
|
|
* Copyright (C) 2018 XRADIO TECHNOLOGY CO., LTD. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the
|
|
* distribution.
|
|
* 3. Neither the name of XRADIO TECHNOLOGY CO., LTD. nor the names of
|
|
* its contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include "cmd_util.h"
|
|
#include "cmd_keyboard.h"
|
|
#include "kernel/os/os.h"
|
|
#include "driver/chip/hal_keyboard.h"
|
|
|
|
|
|
#define NON_KEY_PRESS 0xffffffff
|
|
#define KeyTask_PRIO 4
|
|
#define KeyTask_STACKSIZE 1024
|
|
static OS_Thread_t g_key_thread;
|
|
|
|
typedef struct {
|
|
OS_Semaphore_t key_sem;
|
|
uint8_t len;
|
|
uint32_t buffer[KEY_SCAN_BUFFER_MAX];
|
|
uint8_t p_col;
|
|
uint8_t p_row;
|
|
uint8_t flag;
|
|
} key_priv;
|
|
|
|
static key_priv gkeypriv;
|
|
|
|
void keyboard_press_cols_rows(uint8_t index, uint32_t value)
|
|
{
|
|
for (uint8_t i = 0; i < 32; i++) {
|
|
if ((value & 0x01) == 0) {
|
|
gkeypriv.p_row = i % KEY_SCAN_ROWS_MAX;
|
|
gkeypriv.p_col = (index * 32 + i) / KEY_SCAN_ROWS_MAX;
|
|
CMD_DBG("press key row: %d, col: %d\n", gkeypriv.p_row,
|
|
gkeypriv.p_col);
|
|
}
|
|
value >>= 1;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* keyboard callback function
|
|
*/
|
|
void keyboard_callback(uint32_t *rowdata, uint8_t len)
|
|
{
|
|
OS_Status ret;
|
|
|
|
gkeypriv.len = len;
|
|
for (uint8_t i = 0; i < len; i++) {
|
|
gkeypriv.buffer[i] = rowdata[i];
|
|
}
|
|
gkeypriv.flag = 1;
|
|
ret = OS_SemaphoreRelease(&gkeypriv.key_sem);
|
|
if (ret != OS_OK)
|
|
CMD_ERR("%s,%d release semap err!\n", __func__, __LINE__);
|
|
}
|
|
|
|
void Get_KeyValue_Task(void *arg)
|
|
{
|
|
while (1) {
|
|
if (OS_SemaphoreWait(&gkeypriv.key_sem, OS_WAIT_FOREVER) != OS_OK)
|
|
continue;
|
|
|
|
for (uint8_t i = 0; i < gkeypriv.len; i++) {
|
|
if ((gkeypriv.buffer[i] != NON_KEY_PRESS)) {
|
|
CMD_DBG("keydata[%d]: 0x%08x\n", i, gkeypriv.buffer[i]);
|
|
keyboard_press_cols_rows(i, gkeypriv.buffer[i]);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* drv keyboard open f=<freq> c=<cols> r=<rows> t=<timecycle> s=<scan> d=<debounce>
|
|
*/
|
|
static enum cmd_status cmd_keyboard_open_exec(char *cmd)
|
|
{
|
|
keyboard_InitParam param;
|
|
uint32_t freq, cols, rows, time, scan, debounce;
|
|
int cnt;
|
|
|
|
cnt = cmd_sscanf(cmd, "f=%u c=0x%x r=0x%x t=0x%x s=0x%x d=0x%x",
|
|
&freq, &cols, &rows, &time, &scan, &debounce);
|
|
if (cnt != 6) {
|
|
return CMD_STATUS_INVALID_ARG;
|
|
}
|
|
param.freq = freq;
|
|
param.cols = cols;
|
|
param.rows = rows;
|
|
param.timecycle = time;//0x3c00;
|
|
param.scan = scan;//0x100;
|
|
param.debounce = debounce;//0x100;
|
|
|
|
HAL_KeyBoard_Open(¶m, keyboard_callback);
|
|
|
|
if (OS_SemaphoreCreate(&gkeypriv.key_sem, 0, 1) != OS_OK) {
|
|
CMD_ERR("create semaphore failed\n");
|
|
return -1;
|
|
}
|
|
|
|
if (OS_ThreadCreate(&g_key_thread,
|
|
"user",
|
|
Get_KeyValue_Task,
|
|
NULL,
|
|
KeyTask_PRIO,
|
|
KeyTask_STACKSIZE) != OS_OK) {
|
|
CMD_ERR("create key task failed!\r\n");
|
|
}
|
|
|
|
return CMD_STATUS_OK;
|
|
}
|
|
|
|
/*
|
|
* drv keyboard close
|
|
*/
|
|
static enum cmd_status cmd_keyboard_close_exec(char *cmd)
|
|
{
|
|
OS_SemaphoreDelete(&gkeypriv.key_sem);
|
|
OS_ThreadDelete(&g_key_thread);
|
|
HAL_KeyBoard_Close();
|
|
return CMD_STATUS_OK;
|
|
}
|
|
|
|
static struct cmd_data g_keyboard_cmds[] = {
|
|
{"open", cmd_keyboard_open_exec},
|
|
{"close", cmd_keyboard_close_exec},
|
|
};
|
|
|
|
enum cmd_status cmd_keyboard_exec(char *cmd)
|
|
{
|
|
return cmd_exec(cmd, g_keyboard_cmds, cmd_nitems(g_keyboard_cmds));
|
|
}
|
|
|