changeset 8:4031384c9574

Fix bugs in IK code
author Radomir Dopieralski <sheep-devel@sheep.art.pl>
date Sat, 13 Sep 2014 12:04:56 +0200
parents 36ca3c65a3e6
children 1bb40d59867c
files katka/katka.ino
diffstat 1 files changed, 4 insertions(+), 13 deletions(-) [+]
line wrap: on
line diff
--- a/katka/katka.ino	Sat Sep 13 11:48:59 2014 +0200
+++ b/katka/katka.ino	Sat Sep 13 12:04:56 2014 +0200
@@ -19,16 +19,16 @@
 //  reverse, trim
 
     // hind right
-    {-1, -15}, // ankle
+    {-1, 5}, // ankle
     {1, 0},  // knee
 
     // front right
-    {-1, -5}, // ankle
+    {-1, 5}, // ankle
     {1, -5}, // knee
 
     // front left
     {-1, 0}, // knee
-    {1, -5}, // ankle
+    {1, 0}, // ankle
 
     // hind left
     {-1, 0}, // knee
@@ -85,12 +85,6 @@
     char trim = JOINTS[joint][1];
     freq = min(SERVO_FREQ_MAX, max(SERVO_FREQ_MIN, freq + trim * 10));
     servos[joint].writeMicroseconds(freq);
-    Serial.print(int(joint));
-    Serial.print(':');
-    Serial.print(freq);
-    Serial.print(' ');
-    Serial.print(rads / PI * 180);
-    Serial.print('\n');
 }
 
 bool move_leg(char leg, double x, double y) {
@@ -104,15 +98,12 @@
 }
 
 void setup() {
-    Serial.begin(9600);
-    Serial.print("hello\n");
-
     for (char servo = 0; servo < MAX_SERVO; ++servo) {
         servos[servo].attach(servo + SERVO_PIN_MIN,
                              SERVO_FREQ_MIN, SERVO_FREQ_MAX);
     }
     for (char leg = 0; leg < 4; ++leg) {
-        move_leg(leg, HOME_X, HOME_Y);
+        move_leg(leg, HOME_X * LEGS[leg][2], HOME_Y);
         delay(150);
     }
 }