61 lines
1.4 KiB
C
61 lines
1.4 KiB
C
/*
|
|
* Copyright (C) 2010-2016 Freescale Semiconductor, Inc. All Rights Reserved.
|
|
* Copyright 2017 NXP
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
#include <common.h>
|
|
#include <malloc.h>
|
|
#include <recovery.h>
|
|
#ifdef CONFIG_MXC_KPD
|
|
#include <mxc_keyb.h>
|
|
#endif
|
|
#include <asm/mach-imx/boot_mode.h>
|
|
|
|
#ifdef CONFIG_MXC_KPD
|
|
#define PRESSED_VOL_DOWN 0x01
|
|
#define PRESSED_POWER 0x02
|
|
#define RECOVERY_KEY_MASK (PRESSED_VOL_DOWN | PRESSED_POWER)
|
|
|
|
inline int test_key(int value, struct kpp_key_info *ki)
|
|
{
|
|
return (ki->val == value) && (ki->evt == KDepress);
|
|
}
|
|
|
|
int is_recovery_keypad_pressing(void)
|
|
{
|
|
struct kpp_key_info *key_info = NULL;
|
|
int state = 0, keys, i;
|
|
|
|
int ret = 0;
|
|
|
|
mxc_kpp_init();
|
|
/* due to glitch suppression circuit,
|
|
wait sometime to let all keys scanned. */
|
|
udelay(1000);
|
|
keys = mxc_kpp_getc(&key_info);
|
|
|
|
printf("Detecting VOL_DOWN+POWER key for recovery(%d:%d) ...\n",
|
|
keys, keys ? key_info->val : 0);
|
|
if (keys > 1) {
|
|
for (i = 0; i < keys; i++) {
|
|
if (test_key(CONFIG_POWER_KEY, &key_info[i]))
|
|
state |= PRESSED_POWER;
|
|
else if (test_key(CONFIG_VOL_DOWN_KEY, &key_info[i]))
|
|
state |= PRESSED_VOL_DOWN;
|
|
}
|
|
}
|
|
if ((state & RECOVERY_KEY_MASK) == RECOVERY_KEY_MASK)
|
|
ret = 1;
|
|
if (key_info)
|
|
free(key_info);
|
|
return ret;
|
|
}
|
|
#else
|
|
/* If not using mxc keypad, currently we will detect power key on board */
|
|
int is_recovery_keypad_pressing(void)
|
|
{
|
|
return 0;
|
|
}
|
|
#endif
|