Home | History | Annotate | Download | only in utils
      1 /* Copyright (c) 2011-2013, 2015, 2017The Linux Foundation. All rights reserved.
      2  *
      3  * Redistribution and use in source and binary forms, with or without
      4  * modification, are permitted provided that the following conditions are
      5  * met:
      6  *     * Redistributions of source code must retain the above copyright
      7  *       notice, this list of conditions and the following disclaimer.
      8  *     * Redistributions in binary form must reproduce the above
      9  *       copyright notice, this list of conditions and the following
     10  *       disclaimer in the documentation and/or other materials provided
     11  *       with the distribution.
     12  *     * Neither the name of The Linux Foundation, nor the names of its
     13  *       contributors may be used to endorse or promote products derived
     14  *       from this software without specific prior written permission.
     15  *
     16  * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
     17  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     18  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
     19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
     20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
     23  * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
     24  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
     25  * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
     26  * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27  *
     28  */
     29 #define LOG_NDDEBUG 0
     30 #define LOG_TAG "LocSvc_MsgTask"
     31 
     32 #include <unistd.h>
     33 #include <MsgTask.h>
     34 #include <msg_q.h>
     35 #include <loc_log.h>
     36 #include <platform_lib_includes.h>
     37 
     38 static void LocMsgDestroy(void* msg) {
     39     delete (LocMsg*)msg;
     40 }
     41 
     42 MsgTask::MsgTask(LocThread::tCreate tCreator,
     43                  const char* threadName, bool joinable) :
     44     mQ(msg_q_init2()), mThread(new LocThread()) {
     45     if (!mThread->start(tCreator, threadName, this, joinable)) {
     46         delete mThread;
     47         mThread = NULL;
     48     }
     49 }
     50 
     51 MsgTask::MsgTask(const char* threadName, bool joinable) :
     52     mQ(msg_q_init2()), mThread(new LocThread()) {
     53     if (!mThread->start(threadName, this, joinable)) {
     54         delete mThread;
     55         mThread = NULL;
     56     }
     57 }
     58 
     59 MsgTask::~MsgTask() {
     60     msg_q_flush((void*)mQ);
     61     msg_q_destroy((void**)&mQ);
     62 }
     63 
     64 void MsgTask::destroy() {
     65     LocThread* thread = mThread;
     66     msg_q_unblock((void*)mQ);
     67     if (thread) {
     68         mThread = NULL;
     69         delete thread;
     70     } else {
     71         delete this;
     72     }
     73 }
     74 
     75 void MsgTask::sendMsg(const LocMsg* msg) const {
     76     msg_q_snd((void*)mQ, (void*)msg, LocMsgDestroy);
     77 }
     78 
     79 void MsgTask::prerun() {
     80     // make sure we do not run in background scheduling group
     81      platform_lib_abstraction_set_sched_policy(platform_lib_abstraction_gettid(), PLA_SP_FOREGROUND);
     82 }
     83 
     84 bool MsgTask::run() {
     85     //LOC_LOGV("MsgTask::loop() listening ...\n");
     86     LocMsg* msg;
     87     msq_q_err_type result = msg_q_rcv((void*)mQ, (void **)&msg);
     88     if (eMSG_Q_SUCCESS != result) {
     89         LOC_LOGE("%s:%d] fail receiving msg: %s\n", __func__, __LINE__,
     90                  loc_get_msg_q_status(result));
     91         return false;
     92     }
     93 
     94     msg->log();
     95     // there is where each individual msg handling is invoked
     96     msg->proc();
     97 
     98     delete msg;
     99 
    100     return true;
    101 }
    102