Cleaned up enum usage
Added some println's to forward method for debugging
Added error message for code 0x21