Enable OF function

Enable OF function by commenting away existing OF sensors code and GPS
serial link