I've done something similar before..
EDIT: I found it, the values ​​were copied from picture but I don't remember if I finished the project... test it and you'll see..The code is fine but I don't remember the functionality...... Enjoy