2016年6月9日木曜日

PSoC4 DCOの単体テスト(割り込みがかからない現象を追い込む)

SPI受信の処理を外して、シーケンスをTimer割り込みで処理するようにしてみた。

単純にSPIの処理を外しただけだと割り込みがかからなく現象は改善されなかったが、波形が開始するタイミングでTimerのPeriodを変更するようにしたらゴソッと割り込みがかからなくなる現象は起こらなくなった。

PSoC CreatorのTopDesign

SPISはDisableしている。

単にSPIからTimerに周波数変更の割り込みを変更した場合


ch1:Pin_Check1 ch2:Pin_Check2

ch1のPin_Check1はシーケンス処理をするTimer1の割り込みを捕捉。ch2のPin_Check2は波形を生成するTimer_Samplingの割り込みを捕捉。Timer_Samplingの割り込みが2.8m秒程度かからなくなっている。


ch1:出力波形 ch2:Pin_Check2

Timer_Samplingの割り込みがかからない区間で波形が崩れる。

拡大

波形の開始地点でTimer_SamplingのPeriodを変更。5ミリ秒間隔で周波数を変更。

main.c

/* ========================================
 *
 * Copyright YOUR COMPANY, THE YEAR
 * All Rights Reserved
 * UNPUBLISHED, LICENSED SOFTWARE.
 *
 * CONFIDENTIAL AND PROPRIETARY INFORMATION
 * WHICH IS THE PROPERTY OF your company.
 *
 * ========================================
*/
#include <project.h>
#include <stdio.h>

#define UART_TRACE  (0)
#define LCD_DISPLAY (0)

#define TITLE_STR1  ("PSoC 4 DCO")
#define TITLE_STR2  ("20160609")

#define SAMPLING_CLOCK           (24000000)
#define SPIS_RX_PACKET_SIZE      (5)
#define SPIS_RX_PACKET_HEADER    (0x55)

#define WAVESHAPE_SQUARE    0
#define WAVESHAPE_SAW       1
#define WAVESHAPE_N         2

volatile uint8 count = 0;
volatile uint16 timerPeriod = 100;
volatile int toChangePeriod = 0;

uint8 waveShape   = WAVESHAPE_SAW;
uint8 squareDuty  = 127;
int32 frequency10 = 4400;

#if(LCD_DISPLAY)
void printLCD(uint8* rxBuffer)
{
    char strBuffer[20];
    sprintf(strBuffer, "%3u %3u %3u %3u",
    rxBuffer[0], rxBuffer[1], rxBuffer[2], rxBuffer[3]);
    LCD_Char_Position(0, 0);
    LCD_Char_PrintString(strBuffer);
    sprintf(strBuffer, "%3u %5ld", rxBuffer[4], frequency10);
    LCD_Char_Position(1, 0);
    LCD_Char_PrintString(strBuffer);
}
#endif

CY_ISR(ISR_Saw_handler)
{
    Pin_Check2_Write(1);
    
    count++;
    if (count == 0 && toChangePeriod) {
        Timer_Sampling_WritePeriod(timerPeriod);
        toChangePeriod = 0;
    }
        
    IDAC8_SetValue(count);
 
    Timer_Sampling_ClearInterrupt(Timer_Sampling_INTR_MASK_TC);
    
    Pin_Check2_Write(0);
}

CY_ISR(ISR_Square_handler)
{
    Pin_Check2_Write(1);
    
    count++;
    if (count == 0 && toChangePeriod) {
        Timer_Sampling_WritePeriod(timerPeriod);
        toChangePeriod = 0;
    }
    IDAC8_SetValue((count / squareDuty) ? 255 : 0);    
    
    Timer_Sampling_ClearInterrupt(Timer_Sampling_INTR_MASK_TC);

    Pin_Check2_Write(0);    
}

