Final Working Code

Working Project Hardware Code, May need to be cleaned up with minor bug
fixes.