Neues Rescue-Programm angefangen (2)

adc.c

@@ -0,0 +1,18 @@
+#include "adc.h"
+
+#include <avr/io.h>
+
+
+void initADC() {
+  ADMUX = (1<<REFS0); 
+  ADCSRA = (1<<ADEN)|(1<<ADPS2)|(1<<ADPS1)|(1<<ADPS0); 
+}
+
+uint16_t getADCValue(int port) {
+  ADMUX = (1<<REFS0)|(1<<ADLAR)|(port&0x07);
+  ADCSRA |= (1<<ADSC);
+  
+  while(!(ADCSRA & (1<<ADIF)));
+  
+  return ADC;
+}

adc.h

@@ -0,0 +1,10 @@
+#ifndef _ROBOCUP_ADC_H_
+#define _ROBOCUP_ADC_H_
+
+#include <stdint.h>
+
+
+void initADC();
+uint16_t getADCValue(int port);
+
+#endif

avr.c

@@ -0,0 +1,16 @@
+#include "avr.h"
+#include "util.h"
+
+void setMotorSpeed(MOTOR *motor, int speed) {
+  if(speed > 0) {
+    *motor->port &= ~motor->revMask;
+    *motor->port |= motor->fwdMask;
+  }
+  else if(speed < 0) {
+    *motor->port &= ~motor->fwdMask;
+    *motor->port |= motor->revMask;
+  }
+  else *motor->port |= motor->fwdMask|motor->revMask;
+  
+  *motor->pwmPort = CLAMP(0, ABS(speed), 255);
+}

avr.h

@@ -0,0 +1,16 @@
+#ifndef _ROBOCUP_AVR_H_
+#define _ROBOCUP_AVR_H_
+
+#include <stdint.h>
+
+
+typedef struct {
+  volatile uint8_t *port;
+  volatile uint8_t *pwmPort;
+  uint8_t fwdMask;
+  uint8_t revMask;
+} MOTOR;
+
+void setMotorSpeed(MOTOR *motor, int speed);
+
+#endif

hardware.c

@@ -0,0 +1,6 @@
+#include "hardware.h"
+
+
+void initHardware() {
+  
+}

hardware.h

@@ -0,0 +1,24 @@
+#ifndef _ROBOCUP_HARDWARE_H_
+#define _ROBOCUP_HARDWARE_H_
+
+#include "avr.h"
+
+#include <avr/io.h>
+
+
+static const MOTOR MOTOR1 = {
+  &PORTD, &OCR1BL, 0x01, 0x02
+};
+
+static const MOTOR MOTOR2 = {
+  &PORTD, &OCR1AL, 0x04, 0x08
+};
+
+static const MOTOR MOTOR3 = {
+  &PORTB, &OCR0, 0x01, 0x02
+};
+
+
+void initHardware();
+
+#endif

util.h

@@ -0,0 +1,9 @@
+#ifndef _ROBOCUP_UTIL_H_
+#define _ROBOCUP_UTIL_H_
+
+#define MIN(a,b) ((a<b)?a:b)
+#define MAX(a,b) ((a>b)?a:b)
+#define CLAMP(min,x,max) ((x<min)?min:(x>max)?max:x)
+#define ABS(a) ((a<0)?-a:a)
+
+#endif