#include "io_init.h"

void io_init(void)
{
    /******************************PORT 1**************************************/
    P1OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P1DIR = P1_UNUSED;                                                          // Set to output
    P1DIR &= ~(RTC_MFP | IMU_INTn);                                             // Set to input
        /*Interrupts Enable*/
//  P1SEL = RTC_MFP | IMU_INTn;
//  P1IE  = RTC_MFP | IMU_INTn;                                                 // Enable Interrupts
    P1IES = IMU_INTn;                                                           // High to low
    P1IFG = 0x00;                                                               // Clear all interrupt flags on Port 1
    delay();

    /******************************PORT 2**************************************/
    P2OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P2DIR = P2_UNUSED;                                                          // Set to output
        /*Interrupts Enable */
//  P2SEL = CAN0_INTn | CAN1_INTn | GPS_INTn;                                   // Interrupts Select
//  P2IES = CAN0_INTn | CAN1_INTn | GPS_INTn;
//  P2IE  = CAN0_INTn | CAN1_INTn | GPS_INTn;                                   // Enable Interrupts
//  P2SEL |= CAN0_RXB0n | CAN0_RXB1n | CAN1_RXB0n | CAN1_RXB1n;                 // Interrupts Select
//  P2IES |= CAN0_RXB0n | CAN0_RXB1n | CAN1_RXB0n | CAN1_RXB1n;
//  P2IE  |= CAN0_RXB0n | CAN0_RXB1n | CAN1_RXB0n | CAN1_RXB1n;                 // Enable Interrupts
    P2IFG = 0x00;                                                               // Clear all interrupt flags on Port 2
    delay();

    /******************************PORT 3**************************************/
    P3OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P3DIR =  CAN0_SCLK | CAN0_MOSI | SDC_SCLK | SDC_SIMO | CAN1_SCLK | P3_UNUSED;   // Set to output
    P3OUT |= CAN0_SCLK | CAN0_MOSI | SDC_SCLK | SDC_SIMO | CAN1_SCLK;               // Pull used output pins high
    P3DIR &= ~(CAN0_MISO | SDC_SOMI);
    P3SEL = CAN0_SCLK | CAN0_MOSI | CAN0_MISO | SDC_SCLK | SDC_SIMO | SDC_SOMI | CAN1_SCLK | IMU_SDA;

    /******************************PORT 4**************************************/
    P4OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P4DIR = CAN0_RSTn | CAN0_CSn | CAN1_RSTn | CAN1_CSn | P4_UNUSED;            // Set to output
    P4OUT = CAN0_RSTn | CAN0_CSn | CAN1_RSTn | CAN1_CSn;                        // Pull used output pins high
    delay();
    P4OUT &= ~(CAN0_RSTn | CAN1_RSTn) ;
    delay();
    delay();
    P4OUT |= (CAN0_RSTn | CAN1_RSTn) ;

    /******************************PORT 5**************************************/
    P5OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P5DIR = XT2OUT | CAN1_MOSI | P5_UNUSED;
    P5OUT = CAN1_MOSI;
    P5DIR &= ~(CAN1_MISO);
    P5SEL = XT2IN | XT2OUT | IMU_SCL | CAN1_MOSI | CAN1_MISO;

    /******************************PORT 6**************************************/
    P6OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P6DIR = P6_UNUSED;
    P6SEL = 0x00;

    /******************************PORT 7**************************************/
    P7OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P7DIR = XT1OUT | P7_UNUSED;
    P7SEL = XT1IN | XT1OUT;

    /******************************PORT 8**************************************/
    P8OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P8DIR = LEDG | LEDR | LEDY0 | LEDY1 | P8_UNUSED;
    P8DIR &= ~(Button0);                                                        // Set to input
    P8SEL = 0x00;

    /******************************PORT 9**************************************/
    P9OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P9DIR = USB_TX | SDC_CSn | GPS_CSn | P9_UNUSED;
    P9OUT = SDC_CSn | GPS_CSn;
    P9SEL = RTC_SDA | RTC_SCL | USB_TX | USB_RX;

    /******************************PORT 10**************************************/
    P10OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P10DIR =  BT_CSn | BT_MOSI | BT_SCLK | UART_TX | BT_EN |P10_UNUSED;
    P10OUT =  BT_CSn | BT_MOSI | BT_SCLK;
    P10SEL =  BT_MOSI | BT_MISO | BT_SCLK | UART_TX | UART_RX;


    /******************************PORT 11**************************************/
    P11OUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    P11DIR = ACLK_TEST | MCLK_TEST | SMCLK_TEST;
    P11OUT = ACLK_TEST | MCLK_TEST | SMCLK_TEST;
    P11SEL = ACLK_TEST | MCLK_TEST | SMCLK_TEST;

    /******************************PORT J**************************************/
    PJOUT = 0x00;                                                               // Pull pins low, only affects ports set as output, no effect on inputs
    PJDIR = 0x0F;                                                               // Set to output as per user's guide

}