This is the final build hardware wise.

It shows jerkyness in both motors and servos.