mirror of
git://projects.qi-hardware.com/f32xbase.git
synced 2025-04-21 12:27:27 +03:00
Moved C2 bitbang functions from c2-om.c to (#included) c2-bitbang.c
- f32x/c2-om.c: renamed C2 bitbang functions from om_* to c2_* - f32x/c2-om.c, f32x/c2-bitbang.c: moved most of the content of c2-om.c to c2-bitbang.c and #include c2-bitbang.c - f32x/Makefile: c2-om.o depends on c2-bitbang.c now
This commit is contained in:
122
f32x/c2-om.c
122
f32x/c2-om.c
@@ -27,125 +27,17 @@
|
||||
#define C2D 4, 13 /* E12 = SPI_CLK0 */
|
||||
|
||||
|
||||
/* ----- Bit-level operations ---------------------------------------------- */
|
||||
|
||||
|
||||
static void c2_pulse(void)
|
||||
{
|
||||
gpio_low(C2CK);
|
||||
gpio_high(C2CK);
|
||||
}
|
||||
|
||||
|
||||
static void c2_send(uint32_t value, int bits)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i != bits; i++) {
|
||||
gpio_set(C2D, (value >> i) & 1);
|
||||
c2_pulse();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static uint32_t c2_recv(int bits)
|
||||
{
|
||||
uint32_t v = 0;
|
||||
int i;
|
||||
|
||||
for (i = 0; i != bits; i++) {
|
||||
v |= gpio_get(C2D) << i;
|
||||
c2_pulse();
|
||||
}
|
||||
return v;
|
||||
}
|
||||
|
||||
|
||||
/* ----- C2 Register read/write -------------------------------------------- */
|
||||
|
||||
|
||||
static void om_addr_write(uint8_t addr)
|
||||
{
|
||||
c2_pulse();
|
||||
gpio_output(C2D);
|
||||
c2_send(C2_ADDR_WRITE, 2);
|
||||
c2_send(addr, 8);
|
||||
gpio_input(C2D);
|
||||
c2_pulse();
|
||||
}
|
||||
|
||||
|
||||
static uint8_t om_addr_read(void)
|
||||
{
|
||||
c2_pulse();
|
||||
gpio_output(C2D);
|
||||
c2_send(C2_ADDR_READ, 2);
|
||||
gpio_input(C2D);
|
||||
c2_pulse();
|
||||
return c2_recv(8);
|
||||
}
|
||||
|
||||
|
||||
static void om_data_write(uint32_t data, int bytes)
|
||||
{
|
||||
c2_pulse();
|
||||
gpio_output(C2D);
|
||||
c2_send(C2_DATA_WRITE, 2);
|
||||
c2_send(bytes-1, 2);
|
||||
c2_send(data, 8*bytes);
|
||||
gpio_input(C2D);
|
||||
c2_pulse();
|
||||
while (!c2_recv(1));
|
||||
}
|
||||
|
||||
|
||||
static uint32_t om_data_read(int bytes)
|
||||
{
|
||||
c2_pulse();
|
||||
gpio_output(C2D);
|
||||
c2_send(C2_DATA_READ, 2);
|
||||
c2_send(bytes-1, 2);
|
||||
gpio_input(C2D);
|
||||
c2_pulse();
|
||||
while (!c2_recv(1));
|
||||
return c2_recv(8*bytes);
|
||||
}
|
||||
|
||||
|
||||
/* ----- C2 initialization ------------------------------------------------- */
|
||||
|
||||
|
||||
static void om_init(void)
|
||||
{
|
||||
gpio_init();
|
||||
gpio_input(C2D);
|
||||
gpio_output(C2CK);
|
||||
gpio_low(C2CK);
|
||||
usleep(20);
|
||||
gpio_high(C2CK);
|
||||
usleep(2);
|
||||
}
|
||||
|
||||
|
||||
static void om_reset(void)
|
||||
{
|
||||
gpio_input(C2D);
|
||||
gpio_low(C2CK);
|
||||
usleep(20);
|
||||
// gpio_input(C2CK);
|
||||
gpio_output(C2CK);
|
||||
gpio_high(C2CK);
|
||||
}
|
||||
#include "c2-bitbang.c"
|
||||
|
||||
|
||||
/* ----- Operations -------------------------------------------------------- */
|
||||
|
||||
|
||||
struct c2_ops c2_om = {
|
||||
.init = om_init,
|
||||
.reset = om_reset,
|
||||
.addr_write = om_addr_write,
|
||||
.addr_read = om_addr_read,
|
||||
.data_write = om_data_write,
|
||||
.data_read = om_data_read,
|
||||
.init = c2_init,
|
||||
.reset = c2_reset,
|
||||
.addr_write = c2_addr_write,
|
||||
.addr_read = c2_addr_read,
|
||||
.data_write = c2_data_write,
|
||||
.data_read = c2_data_read,
|
||||
};
|
||||
|
||||
Reference in New Issue
Block a user