Initial commit
This commit is contained in:
commit
d9b088b1be
36
lego_servo.cpp
Normal file
36
lego_servo.cpp
Normal 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
20
lego_servo.h
Normal 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
|
Loading…
Reference in a new issue