// SERVOS // define right(?) side in inverted mode so + values will always move servos in same direction. // Head SERVO head_pan = MAKE_SERVO(FALSE, A0, 1500, 500); SERVO head_tilt = MAKE_SERVO(FALSE, A1, 1500, 500); // Upper Body // Right Side SERVO right_collar = MAKE_SERVO(FALSE, A6, 1500, 500); SERVO right_shoulder = MAKE_SERVO(FALSE, A5, 1500, 500); SERVO right_elbow = MAKE_SERVO(FALSE, A4, 1500, 500); // Left Side SERVO left_collar = MAKE_SERVO(FALSE, E4, 1500, 500); SERVO left_shoulder = MAKE_SERVO(FALSE, E3, 1500, 500); SERVO left_elbow = MAKE_SERVO(FALSE, E2, 1500, 500); // Lower Body // Right Side SERVO right_foot = MAKE_SERVO(FALSE, C0, 1500, 500); SERVO right_ankle = MAKE_SERVO(FALSE, C1, 1500, 500); SERVO right_knee = MAKE_SERVO(FALSE, C2, 1500, 500); SERVO right_thigh = MAKE_SERVO(FALSE, C3, 1500, 500); SERVO right_hip = MAKE_SERVO(FALSE, C4, 1500, 500); // Left Side SERVO left_foot = MAKE_SERVO(FALSE, H6, 1500, 500); SERVO left_ankle = MAKE_SERVO(FALSE, H5, 1500, 500); SERVO left_knee = MAKE_SERVO(FALSE, H4, 1500, 500); SERVO left_thigh = MAKE_SERVO(FALSE, H3, 1500, 500); SERVO left_hip = MAKE_SERVO(FALSE, H2, 1500, 500); // SENSORS /* #define headIR sharp_IR_interpret_GP2Y0A02YK(a2dConvert8bit(0)) #define accelerometerX a2dConvert8bit(1) #define accelerometerY a2dConvert8bit(2) #define xRate a2dConvert8bit(5) #define yRate a2dConvert8bit(6) #define xAcc a2dConvert8bit(7) #define yAcc a2dConvert8bit(8) #define zAcc a2dConvert8bit(9) */