From 4aba3805bfb120c16df78e3241cf98d17ecb8619 Mon Sep 17 00:00:00 2001 From: probonopd Date: Sun, 6 Feb 2022 13:14:11 +0000 Subject: [PATCH] Try to port miniorgan Does not work yet --- src/kernel.cpp | 6 + src/kernel.h | 35 +++++ src/miniorgan.cpp | 375 ++++++++++++++++++++++++++++++++++++++++++++++ src/miniorgan.h | 102 +++++++++++++ 4 files changed, 518 insertions(+) create mode 100644 src/miniorgan.cpp create mode 100644 src/miniorgan.h diff --git a/src/kernel.cpp b/src/kernel.cpp index 0282575..4e89095 100644 --- a/src/kernel.cpp +++ b/src/kernel.cpp @@ -7,6 +7,12 @@ CKernel::CKernel (void) : CStdlibAppStdio ("minidexed") { + m_Screen (m_Options.GetWidth (), m_Options.GetHeight ()), + m_Timer (&m_Interrupt), + m_Logger (m_Options.GetLogLevel (), &m_Timer), + m_I2CMaster (CMachineInfo::Get ()->GetDevice (DeviceI2CMaster), TRUE), + m_USBHCI (&m_Interrupt, &m_Timer, TRUE), // TRUE: enable plug-and-play + m_MiniOrgan (&m_Interrupt, &m_I2CMaster) mActLED.Blink (5); // show we are alive } diff --git a/src/kernel.h b/src/kernel.h index 7c01378..3bb0c4b 100644 --- a/src/kernel.h +++ b/src/kernel.h @@ -5,15 +5,50 @@ #define _kernel_h #include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "miniorgan.h" + +enum TShutdownMode +{ + ShutdownNone, + ShutdownHalt, + ShutdownReboot +}; class CKernel : public CStdlibAppStdio { public: CKernel (void); + ~CKernel (void); bool Initialize (void); TShutdownMode Run (void); + +private: + // do not change this order + CActLED m_ActLED; + CKernelOptions m_Options; + CDeviceNameService m_DeviceNameService; + CScreenDevice m_Screen; + CExceptionHandler m_ExceptionHandler; + CInterruptSystem m_Interrupt; + CTimer m_Timer; + CLogger m_Logger; + CI2CMaster m_I2CMaster; + CUSBHCIDevice m_USBHCI; + + CMiniOrgan m_MiniOrgan; }; #endif diff --git a/src/miniorgan.cpp b/src/miniorgan.cpp new file mode 100644 index 0000000..25ad6e0 --- /dev/null +++ b/src/miniorgan.cpp @@ -0,0 +1,375 @@ +// +// miniorgan.cpp +// +// Circle - A C++ bare metal environment for Raspberry Pi +// Copyright (C) 2017-2021 R. Stange +// +// This program is free software: you can redistribute it and/or modify +// it under the terms of the GNU General Public License as published by +// the Free Software Foundation, either version 3 of the License, or +// (at your option) any later version. +// +// This program is distributed in the hope that it will be useful, +// but WITHOUT ANY WARRANTY; without even the implied warranty of +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +// GNU General Public License for more details. +// +// You should have received a copy of the GNU General Public License +// along with this program. If not, see . +// +#include "miniorgan.h" +#include +#include +#include + +#define VOLUME_PERCENT 20 + +#define MIDI_NOTE_OFF 0b1000 +#define MIDI_NOTE_ON 0b1001 + +#define KEY_NONE 255 + +static const char FromMiniOrgan[] = "organ"; + +// See: http://www.deimos.ca/notefreqs/ +const float CMiniOrgan::s_KeyFrequency[/* MIDI key number */] = +{ + 8.17580, 8.66196, 9.17702, 9.72272, 10.3009, 10.9134, 11.5623, 12.2499, 12.9783, 13.7500, + 14.5676, 15.4339, 16.3516, 17.3239, 18.3540, 19.4454, 20.6017, 21.8268, 23.1247, 24.4997, + 25.9565, 27.5000, 29.1352, 30.8677, 32.7032, 34.6478, 36.7081, 38.8909, 41.2034, 43.6535, + 46.2493, 48.9994, 51.9131, 55.0000, 58.2705, 61.7354, 65.4064, 69.2957, 73.4162, 77.7817, + 82.4069, 87.3071, 92.4986, 97.9989, 103.826, 110.000, 116.541, 123.471, 130.813, 138.591, + 146.832, 155.563, 164.814, 174.614, 184.997, 195.998, 207.652, 220.000, 233.082, 246.942, + 261.626, 277.183, 293.665, 311.127, 329.628, 349.228, 369.994, 391.995, 415.305, 440.000, + 466.164, 493.883, 523.251, 554.365, 587.330, 622.254, 659.255, 698.456, 739.989, 783.991, + 830.609, 880.000, 932.328, 987.767, 1046.50, 1108.73, 1174.66, 1244.51, 1318.51, 1396.91, + 1479.98, 1567.98, 1661.22, 1760.00, 1864.66, 1975.53, 2093.00, 2217.46, 2349.32, 2489.02, + 2637.02, 2793.83, 2959.96, 3135.96, 3322.44, 3520.00, 3729.31, 3951.07, 4186.01, 4434.92, + 4698.64, 4978.03, 5274.04, 5587.65, 5919.91, 6271.93, 6644.88, 7040.00, 7458.62, 7902.13, + 8372.02, 8869.84, 9397.27, 9956.06, 10548.1, 11175.3, 11839.8, 12543.9 +}; + +const TNoteInfo CMiniOrgan::s_Keys[] = +{ + {',', 72}, // C4 + {'M', 71}, // B4 + {'J', 70}, // A#4 + {'N', 69}, // A4 + {'H', 68}, // G#3 + {'B', 67}, // G3 + {'G', 66}, // F#3 + {'V', 65}, // F3 + {'C', 64}, // E3 + {'D', 63}, // D#3 + {'X', 62}, // D3 + {'S', 61}, // C#3 + {'Z', 60} // C3 +}; + +CMiniOrgan *CMiniOrgan::s_pThis = 0; + +CMiniOrgan::CMiniOrgan (CInterruptSystem *pInterrupt, CI2CMaster *pI2CMaster) +: SOUND_CLASS (pInterrupt, SAMPLE_RATE, CHUNK_SIZE +#ifdef USE_I2S + , FALSE, pI2CMaster, DAC_I2C_ADDRESS +#endif + ), + m_pMIDIDevice (0), + m_pKeyboard (0), + m_Serial (pInterrupt, TRUE), + m_bUseSerial (FALSE), + m_nSerialState (0), + m_nSampleCount (0), + m_nFrequency (0), + m_nPrevFrequency (0), + m_ucKeyNumber (KEY_NONE) +{ + s_pThis = this; + + m_nLowLevel = GetRangeMin () * VOLUME_PERCENT / 100; + m_nHighLevel = GetRangeMax () * VOLUME_PERCENT / 100; + m_nNullLevel = (m_nHighLevel + m_nLowLevel) / 2; + m_nCurrentLevel = m_nNullLevel; +} + +CMiniOrgan::~CMiniOrgan (void) +{ + s_pThis = 0; +} + +boolean CMiniOrgan::Initialize (void) +{ + CLogger::Get ()->Write (FromMiniOrgan, LogNotice, + "Please attach an USB keyboard or use serial MIDI!"); + + if (m_Serial.Initialize (31250)) + { + m_bUseSerial = TRUE; + + return TRUE; + } + + return FALSE; +} + +void CMiniOrgan::Process (boolean bPlugAndPlayUpdated) +{ + if (m_pMIDIDevice != 0) + { + return; + } + + if (bPlugAndPlayUpdated) + { + m_pMIDIDevice = + (CUSBMIDIDevice *) CDeviceNameService::Get ()->GetDevice ("umidi1", FALSE); + if (m_pMIDIDevice != 0) + { + m_pMIDIDevice->RegisterRemovedHandler (USBDeviceRemovedHandler); + m_pMIDIDevice->RegisterPacketHandler (MIDIPacketHandler); + + return; + } + } + + if (m_pKeyboard != 0) + { + return; + } + + if (bPlugAndPlayUpdated) + { + m_pKeyboard = + (CUSBKeyboardDevice *) CDeviceNameService::Get ()->GetDevice ("ukbd1", FALSE); + if (m_pKeyboard != 0) + { + m_pKeyboard->RegisterRemovedHandler (USBDeviceRemovedHandler); + m_pKeyboard->RegisterKeyStatusHandlerRaw (KeyStatusHandlerRaw); + + return; + } + } + + if (!m_bUseSerial) + { + return; + } + + // Read serial MIDI data + u8 Buffer[20]; + int nResult = m_Serial.Read (Buffer, sizeof Buffer); + if (nResult <= 0) + { + return; + } + + // Process MIDI messages + // See: https://www.midi.org/specifications/item/table-1-summary-of-midi-message + for (int i = 0; i < nResult; i++) + { + u8 uchData = Buffer[i]; + + switch (m_nSerialState) + { + case 0: + MIDIRestart: + if ((uchData & 0xE0) == 0x80) // Note on or off, all channels + { + m_SerialMessage[m_nSerialState++] = uchData; + } + break; + + case 1: + case 2: + if (uchData & 0x80) // got status when parameter expected + { + m_nSerialState = 0; + + goto MIDIRestart; + } + + m_SerialMessage[m_nSerialState++] = uchData; + + if (m_nSerialState == 3) // message is complete + { + MIDIPacketHandler (0, m_SerialMessage, sizeof m_SerialMessage); + + m_nSerialState = 0; + } + break; + + default: + assert (0); + break; + } + } +} + +unsigned CMiniOrgan::GetChunk (u32 *pBuffer, unsigned nChunkSize) +{ + unsigned nResult = nChunkSize; + + // reset sample counter if key has changed + if (m_nFrequency != m_nPrevFrequency) + { + m_nSampleCount = 0; + + m_nPrevFrequency = m_nFrequency; + } + + // output level has to be changed on every nSampleDelay'th sample (if key is pressed) + unsigned nSampleDelay = 0; + if (m_nFrequency != 0) + { + nSampleDelay = (SAMPLE_RATE/2 + m_nFrequency/2) / m_nFrequency; + } + +#ifdef USE_HDMI + unsigned nFrame = 0; +#endif + for (; nChunkSize > 0; nChunkSize -= 2) // fill the whole buffer + { + u32 nSample = (u32) m_nNullLevel; + + if (m_nFrequency != 0) // key pressed? + { + // change output level if required to generate a square wave + if (++m_nSampleCount >= nSampleDelay) + { + m_nSampleCount = 0; + + if (m_nCurrentLevel < m_nHighLevel) + { + m_nCurrentLevel = m_nHighLevel; + } + else + { + m_nCurrentLevel = m_nLowLevel; + } + } + + nSample = (u32) m_nCurrentLevel; + } + +#ifdef USE_HDMI + nSample = ConvertIEC958Sample (nSample, nFrame); + + if (++nFrame == IEC958_FRAMES_PER_BLOCK) + { + nFrame = 0; + } +#endif + + *pBuffer++ = nSample; // 2 stereo channels + *pBuffer++ = nSample; + } + + return nResult; +} + +void CMiniOrgan::MIDIPacketHandler (unsigned nCable, u8 *pPacket, unsigned nLength) +{ + assert (s_pThis != 0); + + // The packet contents are just normal MIDI data - see + // https://www.midi.org/specifications/item/table-1-summary-of-midi-message + + if (nLength < 3) + { + return; + } + + u8 ucStatus = pPacket[0]; + //u8 ucChannel = ucStatus & 0x0F; + u8 ucType = ucStatus >> 4; + u8 ucKeyNumber = pPacket[1]; + u8 ucVelocity = pPacket[2]; + + if (ucType == MIDI_NOTE_ON) + { + if ( ucVelocity > 0 + && ucKeyNumber < sizeof s_KeyFrequency / sizeof s_KeyFrequency[0]) + { + s_pThis->m_ucKeyNumber = ucKeyNumber; + s_pThis->m_nFrequency = (unsigned) (s_KeyFrequency[ucKeyNumber] + 0.5); + } + else + { + if (s_pThis->m_ucKeyNumber == ucKeyNumber) + { + s_pThis->m_ucKeyNumber = KEY_NONE; + s_pThis->m_nFrequency = 0; + } + } + } + else if (ucType == MIDI_NOTE_OFF) + { + if (s_pThis->m_ucKeyNumber == ucKeyNumber) + { + s_pThis->m_ucKeyNumber = KEY_NONE; + s_pThis->m_nFrequency = 0; + } + } +} + +void CMiniOrgan::KeyStatusHandlerRaw (unsigned char ucModifiers, const unsigned char RawKeys[6]) +{ + assert (s_pThis != 0); + + // find the key code of a pressed key + char chKey = '\0'; + for (unsigned i = 0; i <= 5; i++) + { + u8 ucKeyCode = RawKeys[i]; + if (ucKeyCode != 0) + { + if (0x04 <= ucKeyCode && ucKeyCode <= 0x1D) + { + chKey = RawKeys[i]-0x04+'A'; // key code of 'A' is 0x04 + } + else if (ucKeyCode == 0x36) + { + chKey = ','; // key code of ',' is 0x36 + } + + break; + } + } + + if (chKey != '\0') + { + // find the pressed key in the key table and set its frequency + for (unsigned i = 0; i < sizeof s_Keys / sizeof s_Keys[0]; i++) + { + if (s_Keys[i].Key == chKey) + { + u8 ucKeyNumber = s_Keys[i].KeyNumber; + + assert (ucKeyNumber < sizeof s_KeyFrequency / sizeof s_KeyFrequency[0]); + s_pThis->m_nFrequency = (unsigned) (s_KeyFrequency[ucKeyNumber] + 0.5); + + return; + } + } + } + + s_pThis->m_nFrequency = 0; +} + +void CMiniOrgan::USBDeviceRemovedHandler (CDevice *pDevice, void *pContext) +{ + assert (s_pThis != 0); + + if (s_pThis->m_pMIDIDevice == (CUSBMIDIDevice *) pDevice) + { + CLogger::Get ()->Write (FromMiniOrgan, LogDebug, "USB MIDI keyboard removed"); + + s_pThis->m_pMIDIDevice = 0; + } + else if (s_pThis->m_pKeyboard == (CUSBKeyboardDevice *) pDevice) + { + CLogger::Get ()->Write (FromMiniOrgan, LogDebug, "USB PC keyboard removed"); + + s_pThis->m_pKeyboard = 0; + } +} diff --git a/src/miniorgan.h b/src/miniorgan.h new file mode 100644 index 0000000..08d60a3 --- /dev/null +++ b/src/miniorgan.h @@ -0,0 +1,102 @@ +// +// miniorgan.h +// +// Circle - A C++ bare metal environment for Raspberry Pi +// Copyright (C) 2017-2021 R. Stange +// +// This program is free software: you can redistribute it and/or modify +// it under the terms of the GNU General Public License as published by +// the Free Software Foundation, either version 3 of the License, or +// (at your option) any later version. +// +// This program is distributed in the hope that it will be useful, +// but WITHOUT ANY WARRANTY; without even the implied warranty of +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +// GNU General Public License for more details. +// +// You should have received a copy of the GNU General Public License +// along with this program. If not, see . +// +#ifndef _miniorgan_h +#define _miniorgan_h + +// define only one +//#define USE_I2S +//#define USE_HDMI + +#ifdef USE_I2S + #include + #define SOUND_CLASS CI2SSoundBaseDevice + #define SAMPLE_RATE 192000 + #define CHUNK_SIZE 8192 + #define DAC_I2C_ADDRESS 0 // I2C slave address of the DAC (0 for auto probing) +#elif defined (USE_HDMI) + #include + #define SOUND_CLASS CHDMISoundBaseDevice + #define SAMPLE_RATE 48000 + #define CHUNK_SIZE (384 * 10) +#else + #include + #define SOUND_CLASS CPWMSoundBaseDevice + #define SAMPLE_RATE 48000 + #define CHUNK_SIZE 2048 +#endif + +#include +#include +#include +#include +#include +#include + +struct TNoteInfo +{ + char Key; + u8 KeyNumber; // MIDI number +}; + +class CMiniOrgan : public SOUND_CLASS +{ +public: + CMiniOrgan (CInterruptSystem *pInterrupt, CI2CMaster *pI2CMaster); + ~CMiniOrgan (void); + + boolean Initialize (void); + + void Process (boolean bPlugAndPlayUpdated); + + unsigned GetChunk (u32 *pBuffer, unsigned nChunkSize); + +private: + static void MIDIPacketHandler (unsigned nCable, u8 *pPacket, unsigned nLength); + + static void KeyStatusHandlerRaw (unsigned char ucModifiers, const unsigned char RawKeys[6]); + + static void USBDeviceRemovedHandler (CDevice *pDevice, void *pContext); + +private: + CUSBMIDIDevice * volatile m_pMIDIDevice; + CUSBKeyboardDevice * volatile m_pKeyboard; + + CSerialDevice m_Serial; + boolean m_bUseSerial; + unsigned m_nSerialState; + u8 m_SerialMessage[3]; + + int m_nLowLevel; + int m_nNullLevel; + int m_nHighLevel; + int m_nCurrentLevel; + unsigned m_nSampleCount; + unsigned m_nFrequency; // 0 if no key pressed + unsigned m_nPrevFrequency; + + u8 m_ucKeyNumber; + + static const float s_KeyFrequency[]; + static const TNoteInfo s_Keys[]; + + static CMiniOrgan *s_pThis; +}; + +#endif