Power saving modified & tested. Printf added for debuging.