110 lines
2.4 KiB
C++
110 lines
2.4 KiB
C++
/*
|
|
This file is part of the VidorBoot/VidorPeripherals/VidorGraphics library.
|
|
Copyright (c) 2018 Arduino SA. All rights reserved.
|
|
|
|
This library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Lesser General Public
|
|
License as published by the Free Software Foundation; either
|
|
version 2.1 of the License, or (at your option) any later version.
|
|
|
|
This library 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
|
|
Lesser General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Lesser General Public
|
|
License along with this library; if not, write to the Free Software
|
|
Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
#include "VidorJTAG.h"
|
|
|
|
#include "VidorMailbox.h"
|
|
|
|
#define MB_BASE 0x00000000
|
|
#define MB_INT_PIN 31
|
|
#define MB_TIMEOUT 5000
|
|
|
|
VidorMailboxClass::VidorMailboxClass() {}
|
|
|
|
int VidorMailboxClass::begin()
|
|
{
|
|
if (!VidorJTAG.begin()) {
|
|
return 0;
|
|
}
|
|
|
|
uint32_t rpc[1];
|
|
rpc[0] = 0;
|
|
|
|
VidorJTAG.writeBuffer(MB_BASE, rpc, 1);
|
|
|
|
pinMode(MB_INT_PIN, OUTPUT);
|
|
digitalWrite(MB_INT_PIN, LOW);
|
|
|
|
return 1;
|
|
}
|
|
|
|
void VidorMailboxClass::end()
|
|
{
|
|
VidorJTAG.end();
|
|
|
|
digitalWrite(MB_INT_PIN, LOW);
|
|
pinMode(MB_INT_PIN, INPUT);
|
|
}
|
|
|
|
void VidorMailboxClass::reload()
|
|
{
|
|
VidorJTAG.reset();
|
|
}
|
|
|
|
int VidorMailboxClass::sendCommand(const uint32_t data[], size_t len)
|
|
{
|
|
if (data[0] == 0) {
|
|
return -1;
|
|
}
|
|
if (write(0x00, data, len) != (int)len) {
|
|
return -1;
|
|
}
|
|
|
|
digitalWrite(MB_INT_PIN, HIGH);
|
|
digitalWrite(MB_INT_PIN, LOW);
|
|
|
|
for (unsigned long start = millis(); (millis() - start) < MB_TIMEOUT;) {
|
|
uint32_t result;
|
|
read(0x00, &result, 1);
|
|
|
|
if (result == 0) {
|
|
read(0x01, &result, 1);
|
|
|
|
return result;
|
|
}
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
|
|
int VidorMailboxClass::sendEvent(const uint32_t data[], size_t len)
|
|
{
|
|
if (write(0x00, data, len) != (int)len) {
|
|
return -1;
|
|
}
|
|
|
|
digitalWrite(MB_INT_PIN, HIGH);
|
|
digitalWrite(MB_INT_PIN, LOW);
|
|
|
|
return len;
|
|
}
|
|
|
|
int VidorMailboxClass::read(uint32_t address, uint32_t data[], size_t len)
|
|
{
|
|
VidorJTAG.readBuffer(MB_BASE + address, data, len);
|
|
|
|
return len;
|
|
}
|
|
|
|
int VidorMailboxClass::write(uint32_t address, const uint32_t data[], size_t len)
|
|
{
|
|
return VidorJTAG.writeBuffer(MB_BASE + address, data, len);
|
|
}
|
|
|
|
VidorMailboxClass VidorMailbox;
|