Merge pull request #462 from inesmaria08/servo_motor_test

Userland app for servomotor

Author: alexandruradovici

examples/servo/Makefile

@@ -0,0 +1,11 @@
+# Makefile for user application
+
+# Specify this directory relative to the current application.
+TOCK_USERLAND_BASE_DIR = ../..
+
+# Which files to compile.
+C_SRCS := $(wildcard *.c)
+
+# Include userland master makefile. Contains rules and flags for actually
+# building the application.
+include $(TOCK_USERLAND_BASE_DIR)/AppMakefile.mk

examples/servo/README.md

@@ -0,0 +1,26 @@
+Servo Controller App  
+=====================  
+
+A simple app that tests the functionality of a connected servo motor by reading its initial angle, adjusting the angle from 0 to 180 degrees, and verifying the actual angle at each step.
+
+Example Output  
+--------------  
+
+```  
+The number of available servomotors is: 1  
+Requested angle 0. Actual current angle is: 0  
+Requested angle 1. Actual current angle is: 1  
+Requested angle 2. Actual current angle is: 2  
+...  
+Requested angle 180. Actual current angle is: 180  
+```  
+
+If the servo index is out of range:  
+```  
+The index number is bigger than the available servomotors  
+```  
+
+If the servo cannot report its angle:  
+```  
+This servo cannot return its angle.  
+```  

examples/servo/main.c

@@ -0,0 +1,42 @@
+#include "../../libtock/interface/syscalls/servo_syscalls.h"
+#include <libtock-sync/services/alarm.h>
+#include <libtock/tock.h>
+#include <stdio.h>
+#include <stdlib.h>
+
+int main(void) {
+  // Checks if the driver exists and, if not, returns -1.
+  if (!libtock_servo_exists()) {
+    printf("There is no available servo\n");
+    return -1;
+  }
+  returncode_t result  = RETURNCODE_EOFF;
+  uint32_t servo_count = 0;
+  libtock_servo_count(&servo_count);
+  printf("The number of available servomotors is: %ld\n", servo_count);
+  uint16_t angle = 0;
+  uint16_t index = 0; // the first index available.
+
+  if (libtock_servo_read_angle(index, &angle) == RETURNCODE_ENODEVICE) {
+    printf("\n The index number is bigger than the available servomotors\n");
+    return -1;
+  }
+
+  // Changes the angle of the servomotor from 0 to 180 degrees (waiting 0.1 ms between every change).
+  for (int i = 0; i <= 180; i++) {
+    // `result` stores the returned code received from the driver.
+    result = libtock_servo_set_angle(index, i);
+    if (result == RETURNCODE_SUCCESS) {
+      libtocksync_alarm_delay_ms(100);
+      // Verifies if the function successfully returned the current angle.
+      if (libtock_servo_read_angle(index, &angle) == RETURNCODE_SUCCESS) {
+        printf("Requested angle %d. Actual current angle is: %d\n", i, angle);
+      }
+    } else if (result == RETURNCODE_FAIL) {
+      printf("\nAngle %d exceeds the servo's limit angle.\n", i);
+    }
+  }
+  if (libtock_servo_read_angle(index, &angle) != RETURNCODE_SUCCESS) {
+    printf("\n This servo cannot return its angle.\n");
+  }
+}

libtock/interface/syscalls/servo_syscalls.c

@@ -0,0 +1,28 @@
+#include "servo_syscalls.h"
+#include <stdio.h>
+
+bool libtock_servo_exists(void) {
+  return driver_exists(DRIVER_NUM_SERVO);
+}
+
+returncode_t libtock_servo_count(uint32_t* servo_count) {
+  uint32_t value     = 0;
+  syscall_return_t r = command(DRIVER_NUM_SERVO, 1, 0, 0);
+  returncode_t ret   = tock_command_return_u32_to_returncode(r, &value);
+  *servo_count = (uint16_t)value;
+  return ret;
+
+}
+
+returncode_t libtock_servo_set_angle(uint16_t index, uint16_t angle) {
+  syscall_return_t cval = command(DRIVER_NUM_SERVO, 2, index, angle);
+  return tock_command_return_novalue_to_returncode(cval);
+}
+
+returncode_t libtock_servo_read_angle(uint16_t index, uint16_t* angle) {
+  uint32_t value     = 0;
+  syscall_return_t r = command(DRIVER_NUM_SERVO, 3, index, 0);
+  returncode_t ret   = tock_command_return_u32_to_returncode(r, &value);
+  *angle = (uint16_t)value;
+  return ret;
+}

libtock/interface/syscalls/servo_syscalls.h

@@ -0,0 +1,22 @@
+#pragma once
+
+#include "../../tock.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#define DRIVER_NUM_SERVO 0x90009
+
+// Check if the servo system call driver is available on this board.
+bool libtock_servo_exists(void);
+// Returns the number of available servomotors.
+returncode_t libtock_servo_count(uint32_t* servo_count);
+// Change the angle.
+returncode_t libtock_servo_set_angle(uint16_t index, uint16_t angle);
+// Requests the current angle from the servo.
+returncode_t libtock_servo_read_angle(uint16_t index, uint16_t* angle);
+
+#ifdef __cplusplus
+}
+#endif