• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /* Copyright (c) 2015, The 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 #include <stdint.h>
30 #include <stdlib.h>
31 
32 #include "sync.h"
33 #include "wifi_hal.h"
34 #include "common.h"
35 
36 #include "ring_buffer.h"
37 #include "rb_wrapper.h"
38 
39 #define LOG_TAG  "WifiHAL"
40 
rb_init(hal_info * info,struct rb_info * rb_info,int id,size_t size_of_buf,int num_bufs,char * name)41 wifi_error rb_init(hal_info *info, struct rb_info *rb_info, int id,
42                    size_t size_of_buf, int num_bufs, char *name)
43 {
44     rb_info->rb_ctx = ring_buffer_init(size_of_buf, num_bufs);
45     if (rb_info->rb_ctx == NULL) {
46         ALOGE("Failed to init ring buffer");
47         return WIFI_ERROR_OUT_OF_MEMORY;
48     }
49     strlcpy(rb_info->name, name, MAX_RB_NAME_SIZE);
50     rb_info->ctx = info;
51     rb_info->id = id;
52 
53     /* Initialize last_push_time */
54     gettimeofday(&rb_info->last_push_time, NULL);
55     return WIFI_SUCCESS;
56 }
57 
rb_deinit(struct rb_info * rb_info)58 void rb_deinit(struct rb_info *rb_info)
59 {
60     if (rb_info->rb_ctx) {
61         ring_buffer_deinit(rb_info->rb_ctx);
62         rb_info->rb_ctx = NULL;
63     }
64     rb_info->name[0] = '\0';
65 }
66 
get_rb_status(struct rb_info * rb_info,wifi_ring_buffer_status * rbs)67 void get_rb_status(struct rb_info *rb_info, wifi_ring_buffer_status *rbs)
68 {
69     struct rb_stats rb_stats;
70 
71     strlcpy((char *)rbs->name, rb_info->name, MAX_RB_NAME_SIZE);
72     rbs->flags = rb_info->flags;
73     rbs->ring_id = rb_info->id;
74     rbs->verbose_level = rb_info->verbose_level;
75     rb_get_stats(rb_info->rb_ctx, &rb_stats);
76     rbs->ring_buffer_byte_size = rb_stats.max_num_bufs *
77                                  rb_stats.each_buf_size;
78     rbs->written_bytes = rb_stats.total_bytes_written;
79     rbs->read_bytes = rb_stats.total_bytes_read;
80     rbs->written_records = rb_info->written_records;
81 }
82 
is_rb_name_match(struct rb_info * rb_info,char * name)83 int is_rb_name_match(struct rb_info *rb_info, char *name)
84 {
85     return (strncmp(rb_info->name, name, MAX_RB_NAME_SIZE) == 0);
86 }
87 
ring_buffer_write(struct rb_info * rb_info,u8 * buf,size_t length,int no_of_records,size_t record_length)88 wifi_error ring_buffer_write(struct rb_info *rb_info, u8 *buf, size_t length,
89                              int no_of_records, size_t record_length)
90 {
91     enum rb_status status;
92 
93     status = rb_write(rb_info->rb_ctx, buf, length, 0, record_length);
94     if ((status == RB_FULL) || (status == RB_RETRY)) {
95          push_out_rb_data(rb_info);
96          /* Try writing the data after reading it out */
97         status = rb_write(rb_info->rb_ctx, buf, length, 0, record_length);
98         if (status != RB_SUCCESS) {
99             ALOGE("Failed to rewrite %zu bytes to rb %s with error %d", length,
100                   rb_info->name, status);
101             return WIFI_ERROR_UNKNOWN;
102         }
103     } else if (status == RB_FAILURE) {
104         ALOGE("Failed to write %zu bytes to rb %s with error %d", length,
105               rb_info->name, status);
106         return WIFI_ERROR_UNKNOWN;
107     }
108 
109     rb_info->written_records += no_of_records;
110     return WIFI_SUCCESS;
111 }
112 
push_out_rb_data(void * cb_ctx)113 void push_out_rb_data(void *cb_ctx)
114 {
115     struct rb_info *rb_info = (struct rb_info *)cb_ctx;
116     hal_info *info = (hal_info *)rb_info->ctx;
117     wifi_ring_buffer_status rbs;
118     wifi_ring_buffer_data_handler handler;
119 
120     while (1) {
121         size_t length = 0;
122         u8 *buf;
123 
124         buf = rb_get_read_buf(rb_info->rb_ctx, &length);
125         if (buf == NULL) {
126             break;
127         }
128         get_rb_status(rb_info, &rbs);
129         pthread_mutex_lock(&info->lh_lock);
130         handler.on_ring_buffer_data = info->on_ring_buffer_data;
131         pthread_mutex_unlock(&info->lh_lock);
132         if (handler.on_ring_buffer_data) {
133             handler.on_ring_buffer_data(rb_info->name, (char *)buf,
134                                         length, &rbs);
135         }
136         free(buf);
137     };
138     gettimeofday(&rb_info->last_push_time, NULL);
139 }
140 
rb_start_logging(struct rb_info * rb_info,u32 verbose_level,u32 flags,u32 max_interval_sec,u32 min_data_size)141 wifi_error rb_start_logging(struct rb_info *rb_info, u32 verbose_level,
142                             u32 flags, u32 max_interval_sec, u32 min_data_size)
143 {
144     rb_info->verbose_level = verbose_level;
145     rb_info->flags = flags;
146     rb_info->max_interval_sec = max_interval_sec;
147 
148     rb_config_threshold(rb_info->rb_ctx, min_data_size, push_out_rb_data, rb_info);
149     return WIFI_SUCCESS;
150 }
151 
rb_check_for_timeout(struct rb_info * rb_info,struct timeval * now)152 void rb_check_for_timeout(struct rb_info *rb_info, struct timeval *now)
153 {
154     if (rb_info->max_interval_sec == 0) {
155         return;
156     }
157     if (now->tv_sec >=
158         (rb_info->last_push_time.tv_sec +
159          (__kernel_time_t)rb_info->max_interval_sec)) {
160         push_out_rb_data(rb_info);
161     }
162 }
163