Initial code from http://simit-arm.sourceforge.net/.

Signed-off-by: Giuseppe Barba <giuseppe.barba@st.com>