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

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