Fix #005: one more bug

Signed-off-by: Pascal Brand <pascal.brand@st.com>