add FREQ command
Add frequency parameter received
Add RF_CFG command
Fix RF_CFG after test, test ok