Zhiyuan Shao
1 year ago
parent
6151bee3cd
commit
da9a3e456f
@ -1,43 +0,0 @@
|
||||
/*
|
||||
* Below is the given application for lab5_2.
|
||||
* The goal of this app is to control the car via Bluetooth.
|
||||
*/
|
||||
|
||||
#include "user_lib.h"
|
||||
#include "util/types.h"
|
||||
void delay(unsigned int time){
|
||||
unsigned int a = 0xfffff ,b = time;
|
||||
volatile unsigned int i,j;
|
||||
for(i = 0; i < a; ++i){
|
||||
for(j = 0; j < b; ++j){
|
||||
;
|
||||
}
|
||||
}
|
||||
}
|
||||
int main(void) {
|
||||
printu("Hello world!\n");
|
||||
int i;
|
||||
int pid = fork();
|
||||
if(pid == 0)
|
||||
{
|
||||
while (1)
|
||||
{
|
||||
delay(3);
|
||||
printu("waiting for you!\n");
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
while(1)
|
||||
{
|
||||
char temp = (char)uartgetchar();
|
||||
if(temp == 'q')
|
||||
break;
|
||||
car_control(temp);
|
||||
}
|
||||
}
|
||||
|
||||
exit(0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -0,0 +1,87 @@
|
||||
#pragma pack(4)
|
||||
#define _SYS__TIMEVAL_H_
|
||||
struct timeval {
|
||||
unsigned int tv_sec;
|
||||
unsigned int tv_usec;
|
||||
};
|
||||
|
||||
#include "user_lib.h"
|
||||
#include "videodev2.h"
|
||||
#define DARK 64
|
||||
#define RATIO 7 / 10
|
||||
|
||||
int main() {
|
||||
char *info = allocate_share_page();
|
||||
int pid = fork();
|
||||
if (pid == 0) {
|
||||
int f = open_u("/dev/video0", O_RDWR), r;
|
||||
|
||||
struct v4l2_format fmt;
|
||||
fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
|
||||
fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV;
|
||||
fmt.fmt.pix.width = 320;
|
||||
fmt.fmt.pix.height = 180;
|
||||
fmt.fmt.pix.field = V4L2_FIELD_NONE;
|
||||
r = ioctl_u(f, VIDIOC_S_FMT, &fmt);
|
||||
printu("Pass format: %d\n", r);
|
||||
|
||||
struct v4l2_requestbuffers req;
|
||||
req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
|
||||
req.count = 1; req.memory = V4L2_MEMORY_MMAP;
|
||||
r = ioctl_u(f, VIDIOC_REQBUFS, &req);
|
||||
printu("Pass request: %d\n", r);
|
||||
|
||||
struct v4l2_buffer buf;
|
||||
buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
|
||||
buf.memory = V4L2_MEMORY_MMAP; buf.index = 0;
|
||||
r = ioctl_u(f, VIDIOC_QUERYBUF, &buf);
|
||||
printu("Pass buffer: %d\n", r);
|
||||
|
||||
int length = buf.length;
|
||||
char *img = mmap_u(NULL, length, PROT_READ | PROT_WRITE, MAP_SHARED, f, buf.m.offset);
|
||||
unsigned int type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
|
||||
r = ioctl_u(f, VIDIOC_STREAMON, &type);
|
||||
printu("Open stream: %d\n", r);
|
||||
|
||||
char *img_data = naive_malloc();
|
||||
for (int i = 0; i < (length + 4095) / 4096 - 1; i++)
|
||||
naive_malloc();
|
||||
yield();
|
||||
|
||||
for (;;) {
|
||||
if (*info == '1') {
|
||||
r = ioctl_u(f, VIDIOC_QBUF, &buf);
|
||||
printu("Buffer enqueue: %d\n", r);
|
||||
r = ioctl_u(f, VIDIOC_DQBUF, &buf);
|
||||
printu("Buffer dequeue: %d\n", r);
|
||||
r = read_mmap_u(img_data, img, length);
|
||||
int num = 0;
|
||||
for (int i = 0; i < length; i += 2)
|
||||
if (img_data[i] < DARK) num++;
|
||||
printu("Dark num: %d > %d\n", num, length / 2 * RATIO);
|
||||
if (num > length / 2 * RATIO) {
|
||||
*info = '0'; car_control('0');
|
||||
}
|
||||
} else if (*info == 'q') break;
|
||||
}
|
||||
|
||||
for (char *i = img_data; i - img_data < length; i += 4096)
|
||||
naive_free(i);
|
||||
r = ioctl_u(f, VIDIOC_STREAMOFF, &type);
|
||||
printu("Close stream: %d\n", r);
|
||||
munmap_u(img, length);
|
||||
close(f);
|
||||
exit(0);
|
||||
} else {
|
||||
yield();
|
||||
while(1)
|
||||
{
|
||||
char temp = (char)uartgetchar();
|
||||
*info = temp;
|
||||
if(temp == 'q')
|
||||
break;
|
||||
car_control(temp);
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
File diff suppressed because it is too large
Load Diff
Loading…
Reference in new issue