Hola, lo que pides es algo muuy genérico y complejo, es difícil que alguien simplemente te ponga un código, tu lo compiles y ya estuvo.
si lo que tienes es aprender a hacerlo pues tienes que empezar a investigar sobre como funciona cada sistema involucrado, por ejemplo, cómo funciona el usb en este pic, protocolos, sistemas particiones etc. Son muchos los temas que rodean una función como la que pides. Si preguntas cosas puntuales seguramente la gente te ayuda acá pero seguramente tendrás que desarrollarlo tu.
