From: jino.cho <jino.cho@samsung.com>
Date: Thu, 13 Jul 2017 02:03:18 +0000 (+0900)
Subject: Add test code for HC-SR04 ultrasonic raging module
X-Git-Tag: submit/tizen/20170713.044725~1
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=5603d222c09324a50dddf5b8785962dd955de02f;p=platform%2Fcore%2Fapi%2Fperipheral-io.git

Add test code for HC-SR04 ultrasonic raging module

Change-Id: I132f2b25ed977181dbffd06f9570e0db4510cb81
Signed-off-by: jino.cho <jino.cho@samsung.com>
---

diff --git a/test/peripheral-io-test.c b/test/peripheral-io-test.c
index cb62e2a..3fd3d20 100644
--- a/test/peripheral-io-test.c
+++ b/test/peripheral-io-test.c
@@ -25,6 +25,12 @@
 
 #define BUFFER_LEN 32
 
+typedef struct {
+	int cnt;
+	peripheral_gpio_h gpio_trig;
+	peripheral_gpio_h gpio_echo;
+} gpio_hcsr04_module_s;
+
 typedef struct {
 	const char *tc_name;
 	int tc_code;
@@ -620,6 +626,94 @@ error:
 	return -1;
 }
 
+void gpio_hcsr04_isr(gpio_isr_cb_s *data, void *user_data)
+{
+	float dist = 0;
+	static unsigned long long timestamp = 0;
+
+	if (timestamp > 0 && data->value == 0) {
+		dist = data->timestamp - timestamp;
+		dist = (dist * 34300) / 2000000;
+		printf("%s: Measured Distance : %0.2fcm\n", __func__, dist);
+	}
+
+	timestamp = data->timestamp;
+}
+
+gboolean gpio_hcsr04_timeout_cb(gpointer data)
+{
+	gpio_hcsr04_module_s *dev = (gpio_hcsr04_module_s*)data;
+
+	if (dev->cnt--) {
+		peripheral_gpio_write(dev->gpio_trig, 1);
+		peripheral_gpio_write(dev->gpio_trig, 0);
+	} else
+		return FALSE;
+
+	return TRUE;
+}
+
+void gpio_hcsr04_destroy(gpointer data)
+{
+	gpio_hcsr04_module_s *dev = (gpio_hcsr04_module_s*)data;
+
+	peripheral_gpio_unregister_cb(dev->gpio_echo);
+	peripheral_gpio_close(dev->gpio_echo);
+	peripheral_gpio_close(dev->gpio_trig);
+	free(dev);
+}
+
+int gpio_hcsr04_ultrasonic_ranging_module(void)
+{
+	gpio_hcsr04_module_s *dev;
+	int pin_trig, pin_echo, ret;
+
+	printf("    %s()\n", __func__);
+	printf("Enter triger gpio pin number\n");
+	if (read_int_input(&pin_trig) < 0)
+		return -1;
+
+	printf("Enter echo gpio pin number\n");
+	if (read_int_input(&pin_echo) < 0)
+		return -1;
+
+	dev = calloc(1, sizeof(gpio_hcsr04_module_s));
+	if (dev == NULL) {
+		printf("failed to allocate gpio_hcsr04_module_s\n");
+		return -1;
+	}
+
+	if ((ret = peripheral_gpio_open(pin_trig, &dev->gpio_trig)) < 0) {
+		printf(">>>>> Failed to open GPIO pin, ret : %d\n", ret);
+		goto err;
+	}
+
+	if ((ret = peripheral_gpio_open(pin_echo, &dev->gpio_echo)) < 0) {
+		printf(">>>>> Failed to open GPIO pin, ret : %d\n", ret);
+		peripheral_gpio_close(dev->gpio_trig);
+		goto err;
+	}
+
+	peripheral_gpio_set_direction(dev->gpio_echo, PERIPHERAL_GPIO_DIRECTION_IN);
+	peripheral_gpio_set_edge_mode(dev->gpio_echo, PERIPHERAL_GPIO_EDGE_BOTH);
+	peripheral_gpio_register_cb(dev->gpio_echo, gpio_hcsr04_isr, NULL);
+	peripheral_gpio_set_direction(dev->gpio_trig, PERIPHERAL_GPIO_DIRECTION_OUT);
+
+	dev->cnt = 20;
+
+	g_timeout_add_seconds_full(G_PRIORITY_DEFAULT,
+					1,
+					gpio_hcsr04_timeout_cb,
+					dev,
+					gpio_hcsr04_destroy);
+
+	return 0;
+
+err:
+	free(dev);
+	return -1;
+}
+
 int gpio_test_get_handle_by_pin(int pin, peripheral_gpio_h *gpio)
 {
 	peripheral_gpio_h handle;
@@ -985,8 +1079,9 @@ tc_table_t preset_tc_table[] = {
 	{"[Preset Test] PWM Motor",					5, pwm_test_motor},
 	{"[Preset Test] Uart Accelerometer",		6, uart_test_accelerometer},
 	{"[Preset Test] SPI MMA7455 Accel. sensor",	7, spi_mma7455_module_test},
-	{"[Preset Test] GPIO IRQ register",			8, gpio_irq_register},
-	{"[Preset Test] GPIO IRQ unregister",		9, gpio_irq_unregister},
+	{"[Preset Test] GPIO HC-SR04 Range sensor",	8, gpio_hcsr04_ultrasonic_ranging_module},
+	{"[Preset Test] GPIO IRQ register",			10, gpio_irq_register},
+	{"[Preset Test] GPIO IRQ unregister",		11, gpio_irq_unregister},
 	{"Go back to main",							0, enter_main},
 	{NULL,	0, NULL},
 };