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