Fix accelerometer code
Merge branch 'develop' of github.com:prog694/desiree into develop