Set core frequency in main

* Set core frequency using rcc_ctrl