+ start = t + 100;
+
+ for (; i < N_SERVO; i++) {
+
+ /* set servo and PPM bit */
+ portval = 1 << servo_table[i].bit;
+ if (ppm_enabled)
+ portval |= (1 << servo_table[PPM].bit);
+
+ done = 0;
+ load_timer_at(start);
+ while (done == 0)
+ poll();
+
+ /* reset PPM bit after 300us */
+ portval = 1 << servo_table[i].bit;
+ done = 0;
+ load_timer_at(start + 300);
+ while (done == 0)
+ poll();
+
+ start = start + 1000 + servo_table[i].command;
+ }
+
+ /* set PPM bit only for last servo */
+ portval = 0;
+ if (ppm_enabled)
+ portval |= (1 << servo_table[PPM].bit);
+
+ done = 0;
+ load_timer_at(start);