Development Version 0x001A

Cleaned up code
Moved the afc related functions into a seperate module
Added more serial commands