Bavo Van Achte
Fork
Diff: main.cpp
- Revision:
- 5:daab0e0e67e2
- Parent:
- 4:8d7322108eb7
- Child:
- 6:019ab407ac3c
--- a/main.cpp Tue Jan 12 12:01:27 2021 +0000
+++ b/main.cpp Fri Jan 22 14:06:54 2021 +0000
@@ -1,211 +1,16 @@
#include "mbed.h"
#include "i2c_mbed_fpga.h"
+#include "main_init.h"
//#include "serial_fsm.h"
-/*Digital outputs*/
-DigitalOut led1(LED1);
-DigitalOut led2(LED2);
-DigitalOut led3(LED3);
-DigitalOut led4(LED4);
-DigitalOut fpga_rstb(p21); //p21 of MBED is connectted to p4 of the FPGA CMOD for 90415FPGA_EVB2
-/*Creat serial port to coummunicate with pc*/
-//Serial pc(USBTX, USBRX);
-
-///*Creat I2C master*/
-I2C i2c_master(p9, p10);
-
-//void serial_init(){
-// pc.format(8, SerialBase::None, 1);
-// pc.baud(38400);
-//}
-
-void i2c_init(){
- i2c_master.frequency(35000);
-}
-
-void main_init(){
- led1 = 1;
- led2 = 0;
- led3 = 0;
- led4 = 0;
-
- fpga_rstb = 0;
-
- i2c_init();
- //serial_init();
-
- //pc.printf("Mbed is ready!");
-}
/* Main function */
int main() {
-
- //char i2cWriteTest[4] = {0x13, 0x8a, 0xac, 0x35};
- //char i2cReadTest[4] = {0x13, 0x8a, 0x00, 0x00};
-
- //NV_POSITION
- #define NV_POSITION_DUTY (14 - 8)
- #define NV_POSITION_PULSE_TIME (9 - 8)
- #define NV_POSI_MAJO_VOTE (8 - 8)
- #define NV_ANTI_COG 7
- #define NV_FIRST_NON_FLAT_TIME 0
-
- #define OTP_I2C_POSITIONPULSE_DATA_H (0x03 << NV_POSITION_DUTY) | (0x09 << NV_POSITION_PULSE_TIME) | (0x00 << NV_POSI_MAJO_VOTE)
- #define OTP_I2C_POSITIONPULSE_DATA_L (0x00 << NV_ANTI_COG) | (0x2c << NV_FIRST_NON_FLAT_TIME)
-
- #define OTP_I2C_POSITIONPULSE_ADDR_H 0x13
- #define OTP_I2C_POSITIONPULSE_ADDR_L 0x82
- char i2cPositionPulseSetup[4] = {OTP_I2C_POSITIONPULSE_ADDR_H, OTP_I2C_POSITIONPULSE_ADDR_L, OTP_I2C_POSITIONPULSE_DATA_H,OTP_I2C_POSITIONPULSE_DATA_L};
-
- //NV_START_UP
- #define NV_LONG_START (14 - 8)
- #define NV_SOFT_START (13 - 8)
- #define NV_COMM_START_NUM (11 - 8)
- #define NV_START_DUTY (9 - 8)
- #define NV_SOFT_STEP_SIZE 6
- #define NV_START_UP_TIME 0
-
- #define OTP_I2C_STARTUP_DATA_H (0x00 << NV_SOFT_START) | (0x00 << NV_LONG_START) | (0x02 << NV_COMM_START_NUM) | (0x03 << NV_START_DUTY)
- #define OTP_I2C_STARTUP_DATA_L (0x03 << NV_SOFT_STEP_SIZE) | (0x24 << NV_START_UP_TIME)
-
- #define OTP_I2C_STARTUP_ADDR_H 0x13
- #define OTP_I2C_STARTUP_ADDR_L 0x84
-
- char i2cStartUpSetup[4] = {OTP_I2C_STARTUP_ADDR_H, OTP_I2C_STARTUP_ADDR_L, OTP_I2C_STARTUP_DATA_H, OTP_I2C_STARTUP_DATA_L};
-
- //Start Motor
- #define OTP_MOTOR_START_ADDR_H 0x13
- #define OTP_MOTOR_START_ADDR_L 0xa4
- #define OTP_MOTOR_START_DATA_H 0xca
- #define OTP_MOTOR_START_DATA_L 0xfe
-
- char i2cMotorStartSetup[4] = {OTP_MOTOR_START_ADDR_H, \
- OTP_MOTOR_START_ADDR_L, \
- OTP_MOTOR_START_DATA_H, \
- OTP_MOTOR_START_DATA_L};
-
- int ack;
+
+ i2c_mbed_fpga i2c;
main_init();
- wait_ms(2000); //reset the FPGA for 2s
- fpga_rstb = 1; //enable FPGA
- wait_ms(1);
-
- //Postion Test Pulse setting
- char i2cPositionPulseRead[4] = {OTP_I2C_POSITIONPULSE_ADDR_H, \
- OTP_I2C_POSITIONPULSE_ADDR_L, \
- 0x00, \
- 0x00};
- int i = 3;
- while (i > 0) {
- wait_ms(1);
- ack+=i2c_word_write(i2c_master,i2cPositionPulseSetup);
- wait_ms(1);
- ack+=i2c_word_read(i2c_master,i2cPositionPulseRead);
- if( (i2cPositionPulseRead[1] == OTP_I2C_POSITIONPULSE_DATA_H) && (i2cPositionPulseRead[0] == OTP_I2C_POSITIONPULSE_DATA_L) ){
- i=0;
- led1 = 1;
- led2 = 0;
- }
- else{
- i--;
- led1 = 0;
- led2 = 1;
- fpga_rstb = 0; //disable FPGA
- };
- }
-
-
-
- //Start Up setting
- char i2cStartUpPulseRead[4] = {OTP_I2C_STARTUP_ADDR_H, \
- OTP_I2C_STARTUP_ADDR_L, \
- 0x00, \
- 0x00};
- i = 3;
- while (i > 0) {
- wait_ms(1);
- ack+=i2c_word_write(i2c_master,i2cStartUpSetup);
- wait_ms(1);
- ack+=i2c_word_read(i2c_master,i2cStartUpPulseRead);
- if( (i2cStartUpPulseRead[1] == OTP_I2C_STARTUP_DATA_H) && (i2cStartUpPulseRead[0] == OTP_I2C_STARTUP_DATA_L) ){
- i=0;
- led3 = 1;
- led4 = 0;
- }
- else{
- i--;
- led3 = 0;
- led4 = 1;
- fpga_rstb = 0; //disable FPGA
- };
- }
-
-
- //ack+=i2c_word_write(i2c_master,i2cMotorStartSetup);
-
- while (1) {
- //char c = pc.getc();
- //if(c=='s'){
- //fpga_rstb = 0; //reset FPGA
- //wait_ms(3000);
- //fpga_rstb = 1; //enable FPGA
- //wait_ms(10);
- //i2c_keyEntry(i2c_master);
- //ack+=i2c_word_write(i2c_master,i2cPositionPulseSetup);
- //wait_us(100);
- //ack+=i2c_word_read(i2c_master,i2cPositionPulseSetup);
- //ack+=i2c_word_write(i2c_master,i2cStartMotor);
- //wait_ms(10);
- //ack+=i2c_word_read(i2c_master,i2cStartUpRead);
- //led1 = ack;
- //pc.printf("d[0]=%2d\n",i2cStartUpRead[3]);
- //pc.printf("d[1]=%2d\n",i2cStartUpRead[2]);
- //}
- //if(c=='t'){
- // fpga_rstb = 0; //disable FPGA
- // led1 = 0;
-
- //}
- }
+ while (1) {}
-
-
-// fpga_rstb.write(1);
-//
-// wait_us(10000); //10ms
-//
-//// i2c_master.start();
-//// wait_ms(200);
-//// i2c_master.stop();
-//
-// ack+=i2c_keyEntry(i2c_master);
-//
-// //ack+=ctrPort_ReadActive(i2c_master);
-// buff[0] = 0x00;
-// buff[1] = 0x30;
-// buff[2] = 0x00;
-// buff[3] = 0x01;
-//
-// ack+=i2c_word_write(i2c_master, buff);
-// buff[0] = 0x00;
-// buff[1] = 0x0A;
-// buff[2] = 0x00;
-// buff[3] = 0x00;
-//
-// ack+=i2c_word_read(i2c_master, buff);
-//
-// wait_us(100);
-//
-// pc.printf("d[0]=%2d\n", buff[3]);
-// pc.printf("d[1]=%2d\n", buff[2]);
-// pc.printf("ack=%2d\n", ack);
-// pc.printf("endl\n");
-//
-//
-// while (1) {
-// led1 = !led1;
-// wait(1);
-// }
}
\ No newline at end of file