/*
|
* Copyright (C) 2018 Spreadtrum Communications Inc.
|
*
|
* File: wcn_misc.c
|
* Description: WCN misc file for drivers. Some feature or function
|
* isn't easy to classify, then write it in this file.
|
*
|
* This software is licensed under the terms of the GNU General Public
|
* License version 2, as published by the Free Software Foundation, and
|
* may be copied, distributed, and modified under those terms.
|
*
|
* This program is distributed in the hope that it will be useful,
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1
|
* GNU General Public License for more details.
|
*/
|
|
#include <linux/mutex.h>
|
#include <linux/version.h>
|
#include <linux/time.h>
|
#if KERNEL_VERSION(4, 11, 0) <= LINUX_VERSION_CODE
|
#include <linux/sched/clock.h>
|
#endif
|
|
#include "wcn_misc.h"
|
#include "wcn_procfs.h"
|
#include "wcn_txrx.h"
|
#include "mdbg_type.h"
|
|
static struct atcmd_fifo s_atcmd_owner;
|
static unsigned long int s_marlin_bootup_time;
|
|
void mdbg_atcmd_owner_init(void)
|
{
|
memset(&s_atcmd_owner, 0, sizeof(s_atcmd_owner));
|
mutex_init(&s_atcmd_owner.lock);
|
}
|
|
void mdbg_atcmd_owner_deinit(void)
|
{
|
mutex_destroy(&s_atcmd_owner.lock);
|
}
|
|
static void mdbg_atcmd_owner_add(enum atcmd_owner owner)
|
{
|
mutex_lock(&s_atcmd_owner.lock);
|
s_atcmd_owner.owner[s_atcmd_owner.tail % ATCMD_FIFO_MAX] = owner;
|
s_atcmd_owner.tail++;
|
mutex_unlock(&s_atcmd_owner.lock);
|
}
|
|
enum atcmd_owner mdbg_atcmd_owner_peek(void)
|
{
|
enum atcmd_owner owner;
|
|
mutex_lock(&s_atcmd_owner.lock);
|
owner = s_atcmd_owner.owner[s_atcmd_owner.head % ATCMD_FIFO_MAX];
|
s_atcmd_owner.head++;
|
mutex_unlock(&s_atcmd_owner.lock);
|
|
WCN_DEBUG("owner=%d, head=%d\n", owner, s_atcmd_owner.head-1);
|
return owner;
|
}
|
|
void mdbg_atcmd_clean(void)
|
{
|
mutex_lock(&s_atcmd_owner.lock);
|
memset(&s_atcmd_owner.owner[0], 0, ARRAY_SIZE(s_atcmd_owner.owner));
|
s_atcmd_owner.head = s_atcmd_owner.tail = 0;
|
mutex_unlock(&s_atcmd_owner.lock);
|
}
|
|
/*
|
* Until now, CP2 response every AT CMD to AP side
|
* without owner-id.AP side transfer every ATCMD
|
* response info to WCND.If AP send AT CMD on kernel layer,
|
* and the response info transfer to WCND,
|
* WCND deal other owner's response CMD.
|
* We'll not modify CP2 codes because some
|
* products already released to customer.
|
* We will save all of the owner-id to the atcmd fifo.
|
* and dispatch the response ATCMD info to the matched owner.
|
* We'd better send all of the ATCMD with this function
|
* or caused WCND error
|
*/
|
long int mdbg_send_atcmd(char *buf, long int len, enum atcmd_owner owner)
|
{
|
long int sent_size = 0;
|
|
mdbg_atcmd_owner_add(owner);
|
|
/* confirm write finish */
|
mutex_lock(&s_atcmd_owner.lock);
|
sent_size = mdbg_send(buf, len, MDBG_SUBTYPE_AT);
|
mutex_unlock(&s_atcmd_owner.lock);
|
|
WCN_DEBUG("%s, owner=%d\n", buf, owner);
|
|
return sent_size;
|
}
|
|
/* copy from function: kdb_gmtime */
|
#if KERNEL_VERSION(4, 20, 0) <= LINUX_VERSION_CODE
|
static void wcn_gmtime(struct timespec64 *tv, struct wcn_tm *tm)
|
#else
|
static void wcn_gmtime(struct timespec *tv, struct wcn_tm *tm)
|
#endif
|
{
|
/* This will work from 1970-2099, 2100 is not a leap year */
|
static int mon_day[] = { 31, 29, 31, 30, 31, 30, 31,
|
31, 30, 31, 30, 31 };
|
memset(tm, 0, sizeof(*tm));
|
tm->tm_msec = tv->tv_nsec/1000000;
|
tm->tm_sec = tv->tv_sec % (24 * 60 * 60);
|
tm->tm_mday = tv->tv_sec / (24 * 60 * 60) +
|
(2 * 365 + 1); /* shift base from 1970 to 1968 */
|
tm->tm_min = tm->tm_sec / 60 % 60;
|
tm->tm_hour = tm->tm_sec / 60 / 60;
|
tm->tm_sec = tm->tm_sec % 60;
|
tm->tm_year = 68 + 4*(tm->tm_mday / (4*365+1));
|
tm->tm_mday %= (4*365+1);
|
mon_day[1] = 29;
|
while (tm->tm_mday >= mon_day[tm->tm_mon]) {
|
tm->tm_mday -= mon_day[tm->tm_mon];
|
if (++tm->tm_mon == 12) {
|
tm->tm_mon = 0;
|
++tm->tm_year;
|
mon_day[1] = 28;
|
}
|
}
|
++tm->tm_mday;
|
}
|
|
/* AP notify BTWF time by at+aptime=... cmd */
|
long int wcn_ap_notify_btwf_time(void)
|
{
|
#if KERNEL_VERSION(4, 20, 0) <= LINUX_VERSION_CODE
|
struct timespec64 now;
|
#else
|
struct timespec now;
|
#endif
|
struct wcn_tm tm;
|
char aptime[64];
|
long int send_cnt = 0;
|
|
/* get ap kernel time and transfer to China-BeiJing Time */
|
#if KERNEL_VERSION(4, 20, 0) <= LINUX_VERSION_CODE
|
ktime_get_real_ts64(&now);
|
#else
|
now = current_kernel_time();
|
#endif
|
wcn_gmtime(&now, &tm);
|
tm.tm_hour = (tm.tm_hour + WCN_BTWF_TIME_OFFSET) % 24;
|
|
/* save time with string: month,day,hour,min,sec,mili-sec */
|
memset(aptime, 0, 64);
|
sprintf(aptime, "at+aptime=%d,%d,%d,%d,%d,%d\r",
|
tm.tm_mon+1, tm.tm_mday,
|
tm.tm_hour, tm.tm_min, tm.tm_sec, tm.tm_msec);
|
|
/* send to BTWF CP2 */
|
send_cnt = mdbg_send_atcmd((void *)aptime, strlen(aptime),
|
WCN_ATCMD_KERNEL);
|
WCN_INFO("%s, send_cnt=%ld", aptime, send_cnt);
|
|
return send_cnt;
|
}
|
|
/*
|
* Only marlin poweron and marlin starts to run,
|
* it can call this function.
|
* The time will be sent to marlin with loopcheck CMD.
|
* NOTES:If marlin power off, and power on again, it
|
* should call this function again.
|
*/
|
void marlin_bootup_time_update(void)
|
{
|
s_marlin_bootup_time = local_clock();
|
WCN_INFO("s_marlin_bootup_time=%ld",
|
s_marlin_bootup_time);
|
}
|
|
unsigned long int marlin_bootup_time_get(void)
|
{
|
return s_marlin_bootup_time;
|
}
|
