Compass fix. Restored old KJ6 driver
* Compass reading delay is still slow, it appears choppy, but now you know where north is

Change-Id: Ib097f8dd9807236dc366d5c3dab2b3e6652477f5
Signed-off-by: Fernando Barillas <fbis251@gmail.com>