Initial commit

This commit is contained in:
Leonie 2024-01-23 18:59:26 +01:00
commit d9b088b1be
2 changed files with 56 additions and 0 deletions

36
lego_servo.cpp Normal file
View file

@ -0,0 +1,36 @@
#include "Arduino.h"
#include "lego_servo.h"
lego_servo::Servo::Servo(int pin_a, int pin_b) {
ipin_a = pin_a;
ipin_b = pin_b
}
void lego_servo::Servo::begin()
{
pinMode(ipin_a,OUTPUT);
pinMode(ipin_b,OUTPUT);
digitalWrite(ipin_a,0);
digitalWrite(ipin_b,0);
}
void lego_servo::Servo::position(int pos)
{
switch (pos) {
case 0:
digitalWrite(ipin_a,0);
digitalWrite(ipin_b,0);
digitalWrite(LED_BUILTIN,1);
break;
case 1:
digitalWrite(ipin_a,1);
digitalWrite(ipin_b,0);
digitalWrite(LED_BUILTIN,0);
break;
case 2:
digitalWrite(ipin_a,0);
digitalWrite(ipin_b,1);
digitalWrite(LED_BUILTIN,1);
break;
}
}

20
lego_servo.h Normal file
View file

@ -0,0 +1,20 @@
/*
* lego_servo a libary for contrling some lego servos
* Created by me :3
* I copyrighted your mom lmao gottem
*/
#ifndef lego_servo
#define lego_servo
#include "Arduino.h"
class Servo {
public:
Servo(int pin_a, int pinb);
void begin();
void position(int pos);
private:
int ipin_a;
int ipin_b;
};
#endif