Fix bug: encoder position should not depend on double buffer mem.
Add addTraces script and controllerOff script.
Add PID for position and angle.