Code Cleanup and LCD Adjustments

Adding more comments and cleaning up messy formatting.