forked from xuos/xiuos
378 lines
11 KiB
C
378 lines
11 KiB
C
/*
|
|
* Copyright (c) 2020 AIIT XUOS Lab
|
|
* XiUOS is licensed under Mulan PSL v2.
|
|
* You can use this software according to the terms and conditions of the Mulan PSL v2.
|
|
* You may obtain a copy of Mulan PSL v2 at:
|
|
* http://license.coscl.org.cn/MulanPSL2
|
|
* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
|
|
* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
|
|
* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
|
|
* See the Mulan PSL v2 for more details.
|
|
*/
|
|
|
|
/**
|
|
* @file TestRealtime.c
|
|
* @brief support to test realtime function
|
|
* @version 1.0
|
|
* @author AIIT XUOS Lab
|
|
* @date 2021-04-24
|
|
*/
|
|
|
|
#include <xizi.h>
|
|
#include <string.h>
|
|
#include <dev_pin.h>
|
|
|
|
extern unsigned int usleep(unsigned int seconds);
|
|
static BusType pin;
|
|
|
|
#ifdef ARCH_ARM
|
|
// #include <hardware_gpio.h>
|
|
#define GPIO_C13 7
|
|
#define GPIO_C2 17
|
|
#define GPIO_C11 140
|
|
#define GPIO_D1 143
|
|
|
|
void PinIrqIsr(int vector,void *args)
|
|
{
|
|
/* 将GPIO D1置为高电平 */
|
|
asm volatile("LDR r2, =0x40053838"); // 测试代码
|
|
asm volatile("MOV r3, #0x0002"); // 测试代码
|
|
asm volatile("STR r3, [r2]"); // 测试代码
|
|
|
|
/* 将GPIO D1置为低电平 */
|
|
asm volatile("LDR r2, =0x4005383A"); // 测试代码
|
|
asm volatile("MOV r3, #0x0002"); // 测试代码
|
|
asm volatile("STR r3, [r2]"); // 测试代码
|
|
}
|
|
|
|
int RealtimeIrqTest()
|
|
{
|
|
struct PinParam testpin_1;
|
|
struct PinStat testpin_1_stat;
|
|
struct PinParam testpin_2;
|
|
int ret = 0;
|
|
|
|
struct BusConfigureInfo configure_info_1;
|
|
struct BusConfigureInfo configure_info_2;
|
|
struct BusBlockWriteParam write_param_1;
|
|
|
|
configure_info_1.configure_cmd = OPE_CFG;
|
|
configure_info_1.private_data = (void *)&testpin_1;
|
|
write_param_1.buffer = (void *)&testpin_1_stat;
|
|
|
|
configure_info_2.configure_cmd = OPE_CFG;
|
|
configure_info_2.private_data = (void *)&testpin_2;
|
|
|
|
KPrintf("%s irq test\n",__func__);
|
|
/* config test pin 1 as output*/
|
|
testpin_1.cmd = GPIO_CONFIG_MODE;
|
|
testpin_1.pin = GPIO_D1;
|
|
testpin_1.mode = GPIO_CFG_OUTPUT;
|
|
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info_1);
|
|
if (ret != EOK) {
|
|
KPrintf("config testpin_1 %d failed!\n", GPIO_D1);
|
|
return -ERROR;
|
|
}
|
|
|
|
/* set test pin 1 as high*/
|
|
testpin_1_stat.pin = GPIO_D1;
|
|
testpin_1_stat.val = GPIO_LOW;
|
|
BusDevWriteData(pin->owner_haldev, &write_param_1);
|
|
|
|
/* config test pin 2 as input*/
|
|
testpin_2.cmd = GPIO_CONFIG_MODE;
|
|
testpin_2.pin = GPIO_C11;
|
|
testpin_2.mode = GPIO_CFG_INPUT;
|
|
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info_2);
|
|
if (ret != EOK) {
|
|
KPrintf("config testpin_2 %d input failed!\n", testpin_2.pin);
|
|
return -ERROR;
|
|
}
|
|
|
|
testpin_2.cmd = GPIO_IRQ_REGISTER;
|
|
testpin_2.pin = GPIO_C11;
|
|
testpin_2.irq_set.irq_mode = GPIO_IRQ_EDGE_BOTH;
|
|
testpin_2.irq_set.hdr = (void(*)(void *))PinIrqIsr;
|
|
testpin_2.irq_set.args = NONE;
|
|
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info_2);
|
|
if (ret != EOK) {
|
|
KPrintf("register testpin_2 %d irq failed!\n", testpin_2.pin);
|
|
return -ERROR;
|
|
}
|
|
|
|
testpin_2.cmd = GPIO_IRQ_ENABLE;
|
|
testpin_2.pin = GPIO_C11;
|
|
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info_2);
|
|
if (ret != EOK) {
|
|
KPrintf("enable testpin_2 %d irq failed!\n", testpin_2.pin);
|
|
return -ERROR;
|
|
}
|
|
KPrintf("%s irq test\n",__func__);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void RealtimeTaskSwitchTest()
|
|
{
|
|
struct PinParam testpin_1;
|
|
struct PinStat testpin_1_stat;
|
|
int ret = 0;
|
|
|
|
struct BusConfigureInfo configure_info_1;
|
|
struct BusBlockWriteParam write_param_1;
|
|
|
|
configure_info_1.configure_cmd = OPE_CFG;
|
|
configure_info_1.private_data = (void *)&testpin_1;
|
|
write_param_1.buffer = (void *)&testpin_1_stat;
|
|
|
|
/* config test pin 1 as output*/
|
|
testpin_1.cmd = GPIO_CONFIG_MODE;
|
|
testpin_1.pin = GPIO_C13;
|
|
testpin_1.mode = GPIO_CFG_OUTPUT;
|
|
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info_1);
|
|
if (ret != EOK) {
|
|
KPrintf("config testpin_1 %d failed!\n", GPIO_C13);
|
|
return ;
|
|
}
|
|
|
|
/* set test pin 1 as low*/
|
|
testpin_1_stat.pin = GPIO_C13;
|
|
testpin_1_stat.val = GPIO_LOW;
|
|
BusDevWriteData(pin->owner_haldev, &write_param_1);
|
|
|
|
while (RET_TRUE) {
|
|
DelayKTask(1);
|
|
}
|
|
}
|
|
|
|
void GpioSpeedTest()
|
|
{
|
|
struct PinParam testpin_1;
|
|
struct PinStat testpin_1_stat;
|
|
struct PinParam testpin_2;
|
|
int ret = 0;
|
|
|
|
struct BusConfigureInfo configure_info_1;
|
|
struct BusConfigureInfo configure_info_2;
|
|
struct BusBlockWriteParam write_param_1;
|
|
|
|
configure_info_1.configure_cmd = OPE_CFG;
|
|
configure_info_1.private_data = (void *)&testpin_1;
|
|
write_param_1.buffer = (void *)&testpin_1_stat;
|
|
|
|
configure_info_2.configure_cmd = OPE_CFG;
|
|
configure_info_2.private_data = (void *)&testpin_2;
|
|
|
|
/* config test pin 1 as output*/
|
|
testpin_1.cmd = GPIO_CONFIG_MODE;
|
|
testpin_1.pin = GPIO_C13;
|
|
testpin_1.mode = GPIO_CFG_OUTPUT;
|
|
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info_1);
|
|
if (ret != EOK) {
|
|
KPrintf("config testpin_1 %d failed!\n", GPIO_C13);
|
|
return ;
|
|
}
|
|
|
|
testpin_2.cmd = GPIO_CONFIG_MODE;
|
|
testpin_2.pin = GPIO_C2;
|
|
testpin_2.mode = GPIO_CFG_INPUT;
|
|
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info_2);
|
|
|
|
/* set test pin 1 as low*/
|
|
testpin_1_stat.pin = GPIO_C13;
|
|
testpin_1_stat.val = GPIO_LOW;
|
|
BusDevWriteData(pin->owner_haldev, &write_param_1);
|
|
|
|
while (RET_TRUE) {
|
|
*(volatile unsigned int *)0x40020818 = 0x2000;
|
|
|
|
*(volatile unsigned int*)0x4002081a = 0x2000;
|
|
}
|
|
}
|
|
|
|
#else
|
|
|
|
#define GPIO_34 34
|
|
#define GPIO_35 35
|
|
|
|
void PinIrqIsr(void *args)
|
|
{
|
|
/* 将 GPIO18 置为高电平 */
|
|
asm volatile ("lui a5, 0x38001"); // 测试代码
|
|
asm volatile ("addi a5, a5, 12"); // 测试代码
|
|
asm volatile ("lw a5, 0(a5)"); // 测试代码
|
|
asm volatile ("sext.w a4, a5"); // 测试代码
|
|
asm volatile ("lui a5, 0x38001"); // 测试代码
|
|
asm volatile ("addi a5, a5, 12"); // 测试代码
|
|
asm volatile ("ori a4, a4, 5"); // 测试代码
|
|
asm volatile ("sext.w a4, a4"); // 测试代码
|
|
asm volatile ("sw a4, 0(a5)"); // 测试代码
|
|
|
|
/* 将GPIO18 置为低电平 */
|
|
asm volatile ("lui a5, 0x38001"); // 测试代码
|
|
asm volatile ("addi a5, a5, 12"); // 测试代码
|
|
asm volatile ("lw a5, 0(a5)"); // 测试代码
|
|
asm volatile ("sext.w a4, a5"); // 测试代码
|
|
asm volatile ("lui a5, 0x38001"); // 测试代码
|
|
asm volatile ("addi a5, a5, 12"); // 测试代码
|
|
asm volatile ("andi a4, a4, -6"); // 测试代码
|
|
asm volatile ("sext.w a4, a4"); // 测试代码
|
|
asm volatile ("sw a4, 0(a5)"); // 测试代码
|
|
}
|
|
|
|
int RealtimeIrqTest()
|
|
{
|
|
struct PinParam testpin_1;
|
|
struct PinStat testpin_1_stat;
|
|
struct PinParam testpin_2;
|
|
|
|
struct BusConfigureInfo configure_info_1;
|
|
struct BusConfigureInfo configure_info_2;
|
|
struct BusBlockWriteParam write_param_1;
|
|
|
|
configure_info_1.configure_cmd = OPE_CFG;
|
|
configure_info_1.private_data = (void *)&testpin_1;
|
|
write_param_1.buffer = (void *)&testpin_1_stat;
|
|
|
|
configure_info_2.configure_cmd = OPE_CFG;
|
|
configure_info_2.private_data = (void *)&testpin_2;
|
|
|
|
KPrintf("%s irq test\n",__func__);
|
|
/* config GPIO18 as output and set as low */
|
|
testpin_1.cmd = GPIO_CONFIG_MODE;
|
|
testpin_1.pin = GPIO_34;
|
|
testpin_1.mode = GPIO_CFG_OUTPUT;
|
|
BusDrvConfigure(pin->owner_driver, &configure_info_1);
|
|
|
|
testpin_1_stat.pin = GPIO_34;
|
|
testpin_1_stat.val = GPIO_LOW;
|
|
BusDevWriteData(pin->owner_haldev, &write_param_1);
|
|
|
|
/* config GPIO18 as input */
|
|
testpin_2.cmd = GPIO_CONFIG_MODE;
|
|
testpin_2.pin = GPIO_35;
|
|
testpin_2.mode = GPIO_CFG_INPUT;
|
|
BusDrvConfigure(pin->owner_driver, &configure_info_2);
|
|
|
|
testpin_2.cmd = GPIO_IRQ_REGISTER;
|
|
testpin_2.pin = GPIO_35;
|
|
testpin_2.irq_set.irq_mode = GPIO_IRQ_EDGE_RISING;
|
|
testpin_2.irq_set.hdr = PinIrqIsr;
|
|
testpin_2.irq_set.args = NONE;
|
|
BusDrvConfigure(pin->owner_driver, &configure_info_2);
|
|
|
|
testpin_2.cmd = GPIO_IRQ_ENABLE;
|
|
testpin_2.pin = GPIO_35;
|
|
BusDrvConfigure(pin->owner_driver, &configure_info_2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void RealtimeTaskSwitchTest()
|
|
{
|
|
struct PinParam testpin_1;
|
|
struct PinStat testpin_1_stat;
|
|
|
|
struct BusConfigureInfo configure_info_1;
|
|
struct BusBlockWriteParam write_param_1;
|
|
|
|
configure_info_1.configure_cmd = OPE_CFG;
|
|
configure_info_1.private_data = (void *)&testpin_1;
|
|
write_param_1.buffer = (void *)&testpin_1_stat;
|
|
|
|
testpin_1.cmd = GPIO_CONFIG_MODE;
|
|
testpin_1.pin = GPIO_34;
|
|
testpin_1.mode = GPIO_CFG_OUTPUT;
|
|
BusDrvConfigure(pin->owner_driver, &configure_info_1);
|
|
|
|
testpin_1_stat.pin = GPIO_34;
|
|
testpin_1_stat.val = GPIO_LOW;
|
|
BusDevWriteData(pin->owner_haldev, &write_param_1);
|
|
|
|
while (RET_TRUE) {
|
|
DelayKTask(1);
|
|
}
|
|
}
|
|
|
|
void GpioSpeedTest()
|
|
{
|
|
struct PinParam testpin_1;
|
|
struct PinStat testpin_1_stat;
|
|
|
|
struct BusConfigureInfo configure_info_1;
|
|
struct BusBlockWriteParam write_param_1;
|
|
|
|
configure_info_1.configure_cmd = OPE_CFG;
|
|
configure_info_1.private_data = (void *)&testpin_1;
|
|
write_param_1.buffer = (void *)&testpin_1_stat;
|
|
|
|
testpin_1.cmd = GPIO_CONFIG_MODE;
|
|
testpin_1.pin = GPIO_34;
|
|
testpin_1.mode = GPIO_CFG_OUTPUT;
|
|
BusDrvConfigure(pin->owner_driver, &configure_info_1);
|
|
|
|
testpin_1_stat.pin = GPIO_34;
|
|
testpin_1_stat.val = GPIO_LOW;
|
|
BusDevWriteData(pin->owner_haldev, &write_param_1);
|
|
|
|
while (RET_TRUE) {
|
|
*(volatile unsigned int *)0x3800100c |= 0x5;
|
|
*(volatile unsigned int *)0x3800100c &= ~0x5;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/********************************************************************/
|
|
static void UsageHelp(void)
|
|
{
|
|
KPrintf("TestRealtime.\n");
|
|
}
|
|
|
|
int TestRealtime(int argc, char * argv[])
|
|
{
|
|
int ret = 0;
|
|
struct BusConfigureInfo configure_info;
|
|
|
|
if (NONE == argv || 0 == strncmp("-h", argv[0], strlen("-h")) || 0 == strncmp("usage", argv[0], strlen("usage"))) {
|
|
UsageHelp();
|
|
return -EINVALED;
|
|
}
|
|
|
|
pin = BusFind(PIN_BUS_NAME);
|
|
if (!pin) {
|
|
KPrintf("find %s failed!\n", PIN_BUS_NAME);
|
|
return -ERROR;
|
|
}
|
|
|
|
pin->owner_driver = BusFindDriver(pin, PIN_DRIVER_NAME);
|
|
pin->owner_haldev = BusFindDevice(pin, PIN_DEVICE_NAME);
|
|
|
|
configure_info.configure_cmd = OPE_INT;
|
|
ret = BusDrvConfigure(pin->owner_driver, &configure_info);
|
|
if (ret != EOK) {
|
|
KPrintf("initialize %s failed!\n", PIN_BUS_NAME);
|
|
return -ERROR;
|
|
}
|
|
|
|
if (0 == strncmp("-irq",argv[0],strlen("-irq")) ) {
|
|
RealtimeIrqTest(); ///< static creat single sem test
|
|
}
|
|
|
|
if (0 == strncmp("-task",argv[0],strlen("-task")) ) {
|
|
RealtimeTaskSwitchTest();
|
|
}
|
|
|
|
if (0 == strncmp("-gpio",argv[0],strlen("-gpio")) ) {
|
|
GpioSpeedTest();
|
|
}
|
|
|
|
return 0;
|
|
}
|