Thomas Morris
/
PROJ324_Final
Proj 324 Final
Fork of ELEC351_Group_T by
main.cpp
- Committer:
- thomasmorris
- Date:
- 2018-05-16
- Revision:
- 54:a4c5949707ca
- Parent:
- 53:71f59e195f06
- Child:
- 55:e0e684531825
File content as of revision 54:a4c5949707ca:
#include "SETUP.hpp" #define Cubelet_data_ready 1 #define Not_Cubelet_data_ready 0 /* Colour lookup table 1 = White 2 = Red 3 = Orange 4 = Blue 5 = Green 6 = Yellow */ //Colours Cubelet_Colours_string[]; int SPI_RX_DATA = 0; int Cubelet_Colours[9] = {0,0,0,0,0,0,0,0,0};//9 cubelets store colours here int Received_data = 0; bool Data_from_slave[16] = {0}; //Interrupt service routine for handling the timeout of SW1 void SW1TimeOutHandler() { SW1TimeOut.detach(); //Stop the timeout counter firing SW1.fall(&SW1FallingEdge); //Now wait for a falling edge } //Interrupt service routive for SW2 falling edge (release) void SW1FallingEdge() { SW1.fall(NULL); //Disable this interrupt SW1TimeOut.attach(&SW1TimeOutHandler, SW1_SW2_Timeout_Time); //Start timeout counter } //Interrupt service routine for handling the timeout of SW2 void SW2TimeOutHandler() { SW2TimeOut.detach(); //Stop the timeout counter firing SW2.fall(&SW2FallingEdge); //Now wait for a falling edge } //Interrupt service routive for SW2 falling edge (release) void SW2FallingEdge() { SW2.fall(NULL); //Disable this interrupt SW2TimeOut.attach(&SW2TimeOutHandler, SW1_SW2_Timeout_Time); //Start timeout counter } void LCD_Output() { while(1) { //Write to the LCD } } void Serial_Commands() { while(1) { Serial_Commands_Output(); //Enable Serial Commands } } void LED_Logging() { while(1) { Log_Leds(); //Flashes the yellow led to indicate the logging mode } } void SPI_INTERFACE() { //pc.printf("SPI Test \n"); Thread::wait(1000); while(1) { //Do stuff cs= 0; SPI_RX_DATA = spi.write(0xF0); wait_us(3); cs= 1; //SPI_RX_DATA = SPI_RX_DATA >> 7; //SPI_RX_DATA = SPI_RX_DATA << 1; //std::bitset<16> bits(SPI_RX_DATA); //cout << bits << endl; //if(bits != 0) //{ //find the location possition //find the colour value //Store these values in to the tempory array //When all of the data is received all 9 cubelets set a global variable high / thread signal //} pc.printf("Received data = %d\n", SPI_RX_DATA); //wait_us(3); Thread::wait(1000); } } Colours convert (int Colour) { Colours colours_return_value; if(Colour == 1) { colours_return_value = White; } else if(Colour == 2) { colours_return_value = Red; } else if(Colour == 3) { colours_return_value = Orange; } else if(Colour == 4) { colours_return_value = Blue; } else if(Colour == 5) { colours_return_value = Green; } else if(Colour == 6) { colours_return_value = Yellow; } return colours_return_value; } void Store_Cubelet_data() { /* enum Colours//The posible colours of each point on the cube map { White,//Front Red,//Upper Orange,//Down Blue,//Left Green,//Right Yellow//Back }; */ //signal::wait(Cubelet_data_ready); if(Cubelet_Colours[5] == 1) { CubeMap[0][0][0] = convert(Cubelet_Colours[0]); CubeMap[0][0][1] = convert(Cubelet_Colours[1]); CubeMap[0][0][2] = convert(Cubelet_Colours[2]); CubeMap[0][1][0] = convert(Cubelet_Colours[3]); CubeMap[0][1][1] = convert(Cubelet_Colours[4]); CubeMap[0][1][2] = convert(Cubelet_Colours[5]); CubeMap[0][2][0] = convert(Cubelet_Colours[6]); CubeMap[0][2][1] = convert(Cubelet_Colours[7]); CubeMap[0][2][2] = convert(Cubelet_Colours[8]); //CubeMap[6][3][3] //Store this to the white face } } void Motor_Control() { while(1) { if(Motor_To_Select !=0 and steps !=0) { if(Motor_To_Select == 1) { STEPPER_MOTOR_1.Rotate_Steps(steps ,direction); //Motor_To_Select = 0; } else if(Motor_To_Select == 2) { STEPPER_MOTOR_2.Rotate_Steps(steps ,direction); //Motor_To_Select = 0; } else if(Motor_To_Select == 3) { STEPPER_MOTOR_3.Rotate_Steps(steps ,direction); //Motor_To_Select = 0; } else if(Motor_To_Select == 4) { STEPPER_MOTOR_4.Rotate_Steps(steps ,direction); //Motor_To_Select = 0; } else if(Motor_To_Select == 5) { STEPPER_MOTOR_5.Rotate_Steps(steps ,direction); //Motor_To_Select = 0; } else if(Motor_To_Select == 6) { STEPPER_MOTOR_6.Rotate_Steps(steps ,direction); //Motor_To_Select = 0; } } } } int main() { set_time(1515530152); //Sets time pc.baud(9600); //Sets the Serial Comms Baud Rate //SPI_INIT(); cs = 1; //Active Low // Setup the spi for 8 bit data, high steady state clock, // second edge capture, with a 1MHz clock rate spi.format(16,1); // 8 Data bits phase 0 polarity 0 spi.frequency(1000000);//Output clock frequency 1Mhz //post(); //Power on Self Test //Start Threads t1.start(Motor_Control); t2.start(SPI_INTERFACE); t3.start(Serial_Commands); //Interrupts SW1.fall(&SW1FallingEdge); SW2.fall(&SW2FallingEdge); //Main thread ID idMain = osThreadGetId(); //CMSIS RTOS call //Thread ID id1 = t1.gettid(); id2 = t2.gettid(); id3 = t3.gettid(); id4 = t4.gettid(); id5 = t5.gettid(); id6 = t6.gettid(); while(true) { //Do nothing main thread will sleep } }