You can not select more than 25 topics
			Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
		
		
		
		
		
			
		
			
				
					
					
						
							50 lines
						
					
					
						
							2.1 KiB
						
					
					
				
			
		
		
	
	
							50 lines
						
					
					
						
							2.1 KiB
						
					
					
				| #include "selfdrive/modeld/models/commonmodel.h"
 | |
| 
 | |
| #include <cassert>
 | |
| #include <cmath>
 | |
| #include <cstring>
 | |
| 
 | |
| #include "common/clutil.h"
 | |
| 
 | |
| ModelFrame::ModelFrame(cl_device_id device_id, cl_context context) {
 | |
|   input_frames = std::make_unique<uint8_t[]>(buf_size);
 | |
| 
 | |
|   q = CL_CHECK_ERR(clCreateCommandQueue(context, device_id, 0, &err));
 | |
|   y_cl = CL_CHECK_ERR(clCreateBuffer(context, CL_MEM_READ_WRITE, MODEL_WIDTH * MODEL_HEIGHT, NULL, &err));
 | |
|   u_cl = CL_CHECK_ERR(clCreateBuffer(context, CL_MEM_READ_WRITE, (MODEL_WIDTH / 2) * (MODEL_HEIGHT / 2), NULL, &err));
 | |
|   v_cl = CL_CHECK_ERR(clCreateBuffer(context, CL_MEM_READ_WRITE, (MODEL_WIDTH / 2) * (MODEL_HEIGHT / 2), NULL, &err));
 | |
|   net_input_cl = CL_CHECK_ERR(clCreateBuffer(context, CL_MEM_READ_WRITE, MODEL_FRAME_SIZE * sizeof(uint8_t), NULL, &err));
 | |
| 
 | |
|   transform_init(&transform, context, device_id);
 | |
|   loadyuv_init(&loadyuv, context, device_id, MODEL_WIDTH, MODEL_HEIGHT);
 | |
| }
 | |
| 
 | |
| uint8_t* ModelFrame::prepare(cl_mem yuv_cl, int frame_width, int frame_height, int frame_stride, int frame_uv_offset, const mat3 &projection, cl_mem *output) {
 | |
|   transform_queue(&this->transform, q,
 | |
|                 yuv_cl, frame_width, frame_height, frame_stride, frame_uv_offset,
 | |
|                 y_cl, u_cl, v_cl, MODEL_WIDTH, MODEL_HEIGHT, projection);
 | |
| 
 | |
|   if (output == NULL) {
 | |
|     loadyuv_queue(&loadyuv, q, y_cl, u_cl, v_cl, net_input_cl);
 | |
| 
 | |
|     std::memmove(&input_frames[0], &input_frames[MODEL_FRAME_SIZE], sizeof(uint8_t) * MODEL_FRAME_SIZE);
 | |
|     CL_CHECK(clEnqueueReadBuffer(q, net_input_cl, CL_TRUE, 0, MODEL_FRAME_SIZE * sizeof(uint8_t), &input_frames[MODEL_FRAME_SIZE], 0, nullptr, nullptr));
 | |
|     clFinish(q);
 | |
|     return &input_frames[0];
 | |
|   } else {
 | |
|     loadyuv_queue(&loadyuv, q, y_cl, u_cl, v_cl, *output, true);
 | |
|     // NOTE: Since thneed is using a different command queue, this clFinish is needed to ensure the image is ready.
 | |
|     clFinish(q);
 | |
|     return NULL;
 | |
|   }
 | |
| }
 | |
| 
 | |
| ModelFrame::~ModelFrame() {
 | |
|   transform_destroy(&transform);
 | |
|   loadyuv_destroy(&loadyuv);
 | |
|   CL_CHECK(clReleaseMemObject(net_input_cl));
 | |
|   CL_CHECK(clReleaseMemObject(v_cl));
 | |
|   CL_CHECK(clReleaseMemObject(u_cl));
 | |
|   CL_CHECK(clReleaseMemObject(y_cl));
 | |
|   CL_CHECK(clReleaseCommandQueue(q));
 | |
| } |