Motion code
Pairing the legs in software
// Pair A: front-right + back-left
writeServo(0, neutral[0] + cos(t) * amplitude);
writeServo(1, neutral[1] + sin(t) * amplitude);
writeServo(6, neutral[6] + cos(t) * amplitude);
writeServo(7, neutral[7] + sin(t) * amplitude);
// Pair B: same cycle, shifted by PI
writeServo(2, neutral[2] + cos(t + PI) * amplitude);
writeServo(3, neutral[3] + sin(t + PI) * amplitude);
writeServo(4, neutral[4] + cos(t + PI) * amplitude);
writeServo(5, neutral[5] + sin(t + PI) * amplitude);
t = fmod(t + gaitSpeed, TWO_PI);





