301 lines
8.0 KiB
C
301 lines
8.0 KiB
C
|
||
#include "gSensor_manage.h"
|
||
#include "gma301.h"
|
||
|
||
#ifdef CONFIG_GSENSOR_ENABLE
|
||
|
||
u8 gma301_sensor_command(u8 register_address, u8 function_command)
|
||
{
|
||
gravity_sensor_command(WRITE_COMMAND_FOR_GMA301, register_address, function_command);
|
||
return 0;
|
||
}
|
||
|
||
u8 gma301_sensor_get_data(u8 register_address)
|
||
{
|
||
return _gravity_sensor_get_data(WRITE_COMMAND_FOR_GMA301, READ_COMMAND_FOR_GMA301, register_address);
|
||
}
|
||
|
||
|
||
void gma301_init(void)
|
||
{
|
||
// puts("\n gma301_init\n");
|
||
gma301_sensor_command(0x21, 0x52); //RESET
|
||
|
||
|
||
gma301_sensor_command(0x00, 0x02); //This will download OTP data into internal parameter registers and
|
||
gma301_sensor_command(0x00, 0x12); //enable internal clock then clear the data path.
|
||
gma301_sensor_command(0x00, 0x02); //
|
||
gma301_sensor_command(0x00, 0x82); //
|
||
gma301_sensor_command(0x00, 0x02); //
|
||
gma301_sensor_command(0x1F, 0x28); //Select the calibrated data as output
|
||
//gma301_sensor_command(0x1F,0x08);//Select the decimation filter as output 2014-12-29 alter by zhuo
|
||
gma301_sensor_command(0x0F, 0x00); // set tap number register 2014-12-29 add by zhuo
|
||
gma301_sensor_command(0x11, 0x07); //
|
||
gma301_sensor_command(0x0C, 0x8f); // 0x8f to enable enz eny enx ent / 0x8d to enable z y ent / 0x89 to enable z ent
|
||
gma301_sensor_command(0x00, 0x06); //enable sensor and output
|
||
|
||
|
||
//interrupt init
|
||
// gma301_sensor_command(0x11,0x07);//IIC 0X07 for no pull up //0x06 High active 0x04 low active
|
||
#if 0
|
||
// gma301_sensor_command(0x38,0X53);//用来配置加速度值的大小//10 1g 20 2g 30 3g 40 4g 50 5g 60 6g 最大60 ，在gma301_resolution_range中配置
|
||
// gma301_sensor_command(0x39,0X60);//10 1g 20 2g 30 3g 40 4g 50 5g 60 6g 最大60
|
||
|
||
delay_2ms(1);
|
||
|
||
gma301_sensor_command(0x0E, 0x00); //0x1C//0x00 // 0x00:disable interrupt
|
||
|
||
delay_2ms(1); //2014_0819 added 1ms delay for micro motion setup itself.
|
||
|
||
gma301_sensor_command(0x0E, 0x1C); //To enable interrupt.
|
||
gma301_sensor_get_data(0x1C);//clear INT status
|
||
gma301_sensor_get_data(0x1D);
|
||
#endif
|
||
puts("\n gma301_init end\n");
|
||
|
||
}
|
||
|
||
|
||
|
||
s8 gma301_id_check(void)
|
||
{
|
||
int chipid;
|
||
|
||
chipid = gma301_sensor_get_data(0x12);//chip id
|
||
|
||
log_d("CHIPID_GMA301: %x", chipid);
|
||
|
||
if (chipid != 0x55) {
|
||
puts("not gma301");
|
||
return -1;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
|
||
s8 gma301_check(void)
|
||
{
|
||
|
||
// init_i2c_io();
|
||
|
||
// gma301_iic_set(1);
|
||
|
||
// gma301_sensor_command(0x21,0x52);//RESET
|
||
|
||
if (0 != gma301_id_check()) {
|
||
return -1;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
|
||
//工作模式选着
|
||
void gma301_work_mode(u8 work_mode)
|
||
{
|
||
switch (work_mode) {
|
||
case G_NORMAL_MODE:
|
||
gma301_sensor_command(0x00, 0X06);//normal mode
|
||
break;
|
||
case G_SUSPEND_MODE:
|
||
gma301_sensor_command(0x00, 0X00);
|
||
break;
|
||
case G_LOW_POWER_MODE:
|
||
// gma301_sensor_command(0x11, 0X07);//INT active H
|
||
gma301_sensor_command(0x00, 0X06);//low_power mode
|
||
gma301_sensor_command(0x0C, 0x8F);
|
||
gma301_sensor_command(0x0D, 0X50);//感度
|
||
|
||
break;
|
||
}
|
||
}
|
||
|
||
|
||
//工作分辨率选着
|
||
void gma301_resolution_range(u8 range)
|
||
{
|
||
//gma301_sensor_command(0x00, 0X02);
|
||
gma301_sensor_command(0x11, 0x07);
|
||
gma301_sensor_command(0x0F, 0X00);
|
||
// gma301_sensor_command(0x0D, 0X50);
|
||
gma301_sensor_command(0x0E, 0X00);
|
||
gma301_sensor_command(0x1F, 0X28);
|
||
switch (range) {
|
||
case G_SENSITY_HIGH:
|
||
// gma301_sensor_command(0x38, 0x3F);// 高灵敏度 2g
|
||
puts("\n G_SENSITY_HIGH \n");
|
||
gma301_sensor_command(0x0D, 0X70);//感度 70 60 50 44 34 24 14
|
||
gma301_sensor_command(0x39, 0x18);// 高灵敏度 1.5g
|
||
break;
|
||
case G_SENSITY_MEDIUM:
|
||
// gma301_sensor_command(0x38, 0x7F);// 中 4g
|
||
puts("\n G_SENSITY_MEDIUM \n");
|
||
gma301_sensor_command(0x0D, 0X50);//感度 34
|
||
gma301_sensor_command(0x39, 0x38);// 中 3.5g
|
||
break;
|
||
case G_SENSITY_LOW:
|
||
puts("\n G_SENSITY_LOW \n");
|
||
// gma301_sensor_command(0x38, 0xFF);// 低 8g
|
||
gma301_sensor_command(0x0D, 0X44);//感度 34
|
||
gma301_sensor_command(0x39, 0x48);// 低 5.5g
|
||
break;
|
||
}
|
||
// puts("\n gma301_sensor_get_data 1 \n");
|
||
gma301_sensor_get_data(0x12);//
|
||
gma301_sensor_get_data(0x13);
|
||
gma301_sensor_get_data(0x14);//X
|
||
gma301_sensor_get_data(0x15);
|
||
gma301_sensor_get_data(0x16);//Y
|
||
gma301_sensor_get_data(0x17);
|
||
gma301_sensor_get_data(0x18);//Z
|
||
gma301_sensor_get_data(0x19);
|
||
// puts("\n gma301_sensor_get_data 2 \n");
|
||
|
||
// delay_2ms(2); //2014_0819 added 1ms delay for micro motion setup itself.
|
||
delay(1000);
|
||
// puts("\n gma301_sensor_get_data 3 \n");
|
||
gma301_sensor_command(0x1F, 0x38);
|
||
// gma301_sensor_command(0x11,0x07);
|
||
// puts("\n gma301_sensor_get_data 4 \n");
|
||
// delay_2ms(1);
|
||
// delay(1000);
|
||
// puts("\n gma301_sensor_get_data 5 \n");
|
||
gma301_sensor_get_data(0x1C);//clear INT status
|
||
gma301_sensor_get_data(0x1D);
|
||
gma301_sensor_command(0x0E, 0x1C);
|
||
//gma301_sensor_command(0x00, 0X06);
|
||
// puts("\n gma301_resolution_range \n");
|
||
|
||
}
|
||
|
||
extern int gma301_pin_int_interrupt();
|
||
int gma301_gravity_sensity(u8 gsid)
|
||
{
|
||
|
||
if (gsid == G_SENSOR_SCAN) {
|
||
if (gma301_pin_int_interrupt()) {
|
||
return -EINVAL;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
//高中低
|
||
if (gsid == G_SENSOR_HIGH) {
|
||
gma301_work_mode(G_NORMAL_MODE);
|
||
gma301_resolution_range(G_SENSITY_HIGH);
|
||
}
|
||
|
||
if (gsid == G_SENSOR_MEDIUM) {
|
||
gma301_work_mode(G_NORMAL_MODE);
|
||
gma301_resolution_range(G_SENSITY_MEDIUM);
|
||
}
|
||
|
||
if (gsid == G_SENSOR_LOW) {
|
||
gma301_work_mode(G_NORMAL_MODE);
|
||
gma301_resolution_range(G_SENSITY_LOW);
|
||
}
|
||
|
||
if (gsid == G_SENSOR_CLOSE) {
|
||
gma301_sensor_get_data(0x1c);
|
||
gma301_sensor_get_data(0x1D);
|
||
os_time_dly(50);
|
||
|
||
gma301_sensor_command(0x38, 0XFF); //关闭
|
||
gma301_work_mode(G_SUSPEND_MODE);//暂停
|
||
|
||
}
|
||
|
||
if (gsid == G_SENSOR_LOW_POWER_MODE) { //低功耗
|
||
|
||
gma301_sensor_get_data(0x1c);
|
||
gma301_sensor_get_data(0x1D);
|
||
os_time_dly(50);
|
||
|
||
gma301_work_mode(G_LOW_POWER_MODE);
|
||
gma301_resolution_range(G_SENSITY_MEDIUM);
|
||
}
|
||
|
||
|
||
|
||
return 0;
|
||
|
||
}
|
||
|
||
//u8 lock_current_file;
|
||
|
||
|
||
int gma301_pin_int_interrupt()
|
||
{
|
||
u8 temp;
|
||
temp = gma301_sensor_get_data(0x12);
|
||
temp = gma301_sensor_get_data(0x13);
|
||
if (temp & BIT(5)) { //INT
|
||
// if(!gma301_sensor_get_data(0x1c))
|
||
// {
|
||
// gma301_init();
|
||
// return;
|
||
// }
|
||
// if(!gma301_sensor_get_data(0x1D))
|
||
// {
|
||
// gma301_init();
|
||
// return;
|
||
// }
|
||
gma301_sensor_get_data(0x1c);
|
||
gma301_sensor_get_data(0x1D);
|
||
|
||
return 0;
|
||
}
|
||
return -EINVAL;
|
||
}
|
||
|
||
void gma301_test(void)
|
||
{
|
||
// temp = gma301_sensor_get_data(0x12);
|
||
// put_u32hex(temp);
|
||
// printf("\n>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>gma301 0x12:%8x\n",temp);
|
||
//
|
||
// temp = gma301_sensor_get_data(0x13);
|
||
//
|
||
//
|
||
// if (temp & BIT(5))
|
||
// {
|
||
// put_u32hex(temp);
|
||
// gma301_sensor_get_data(0x1c);
|
||
// gma301_sensor_get_data(0x1D);
|
||
// putchar('\n');
|
||
// }
|
||
// gui_number(DVcNumber2_3,temp, -1, -1, ERASE_BACKGROUND);
|
||
// gui_number(DVcNumber2_3,temp, -1, -1, USE_ORIG_COLOR);
|
||
|
||
|
||
// printf("\n>gma301 0x13:%8x\n",temp);
|
||
|
||
// temp = gma301_sensor_get_data(0x1c);
|
||
// put_u32hex(temp);
|
||
//
|
||
// temp = gma301_sensor_get_data(0x14);//X
|
||
// put_u32hex(temp);
|
||
// temp = gma301_sensor_get_data(0x16);//Y
|
||
// put_u32hex(temp);
|
||
// temp = gma301_sensor_get_data(0x18);//Z
|
||
// put_u32hex(temp);
|
||
//
|
||
// printf("\n>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>gma301 0x1c:%8x\n",temp);
|
||
}
|
||
|
||
_G_SENSOR_INTERFACE gma301_ops = {
|
||
.logo = "gma301",
|
||
.gravity_sensor_check = gma301_check,
|
||
.gravity_sensor_init = gma301_init,
|
||
.gravity_sensor_sensity = gma301_gravity_sensity,
|
||
// .gravity_sensor_interrupt = gma301_pin_int_interrupt,
|
||
// .gravity_sensor_read = gma301_sensor_get_data,
|
||
// .gravity_sensor_write = gma301_sensor_command,
|
||
};
|
||
REGISTER_GRAVITY_SENSOR(gma301)
|
||
.gsensor_ops = &gma301_ops,
|
||
};
|
||
|
||
#endif // CONFIG_GSENSOR_ENABLE
|