1. Reworked the servo IDs and added defines to easily change them.
2. Changed the default baud rate down to 115,200 because I could not get it to work on Ubuntu at a higher rate.