X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Fmainboard%2Fstrat_corn.c;fp=projects%2Fmicrob2010%2Fmainboard%2Fstrat_corn.c;h=48eff29a45efc24b2f7cf9131d913ac75bb3c2c6;hp=1f5e1d347c4868af3093b634cb242ef842498480;hb=a3ec2f79a4ed7b2148ede881e0685ddb6f141d82;hpb=4872fe91ffcc459a56e45cb213eec2a8660075e1

diff --git a/projects/microb2010/mainboard/strat_corn.c b/projects/microb2010/mainboard/strat_corn.c
index 1f5e1d3..48eff29 100644
--- a/projects/microb2010/mainboard/strat_corn.c
+++ b/projects/microb2010/mainboard/strat_corn.c
@@ -168,15 +168,23 @@ static uint8_t clitoid_select_speed(uint8_t num1, uint8_t dir1,
 		return 1;
 	}
 
-/* 	if (time_get_s() > 39) */
-/* 		DEBUG(E_USER_STRAT, "i,j = (%d %d), count=%d", i, j, corn_count_neigh(i, j)); */
+/* 	if (time_get_s() > 32) */
+/* 		DEBUG(E_USER_STRAT, "i,j = (%d %d), count=%d", i, j, */
+/* 		      corn_count_neigh(i, j)); */
 
 	if (corn_count_neigh(i, j) == 2)
 		return 1;
 
+	/* we are on intersection, let's go slow... but as we enter in
+	 * the curve-part of the clitoid, we should not go there */
 	if (wp_belongs_to_line(i, j, num2, dir2))
 		return 0;
 
+	/* we can ge fast if it's a 60deg angle and if we checked the
+	 * current point */
+	if (is_60deg(dir1, dir2))
+		return 0;
+
 	/* get next point */
 	if (wp_get_neigh(i, j, &i2, &j2, dir1) < 0) {
 		DEBUG(E_USER_STRAT, "%s(): cannot get neigh1",
@@ -184,7 +192,7 @@ static uint8_t clitoid_select_speed(uint8_t num1, uint8_t dir1,
 		return 1;
 	}
 
-	/* if (i2, j2) belongs to next line, check corn in opposition */
+	/* if (i2, j2) belongs to next line, check corns */
 	if (wp_belongs_to_line(i2, j2, num2, dir2)) {
 		if (corn_count_neigh(i2, j2) > 0)
 			return 1;
@@ -199,7 +207,7 @@ static uint8_t clitoid_select_speed(uint8_t num1, uint8_t dir1,
 		return 1;
 	}
 
-	/* if (i3, j3) belongs to next line, check corn in opposition */
+	/* if (i3, j3) belongs to next line, check corns */
 	if (wp_belongs_to_line(i3, j3, num2, dir2)) {
 		if (corn_count_neigh(i2, j2) > 0 ||
 		    corn_count_neigh(i3, j3) > 0)
@@ -316,11 +324,11 @@ static int8_t strat_calc_clitoid(uint8_t num1, uint8_t dir1,
 
 	clitoid_slow = clitoid_select_speed(num1, dir1, num2, dir2);
 	if (clitoid_slow) {
-		DEBUG(E_USER_STRAT, "slow clito\n");
+		DEBUG(E_USER_STRAT, "slow clito");
 		strat_set_speed(SPEED_CLITOID_SLOW, SPEED_ANGLE_SLOW);
 	}
 	else {
-		DEBUG(E_USER_STRAT, "fast clito\n");
+		DEBUG(E_USER_STRAT, "fast clito");
 		strat_set_speed(SPEED_CLITOID_FAST, SPEED_ANGLE_SLOW);
 	}