Implement SetColorDirect function and played around with the fwtest function
PLEASE CHECK, if theres is a better way of implementation for the changes in wifly_cmd.h