Changeset 42180f7 in robotics

Timestamp:

06/16/14 16:03:51 (8 years ago)

Author:

Steve Castellotti <sc@…>

Branches:

master

Children:

3a28fb6

Parents:

1afeb71

Message:

• drive commands added

File:

• car/firmware/car/car.ino (modified) (2 diffs)

car/firmware/car/car.ino

@@ -3 +3 @@
 Puzzlebox - Robotics - Car
 
-Puzzlebox Lotus drive motor sketch.
+Puzzlebox Robotics car driving sketch.
 
 Copyright Puzzlebox Productions, LLC (2014)
@@ -27 +27 @@
 
 */
+
+#include <Servo.h>
+
+#define SERVO_PIN_BRAKE 7
+#define SERVO_PIN_DIRECTION 8
+#define SERVO_PIN_TURN 9
+
+#define DEBUG_OUTPUT 1 // 1 for debug
+
+Servo servoBrake;
+Servo servoDirection;
+Servo servoTurn;
+
+char _command;
+
+
+// ################################################################
+
+/////////
+//SETUP//
+/////////
+
+void setup() {
+        
+  Serial.begin(115200);
+
+  servoBrake.attach(SERVO_PIN_BRAKE);
+  servoDirection.attach(SERVO_PIN_DIRECTION);
+  servoTurn.attach(SERVO_PIN_TURN);
+
+} // setup
+
+
+// ################################################################
+
+/////////////
+//MAIN LOOP//
+/////////////
+
+void loop() {
+
+  parseSerialInput();
+
+} // Main loop
+
+
+// ################################################################
+
+int parseValue() {
+  
+  char inByte=0;
+  int a=0;
+  int b=0;
+  int c=0;
+  int newValue=0;
+
+  while (Serial.available() == 0);
+  inByte = Serial.read() - '0';
+  a = inByte;
+
+  while (Serial.available() == 0);
+  inByte = Serial.read() - '0';
+  b = inByte;
+
+  while (Serial.available() == 0);
+  inByte = Serial.read() - '0';
+  c = inByte;
+
+  newValue = (a * 100) + (b * 10) + c;
+
+  return(newValue);
+
+} // parseValue
+
+
+// ################################################################
+
+void parseSerialInput() {
+
+  if (Serial.available() > 0)  {
+
+    _command = Serial.read();
+
+    #if DEBUG_OUTPUT
+      Serial.print("Serial.read(): ");
+      Serial.println(_command);
+    #endif
+
+    switch (_command) {
+
+      case '0':  driveRepeat(); break;
+      case '1':  driveForward(); break;
+      case '2':  driveStop(); break;
+      case '3':  driveLeft(); break;
+      case '4':  driveRight(); break;
+
+//      case 'S':  setServo(); break;
+//      case 'L':  loopServo(); break;
+
+    }
+    
+  }
+
+} // parseSerialInput()
+
+
+// ################################################################
+
+void driveRepeat() {
+  
+}
+
+// ################################################################
+
+void driveForward() {
+
+}
+
+// ################################################################
+
+void driveStop() {
+
+}
+
+// ################################################################
+
+void driveLeft() {
+
+}
+
+// ################################################################
+
+void driveRight() {
+
+}
+
+// ################################################################