ACS Reichweiten-Einstellung

Hallo Robby Community,

ich habe nun seit einigen Tagen den RP6 von Arexx, um die Grundlagen der Programmierung parallel zum Studium zu erlernen.

Der Selbsttest und die Beispielprogramme sind bereits abgeschlossen.

Nun wollte ich das Beispielprogramm Move_5 etwas abändern:

- Nachdem beide Kanäle wieder freie fahrt melden den Ausweich/Weiterfahrt Winkel verkleinern. Hierbei habe ich einfach die StopWatches Werte verkleinert.

- Der nächste Schritt sollte die Minderung der ACS-Reichweite sein. Der RP6 soll bei FrontMeldung näher an das Objekt dran fahren als dies im Beispielprojekt realisiert wurde. Leider habe ich hierbei keine Ahnung wie ich das ändern könnte?!

Hatte jemand bereits die gleiche Idee und weiß was man im vorhandenen Beispielprogramm abändern muss?

Vielen Dank


EDIT:

http://www.rn-wissen.de/index.php/RP...llision_System

Der aus Softwaresicht komplexeste Sensor des RP6 ist das ACS - das „Anti Collision System“ ...

.....Damit das ACS nicht zu empfindlich bzw. auf eventuelle Störungen reagiert, wartet die Software bis eine bestimmte Anzahl von Impulsen in einer bestimmten Zeit empfangen worden ist....

...Man kann zusätzlich noch die Stromstärke mit der die beiden IR LEDs gepulst werden in drei Stufen einstellen. ...


Es ist schonmal klar, dass es gehen muss ;-) nur wie liegt noch in der Luft

Hi,
und Glückwunsch zum RP6.
In Move 5 wird die Einstellung PwrMed benutzt, hast Du es schon mit der Einstellung setACSPwrLow für geringe Reichweite probiert ?
Ja und die Low/Med/High müssen ja irgendwo definiert sein. Ich denke mal das man in den Libs entsprechendes findet, sollte das Low nichts ausreichen.
TrainMen

Hallo

Zitat:

---

Man kann zusätzlich noch die Stromstärke mit der die beiden IR LEDs gepulst werden in drei Stufen einstellen

---

Es wird hierbei der Vorwiderstand für die ACS-LEDs verändert. Entweder nur R9 (2k2) für Low, R8 (1k5) für Med oder beide zusammen für High:

Code:

---

/**
 * Set ACS Power low.
 *
 * Example:
 *
 *                        setACSPwrLow();
 *
 */
void setACSPwrLow(void)
{
        DDRD |= ACS_PWR;
        PORTD |= ACS_PWR;
        DDRB &= ~ACS_PWRH;
        PORTB &= ~ACS_PWRH;
}

/**
 * Set ACS Power medium.
 *
 * Example:
 *
 *                        setACSPwrMed();
 *
 */
void setACSPwrMed(void)
{
        DDRD &= ~ACS_PWR;
        PORTD &= ~ACS_PWR;
        DDRB |= ACS_PWRH;
        PORTB |= ACS_PWRH;
}

/**
 * Set ACS Power high.
 *
 * Example:
 *
 *                        setACSPwrHigh();
 *
 */
void setACSPwrHigh(void)
{
        DDRD |= ACS_PWR;
        PORTD |= ACS_PWR;
        DDRB |= ACS_PWRH;
        PORTB |= ACS_PWRH;
}

/*****************************************************************************/
//

---

(Aus der Datei RP6RobotBaseLib.c)

Die Trägerfrequenz, und damit auch die ACS-Impulse, werden in der Timer2-ISR erzeugt:

Code:

---

        else if(acs_pulse) { // Send ACS IR pulses?
                if(sysStatACS.channel == ACS_CHANNEL_LEFT) // which channel?
                        PORTB ^= ACS_L;
                else                       
                        PORTC ^= ACS_R;
                acs_pulse--;
        }
        else { // no more pulses - IR LEDs off!
                PORTB |= ACS_L;
                PORTC |= ACS_R;
        }

---

(Aus der Datei RP6RobotBaseLib.c)

Zitat:

---

Damit das ACS nicht zu empfindlich bzw. auf eventuelle Störungen reagiert, wartet die Software bis eine bestimmte Anzahl von Impulsen in einer bestimmten Zeit empfangen worden ist

---

In der Datei RP6Config.h kann man dann noch ein paar zusätzliche Einstellungen vornehmen:

Code:

---

/*****************************************************************************/
// ACS Config:

// You can only uncomment ONE of these two defines at a time.
// use ACS_CONFIG_CUSTOM for your own ACS settings!
#define ACS_CONFIG_DEFAULT
//#define ACS_CONFIG_CUSTOM

