Exemplo n.º 1
0
static int l3g4200d_read(lua_State* L) {

    uint8_t data[6];
    int x,y,z;
    int i;

    platform_i2c_send_start(i2c_id);
    platform_i2c_send_address(i2c_id, i2c_addr, PLATFORM_I2C_DIRECTION_TRANSMITTER);
    platform_i2c_send_byte(i2c_id, 0xA8);
    platform_i2c_send_start(i2c_id);
    platform_i2c_send_address(i2c_id, i2c_addr, PLATFORM_I2C_DIRECTION_RECEIVER);

    for (i=0; i<5; i++) {
	data[i] = platform_i2c_recv_byte(i2c_id, 1);
    }

    data[5] = platform_i2c_recv_byte(i2c_id, 0);

    platform_i2c_send_stop(i2c_id);

    x = (int16_t) ((data[1] << 8) | data[0]);
    y = (int16_t) ((data[3] << 8) | data[2]);
    z = (int16_t) ((data[5] << 8) | data[4]);

    lua_pushinteger(L, x);
    lua_pushinteger(L, y);
    lua_pushinteger(L, z);

    return 3;
}
int16_t accelerometer_readSigned16(int reg) {

	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, ADXL345_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
	platform_i2c_send_byte(endpoint_id, reg);
	platform_i2c_send_stop(endpoint_id);

	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, ADXL345_ADDRESS, PLATFORM_I2C_DIRECTION_RECEIVER);
	uint8_t b0 = platform_i2c_recv_byte(endpoint_id, 1);
	uint8_t b1 = platform_i2c_recv_byte(endpoint_id, 0);
	platform_i2c_send_stop(endpoint_id);

	uint16_t output = (b1 << 8) | b0;

	int16_t output2 = comm_fromUnsigned16(output);
	/*
	if (output < 32767)
		output2 = + (int)output;
	else
		output2 = - (int)(65536 - output);
	*/

	return output2;
}
void orient_update() {

	updateinterval ++;

	if (updateinterval % 20 == 0) {
		int16_t ax = accelerometer_readSigned16(ADXL345_REG_DATAX0);
		int16_t ay = accelerometer_readSigned16(ADXL345_REG_DATAY0);
		int16_t az = accelerometer_readSigned16(ADXL345_REG_DATAZ0);

		if (ax != last_ax ||
			ay != last_ay ||
			az != last_az) {

			comm_send_acceleration(ax, ay, az);

			last_ax = ax;
			last_ay = ay;
			last_az = az;
		}
	}

	if (updateinterval % 3 == 1) {

		platform_i2c_send_start(endpoint_id);
		platform_i2c_send_address(endpoint_id, L3GD20_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
		platform_i2c_send_byte(endpoint_id, L3GD20_REGISTER_OUT_X_L | 0x80);
		platform_i2c_send_stop(endpoint_id);

		platform_i2c_send_start(endpoint_id);
		platform_i2c_send_address(endpoint_id, L3GD20_ADDRESS, PLATFORM_I2C_DIRECTION_RECEIVER);
		uint8_t b0 = platform_i2c_recv_byte(endpoint_id, 1);
		uint8_t b1 = platform_i2c_recv_byte(endpoint_id, 1);
		uint8_t b2 = platform_i2c_recv_byte(endpoint_id, 1);
		uint8_t b3 = platform_i2c_recv_byte(endpoint_id, 1);
		uint8_t b4 = platform_i2c_recv_byte(endpoint_id, 1);
		uint8_t b5 = platform_i2c_recv_byte(endpoint_id, 0);
		platform_i2c_send_stop(endpoint_id);

		int16_t gx = comm_fromUnsigned16((b1 << 8) | b0);
		int16_t gy = comm_fromUnsigned16((b3 << 8) | b2);
		int16_t gz = comm_fromUnsigned16((b5 << 8) | b4);

		acc_gx = ((acc_gx * 3) / 4) + (gx / 4);
		acc_gy = ((acc_gy * 3) / 4) + (gy / 4);
		acc_gz = ((acc_gz * 3) / 4) + (gz / 4);
	}

	if (updateinterval % 20 == 10) {
		if (acc_gx != last_gx ||
			acc_gy != last_gy ||
			acc_gz != last_gz) {

			comm_send_rotation(acc_gx, acc_gy, acc_gz);

			last_gx = acc_gx;
			last_gy = acc_gy;
			last_gz = acc_gz;
		}
	}
}
Exemplo n.º 4
0
static uint8_t r8u(uint32_t id, uint8_t reg) {
    uint8_t ret;

    platform_i2c_send_start(id);
    platform_i2c_send_address(id, i2c_addr, PLATFORM_I2C_DIRECTION_TRANSMITTER);
    platform_i2c_send_byte(id, reg);
    platform_i2c_send_stop(id);
    platform_i2c_send_start(id);
    platform_i2c_send_address(id, i2c_addr, PLATFORM_I2C_DIRECTION_RECEIVER);
    ret = platform_i2c_recv_byte(id, 0);
    platform_i2c_send_stop(id);
    return ret;
}
uint8_t gyro_read_all(int reg) {
	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, L3GD20_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
	platform_i2c_send_byte(endpoint_id, reg);
	platform_i2c_send_stop(endpoint_id);

	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, L3GD20_ADDRESS, PLATFORM_I2C_DIRECTION_RECEIVER);
	uint8_t b0 = platform_i2c_recv_byte(endpoint_id, 0);
	platform_i2c_send_stop(endpoint_id);

	return b0;
}
void accelerometer_start() {
	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, ADXL345_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
	platform_i2c_send_byte(endpoint_id, ADXL345_REG_POWER_CTL);
	platform_i2c_send_byte(endpoint_id, 0x08);
	platform_i2c_send_stop(endpoint_id);

	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, ADXL345_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
	platform_i2c_send_byte(endpoint_id, ADXL345_REG_BW_RATE);
	platform_i2c_send_byte(endpoint_id, ADXL345_DATARATE_50_HZ);
	platform_i2c_send_stop(endpoint_id);
}
Exemplo n.º 7
0
static void w8u(uint32_t id, uint8_t reg, uint8_t val) {
    platform_i2c_send_start(i2c_id);
    platform_i2c_send_address(i2c_id, i2c_addr, PLATFORM_I2C_DIRECTION_TRANSMITTER);
    platform_i2c_send_byte(i2c_id, reg);
    platform_i2c_send_byte(i2c_id, val);
    platform_i2c_send_stop(i2c_id);
}
Exemplo n.º 8
0
static uint8_t do_i2c_start(uint8_t id, uint8_t sla)
{
    platform_i2c_send_start( id );

    // ignore return value -> tolerate missing ACK
    platform_i2c_send_address( id, sla, PLATFORM_I2C_DIRECTION_TRANSMITTER );

    return 1;
}
irom static uint8_t do_i2c_start(uint8_t sla)
{
	platform_i2c_send_start();

	// ignore return value -> tolerate missing ACK
	platform_i2c_send_address(sla);

	return 1;
}
Exemplo n.º 10
0
// Lua: i2c.address( id, address, direction )
static int i2c_address( lua_State *L )
{
  unsigned id = luaL_checkinteger( L, 1 );
  u16 address = ( u16 )luaL_checkinteger( L, 2 );
  int direction = luaL_checkinteger( L, 3 );

  MOD_CHECK_ID( i2c, id );
  lua_pushboolean( L, platform_i2c_send_address( id, address, direction ) );
  return 1;
}
Exemplo n.º 11
0
void gyro_start() {
	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, L3GD20_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
	platform_i2c_send_byte(endpoint_id, L3GD20_REGISTER_CTRL_REG1);
	platform_i2c_send_byte(endpoint_id, 0x0F);
	platform_i2c_send_stop(endpoint_id);

	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, L3GD20_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
	platform_i2c_send_byte(endpoint_id, L3GD20_REGISTER_CTRL_REG2);
	platform_i2c_send_byte(endpoint_id, 0x08);
	platform_i2c_send_stop(endpoint_id);

	platform_i2c_send_start(endpoint_id);
	platform_i2c_send_address(endpoint_id, L3GD20_ADDRESS, PLATFORM_I2C_DIRECTION_TRANSMITTER);
	platform_i2c_send_byte(endpoint_id, L3GD20_REGISTER_CTRL_REG4);
	platform_i2c_send_byte(endpoint_id, 0x00);
	platform_i2c_send_stop(endpoint_id);

}
Exemplo n.º 12
0
// Lua: i2c.address( id, address, direction )
static int i2c_address( lua_State *L )
{
  unsigned id = luaL_checkinteger( L, 1 );
  int address = luaL_checkinteger( L, 2 );
  int direction = luaL_checkinteger( L, 3 );

  MOD_CHECK_ID( i2c, id );
  if ( address < 0 || address > 127 )
    return luaL_error( L, "slave address must be from 0 to 127" );
  lua_pushboolean( L, platform_i2c_send_address( id, (u16)address, direction ) );
  return 1;
}