dev #1
|
@ -54,17 +54,7 @@ enum gy521_map {
|
||||||
* ############################
|
* ############################
|
||||||
*/
|
*/
|
||||||
|
|
||||||
typedef struct{
|
|
||||||
uint16_t x;
|
|
||||||
uint16_t y;
|
|
||||||
uint16_t z;
|
|
||||||
}gyro_values_struct;
|
|
||||||
|
|
||||||
typedef struct{
|
|
||||||
uint16_t x;
|
|
||||||
uint16_t y;
|
|
||||||
uint16_t z;
|
|
||||||
}accel_values_struct;
|
|
||||||
|
|
||||||
struct gy521_module{
|
struct gy521_module{
|
||||||
uint8_t slave_address;
|
uint8_t slave_address;
|
||||||
|
@ -139,6 +129,7 @@ _Bool gy521_init(gy521_module *m, uint8_t slave_address) {
|
||||||
|
|
||||||
void gy521_update_accel(gy521_module *m)
|
void gy521_update_accel(gy521_module *m)
|
||||||
{
|
{
|
||||||
|
/*We shift the High byte over by 8 for a u16*/
|
||||||
m->accel.x = read_register(m, accel_xouth) <<8;
|
m->accel.x = read_register(m, accel_xouth) <<8;
|
||||||
m->accel.x |= read_register(m, accel_xoutl);
|
m->accel.x |= read_register(m, accel_xoutl);
|
||||||
m->accel.y = read_register(m, accel_youth) <<8;
|
m->accel.y = read_register(m, accel_youth) <<8;
|
||||||
|
@ -149,6 +140,7 @@ void gy521_update_accel(gy521_module *m)
|
||||||
|
|
||||||
void gy521_update_gyro(gy521_module *m)
|
void gy521_update_gyro(gy521_module *m)
|
||||||
{
|
{
|
||||||
|
/*We shift the High byte over by 8 for a u16*/
|
||||||
m->gyro.x = read_register(m, gyro_xouth) <<8;
|
m->gyro.x = read_register(m, gyro_xouth) <<8;
|
||||||
m->gyro.x |= read_register(m, gyro_xoutl);
|
m->gyro.x |= read_register(m, gyro_xoutl);
|
||||||
m->gyro.y = read_register(m, gyro_youth) <<8;
|
m->gyro.y = read_register(m, gyro_youth) <<8;
|
||||||
|
@ -158,3 +150,21 @@ void gy521_update_gyro(gy521_module *m)
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
struct accel_values gy521_get_accel(struct gy521_module* m)
|
||||||
|
{
|
||||||
|
struct accel_values s;
|
||||||
|
s.x = m->accel.x;
|
||||||
|
s.y = m->accel.y;
|
||||||
|
s.z = m->accel.z;
|
||||||
|
return s;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
struct gyro_values gy521_get_gyro(struct gy521_module* m)
|
||||||
|
{
|
||||||
|
struct gyro_values s;
|
||||||
|
s.x = m->gyro.x;
|
||||||
|
s.y = m->gyro.y;
|
||||||
|
s.z = m->gyro.z;
|
||||||
|
return s;
|
||||||
|
}
|
||||||
|
|
|
@ -24,7 +24,19 @@
|
||||||
* ############################
|
* ############################
|
||||||
* Types/Structures
|
* Types/Structures
|
||||||
* ############################
|
* ############################
|
||||||
*/
|
*/
|
||||||
|
typedef struct gyro_values{
|
||||||
|
uint16_t x;
|
||||||
|
uint16_t y;
|
||||||
|
uint16_t z;
|
||||||
|
}gyro_values_struct;
|
||||||
|
|
||||||
|
typedef struct accel_values{
|
||||||
|
uint16_t x;
|
||||||
|
uint16_t y;
|
||||||
|
uint16_t z;
|
||||||
|
}accel_values_struct;
|
||||||
|
|
||||||
typedef struct gy521_module gy521_module;
|
typedef struct gy521_module gy521_module;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -45,6 +57,7 @@ _Bool gy521_init(struct gy521_module *m, uint8_t slave_address);
|
||||||
void gy521_update_gyro(struct gy521_module* m);
|
void gy521_update_gyro(struct gy521_module* m);
|
||||||
void gy521_update_accel(struct gy521_module* m);
|
void gy521_update_accel(struct gy521_module* m);
|
||||||
void gy521_free(struct gy521_module *m);
|
void gy521_free(struct gy521_module *m);
|
||||||
|
struct accel_values gy521_get_accel(struct gy521_module* m);
|
||||||
|
struct gyro_values gy521_get_gyro(struct gy521_module* m);
|
||||||
|
|
||||||
#endif /* GY521_DRIVER_H */
|
#endif /* GY521_DRIVER_H */
|
||||||
|
|
Loading…
Reference in New Issue