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