void update_lcd(int freq, int dutycycle, u32 linenum) {
PMDIO_LCD_setcursor(linenum, 5);
PMDIO_LCD_wrstring(" ");
PMDIO_LCD_setcursor(linenum, 5);
// write the frequency
if (freq < 1000) { // display Hz if frequency < 1KHz
PMDIO_LCD_putnum(freq, 10);
}
else if (freq < 1000000) { // display Hz if frequency < 1MHz
PMDIO_LCD_putnum((freq / 1000), 10);
PMDIO_LCD_wrstring("K");
}
else { // otherwise, use the MHz suffix
PMDIO_LCD_putnum((freq / 1000000), 10);
PMDIO_LCD_wrstring("M");
}
// write the duty cycle
PMDIO_LCD_setcursor(linenum, 13);
PMDIO_LCD_wrstring(" %");
PMDIO_LCD_setcursor(linenum, 13);
PMDIO_LCD_putnum(dutycycle, 10);
}
void errorExit(void) {
PMDIO_LCD_setcursor(1,0);
PMDIO_LCD_wrstring("****** ERROR *******");
PMDIO_LCD_setcursor(2,0);
PMDIO_LCD_wrstring("INIT FAILED- EXITING");
exit(XST_FAILURE);
}
void update_lcd(int freq, int dutycycle, u32 linenum) {
PMDIO_LCD_setcursor(linenum, 5);
PMDIO_LCD_wrstring(" ");
PMDIO_LCD_setcursor(linenum, 5);
if (freq < 1000) { // display Hz if frequency < 1Khz
PMDIO_LCD_putnum(freq, 10);
}
else if (freq < 1000000) { // display frequency in KHz
PMDIO_LCD_putnum((freq / 1000), 10);
PMDIO_LCD_wrstring("K");
}
else { // display frequency in KHz
PMDIO_LCD_putnum((freq / 1000000), 10);
PMDIO_LCD_wrstring("M");
}
PMDIO_LCD_setcursor(linenum, 13);
PMDIO_LCD_wrstring(" %");
PMDIO_LCD_setcursor(linenum, 13);
PMDIO_LCD_putnum(dutycycle, 10);
}
void init_welcom(void) {
// display the greeting
PMDIO_LCD_setcursor(1,0);
PMDIO_LCD_wrstring(" Project 01 ");
PMDIO_LCD_setcursor(2,0);
PMDIO_LCD_wrstring(" by Chad Sutfin ");
NX4IO_setLEDs(0x0000FFFF);
MB_Sleep(2000);
NX4IO_setLEDs(0x00000000);
// write the static text to the display
PMDIO_LCD_clrd();
PMDIO_LCD_setcursor(1,0);
PMDIO_LCD_wrstring("G|FR: DCY: %");
PMDIO_LCD_setcursor(2,0);
PMDIO_LCD_wrstring("M|FR: DCY: %");
// turn off the LEDs and clear the seven segment display
NX4IO_setLEDs(0x00000000);
NX410_SSEG_setAllDigits(SSEGLO, CC_BLANK, CC_BLANK, CC_BLANK, CC_BLANK, DP_NONE);
NX410_SSEG_setAllDigits(SSEGHI, CC_BLANK, CC_BLANK, CC_BLANK, CC_BLANK, DP_NONE);
}
int main() {
XStatus status;
u16 sw, oldSw =0xFFFF; // 0xFFFF is invalid --> makes sure the PWM freq is updated 1st time
int rotcnt, oldRotcnt = 0x1000;
bool done = false;
bool hw_switch = 0;
init_platform();
// initialize devices and set up interrupts, etc.
status = do_init();
if (status != XST_SUCCESS) {
PMDIO_LCD_setcursor(1,0);
PMDIO_LCD_wrstring("****** ERROR *******");
PMDIO_LCD_setcursor(2,0);
PMDIO_LCD_wrstring("INIT FAILED- EXITING");
exit(XST_FAILURE);
}
// initialize the global variables
timestamp = 0;
pwm_freq = INITIAL_FREQUENCY;
pwm_duty = INITIAL_DUTY_CYCLE;
clkfit = 0;
new_perduty = false;
// start the PWM timer and kick of the processing by enabling the Microblaze interrupt
PWM_SetParams(&PWMTimerInst, pwm_freq, pwm_duty);
PWM_Start(&PWMTimerInst);
microblaze_enable_interrupts();
// display the greeting
PMDIO_LCD_setcursor(1,0);
PMDIO_LCD_wrstring("ECE544 Project 1");
PMDIO_LCD_setcursor(2,0);
PMDIO_LCD_wrstring(" by Rehan Iqbal ");
NX4IO_setLEDs(0x0000FFFF);
delay_msecs(2000);
NX4IO_setLEDs(0x00000000);
// write the static text to the display
PMDIO_LCD_clrd();
PMDIO_LCD_setcursor(1,0);
PMDIO_LCD_wrstring("G|FR: DCY: %");
PMDIO_LCD_setcursor(2,0);
PMDIO_LCD_wrstring("D|FR: DCY: %");
// turn off the LEDs and clear the seven segment display
NX4IO_setLEDs(0x00000000);
NX410_SSEG_setAllDigits(SSEGLO, CC_BLANK, CC_BLANK, CC_BLANK, CC_BLANK, DP_NONE);
NX410_SSEG_setAllDigits(SSEGHI, CC_BLANK, CC_BLANK, CC_BLANK, CC_BLANK, DP_NONE);
// main loop
do {
// check rotary encoder pushbutton to see if it's time to quit
if (PMDIO_ROT_isBtnPressed()) {
done = true;
}
else {
new_perduty = false;
// get the switches and mask out all but the switches that determine the PWM timer frequency
sw &= PWM_FREQ_MSK;
sw = NX4IO_getSwitches();
if (sw != oldSw) {
// check the status of sw[2:0] and assign appropriate PWM output frequency
switch (sw & 0x07) {
case 0x00: pwm_freq = PWM_FREQ_100HZ; break;
case 0x01: pwm_freq = PWM_FREQ_1KHZ; break;
case 0x02: pwm_freq = PWM_FREQ_10KHZ; break;
case 0x03: pwm_freq = PWM_FREQ_50KHZ; break;
case 0x04: pwm_freq = PWM_FREQ_100KHZ; break;
case 0x05: pwm_freq = PWM_FREQ_500KHZ; break;
case 0x06: pwm_freq = PWM_FREQ_1MHZ; break;
case 0x07: pwm_freq = PWM_FREQ_5MHZ; break;
}
// check the status of sw[3] and assign to global variable
hw_switch = (sw & 0x08);
// update global variable indicating there are new changes
oldSw = sw;
new_perduty = true;
}
// read rotary count and handle duty cycle changes
// limit duty cycle to 0% to 99%
PMDIO_ROT_readRotcnt(&rotcnt);
if (rotcnt != oldRotcnt) {
// show the rotary count in hex on the seven segment display
NX4IO_SSEG_putU16Hex(SSEGLO, rotcnt);
// change the duty cycle
pwm_duty = MAX(1, MIN(rotcnt, 99));
oldRotcnt = rotcnt;
new_perduty = true;
}
// update generated frequency and duty cycle
if (new_perduty) {
u32 freq,
dutycycle;
unsigned int detect_freq = 0x00;
unsigned int detect_duty = 0x00;
// set the new PWM parameters - PWM_SetParams stops the timer
status = PWM_SetParams(&PWMTimerInst, pwm_freq, pwm_duty);
if (status == XST_SUCCESS) {
PWM_GetParams(&PWMTimerInst, &freq, &dutycycle);
update_lcd(freq, dutycycle, 1);
// check if sw[3] is high or low (HWDET / SWDET)
// pass functions different args depending on which mode is selected
if (hw_switch) {
detect_freq = calc_freq(hw_high_count, hw_low_count, hw_switch);
detect_duty = calc_duty(hw_high_count, hw_low_count);
}
else {
detect_freq = calc_freq(sw_high_count, sw_low_count, hw_switch);
detect_duty = calc_duty(sw_high_count, sw_low_count);
}
// update the LCD display with detected frequency & duty cycle
update_lcd(detect_freq, detect_duty, 2);
PWM_Start(&PWMTimerInst);
}
}
}
} while (!done);
// wait until rotary encoder button is released
do {
delay_msecs(10);
} while (PMDIO_ROT_isBtnPressed());
// we're done, say goodbye
xil_printf("\nThat's All Folks!\n\n");
PMDIO_LCD_setcursor(1,0);
PMDIO_LCD_wrstring("That's All Folks");
PMDIO_LCD_setcursor(2,0);
PMDIO_LCD_wrstring(" ");
NX410_SSEG_setAllDigits(SSEGHI, CC_BLANK, CC_B, CC_LCY, CC_E, DP_NONE);
NX410_SSEG_setAllDigits(SSEGLO, CC_B, CC_LCY, CC_E, CC_BLANK, DP_NONE);
delay_msecs(5000);
// turn the lights out
PMDIO_LCD_clrd();
NX410_SSEG_setAllDigits(SSEGHI, CC_BLANK, CC_BLANK, CC_BLANK, CC_BLANK, DP_NONE);
NX410_SSEG_setAllDigits(SSEGLO, CC_BLANK, CC_BLANK, CC_BLANK, CC_BLANK, DP_NONE);
NX4IO_RGBLED_setDutyCycle(RGB1, 0, 0, 0);
NX4IO_RGBLED_setChnlEn(RGB1, false, false, false);
// exit gracefully
cleanup_platform();
exit(0);
}