New configuration.

New servo pragmas and reworked motor code. Still does not work.