added startup check for pluged periferials
This commit is contained in:
Chris Boudacoff
parent
e4dbe8ed35
commit
f15a7c3035
GPG Key ID:
4AEE18F83AFDEB23
|
|
@ -14,52 +14,23 @@
|
|||
#include <fcntl.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
#include <linux/input.h>
|
||||
#include <signal.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/mman.h>
|
||||
#include <unistd.h>
|
||||
#include <string.h>
|
||||
|
||||
#define SW_AC_IO_BASE 0x01c22c00
|
||||
#define SUNXI_HMIC_STS 0x01c22c00+0x319
|
||||
|
||||
void usage(void)
|
||||
{
|
||||
extern char *program_invocation_short_name;
|
||||
printf("USAGE:\n");
|
||||
printf(" %s /dev/input/eventX\n", program_invocation_short_name);
|
||||
printf("\n");
|
||||
}
|
||||
|
||||
int main (int argc, char **argv)
|
||||
{
|
||||
const char *device = NULL;
|
||||
int fd;
|
||||
struct input_event ie;
|
||||
|
||||
if (!argv[1])
|
||||
{
|
||||
usage();
|
||||
exit(0);
|
||||
}
|
||||
|
||||
device = argv[1];
|
||||
|
||||
if((fd = open(device, O_RDONLY)) == -1)
|
||||
{
|
||||
perror("Could not open input device");
|
||||
exit(255);
|
||||
}
|
||||
|
||||
|
||||
|
||||
while(read(fd, &ie, sizeof(struct input_event)))
|
||||
{
|
||||
printf("type %d\tcode %d\tvalue %d\n", ie.type, ie.code, ie.value);
|
||||
switch (ie.type)
|
||||
{
|
||||
|
||||
case 5: // pluged
|
||||
switch (ie.code) {
|
||||
unsigned long SUNXI_PIO_BASE = 0;
|
||||
void select_mode(char mmsel,char mval){
|
||||
switch (mmsel) {
|
||||
|
||||
case 2: // headphones
|
||||
printf("Headphones: %d\n", ie.value);
|
||||
if (ie.value == 0)
|
||||
// printf("Headphones: %d\n", mval);
|
||||
if (mval == 0)
|
||||
{
|
||||
system("amixer -c 0 set \"External Speaker\" on > /dev/null");
|
||||
system("amixer -c 0 set \"Headphone\" off > /dev/null");
|
||||
|
|
@ -72,8 +43,8 @@ int main (int argc, char **argv)
|
|||
break;
|
||||
|
||||
case 4: // mice
|
||||
printf("Microphone: %d\n", ie.value);
|
||||
if (ie.value == 0)
|
||||
// printf("Microphone: %d\n", mval);
|
||||
if (mval == 0)
|
||||
{
|
||||
system("amixer -c 0 sset \"RADC input Mixer MIC1 boost\" unmute > /dev/null" );
|
||||
system("amixer -c 0 sset \"LADC input Mixer MIC1 boost\" unmute > /dev/null");
|
||||
|
|
@ -97,9 +68,134 @@ int main (int argc, char **argv)
|
|||
}
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
const char *readLine(FILE *file) {
|
||||
|
||||
if (file == NULL) {
|
||||
printf("Error: file pointer is null.");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
int maximumLineLength = 128;
|
||||
char *lineBuffer = (char *)malloc(sizeof(char) * maximumLineLength);
|
||||
|
||||
if (lineBuffer == NULL) {
|
||||
printf("Error allocating memory for line buffer.");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
char ch = getc(file);
|
||||
int count = 0;
|
||||
|
||||
while ((ch != '\n') && (ch != EOF)) {
|
||||
if (count == maximumLineLength) {
|
||||
maximumLineLength += 128;
|
||||
lineBuffer = realloc(lineBuffer, maximumLineLength);
|
||||
if (lineBuffer == NULL) {
|
||||
printf("Error reallocating space for line buffer.");
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
lineBuffer[count] = ch;
|
||||
count++;
|
||||
|
||||
ch = getc(file);
|
||||
}
|
||||
|
||||
lineBuffer[count] = '\0';
|
||||
char line[count + 1];
|
||||
strncpy(line, lineBuffer, (count + 1));
|
||||
free(lineBuffer);
|
||||
const char *constLine = line;
|
||||
return constLine;
|
||||
}
|
||||
int main (int argc, char **argv)
|
||||
{
|
||||
const char *device = NULL;
|
||||
const char *debug;
|
||||
int fd;
|
||||
struct input_event ie;
|
||||
|
||||
FILE *uenv;
|
||||
/*
|
||||
* When started without argument just check for jack and set mixer
|
||||
*/
|
||||
uenv=fopen("/boot/uEnv.txt","r");
|
||||
if (uenv) {
|
||||
while(1)
|
||||
{
|
||||
debug = readLine(uenv);
|
||||
if (strlen(debug)==0) break;
|
||||
if (strcmp(debug,"debug=on")==0) {
|
||||
// device is in debug mode!!!
|
||||
select_mode(2,0);
|
||||
select_mode(4,0);
|
||||
exit(0);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
off_t offset = SUNXI_HMIC_STS;
|
||||
size_t len = 0x01;
|
||||
size_t pagesize = sysconf(_SC_PAGE_SIZE);
|
||||
off_t page_base = (offset / pagesize) * pagesize;
|
||||
off_t page_offset = offset - page_base;
|
||||
|
||||
fd = open("/dev/mem", O_SYNC);
|
||||
unsigned char *mem = mmap(NULL, page_offset + len, PROT_READ | PROT_WRITE, MAP_PRIVATE, fd, page_base);
|
||||
if (mem == MAP_FAILED) {
|
||||
perror("Can't map memory");
|
||||
return -1;
|
||||
}
|
||||
|
||||
if ((int)mem[page_offset] && 0x08) //headset?
|
||||
select_mode(4,1);
|
||||
else
|
||||
select_mode(4,0);
|
||||
if ((int)mem[page_offset] && 0x04) //headphone?
|
||||
select_mode(2,1);
|
||||
else
|
||||
select_mode(2,0);
|
||||
|
||||
close(fd);
|
||||
|
||||
|
||||
if (!argv[1])
|
||||
exit(0);
|
||||
|
||||
|
||||
device = argv[1];
|
||||
|
||||
for (;;)
|
||||
{
|
||||
if((fd = open(device, O_RDONLY)) == -1)
|
||||
{
|
||||
perror("Could not open input device ");
|
||||
exit(255);
|
||||
}
|
||||
|
||||
|
||||
|
||||
while(read(fd, &ie, sizeof(struct input_event))>0)
|
||||
{
|
||||
// printf("type %d\tcode %d\tvalue %d\n", ie.type, ie.code, ie.value);
|
||||
switch (ie.type)
|
||||
{
|
||||
|
||||
case 5: // pluged
|
||||
|
||||
select_mode(ie.code,ie.value);
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
close(fd);
|
||||
usleep(65535u);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
|
|||
Loading…
Reference in New Issue