http://mbed.org/users/littlexc/code/GP2xx/#e3ea40a41d27