Move several functions to icache, fixing flash upload failure