Pressure sensor example fix

This is my first pull request so i hope everything is OK. Algorithm still need same work but my fix solve problem of freezing controller.