1 /*
2 * Copyright (c) 2021 Huawei Device Co., Ltd.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at
6 *
7 * http://www.apache.org/licenses/LICENSE-2.0
8 *
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
14 */
15
16 #include <fcntl.h>
17 #include <hdf_io_service_if.h>
18 #include <hdf_log.h>
19 #include <osal_file.h>
20 #include <osal_mem.h>
21 #include <osal_mutex.h>
22 #include <osal_thread.h>
23 #include <osal_time.h>
24 #include <pthread.h>
25 #include <securec.h>
26 #include <signal.h>
27 #include <stdio.h>
28 #include <sys/time.h>
29 #include <unistd.h>
30
31 #define HDF_LOG_TAG cdc_acm_speed
32
33 enum UsbSerialCmd {
34 USB_SERIAL_OPEN = 0,
35 USB_SERIAL_CLOSE,
36 USB_SERIAL_READ,
37 USB_SERIAL_WRITE,
38 USB_SERIAL_GET_BAUDRATE,
39 USB_SERIAL_SET_BAUDRATE,
40 USB_SERIAL_SET_PROP,
41 USB_SERIAL_GET_PROP,
42 USB_SERIAL_REGIST_PROP,
43 USB_SERIAL_WRITE_SPEED,
44 USB_SERIAL_WRITE_GET_TEMP_SPEED,
45 USB_SERIAL_WRITE_SPEED_DONE,
46 USB_SERIAL_WRITE_GET_TEMP_SPEED_UINT32,
47 USB_SERIAL_READ_SPEED,
48 USB_SERIAL_READ_GET_TEMP_SPEED,
49 USB_SERIAL_READ_SPEED_DONE,
50 USB_SERIAL_READ_GET_TEMP_SPEED_UINT32,
51 };
52
53 static struct HdfSBuf *g_data;
54 static struct HdfSBuf *g_reply;
55 static struct HdfIoService *g_acmService;
56 static bool g_readRuning = false;
57 static sigset_t g_mask;
TestSpeed(void)58 static void TestSpeed(void)
59 {
60 HdfSbufFlush(g_reply);
61 int32_t status = g_acmService->dispatcher->Dispatch(&g_acmService->object, USB_SERIAL_READ_SPEED, g_data, g_reply);
62 if (status != HDF_SUCCESS) {
63 HDF_LOGE("%s: Dispatch USB_SERIAL_READ_SPEED err", __func__);
64 return;
65 }
66 }
67
GetTempSpeed(void)68 static void GetTempSpeed(void)
69 {
70 const float calc = 10000;
71 uint32_t speed = 0;
72 HdfSbufFlush(g_reply);
73 int32_t status = g_acmService->dispatcher->Dispatch(&g_acmService->object,
74 USB_SERIAL_READ_GET_TEMP_SPEED_UINT32, g_data, g_reply);
75 if (status != HDF_SUCCESS) {
76 HDF_LOGE("%s: Dispatch USB_SERIAL_WRITE_GET_TEMP_SPEED failed status = %d",
77 __func__, status);
78 return;
79 }
80 if (!HdfSbufReadUint32(g_reply, &speed)) {
81 HDF_LOGE("%s: HdfSbufReadFloat failed", __func__);
82 return;
83 }
84 if (speed > 0) {
85 printf("speed : %f MB/s\n", (float)speed / calc);
86 }
87 }
88
ReadSpeedDone(void)89 static void ReadSpeedDone(void)
90 {
91 int32_t status = g_acmService->dispatcher->Dispatch(&g_acmService->object,
92 USB_SERIAL_READ_SPEED_DONE, g_data, g_reply);
93 if (status != HDF_SUCCESS) {
94 HDF_LOGE("%s: Dispatch USB_SERIAL_WRITE_SPEED_DONE failed status = %d",
95 __func__, status);
96 return;
97 }
98 }
99
StopHandler(void * arg)100 static void *StopHandler(void *arg)
101 {
102 (void)arg;
103 int32_t signo;
104 while (1) {
105 int32_t err = sigwait(&g_mask, &signo);
106 if (err != 0) {
107 printf("Sigwait failed: %d\n", err);
108 }
109
110 switch (signo) {
111 case SIGINT:
112 case SIGQUIT:
113 printf("AcmSpeedRead exit\n");
114 ReadSpeedDone();
115 g_readRuning = false;
116 return NULL;
117 default:
118 printf("Unexpected signal %d\n", signo);
119 }
120 }
121 }
122
123 static pthread_t g_threads;
StartStopHandler(void)124 static void StartStopHandler(void)
125 {
126 sigemptyset(&g_mask);
127 sigaddset(&g_mask, SIGINT);
128 sigaddset(&g_mask, SIGQUIT);
129 if (pthread_sigmask(SIG_BLOCK, &g_mask, NULL) != 0) {
130 printf("SIG_BLOCK error\n");
131 return;
132 }
133 if (pthread_create(&g_threads, NULL, StopHandler, NULL) != 0) {
134 printf("Could not create core thread\n");
135 return;
136 }
137 }
138
AcmSpeedRead(int32_t argc,const char * argv[])139 int32_t AcmSpeedRead(int32_t argc, const char *argv[])
140 {
141 (void)argc;
142 (void)argv;
143 int32_t status;
144 g_acmService = HdfIoServiceBind("usbfn_cdcacm");
145 if (g_acmService == NULL || g_acmService->dispatcher == NULL || g_acmService->dispatcher->Dispatch == NULL) {
146 HDF_LOGE("%s: GetService err", __func__);
147 return HDF_FAILURE;
148 }
149
150 g_data = HdfSbufObtainDefaultSize();
151 g_reply = HdfSbufObtainDefaultSize();
152 if (g_data == NULL || g_reply == NULL) {
153 HDF_LOGE("%s: GetService err", __func__);
154 return HDF_FAILURE;
155 }
156
157 status = g_acmService->dispatcher->Dispatch(&g_acmService->object, USB_SERIAL_OPEN, g_data, g_reply);
158 if (status != HDF_SUCCESS) {
159 HDF_LOGE("%s: Dispatch USB_SERIAL_OPEN err", __func__);
160 return HDF_FAILURE;
161 }
162
163 StartStopHandler();
164 TestSpeed();
165 g_readRuning = true;
166 while (g_readRuning) {
167 sleep(0x2);
168 if (g_readRuning) {
169 GetTempSpeed();
170 }
171 }
172
173 HdfSbufRecycle(g_data);
174 HdfSbufRecycle(g_reply);
175 HdfIoServiceRecycle(g_acmService);
176 return 0;
177 }
178