void doCommand(uint8 *rxBuffer)
{
    if (waveShape != rxBuffer[1]) {
        waveShape = rxBuffer[1];
        switch (waveShape) {
        case WAVESHAPE_SQUARE:
            ISR_Timer_Sampling_StartEx(ISR_Square_handler);
            break;
        case WAVESHAPE_SAW:
            ISR_Timer_Sampling_StartEx(ISR_Saw_handler);
            break;
        }
    }

    squareDuty = rxBuffer[2];
    frequency10 = ((uint16)rxBuffer[3] << 8) | rxBuffer[4];
    
    timerPeriod = (uint64)SAMPLING_CLOCK * 10 / (frequency10 * 256);
    toChangePeriod = 1;
}

#define CNT_MAX (125)

CY_ISR(ISR_Timer1_handler)
{
    const uint16 freq10Arr[] = { 654, 1308 };
    static int cnt = 0;
    static int idx = 0;
    static int f_delta = 0;
    static uint8 rxBuffer[] = {
        SPIS_RX_PACKET_HEADER, WAVESHAPE_SQUARE, 127, 0x00, 0x00
    };
    
    Pin_Check1_Write(1);

    cnt++;
    if (cnt == CNT_MAX) {
        cnt = 0;
        idx++;
        if (idx > 1) {
            idx = 0;
        }
        frequency10 = freq10Arr[idx];
        f_delta = (freq10Arr[(idx == 0) ? 1 : 0] - frequency10) / CNT_MAX;
    }
    frequency10 += f_delta;
    rxBuffer[3] = frequency10 >> 8;
    rxBuffer[4] = frequency10 & 0xff;
    #if(LCD_DISPLAY)
    printLCD(rxBuffer);
    #endif
    doCommand(rxBuffer);

    Timer1_ClearInterrupt(Timer_Sampling_INTR_MASK_TC);
    
    Pin_Check1_Write(0);
}

int main()
{
    CyGlobalIntEnable; /* Enable global interrupts. */

    #if(UART_TRACE)
    UART_Start();
    UART_UartPutString("PSoC 4 SPI Slave Test\r\n");
    #endif
    
    #if(LCD_DISPLAY)
    LCD_Char_Start();
    LCD_Char_ClearDisplay();
    LCD_Char_PrintString(TITLE_STR1);
    LCD_Char_Position(1, 0);
    LCD_Char_PrintString(TITLE_STR2);
    CyDelay(1000);
    #endif
    
    IDAC8_Start();
    Opamp_IV_Conv_Start();

    Timer_Sampling_Start();
    ISR_Timer_Sampling_StartEx(ISR_Saw_handler);
    
    Timer1_Start();
    ISR_Timer1_StartEx(ISR_Timer1_handler);

    for(;;)
    {
    }
}

/* [] END OF FILE */

BPM120/16Stepで4StepごとにC(ド)の音を1オクターブ上下させて、線形補間している。補完の間隔が5m秒。

オシロでトリガを掛けてしばらく様子を見てみたが、Timer_Samplingの割り込みが掛からなくなることはなくなったようだ。

※LCD表示を有効化すると割り込みが遅延する。

Github:
https://github.com/ryood/PSoC4_DCO/tree/master/PSoC/PSoC4_DCO_No_SPI_Interrupt_Test.cydsn

メモ:


うまくいった理由はよくわからないが、波形の開始地点でPeriodを更新するようにしたことよりもTimer_Sapmlingの割り込みのタイミングで更新しているからなのかもしれない。

波形の開始地点でTimer_SamplingのPeriod更新すると単波形の波形の崩れもなくなるので、これはこれでよさそう。

ToDo: SPIマスターからの命令で周波数を変更するようにする。
→これでまたおかしくなるようなら、ノコギリ波はDDS、矩形波はPWMで生成するように根本から変更。DDSのノコギリ波は波形がいまいちなのでできれば現状の方法でやりたい。

ノコギリ波ぐらいは、プログラムではなくてPSoCのUDB(プチFPGA?)で実装できないかと妄想中。

0 件のコメント:

コメントを投稿