Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #ifndef _ibit_h
- #define _ibit_h
- #include <Wire.h>
- #define DIR1 13
- #define PWM1 14
- #define DIR2 15
- #define PWM2 16
- static volatile int __flag1=0;
- bool sw_A(){
- pinMode(5,INPUT);
- return !digitalRead(5);
- }
- bool sw_B(){
- pinMode(11,INPUT);
- return !digitalRead(11);
- }
- bool IN(int CH){
- pinMode(CH,INPUT);
- return digitalRead(CH);
- }
- void OUT(int CH,int VAL){
- pinMode(CH,OUTPUT);
- digitalWrite(CH,VAL);
- }
- void fd(int speeds){
- pinMode(DIR1,OUTPUT);pinMode(DIR2,OUTPUT);
- pinMode(PWM1,OUTPUT);pinMode(PWM2,OUTPUT);
- digitalWrite(DIR1,1);analogWrite(PWM1,speeds);
- digitalWrite(DIR2,0);analogWrite(PWM2,speeds);
- }
- void fd2(int speed1,int speed2){
- pinMode(DIR1,OUTPUT);pinMode(DIR2,OUTPUT);
- pinMode(PWM1,OUTPUT);pinMode(PWM2,OUTPUT);
- digitalWrite(DIR1,1);analogWrite(PWM1,speed1);
- digitalWrite(DIR2,0);analogWrite(PWM2,speed2);
- }
- void bk(int speeds){
- pinMode(DIR1,OUTPUT);pinMode(DIR2,OUTPUT);
- pinMode(PWM1,OUTPUT);pinMode(PWM2,OUTPUT);
- digitalWrite(DIR1,0);analogWrite(PWM1,speeds);
- digitalWrite(DIR2,1);analogWrite(PWM2,speeds);
- }
- void bk2(int speed1,int speed2){
- pinMode(DIR1,OUTPUT);pinMode(DIR2,OUTPUT);
- pinMode(PWM1,OUTPUT);pinMode(PWM2,OUTPUT);
- digitalWrite(DIR1,0);analogWrite(PWM1,speed1);
- digitalWrite(DIR2,1);analogWrite(PWM2,speed2);
- }
- void sl(int speeds){
- pinMode(DIR1,OUTPUT);pinMode(DIR2,OUTPUT);
- pinMode(PWM1,OUTPUT);pinMode(PWM2,OUTPUT);
- digitalWrite(DIR1,0);analogWrite(PWM1,speeds);
- digitalWrite(DIR2,0);analogWrite(PWM2,speeds);
- }
- void sr(int speeds){
- pinMode(DIR1,OUTPUT);pinMode(DIR2,OUTPUT);
- pinMode(PWM1,OUTPUT);pinMode(PWM2,OUTPUT);
- digitalWrite(DIR1,1);analogWrite(PWM1,speeds);
- digitalWrite(DIR2,1);analogWrite(PWM2,speeds);
- }
- void ao(){
- pinMode(PWM1,OUTPUT);pinMode(PWM2,OUTPUT);
- analogWrite(PWM1,0);
- analogWrite(PWM2,0);
- }
- int analog(int ch){
- int AD[8]={132,196,148,212,164,228,180,244};
- unsigned int dat;
- byte dat1,dat2;
- if(!__flag1){
- Wire.begin();
- Wire.setClock(100000UL);
- __flag1=1;
- }
- Wire.beginTransmission(0x48); delayMicroseconds(100);
- Wire.write(AD[ch]);
- Wire.endTransmission(0);
- Wire.requestFrom(0x48,2);
- if(2 <= Wire.available()){
- dat1=Wire.read();
- dat2=Wire.read();
- }
- return ((dat1&0x0F)<<8)|dat2;
- }
- int ADC(int ch){
- int AD[8]={132,196,148,212,164,228,180,244};
- byte dat;
- if(!__flag1){
- Wire.begin();
- Wire.setClock(3400000);
- __flag1=1;
- }
- Wire.beginTransmission(0x48);
- Wire.write(AD[ch]);
- Wire.endTransmission(); delay(5);
- Wire.requestFrom(0x48,1);
- if(Wire.available()){
- dat=Wire.read();
- }
- return dat;
- }
- #endif
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement