Fix #005: one more bug

Signed-off-by: Pascal Brand <pascal.brand@st.com>
Merge pull request #6 from pascal-brand-st-dev/issue/005/one_more

Fix #005: one more bug