Found a bug in joint 2.
THIS IS THE GOLDEN ONE...!!!
Cleaned lots of commented code.
Added circuit schematic file.
Added Lucas' work.