Finished Key Expansion

Completed code and tested with book test cases
Finished Encryption