1st Version with ECAL
This commit is contained in:
1057
__logicsample/backend.c
Normal file
1057
__logicsample/backend.c
Normal file
File diff suppressed because it is too large
Load Diff
204
__logicsample/keyboard.c
Normal file
204
__logicsample/keyboard.c
Normal file
@@ -0,0 +1,204 @@
|
||||
/*
|
||||
* <Description>
|
||||
*
|
||||
* Copyright (C) 2018, STMicroelectronics - All Rights Reserved
|
||||
* Author: YOUR NAME <> for STMicroelectronics.
|
||||
*
|
||||
* License type: GPLv2
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License version 2 as published by
|
||||
* the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful, but
|
||||
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
||||
* or FITNESS FOR A PARTICULAR PURPOSE.
|
||||
* See the GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along with
|
||||
* this program. If not, see
|
||||
* <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <signal.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <unistd.h>
|
||||
#include <fcntl.h>
|
||||
#include <linux/gpio.h>
|
||||
#include <pthread.h>
|
||||
|
||||
#define USER_GPIO_OFFSET 13
|
||||
|
||||
int running = 0;
|
||||
int gpio13_pressed = 0;
|
||||
int gpio14_pressed = 0;
|
||||
static pthread_t thread_ioctl1;
|
||||
static pthread_t thread_ioctl2;
|
||||
pthread_mutex_t keybMutex;
|
||||
struct gpioevent_request ereq1, ereq2;
|
||||
struct gpioevent_data event1, event2;
|
||||
|
||||
static void sleep_ms(int milliseconds)
|
||||
{
|
||||
usleep(milliseconds * 1000);
|
||||
}
|
||||
|
||||
/***************** configure_userbutton ***************************/
|
||||
int configure_userbutton(struct gpioevent_request *ereq, int offset)
|
||||
{
|
||||
char chrdev_name[20];
|
||||
int fd,ret;
|
||||
|
||||
strcpy(chrdev_name, "/dev/gpiochip0");
|
||||
|
||||
/* Open device: gpiochip0 for GPIO bank A */
|
||||
fd = open(chrdev_name, 0);
|
||||
|
||||
if (fd == -1) {
|
||||
ret = -errno;
|
||||
fprintf(stderr, "Failed to open %s\n", chrdev_name);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* request GPIO line for Button activation*/
|
||||
memset(ereq,0,sizeof(struct gpioevent_request));
|
||||
ereq->lineoffset = offset;
|
||||
ereq->handleflags = GPIOHANDLE_REQUEST_INPUT;
|
||||
ereq->eventflags = GPIOEVENT_EVENT_FALLING_EDGE;
|
||||
sprintf(ereq->consumer_label, "User PA%02d", offset);
|
||||
|
||||
ret = ioctl(fd, GPIO_GET_LINEEVENT_IOCTL, ereq);
|
||||
if (ret == -1) {
|
||||
ret = -errno;
|
||||
fprintf(stderr, "Failed to issue GET event1 IOCTL (%d)\n",ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
close(fd);
|
||||
return 0;
|
||||
}
|
||||
|
||||
void *ioctl1_thread(void *arg)
|
||||
{
|
||||
int ret;
|
||||
while (1) {
|
||||
/* read User button input event1 */
|
||||
ret = read(ereq1.fd, &event1, sizeof(event1));
|
||||
if (ret == -1) {
|
||||
if (errno == -EAGAIN) {
|
||||
fprintf(stderr, "nothing available\n");
|
||||
continue;
|
||||
} else {
|
||||
ret = -errno;
|
||||
fprintf(stderr, "Failed to read event1 (%d)\n",ret);
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (ret != sizeof(event1)) {
|
||||
fprintf(stderr, "Reading event1 failed\n");
|
||||
ret = -EIO;
|
||||
break;
|
||||
}
|
||||
|
||||
/* process the event1 received */
|
||||
switch (event1.id) {
|
||||
case GPIOEVENT_EVENT_FALLING_EDGE:
|
||||
printf("GPIO13 GPIOEVENT_EVENT_FALLING_EDGE\n");
|
||||
pthread_mutex_lock(&keybMutex);
|
||||
gpio13_pressed = 1;
|
||||
pthread_mutex_unlock(&keybMutex);
|
||||
break;
|
||||
default:
|
||||
fprintf(stdout, "unknown event1\n");
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void *ioctl2_thread(void *arg)
|
||||
{
|
||||
int ret;
|
||||
while (1) {
|
||||
/* read User button input event2 */
|
||||
ret = read(ereq2.fd, &event2, sizeof(event2));
|
||||
if (ret == -1) {
|
||||
if (errno == -EAGAIN) {
|
||||
fprintf(stderr, "nothing available\n");
|
||||
continue;
|
||||
} else {
|
||||
ret = -errno;
|
||||
fprintf(stderr, "Failed to read event2 (%d)\n",ret);
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (ret != sizeof(event2)) {
|
||||
fprintf(stderr, "Reading event2 failed\n");
|
||||
ret = -EIO;
|
||||
break;
|
||||
}
|
||||
|
||||
/* process the event2 received */
|
||||
switch (event2.id) {
|
||||
case GPIOEVENT_EVENT_FALLING_EDGE:
|
||||
printf("GPIO14 GPIOEVENT_EVENT_FALLING_EDGE\n");
|
||||
pthread_mutex_lock(&keybMutex);
|
||||
gpio14_pressed = 1;
|
||||
pthread_mutex_unlock(&keybMutex);
|
||||
break;
|
||||
default:
|
||||
fprintf(stdout, "unknown event2\n");
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
int main(int argc, char **argv)
|
||||
{
|
||||
int ret=0;
|
||||
|
||||
printf("read keyb event thread\n");
|
||||
|
||||
if ((getuid ()) != 0) {
|
||||
fprintf(stderr, "You are not root! This may not work...\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* configure USER button */
|
||||
if (configure_userbutton(&ereq1, 14) < 0){
|
||||
perror("GPIO_A14 export issue");
|
||||
goto quit;
|
||||
}
|
||||
if (configure_userbutton(&ereq2, 13) < 0){
|
||||
perror("GPIO_A13 export issue");
|
||||
goto quit;
|
||||
}
|
||||
if (pthread_create( &thread_ioctl1, NULL, ioctl1_thread, NULL) != 0) {
|
||||
printf("greio_receiver_thread creation fails\n");
|
||||
goto quit;
|
||||
}
|
||||
if (pthread_create( &thread_ioctl2, NULL, ioctl2_thread, NULL) != 0) {
|
||||
printf("greio_receiver_thread creation fails\n");
|
||||
goto quit;
|
||||
}
|
||||
pthread_mutex_init(&keybMutex, NULL);
|
||||
|
||||
while(1) {
|
||||
sleep_ms(1);
|
||||
pthread_mutex_lock(&keybMutex);
|
||||
if (gpio13_pressed) {
|
||||
gpio13_pressed = 0;
|
||||
system("/usr/local/demo/la/run_la.sh");
|
||||
} else if (gpio14_pressed) {
|
||||
gpio14_pressed = 0;
|
||||
system("/usr/local/demo/la/run_la.sh");
|
||||
}
|
||||
pthread_mutex_unlock(&keybMutex);
|
||||
}
|
||||
return EXIT_SUCCESS;
|
||||
|
||||
quit:
|
||||
return 0;
|
||||
}
|
||||
64
__logicsample/testMQ.c
Normal file
64
__logicsample/testMQ.c
Normal file
@@ -0,0 +1,64 @@
|
||||
#include <boost/interprocess/ipc/message_queue.hpp>
|
||||
#include <iostream>
|
||||
#include <iomanip>
|
||||
|
||||
namespace bip = boost::interprocess;
|
||||
using MQ = bip::message_queue;
|
||||
|
||||
template<size_t N>
|
||||
static inline void safe_copy(std::array<char, N>& dst, std::string_view src) {
|
||||
std::copy_n(src.data(), std::min(src.size(), N), dst.data());
|
||||
dst.back() = 0; // make sure of NUL termination
|
||||
}
|
||||
|
||||
struct AccessQueue {
|
||||
std::array<char, 64> name{0};
|
||||
std::array<char, 64> action{0};
|
||||
|
||||
AccessQueue(std::string_view n = "", std::string_view a = "") {
|
||||
safe_copy(name, n);
|
||||
safe_copy(action, a);
|
||||
}
|
||||
};
|
||||
|
||||
static_assert(std::is_standard_layout_v<AccessQueue>);
|
||||
|
||||
struct X {
|
||||
void send() {
|
||||
AccessQueue packet("asd", "vsq");
|
||||
try {
|
||||
mq.send(&packet, sizeof(packet), 0);
|
||||
} catch(std::exception const & ex) {
|
||||
std::cout << ex.what() << std::endl;
|
||||
}
|
||||
}
|
||||
|
||||
AccessQueue receive() {
|
||||
AccessQueue retval;
|
||||
|
||||
report();
|
||||
try {
|
||||
unsigned int priority;
|
||||
MQ::size_type recvd_size;
|
||||
mq.try_receive(&retval, sizeof(AccessQueue), recvd_size, priority);
|
||||
} catch(std::exception const & ex) {
|
||||
std::cout << ex.what() << std::endl;
|
||||
}
|
||||
report();
|
||||
return retval;
|
||||
}
|
||||
|
||||
void report() {
|
||||
std::cout << mq.get_num_msg() << "\t" << mq.get_max_msg_size() << "\t" << mq.get_max_msg() << std::endl;
|
||||
}
|
||||
|
||||
MQ mq { bip::open_or_create, "somequeue", 10, sizeof(AccessQueue) };
|
||||
};
|
||||
|
||||
int main() {
|
||||
X tryit;
|
||||
tryit.send();
|
||||
auto const& [name, action] = tryit.receive();
|
||||
|
||||
std::cout << std::quoted(name.data()) << " " << std::quoted(action.data()) << std::endl;
|
||||
}
|
||||
Reference in New Issue
Block a user