Skip to content
Snippets Groups Projects
Commit 94729507 authored by Junho Cheong's avatar Junho Cheong
Browse files

Merge branch 'kamgyul' into 'main'

RPI2

See merge request !4
parents 3da053c5 c1e76a3c
No related branches found
No related tags found
1 merge request!4RPI2
......@@ -10,3 +10,9 @@
rfid.c 내부의 server_address[], port를 도서관 개폐부와 연결
make run
```
### RPI 2 (도서관 개폐부)
```
Door.c 내부의 server를 도서관 중앙부에 연결하고, client로 작동하여 server인 상황실과 연결
```
#include <stdio.h>
#include <wiringPi.h>
#include <wiringPiSPI.h>
#include <softPwm.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <stdlib.h>
#include <stdbool.h>
#include <pthread.h>
#include <string.h>
#include <arpa/inet.h>
#include <sys/socket.h>
#define SERVO 1
#define IN 0
#define OUT 1
#define LOW 0
#define HIGH 1
#define POUT_WHITE 4
#define POUT_RED 26
#define VALUE_MAX 40
#define CHANNEL 0 // 아날로그 입력 채널
#define PORT 7777
#define BUF_SIZE 1024
char em[2]="0";
int str_len;
bool press_flag = true;
int servo_command;
int fd;
unsigned char spiData[3];
static int GPIOExport(int pin) {
#define BUFFER_MAX 3
char buffer[BUFFER_MAX];
ssize_t bytes_written;
int fd;
fd = open("/sys/class/gpio/export", O_WRONLY);
if (-1 == fd) {
fprintf(stderr, "Failed to open export for writing!\n");
return(-1);
}
bytes_written = snprintf(buffer, BUFFER_MAX, "%d", pin);
write(fd, buffer, bytes_written);
close(fd);
return(0);
}
static int GPIODirection(int pin, int dir) {
static const char s_directions_str[] = "in\0out";
#define DIRECTION_MAX 35
char path[DIRECTION_MAX];
int fd;
snprintf(path, DIRECTION_MAX, "/sys/class/gpio/gpio%d/direction", pin);
fd = open(path, O_WRONLY);
if (-1 == fd) {
fprintf(stderr, "Failed to open gpio direction for writing!\n");
return(-1);
}
if (-1 == write(fd, &s_directions_str[IN == dir ? 0 : 3], IN == dir ? 2 : 3)) {
fprintf(stderr, "Failed to set direction!\n");
return(-1);
}
close(fd);
return(0);
}
static int GPIOWrite(int pin, int value) {
static const char s_values_str[] = "01";
char path[VALUE_MAX];
int fd;
snprintf(path, VALUE_MAX, "/sys/class/gpio/gpio%d/value", pin);
fd = open(path, O_WRONLY);
if (-1 == fd) {
fprintf(stderr, "Failed to open gpio value for writing!\n");
return(-1);
}
if (1 != write(fd, &s_values_str[LOW == value ? 0 : 1], 1)) {
fprintf(stderr, "Failed to write value!\n");
return(-1);
}
close(fd);
return(0);
}
static int GPIOUnexport(int pin) {
char buffer[BUFFER_MAX];
ssize_t bytes_written;
int fd;
fd = open("/sys/class/gpio/unexport", O_WRONLY);
if (-1 == fd) {
fprintf(stderr, "Failed to open unexport for writing!\n");
return(-1);
}
bytes_written = snprintf(buffer, BUFFER_MAX, "%d", pin);
write(fd, buffer, bytes_written);
close(fd);
return(0);
}
static int GPIORead(int pin){
char path[VALUE_MAX];
char value_str[3];
int fd;
snprintf(path, VALUE_MAX, "/sys/class/gpio/gpio%d/value", pin);
fd = open(path, O_RDONLY);
if(-1 == fd){
fprintf(stderr, "Failed to open gpio value for reading!\n");
return(-1);
}
if(-1 == read(fd, value_str, 3)) {
fprintf(stderr, "Failed to read value!\n");
close(fd);
return(-1);
}
close(fd);
return(atoi(value_str));
}
void error_handling(char *message){
fputs(message,stderr);
fputc('\n',stderr);
exit(1);
}
static int servoControl(void) {
//Enable GPIO pins
if (-1 == GPIOExport (POUT_WHITE))
return(1);
//Set GPIO directions
if (-1 == GPIODirection(POUT_WHITE, OUT))
return(2);
float dir = 0.1;
float pos = 0;
softPwmCreate(SERVO, 0, 200);
printf("Servo Control Start\n");
GPIOWrite(POUT_WHITE, HIGH);
while (pos < 90) {
pos += dir;
softPwmWrite(SERVO, pos);
delay(10);
}
printf("Door Open\n");
for (int i = 5; i > 0; i--) {
printf("문이 닫히기 까지 %d초 남았습니다.\n", i);
delay(1000);
}
while (pos > 0) {
pos -= dir;
softPwmWrite(SERVO, pos);
delay(10);
}
printf("\nDoor Close\n");
GPIOWrite(POUT_WHITE, LOW);
printf("end Servo\n");
return 0;
}
static int forcedOpen (void* arg) {
int sock = (int)arg;
printf("문이 강제 개방되었습니다!!\n");
printf("문을 닫아주세요.\n");
//Enable GPIO pins
if (-1 == GPIOExport (POUT_RED))
return(1);
//Set GPIO directions
if (-1 == GPIODirection(POUT_RED, OUT))
return(2);
GPIOWrite(POUT_RED, HIGH);
write(sock, em, sizeof(em));
while(1) {
char received_command[2];
read(sock, received_command, sizeof(received_command));
if (atoi(received_command) == 2)
break;
}
printf("\n문열림 상황 종료\n");
GPIOWrite(POUT_RED, LOW);
return 0;
}
void *pressValuePrint (void *arg) {
while(1) {
while(press_flag) {
spiData[0] = 0x01; // Start bit (항상 같음)
spiData[1] = ((CHANNEL+8)<<4); // Channel 선택 (0~7)
spiData[2] = 0x00; // Don't care (항상 같음)
wiringPiSPIDataRW(CHANNEL, spiData, 3); // SPI 통신으로 데이터 수신
int adcValue = ((spiData[1]&3) << 8) + spiData[2]; // 아날로그 값 계산
printf("ADC value: %d\n", adcValue);
delay(3000);
if (adcValue < 10 && press_flag) {
forcedOpen(arg);
printf("forced open situation finished!!\n");
}
}
}
}
void *pressCheck (void *arg) {
char msg[2];
int serv_sock, clnt_sock =1;
struct sockaddr_in serv_addr, clnt_addr;
socklen_t clnt_addr_size;
// 서버 소켓 생성
serv_sock = socket(PF_INET, SOCK_STREAM, 0);
if (serv_sock == -1)
error_handling("socket() error");
// 서버 소켓 주소 설정
memset(&serv_addr, 0, sizeof(serv_addr));
serv_addr.sin_family = AF_INET;
serv_addr.sin_addr.s_addr = htonl(INADDR_ANY);
serv_addr.sin_port = htons(atoi("7777"));
// 서버 소켓에 주소 바인딩
if (bind(serv_sock, (struct sockaddr*)&serv_addr, sizeof(serv_addr)) == -1)
error_handling("bind() error");
// 클라이언트 연결을 수락
if (listen(serv_sock, 5) == -1)
error_handling("listen() error");
while(1) {
clnt_addr_size = sizeof(clnt_addr);
clnt_sock = accept(serv_sock, (struct sockaddr*)&clnt_addr, &clnt_addr_size);
if (clnt_sock == -1)
error_handling("accept() error");
char received_command[2];
read(clnt_sock, received_command, sizeof(received_command));
servo_command = atoi(received_command);
if (servo_command == 1) {
press_flag = false;
servoControl();
press_flag = true;
}
servo_command = 0;
}
}
int main(int argc, char *argv[]) {
char msg[2];
int serv_sock, clnt_sock;
struct sockaddr_in serv_addr, clnt_addr;
socklen_t clnt_addr_size;
memset(&serv_addr, 0, sizeof(serv_addr));
serv_addr.sin_family = AF_INET;
serv_addr.sin_addr.s_addr = inet_addr(argv[1]);
serv_addr.sin_port = htons(atoi(argv[2]));
// 상황실 클라이언트 소켓 세팅
clnt_sock = socket(PF_INET, SOCK_STREAM, 0);
if (clnt_sock == -1)
error_handling("socket() error");
// 서버 연결 시도
if (connect(clnt_sock, (struct sockaddr*)&serv_addr, sizeof(serv_addr)) == -1)
error_handling("connect() error");
pthread_t t_press, t_press_check;
fd = wiringPiSPISetup(CHANNEL, 1000000);
if(fd == -1) {
printf("SPI setup failed!");
return 2;
}
if (wiringPiSetup() == -1) {
printf("Wiring Pi setup failed!");
return -1;
}
pthread_create(&t_press, NULL, pressValuePrint, (void*)clnt_sock);
pthread_create(&t_press_check, NULL, pressCheck, NULL);
pthread_join(t_press, NULL);
pthread_join(t_press_check, NULL);
close(clnt_sock);
return 0;
}
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment