diff --git a/main.c b/main.c
new file mode 100644
index 0000000..35f1094
--- /dev/null
+++ b/main.c
@@ -0,0 +1,47 @@
+#include <bcm2835.h>
+#include <sys/types.h>
+
+int dacX = 0x60;
+int dacY = 0x61;
+
+int main(int argc, char **argv)
+{
+    char buf[1];
+
+    if (!bcm2835_init())return 1;
+    bcm2835_i2c_begin();                //Start I2C operations.
+    bcm2835_i2c_setSlaveAddress(0x20);  //I2C address
+    bcm2835_i2c_set_baudrate(10000);    //1M baudrate
+
+    while(1)
+    {
+        buf[0] = 0xEF;    //LED ON
+        bcm2835_i2c_write(buf,1);
+        bcm2835_delay(500);
+        buf[0] = 0xFF;     //LED OFF
+        bcm2835_i2c_write(buf,1);
+        bcm2835_delay(500);
+    }
+    bcm2835_i2c_end();
+    bcm2835_close();
+    return 0;
+}
+
+int i2c_init() {
+
+	if (!bcm2835_init())
+		return(1);
+
+	bcm2835_i2c_set_baudrate(10000);
+
+	return(0);
+}
+
+
+mcp4725_setVoltageFast(int dac, u_int16_t volt) {
+  bcm2835_i2c_begin();
+  bcm2835_i2c_setSlaveAddress(dac);
+  bcm2835_i2c_write(volt>>8);
+  bcm2835_i2c_write(volt);
+  bcm2835_i2c_end();
+}