Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- // SoftwareSerial を使って Bluetooth で通信
- #include <SoftwareSerial.h>
- #include <TinyWireM.h>
- const int DRV8830 = 0xC8 >> 1 ; // 0x64;
- SoftwareSerial mySerial = SoftwareSerial(3, 4); // RX, TX
- void writeRegister( int drv, byte vset, byte data )
- {
- int vdata = vset << 2 | data ;
- TinyWireM.beginTransmission( drv );
- TinyWireM.send( 0x00 );
- TinyWireM.send( (vset<<2) + data );
- TinyWireM.endTransmission();
- }
- void setup() {
- // put your setup code here, to run once:
- TinyWireM.begin();
- writeRegister( DRV8830, 0x00, 0x00 );
- mySerial.begin(9600);
- delay( 2000 );
- }
- void loop() {
- int len = mySerial.available();
- if ( len < 2 ) return ;
- int type = mySerial.read(); // M or L
- int num = mySerial.read(); // MF/MB/M0, L0/L1
- if ( type == 'M' || type == 'N') {
- int mode = 0;
- switch ( num ) {
- case '0': mode = 0; break;
- case 'F': mode = 1; break;
- case 'B': mode = 2; break;
- default: mode = 0; break;
- }
- switch ( mode ) {
- case 0:
- writeRegister( DRV8830, 0x00, 0x00 );
- break;
- case 1:
- writeRegister( DRV8830, 0x15, 0x02 );
- break;
- case 2:
- writeRegister( DRV8830, 0x15, 0x01 );
- break;
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement