Sorry about the formatting. It doesn't work right now. The seperate movement routines work but the serial doesn't. I can make it work with a timer interrupt but it refreshes about every 25 to 30 ms which is too long and makes the servos weak. I want the servo controllers to wait for a signal from the main and if it does't get one in time then I want it to refresh using the same position.