/******************************************************************************
* GET_PULL_STA
* SET_PULL_DOWN
* SET_PULL_UP
*****************************************************************************/
int test_gpio_pull(HW_GPIO pin)
{
GPIO_REQ req_get = {NULL_FT, pin, GET_PULL_STA};
GPIO_REQ req_set_pulldn = {NULL_FT, pin, SET_PULL_DOWN};
GPIO_REQ req_set_pullup = {NULL_FT, pin, SET_PULL_UP};
GPIO_REQ req_restore = {NULL_FT, pin, SET_PULL_DOWN};
GPIO_CNF cnf = Meta_GPIO_OP(req_get, NULL, 0);
unsigned char old = (unsigned char)cnf.data;
if (old == GPIO_PULL_DOWN) req_restore.op = SET_PULL_DOWN;
else if (old == GPIO_PULL_UP) req_restore.op = SET_PULL_UP;
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (old == GPIO_PULL_DOWN || old == GPIO_PULL_UP)
printf(TAG "pull old = %d\n", old);
else
printf(TAG "test pull fail: %d\n", old);
/*SET_PULL_DOWN*/
cnf = Meta_GPIO_OP(req_set_pulldn, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_PULL_DOWN)
GIO_RETERR(META_FAILED, "");
/*SET_PULL_UP*/
cnf = Meta_GPIO_OP(req_set_pullup, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_PULL_UP)
GIO_RETERR(META_FAILED, "");
/*restore*/
cnf = Meta_GPIO_OP(req_restore, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != old)
GIO_RETERR(META_FAILED, "");
return META_SUCCESS;
}
/******************************************************************************
* GET_PULLEN_STA
* SET_PULLEN_DISABLE
* SET_PULLEN_ENABLE
*****************************************************************************/
int test_gpio_pullen(HW_GPIO pin)
{
GPIO_REQ req_get = {NULL_FT, pin, GET_PULLEN_STA};
GPIO_REQ req_set_pulldi = {NULL_FT, pin, SET_PULLEN_DISABLE};
GPIO_REQ req_set_pullen = {NULL_FT, pin, SET_PULLEN_ENABLE};
GPIO_REQ req_restore = {NULL_FT, pin, SET_PULLEN_DISABLE};
GPIO_CNF cnf = Meta_GPIO_OP(req_get, NULL, 0);
unsigned char old = (unsigned char)cnf.data;
if (old == GPIO_PULL_DISABLE) req_restore.op = SET_PULLEN_DISABLE;
else if (old == GPIO_PULL_ENABLE) req_restore.op = SET_PULLEN_ENABLE;
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (old == GPIO_PULL_DISABLE || old == GPIO_PULL_ENABLE)
printf(TAG "pull old = %d\n", old);
else
printf(TAG "test pull fail: %d\n", old);
/*SET_PULLEN_DISABLE*/
cnf = Meta_GPIO_OP(req_set_pulldi, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_PULL_DISABLE)
GIO_RETERR(META_FAILED, "");
/*SET_PULLEN_ENABLE*/
cnf = Meta_GPIO_OP(req_set_pullen, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_PULL_ENABLE)
GIO_RETERR(META_FAILED, "");
/*restore*/
cnf = Meta_GPIO_OP(req_restore, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != old)
GIO_RETERR(META_FAILED, "");
return META_SUCCESS;
}
/******************************************************************************
* GET_INV_STA
* SET_INV_ENABLE
* SET_INV_DISABLE
*****************************************************************************/
int test_gpio_inv(HW_GPIO pin)
{
GPIO_REQ req_get = {NULL_FT, pin, GET_INV_STA};
GPIO_REQ req_set_inven = {NULL_FT, pin, SET_INV_ENABLE};
GPIO_REQ req_set_invdi = {NULL_FT, pin, SET_INV_DISABLE};
GPIO_REQ req_restore = {NULL_FT, pin, SET_INV_ENABLE};
GPIO_CNF cnf = Meta_GPIO_OP(req_get, NULL, 0);
unsigned char old = (unsigned char)cnf.data;
if (old == GPIO_DATA_UNINV) req_restore.op = SET_INV_DISABLE;
else if (old == GPIO_DATA_INV) req_restore.op = SET_INV_ENABLE;
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (old == GPIO_DATA_UNINV || old == GPIO_DATA_INV)
printf(TAG "inv old = %d\n", old);
else
printf(TAG "test inv fail: %d\n", old);
/*SET_INV_ENABLE*/
cnf = Meta_GPIO_OP(req_set_inven, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_DATA_INV)
GIO_RETERR(META_FAILED, "");
/*SET_INV_DISABLE*/
cnf = Meta_GPIO_OP(req_set_invdi, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_DATA_UNINV)
GIO_RETERR(META_FAILED, "");
/*restore*/
cnf = Meta_GPIO_OP(req_restore, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != old)
GIO_RETERR(META_FAILED, "");
return META_SUCCESS;
}
/******************************************************************************
* GET_MODE_STA
* SET_MODE_0
* SET_MODE_1
* SET_MODE_2
* SET_MODE_3
*****************************************************************************/
int test_gpio_mode(HW_GPIO pin)
{
GPIO_REQ req_get = {NULL_FT, pin, GET_MODE_STA};
GPIO_REQ req_set_mode0 = {NULL_FT, pin, SET_MODE_0};
GPIO_REQ req_set_mode1 = {NULL_FT, pin, SET_MODE_1};
GPIO_REQ req_set_mode2 = {NULL_FT, pin, SET_MODE_2};
GPIO_REQ req_set_mode3 = {NULL_FT, pin, SET_MODE_3};
GPIO_REQ req_restore = {NULL_FT, pin, SET_DIR_IN};
GPIO_CNF cnf = Meta_GPIO_OP(req_get, NULL, 0);
unsigned char old = (unsigned char)cnf.data;
if (old == GPIO_MODE_00) req_restore.op = SET_MODE_0;
else if (old == GPIO_MODE_01) req_restore.op = SET_MODE_1;
else if (old == GPIO_MODE_02) req_restore.op = SET_MODE_2;
else if (old == GPIO_MODE_03) req_restore.op = SET_MODE_3;
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (old == GPIO_MODE_00 || old == GPIO_MODE_01 ||
old == GPIO_MODE_02 || old == GPIO_MODE_03)
printf(TAG "mode old = %d\n", old);
else
printf(TAG "test mode fail: %d\n", old);
/*SET_MODE_0*/
cnf = Meta_GPIO_OP(req_set_mode0, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_MODE_00)
GIO_RETERR(META_FAILED, "");
/*SET_MODE_1*/
cnf = Meta_GPIO_OP(req_set_mode1, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_MODE_01)
GIO_RETERR(META_FAILED, "");
/*SET_MODE_2*/
cnf = Meta_GPIO_OP(req_set_mode2, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_MODE_02)
GIO_RETERR(META_FAILED, "");
/*SET_MODE_3*/
cnf = Meta_GPIO_OP(req_set_mode3, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_MODE_03)
GIO_RETERR(META_FAILED, "");
/*restore*/
cnf = Meta_GPIO_OP(req_restore, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != old)
GIO_RETERR(META_FAILED, "");
return META_SUCCESS;
}
/******************************************************************************
* GET_DIR_STA
* SET_DIR_IN
* SET_DIR_OUT
* GET_DATA_IN
* GET_DATA_OUT
* SET_DATA_LOW
* SET_DATA_HIGH
*****************************************************************************/
int test_gpio_dir(HW_GPIO pin)
{
GPIO_REQ req_get = {NULL_FT, pin, GET_DIR_STA};
GPIO_REQ req_set_dir_in = {NULL_FT, pin, SET_DIR_IN};
GPIO_REQ req_set_dir_out = {NULL_FT, pin, SET_DIR_OUT};
GPIO_REQ req_get_dat_in = {NULL_FT, pin, GET_DATA_IN};
GPIO_REQ req_get_dat_out = {NULL_FT, pin, GET_DATA_OUT};
GPIO_REQ req_set_dat_hi = {NULL_FT, pin, SET_DATA_HIGH};
GPIO_REQ req_set_dat_lo = {NULL_FT, pin, SET_DATA_LOW};
GPIO_REQ req_restore = {NULL_FT, pin, SET_DIR_IN};
GPIO_CNF cnf = Meta_GPIO_OP(req_get, NULL, 0);
unsigned char old = (unsigned char)cnf.data;
if (old == GPIO_DIR_IN) req_restore.op = SET_DIR_IN;
else if (old == GPIO_DIR_OUT) req_restore.op = SET_DIR_OUT;
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (old == GPIO_DIR_IN || old == GPIO_DIR_OUT)
printf(TAG "dir old = %d\n", old);
else
printf(TAG "test dir fail: %d\n", old);
/*SET_DIR_OUT*/
cnf = Meta_GPIO_OP(req_set_dir_out, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_DIR_OUT)
GIO_RETERR(META_FAILED, "");
/*SET_DIR_OUT: 1*/
cnf = Meta_GPIO_OP(req_set_dat_hi, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get_dat_out, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_OUT_ONE)
GIO_RETERR(META_FAILED, "");
/*SET_DIR_OUT: 0*/
cnf = Meta_GPIO_OP(req_set_dat_lo, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get_dat_out, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_OUT_ZERO)
GIO_RETERR(META_FAILED, "");
/*SET_DIR_IN*/
cnf = Meta_GPIO_OP(req_set_dir_in, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_DIR_IN)
GIO_RETERR(META_FAILED, "");
cnf = Meta_GPIO_OP(req_get_dat_in, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != GPIO_OUT_ZERO && cnf.data != GPIO_OUT_ONE)
GIO_RETERR(META_FAILED, "");
/*restore*/
cnf = Meta_GPIO_OP(req_restore, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
cnf = Meta_GPIO_OP(req_get, NULL, 0);
if (cnf.status != META_SUCCESS)
GIO_RETERR(cnf.status, "");
if (cnf.data != old)
GIO_RETERR(META_FAILED, "");
return META_SUCCESS;
}
