Initial shcem upload and firmware bug fixes