123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112 |
- #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();
-
- 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;
-
-
-
-
-
- printf("start test hcsr04\r\n");
- while (1) {
-
-
- 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);
|