■環境
PC:ubuntu:Ubuntu 18.04.4 LTS
SDK:v2.0.0
IDE:v1.2.0
■やりたいこと
Adafruitの出しているハプティックドライバを用いてモーターの制御をしようとしております。
https://www.marutsu.co.jp/pc/i/574336/
ハプティックドライバhttps://www.marutsu.co.jp/pc/i/574336/
ハプティックドライバの初期化のために、ハプティックドライバのレジスタをI2C経由で弄る必要があるのですが、上手く行きません。
■やったこと
Spresense SDKでの開発→5.8.7ドライバ開発者のためのガイドライン(
https://developer.sony.com/develop/spresense/docs/sdk_developer_guide_ja.html#_sensor_control_unit)
を見ながら作業しています。
■質問
長くなりましたが、質問したいことは2点です。
1.今回やりたいことの、モーターを動かすためにSCUを使用するのは、正しいやり方なのでしょうか。i2c_masterの様なnuttxで用意されたライブラリを使用するべきなのでしょうか。
2.SCUドライバを無効値で使用しても成功判定されるのはなぜでしょうか。
- 今回やりたいことの、モーターを動かすためにSCUを使用するのは、正しいやり方なのでしょうか。i2c_masterの様なnuttxで用意されたライブラリを使用するべきなのでしょうか。
- SCUドライバを無効値で使用しても成功判定されるのはなぜでしょうか。
また、非常に汚い状態ですが、ソースを載せておきます。
'''
int ret;
FAR struct seq_s *ada_seq;
uint16_t inst[2];
void init_vibration()
{
printf("AutoCalib start\n");
ada_seq = seq_open(SEQ_TYPE_NORMAL, SCU_BUS_I2C0);
if (!ada_seq)
{
printf("ada_seq : NULL error\n");
return -ENOENT;
}
else
{
printf("openSequence\n");
//printf("ada_seq:%d\n", ada_seq);
}
seq_setaddress(ada_seq, ADAFRUT_ADDRESS);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_STATUS, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_RTPIN, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_WAVESEQ1, 1);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_WAVESEQ2, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_OVERDRIVE, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_SUSTAINPOS, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_SUSTAINNEG, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_BREAK, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_AUDIOMAX, 0x64);
printf("setup completed\n");
}
}
int write_adafruit(int port, int addr, int reg, int instruc)
{
inst[0] = SCU_INST_SEND(reg);
inst[1] = SCU_INST_SEND(instruc) | SCU_INST_LAST;
ret = scu_i2ctransfer(port, addr, inst, 2, NULL, 0);
if (ret == 0)
{
printf("tarnsferok\n");
}
else
{
printf("failed. %d\n", ret);
printf("%d\n", errno);
return ret;
}
}
'''
int ret;
FAR struct seq_s *ada_seq;
uint16_t inst[2];
void init_vibration()
{
printf("AutoCalib start\n");
ada_seq = seq_open(SEQ_TYPE_NORMAL, SCU_BUS_I2C0);
if (!ada_seq)
{
printf("ada_seq : NULL error\n");
return -ENOENT;
}
else
{
printf("openSequence\n");
//printf("ada_seq:%d\n", ada_seq);
}
seq_setaddress(ada_seq, ADAFRUT_ADDRESS);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_STATUS, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_RTPIN, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_WAVESEQ1, 1);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_WAVESEQ2, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_OVERDRIVE, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_SUSTAINPOS, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_SUSTAINNEG, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_BREAK, 0x00);
ret = write_adafruit(0, ADAFRUT_ADDRESS, DRV2605_REG_AUDIOMAX, 0x64);
printf("setup completed\n");
}
}
int write_adafruit(int port, int addr, int reg, int instruc)
{
inst[0] = SCU_INST_SEND(reg);
inst[1] = SCU_INST_SEND(instruc) | SCU_INST_LAST;
ret = scu_i2ctransfer(port, addr, inst, 2, NULL, 0);
if (ret == 0)
{
printf("tarnsferok\n");
}
else
{
printf("failed. %d\n", ret);
printf("%d\n", errno);
return ret;
}
}