#include "bsp.h"
#include "custom_prephrals.h"
#include "prepherials.h"
#include <cstdio>



int main() {
    system_init();
    setup_prepherials();
//    pb.init(LED_BLUE_PIN);
//    pa.init(9);
//
//    while (1) {
////        pb.toggle(LED_BLUE_PIN);
//        pa.toggle(10);
////        delay_ms(1000, true);
////        delay.us(1, true);
//        delay_us(1,false);
//    };

    setup_pins();
//    setup_timer();
    i2c_plus.init();
    i2c_minus.init();

    delay.ms(1, true);

    s0.set_low();
    s1.set_low();
    s2.set_low();
    s3.set_low();


    uint8_t data[2] = {mem1_addr,0xDF };
    hal_status_e ret;
    ret = i2c_plus.send(slave_addr, data, 2);
   // delay.delay_ms(10);
    data[0] = mem2_addr;
    ret = i2c_plus.send(slave_addr, data, 2);
    //delay.delay_ms(10);
    data[0] = mem3_addr;
    ret = i2c_plus.send(slave_addr, data, 2);
    //delay.delay_ms(10);
    data[0] = mem4_addr;
    ret = i2c_plus.send(slave_addr, data, 2);

    //delay.delay_ms(30);
    data[0] = mem1_addr;
    data[1] = 0x4F;
    ret = i2c_minus.send(slave_addr, data, 2);
    //delay.delay_ms(10);
    data[0] = mem2_addr;
    ret = i2c_minus.send(slave_addr, data, 2);
    //delay.delay_ms(10);
    data[0] = mem3_addr;
    ret = i2c_minus.send(slave_addr, data, 2);
    //delay.delay_ms(10);
    data[0] = mem4_addr;
    ret = i2c_minus.send(slave_addr, data, 2);
    //data[0] = mem1_addr;
    //ret = i2c_plus.send(slave_addr, data,1);
    //uint8_t data_back[2] = {0};
    //ret = i2c_plus.read(slave_addr,data_back, 1);

//    while(1){  //monophasic coding
//        s2.set_high();
//        s1.set_high();
//        s0.set_high();
//        delay.delay_us(200);
//        s2.set_low();
//        delay.delay_us(20);
//        s1.set_low();
//        delay.delay_us(20);
//        s3.set_high();
//        delay.delay_us(400);
//        s3.set_low();
//        delay.delay_ms(2);
//    };
//    while(1){//Biphasice coding
//        s3.set_high();
//        s1.set_high();
//        delay.delay_us(100);
//        s1.set_low();
//        delay.delay_us(20);
//        s2.set_high();
//        delay.delay_us(200);
//        s2.set_low();
//        delay.delay_us(480);
//    }
    while(1){
        s3.set_high();
        s1.set_high();
        delay.ms(400);
        s1.set_low();
        delay.ms(1600);
    }
}