112 lines
2.8 KiB
C
112 lines
2.8 KiB
C
![]() |
/*
|
|||
|
* Copyright (c) 2022 Jinan Bosai Network Technology Co., LTD Ltd.
|
|||
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|||
|
* you may not use this file except in compliance with the License.
|
|||
|
* You may obtain a copy of the License at
|
|||
|
*
|
|||
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|||
|
*
|
|||
|
* Unless required by applicable law or agreed to in writing, software
|
|||
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|||
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|||
|
* See the License for the specific language governing permissions and
|
|||
|
* limitations under the License.
|
|||
|
*/
|
|||
|
|
|||
|
#include <stdio.h>
|
|||
|
#include <string.h>
|
|||
|
#include <unistd.h>
|
|||
|
|
|||
|
#include "DOOR.h"
|
|||
|
#include "cmsis_os2.h"
|
|||
|
#include "ohos_init.h"
|
|||
|
#include "iot_gpio.h"
|
|||
|
#include "iot_gpio_ex.h"
|
|||
|
|
|||
|
#include "hi_time.h"
|
|||
|
|
|||
|
|
|||
|
#define TASK_STACK_SIZE 1024 * 8
|
|||
|
#define TASK_PRIO 25
|
|||
|
|
|||
|
|
|||
|
#define GPIO_0 10
|
|||
|
#define GPIO_1 12
|
|||
|
|
|||
|
float GetDistance (void) {
|
|||
|
static unsigned long start_time = 0, time = 0;
|
|||
|
float distance = 0.0;
|
|||
|
IotGpioValue value = IOT_GPIO_VALUE0;
|
|||
|
unsigned int flag = 0;
|
|||
|
IoTWatchDogDisable();
|
|||
|
|
|||
|
// hi_io_set_func(GPIO_8, GPIO_FUNC);
|
|||
|
IoTGpioInit(GPIO_0);
|
|||
|
IoTGpioSetFunc(GPIO_0, IOT_GPIO_FUNC_GPIO_10_GPIO);
|
|||
|
IoTGpioSetDir(GPIO_0, IOT_GPIO_DIR_IN);
|
|||
|
|
|||
|
IoTGpioInit(GPIO_1);
|
|||
|
IoTGpioSetFunc(GPIO_1, IOT_GPIO_FUNC_GPIO_12_GPIO);
|
|||
|
IoTGpioSetDir(GPIO_1, IOT_GPIO_DIR_OUT);
|
|||
|
IoTGpioSetOutputVal(GPIO_1, IOT_GPIO_VALUE1);
|
|||
|
hi_udelay(20);
|
|||
|
IoTGpioSetOutputVal(GPIO_1, IOT_GPIO_VALUE0);
|
|||
|
|
|||
|
while (1) {
|
|||
|
IoTGpioGetInputVal(GPIO_0, &value);
|
|||
|
if ( value == IOT_GPIO_VALUE1 && flag == 0) {
|
|||
|
start_time = hi_get_us();
|
|||
|
flag = 1;
|
|||
|
}
|
|||
|
if (value == IOT_GPIO_VALUE0 && flag == 1) {
|
|||
|
time = hi_get_us() - start_time;
|
|||
|
start_time = 0;
|
|||
|
break;
|
|||
|
}
|
|||
|
}
|
|||
|
distance = time * 0.034 / 2;
|
|||
|
return distance;
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
|
|||
|
static void ExampleTask(void)
|
|||
|
{
|
|||
|
IotGpioValue value = IOT_GPIO_VALUE0;
|
|||
|
// IoTGpioInit(11);
|
|||
|
// IoTGpioSetFunc(11, IOT_GPIO_FUNC_GPIO_11_GPIO);
|
|||
|
// IoTGpioSetPull(11,IOT_GPIO_PULL_UP);
|
|||
|
// IoTGpioSetDir(11, IOT_GPIO_DIR_IN);
|
|||
|
|
|||
|
printf("start test hcsr04\r\n");
|
|||
|
while (1) {
|
|||
|
// IoTGpioGetInputVal(11, &value);
|
|||
|
// if (value == IOT_GPIO_VALUE0) {
|
|||
|
float distance = GetDistance();
|
|||
|
printf("distance is %f\r\n", distance);
|
|||
|
//
|
|||
|
// }
|
|||
|
osDelay(100);
|
|||
|
}
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
static void ExampleEntry(void)
|
|||
|
{
|
|||
|
osThreadAttr_t attr;
|
|||
|
|
|||
|
attr.name = "ExampleTask";
|
|||
|
attr.attr_bits = 0U;
|
|||
|
attr.cb_mem = NULL;
|
|||
|
attr.cb_size = 0U;
|
|||
|
attr.stack_mem = NULL;
|
|||
|
attr.stack_size = TASK_STACK_SIZE;
|
|||
|
attr.priority = TASK_PRIO;
|
|||
|
|
|||
|
if (osThreadNew((osThreadFunc_t)ExampleTask, NULL, &attr) == NULL) {
|
|||
|
printf("Failed to create ExampleTask!\n");
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
APP_FEATURE_INIT(ExampleEntry);
|