// General hints:
// Only values > 0 will work for ALL values!
// Settings with very different values from those that are in here
// by default will maybe not work! You have to do some experiments...


#ifdef ACS_CONFIG_DEFAULT        // ACS General update interval:
        #define ACS_UPDATE_INTERVAL 2  // ms
       
        // ACS Wait for IRCOMM transmissions time:
        #define ACS_IRCOMM_WAIT_TIME 16  // ACS_IRCOMM_WAIT_TIME * ACS_UPDATE_INTERVAL ms
       
        // ------------------
        // ACS Left Channel:
        #define ACS_SEND_PULSES_LEFT 36    // Number of pulses to send must be much higher than...
        #define ACS_REC_PULSES_LEFT 5      // ... number of pulses that must be received!
        #define ACS_REC_PULSES_LEFT_THRESHOLD 3
                                                                                // Once an object has been detected, it is
                                                                                // required to get lower than this threshold value
                                                                                // to turn of the "obstacle_left" flag.
                                                                                // If you set this equal to ACS_REC_PULSES_LEFT
                                                                                // it will have no influence on the behaviour.
        #define ACS_TIMEOUT_LEFT 16                    // ACS_TIMEOUT_LEFT * ACS_UPDATE_INTERVAL ms
       
        // ------------------
        // ACS Right Channel:
        #define ACS_SEND_PULSES_RIGHT 36 // Number of pulses to send must be much higher than...
        #define ACS_REC_PULSES_RIGHT 5  // ... number of pulses that must be received!
        #define ACS_REC_PULSES_RIGHT_THRESHOLD 3
                                                                                // Once an object has been detected, it is
                                                                                // required to get lower than this threshold value
                                                                                // to turn of the "obstacle_right" flag.
                                                                                // If you set this equal to ACS_REC_PULSES_RIGHT
                                                                                // it will have no influence on the behaviour.
        #define ACS_TIMEOUT_RIGHT 16    // ACS_TIMEOUT_RIGHT * ACS_UPDATE_INTERVAL ms
#endif

// Use this for your own ACS settings!
#ifdef ACS_CONFIG_CUSTOM
        // ACS General update interval:
        #define ACS_UPDATE_INTERVAL 2  // ms
       
        // ACS Wait for IRCOMM transmissions time:
        #define ACS_IRCOMM_WAIT_TIME 20  // ACS_IRCOMM_WAIT_TIME * ACS_UPDATE_INTERVAL ms
       
        // ------------------
        // ACS Left Channel:
        #define ACS_SEND_PULSES_LEFT 36    // Number of pulses to send must be much higher than...
        #define ACS_REC_PULSES_LEFT 5      // ... number of pulses that must be received!
        #define ACS_REC_PULSES_LEFT_THRESHOLD 1
                                                                                // Once an object has been detected, it is
                                                                                // required to get lower than this threshold value
                                                                                // to turn of the "obstacle_left" flag.
                                                                                // If you set this equal to ACS_REC_PULSES_LEFT
                                                                                // it will have no influence on the behaviour.
        #define ACS_TIMEOUT_LEFT 16                    // ACS_TIMEOUT_LEFT * ACS_UPDATE_INTERVAL ms
       
        // ------------------
        // ACS Right Channel:
        #define ACS_SEND_PULSES_RIGHT 36 // Number of pulses to send must be much higher than...
        #define ACS_REC_PULSES_RIGHT 5  // ... number of pulses that must be received!
        #define ACS_REC_PULSES_RIGHT_THRESHOLD 1
                                                                                // Once an object has been detected, it is
                                                                                // required to get lower than this threshold value
                                                                                // to turn of the "obstacle_right" flag.
                                                                                // If you set this equal to ACS_REC_PULSES_RIGHT
                                                                                // it will have no influence on the behaviour.
        #define ACS_TIMEOUT_RIGHT 16    // ACS_TIMEOUT_RIGHT * ACS_UPDATE_INTERVAL ms
#endif

---

https://www.roboternetz.de/phpBB2/ze...=304868#304868
https://www.roboternetz.de/phpBB2/ze...ag.php?t=50529

Gruß

mic

[Edit]
Eine vierte Stufe der Vorwiderstände könnte man vielleicht so erreichen:

Code:

---

void setACSPwrLow2(void) // Beide Pins Eingang mit PullUp
{
  DDRD &= ~ACS_PWR;
  PORTD |= ACS_PWR;
  DDRB &= ~ACS_PWRH;
  PORTB |= ACS_PWRH;
}

---

Beide Pins werden auf Eingang mit aktivem PullUp geschaltet. Ob das zu erwartende extrem geringe Strömchen überhaupt etwas bewirkt habe ich allerdings nicht getestet. Die PullUps sind mit 20-50k vielleicht etwas zu hochohmig. (Datenblatt S. 296 ganz unten)