Organized

Organized the files and coding to improve readability.
Hand Written Code

- Successful build with handwritten code.
- Not tested yet