Changeset 425

Timestamp:

02/17/07 22:12:51 (2 years ago)

Author:

goodea

Message:

servo

Files:

• trunk/projects/cmucam2/cmucam2.c (modified) (3 diffs)

trunk/projects/cmucam2/cmucam2.c

@@ -55 +55 @@
-  NOISE_FILTER,
-  TRACK_INVERT,
+  SERVO_OUTPUT,
-  CMUCAM2_CMD_END               // Must be last entry so array sizes are correct
-} cmucam2_command_t;
@@ -86 +87 @@
-  //  GP get servo position
-  //  SM servo mask
-//  SO servo output
+cmucam2_cmds[SERVO_OUTPUT] = "SO";
-
-  /* Image Windowing Commands */
@@ -587 +588 @@
-        else
-          print_ACK ();
+        cc3_gpio_set_mode(arg_list[0], CC3_GPIO_MODE_SERVO);
-        cc3_gpio_set_servo_position (arg_list[0], arg_list[1]);
-        break;
-
+      case SERVO_OUTPUT:
+        if (n != 2) {
+          error = true;
+          break;
+        }
+        print_ACK ();
+        cc3_gpio_set_mode(arg_list[0], CC3_GPIO_MODE_OUTPUT);
+        cc3_gpio_set_value(arg_list[0], arg_list[1]);
+
+        break;
-
-      default: