axehelper: add possibility to change demod registers (i2c_demod_reg_read,i2c_demod_reg_write)
This commit is contained in:
Jaroslav Kysela
parent
7634ebccd6
commit
a6932fe5b0
2
Makefile
2
Makefile
@ -139,7 +139,7 @@ kernel: kernel/arch/sh/boot/uImage.gz
|
||||
|
||||
.PHONY: kernel-mrproper
|
||||
kernel-mrproper:
|
||||
make -C kernel ARCH=sh CROSS_COMPILE=$(TOOLCHAIN_KERNEL)/bin/sh4-linux- mrproper
|
||||
make -C kernel -k ${CPUS} ARCH=sh CROSS_COMPILE=$(TOOLCHAIN_KERNEL)/bin/sh4-linux- mrproper
|
||||
|
||||
define RPM_UNPACK
|
||||
@mkdir -p $(1)
|
||||
|
||||
@ -19,3 +19,6 @@ Possible steps:
|
||||
- write own axe-fe module ? because nothing else depends on it,
|
||||
it could be replaced, the only big thing is to determine the i2c
|
||||
connection to STx7018
|
||||
|
||||
Checking STV0900 registers:
|
||||
|
||||
|
||||
@ -10,6 +10,8 @@
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/i2c-dev.h>
|
||||
|
||||
typedef unsigned char u8;
|
||||
|
||||
static unsigned long
|
||||
getTick ()
|
||||
{
|
||||
@ -275,51 +277,123 @@ i2c_decoder(void)
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
i2c_scan(void)
|
||||
static int i2c_fd = -1;
|
||||
|
||||
static int
|
||||
i2c_open(int num, char *_path)
|
||||
{
|
||||
int i, fd, l;
|
||||
char path[32];
|
||||
unsigned char buf1[16], buf2[16];
|
||||
if (num < 8)
|
||||
sprintf(path, "/dev/i2c-%d", num);
|
||||
else
|
||||
strcpy(path, "/dev/axe/i2c_drv-0");
|
||||
i2c_fd = open(path, O_RDWR);
|
||||
if (i2c_fd < 0)
|
||||
return -1;
|
||||
if (_path)
|
||||
strcpy(_path, path);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int
|
||||
i2c_open_check(void)
|
||||
{
|
||||
if (i2c_fd >= 0)
|
||||
return 0;
|
||||
if (i2c_open(0, NULL)) {
|
||||
printf("Unable to open i2c device\n");
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int
|
||||
i2c_demod_reg_read(int addr, int reg, u8 *buf, int cnt)
|
||||
{
|
||||
u8 buf1[3];
|
||||
struct i2c_rdwr_ioctl_data d;
|
||||
struct i2c_msg m[2];
|
||||
|
||||
for (i = 0; i < 9; i++) {
|
||||
if (i < 8)
|
||||
sprintf(path, "/dev/i2c-%d", i);
|
||||
else
|
||||
strcpy(path, "/dev/axe/i2c_drv-0");
|
||||
fd = open(path, O_RDWR);
|
||||
if (fd < 0)
|
||||
continue;
|
||||
printf("read addr 0x%x reg 0x%x cnt %i\n", addr, reg, cnt);
|
||||
|
||||
if (i2c_open_check())
|
||||
return -1;
|
||||
|
||||
memset(&d, 0, sizeof(d));
|
||||
memset(&m, 0, sizeof(m));
|
||||
memset(buf1, 0, sizeof(buf1));
|
||||
memset(buf2, 0, sizeof(buf2));
|
||||
memset(buf, 0, cnt);
|
||||
|
||||
buf1[0] = 0xd0 >> 1;
|
||||
buf1[1] = 0xf1;
|
||||
buf1[2] = 0x00;
|
||||
l = 2;
|
||||
buf1[0] = reg >> 8;
|
||||
buf1[1] = reg;
|
||||
|
||||
m[0].addr = buf1[0];
|
||||
m[0].len = l;
|
||||
m[0].addr = addr >> 1;
|
||||
m[0].len = 2;
|
||||
m[0].flags = 0;
|
||||
m[0].buf = buf1 + 1;
|
||||
m[0].buf = buf1;
|
||||
|
||||
m[1].addr = buf1[0];
|
||||
m[1].len = 1;
|
||||
m[1].addr = addr >> 1;
|
||||
m[1].len = cnt;
|
||||
m[1].flags = I2C_M_RD;
|
||||
m[1].buf = buf2;
|
||||
m[1].buf = buf;
|
||||
|
||||
d.nmsgs = 2;
|
||||
d.msgs = m;
|
||||
if (ioctl(fd, I2C_RDWR, &d) < 0)
|
||||
printf("I2C RDWR failed for '%s'\n", path);
|
||||
else
|
||||
printf("I2C byte from '%s': %02x\n", path, buf2[0]);
|
||||
close(fd);
|
||||
if (ioctl(i2c_fd, I2C_RDWR, &d) < 0) {
|
||||
printf("I2C RDWR failed for addr 0x%x\n", addr);
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int
|
||||
i2c_demod_reg_write(int addr, int reg, u8 *buf, int cnt)
|
||||
{
|
||||
u8 buf1[32];
|
||||
struct i2c_rdwr_ioctl_data d;
|
||||
struct i2c_msg m[2];
|
||||
|
||||
if (i2c_open_check())
|
||||
return -1;
|
||||
|
||||
memset(&d, 0, sizeof(d));
|
||||
memset(&m, 0, sizeof(m));
|
||||
memset(buf1, 0, sizeof(buf1));
|
||||
|
||||
buf1[0] = reg >> 8;
|
||||
buf1[1] = reg;
|
||||
memcpy(buf1 + 2, buf, cnt);
|
||||
|
||||
m[0].addr = addr >> 1;
|
||||
m[0].len = 2 + cnt;
|
||||
m[0].flags = 0;
|
||||
m[0].buf = buf1;
|
||||
|
||||
d.nmsgs = 1;
|
||||
d.msgs = m;
|
||||
if (ioctl(i2c_fd, I2C_RDWR, &d) < 0) {
|
||||
printf("I2C RDWR failed for addr 0x%x\n", addr);
|
||||
return -1;
|
||||
}
|
||||
return cnt;
|
||||
}
|
||||
|
||||
static void
|
||||
i2c_scan(void)
|
||||
{
|
||||
int i, a, r;
|
||||
u8 v;
|
||||
char path[32];
|
||||
|
||||
for (i = 0; i < 9; i++) {
|
||||
if (i2c_open(i, path))
|
||||
continue;
|
||||
a = 0xd0;
|
||||
r = i2c_demod_reg_read(a, 0xf000, &v, 1);
|
||||
if (r >= 0)
|
||||
printf("I2C read succeed for %s, addr 0x%02x: 0x%02x\n", path, a, r);
|
||||
close(i2c_fd);
|
||||
i2c_fd = -1;
|
||||
}
|
||||
}
|
||||
|
||||
@ -345,5 +419,43 @@ int main(int argc, char *argv[])
|
||||
if (argc > 1 && !strcmp(argv[1], "i2c_scan")) {
|
||||
i2c_scan();
|
||||
}
|
||||
if (argc > 1 && !strcmp(argv[1], "i2c_demod_reg_read")) {
|
||||
if (argc > 3) {
|
||||
int i;
|
||||
int a = strtol(argv[2], NULL, 0);
|
||||
int r = strtol(argv[3], NULL, 0);
|
||||
int c = argc > 4 ? strtol(argv[4], NULL, 0) : 1;
|
||||
u8 buf[16];
|
||||
if (a > 0 && r > 0) {
|
||||
i = i2c_demod_reg_read(a, r, buf, c > sizeof(buf) ? sizeof(buf) : c);
|
||||
if (i < 0)
|
||||
printf("Unable to read register 0x%x from addr 0x%x\n", r, a);
|
||||
else {
|
||||
for (r = 0; r < i; r++)
|
||||
printf("%s0x%02x", r > 0 ? ":" : "", buf[i]);
|
||||
exit(EXIT_SUCCESS);
|
||||
}
|
||||
}
|
||||
}
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
if (argc > 1 && !strcmp(argv[1], "i2c_demod_reg_write")) {
|
||||
if (argc > 4) {
|
||||
int i, j;
|
||||
int a = strtol(argv[2], NULL, 0);
|
||||
int r = strtol(argv[3], NULL, 0);
|
||||
u8 buf[16];
|
||||
for (j = 4; j < argc && j < sizeof(buf) + 4; j++)
|
||||
buf[j-4] = strtol(argv[j], NULL, 0);
|
||||
if (a > 0 && r > 0) {
|
||||
i = i2c_demod_reg_write(a, r, buf, j);
|
||||
if (i < 0)
|
||||
printf("Unable to write register 0x%x to addr 0x%x\n", r, a);
|
||||
else
|
||||
exit(EXIT_SUCCESS);
|
||||
}
|
||||
}
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue
Block a user