|
Ocena wątku:
Modelarski sterownik silnika DC na Atmega8 według projektu AVT
|
/* test z monitorowaniem wartosci kanału na arduino nano
*/
//definicje kanalow
#define CH1 2
// Motor A Control Connections
#define pwmB 15 //Atmega PB1-15
#define pwmA 16 //Atmega PB2-16
#define in1A 13 //At PB5-13
#define in2A 12 //At PB5
//zmienne
//kontrola silnika
//void mControlA(int mspeed, int mdir) {
// }
int ch1Value;
int pwnValue;
//czytaj kanał
int readChannel(int channelInput, int minLimit, int maxLimit, int defaultValue){
int ch = pulseIn(channelInput, HIGH, 30000);
if (ch < 100) return defaultValue;
return map(ch, 1000, 2000, minLimit, maxLimit);
}
//
bool readSwitch(byte channelInput, bool defaultValue){
int intDefaultValue = (defaultValue)? 100: 0;
int ch = readChannel(channelInput, 0, 100, intDefaultValue);
return (ch > 50);
}
//***********************************************************************
void setup(){
// Set up serial monitor
Serial.begin(115200);
pinMode(CH1, INPUT);
pinMode(pwmA, OUTPUT);
pinMode(pwmB, OUTPUT);
pinMode(in1A, OUTPUT);
pinMode(in2A, OUTPUT);
}
//*************************************************************************
void loop() {
// CH1 = readChannel(0, -100, 100, 0);
// Set forward/backward direction with channel 2 value
if (ch1Value >= 0) {
// Forward
digitalWrite(in1A , HIGH);
digitalWrite(in2A , LOW);
pwnValue= map(ch1Value, 0 ,100 , 0 , 255);//nie mapuje
//in1A==pwnValue;
//analogWrite(int1A , pwnValue);
Serial.println(" Forward");
Serial.print( pwnValue);//nie wyswietla
} else {
//Backward
digitalWrite(in1A , LOW);
digitalWrite(in2A , HIGH);
Serial.println(" Backward");
Serial.print(pwnValue);
}
ch1Value = readChannel(CH1, -100, 100, -100);
Serial.print("Ch1: ");
Serial.print(ch1Value);
//Serial.print(in2a);
delay(200);
} //poczatek do produ
if(nThrottleIn>1550){
pwM1a = map( nThrottleIn ,1550, 1995, 0, 255);if(z<1050)
{
funkcja1();
funkcja2();
//wszystkie polecenia w tych klamerkach są do z<1050 i jeśli to się wykonuje to żaden kolejny else if już nie
}
else if (z<1450)
{
//wszystkie polecenia w tych klamerkach są do z<1450 i jeśli to się wykonuje to żaden kolejny else if już nie
//ale są też dla z>=1050 bo skoro tu się znaleźliśmy to poprzedni warunek nie był spełniony;
}
else if (z<1550)
{
//wszystkie polecenia w tych klamerkach są do z<1550 i jeśli to się wykonuje to żaden kolejny else if już nie
//ale są też dla z>=1450 bo skoro tu się znaleźliśmy to poprzedni warunek nie był spełniony
}
else if (z<=1950)
{
//itd.
}
else
{
//czyli pwm=255; i nic z powyzszych sie nie wykonywalo, z miało wartość powyżej 1950
//jak jest jedno polecenie za if lub else to nie musi być klamerek
}
ZupelnieInnafunkcjaNieZwiazanaZifami();//bo jest za klamra od bloku programu przypisanego do else i wykona się zawsze niezależnie od wcześniejszych porównań.