recent projects

Author: cbott

StrokeRate/StrokeRate.ino

@@ -1,46 +1,48 @@
-const int SIG_A = 8;
-const int SIG_B = 9;
+#include <Servo.h>
 
-const int IN1 = 10;
-const int IN2 = 11;
+const int STICK_PIN = A0;
+const int VICTOR_PIN = 9;
+
+Servo victor;
 
 void setup(){
-  pinMode(SIG_A, OUTPUT);
-  pinMode(SIG_B, OUTPUT);
-  
-  pinMode(IN1, INPUT);
-  pinMode(IN2, INPUT);
-  
+  victor.attach(VICTOR_PIN);
   Serial.begin(9600);
 }
 
 void loop(){
-//  if (digitalRead(IN1)){
-//    digitalWrite(SIG_A, HIGH);
-//    digitalWrite(SIG_B, LOW);
-//  } else if (digitalRead(IN2)){
-//    digitalWrite(SIG_B, HIGH);
-//    digitalWrite(SIG_A, LOW);
-//  } else {
-//    digitalWrite(SIG_A, LOW);
-//    digitalWrite(SIG_B, LOW);
-//  }
-//  
-//  Serial.print(digitalRead(IN1));
-//  Serial.print(", ");
-//  Serial.println(digitalRead(IN2));
-//  delay(100);
-  digitalWrite(SIG_A, HIGH);
-  digitalWrite(SIG_B, LOW);
-  delay(500);
-  digitalWrite(SIG_A, LOW);
-  digitalWrite(SIG_B, LOW);
-  delay(500);
-  digitalWrite(SIG_B, HIGH);
-  digitalWrite(SIG_A, LOW);
-  delay(500);
-  digitalWrite(SIG_A, LOW);
-  digitalWrite(SIG_B, LOW);
-  delay(500);
+  //setMotor(getJoystick());
+  //delay(1);
+  setMotor(-0.35);
+  delay(1000);
+  setMotor(0);
+  delay(100);
+  setMotor(0.15);
+  delay(900);
+  setMotor(0);
+  delay(100);
+}
+
+void setMotor(float val){
+  val = constrain(val, -1.0, 1.0);
+  int us = (val * 500) + 1500;
+  victor.writeMicroseconds(us);
+}
+
+float getJoystick(){
+  int raw = analogRead(STICK_PIN);
+  float res = constrain((raw - 511) / (-511.0), -1.0, 1.0);
+
+  float sign = 1.0;
+  if(res < 0){
+    sign = -1.0;
+  }
+
+  res = res * res * sign;
 
+  if(abs(res) < 0.05){
+    res = 0.0;
+  } 
+  return res;
 }
+  

bionic_arm/bionic_arm.ino

@@ -46,18 +46,6 @@ void loop() {
     Serial.println(reading);   // print the reading
   }
 
-/*  
-  // print out the decimal result
-  Serial.print(inches,DEC);
-  
-  // print out a graphic representation of the result
-  Serial.print(" ");
-  for (x=0;x<(inches/5);x++)
-  {
-    Serial.print(".");
-  }
-  Serial.println("|");
-*/
 
   lcd.setCursor(0,0);
   lcd.print("    ");