mirror of
https://github.com/halleysfifthinc/Toyota-AVC-LAN
synced 2025-06-07 07:56:21 +00:00
Merged Marcin's AVC-LAN driver
This commit is contained in:
Allen Hill
parent
a4750f80b6
commit
214cc168fd
@ -41,8 +41,8 @@
|
||||
#define START_BIT_LENGTH 372 //186*2
|
||||
#define START_BIT_HOLD_ON_LENGTH 336 //168*2
|
||||
|
||||
#define AVC_OUT_EN() sbi(PORTD, 6); sbi(DDRD, 6); sbi(DDRD, 7); sbi(ACSR, ACD);
|
||||
#define AVC_OUT_DIS() cbi(PORTD, 6); cbi(DDRD, 6); cbi(DDRD, 7); cbi(ACSR, ACD);
|
||||
#define AVC_OUT_EN() sbi(PORTD, 6); sbi(DDRD, 6); sbi(DDRD, 7); sbi(ACSR, ACD); // Output mode
|
||||
#define AVC_OUT_DIS() cbi(PORTD, 6); cbi(DDRD, 6); cbi(DDRD, 7); cbi(ACSR, ACD); // Read mode
|
||||
#define AVC_SET_1() sbi(PORTD, 6);
|
||||
#define AVC_SET_0() cbi(PORTD, 6);
|
||||
|
||||
|
||||
@ -31,8 +31,8 @@
|
||||
#define LED_PORT PORTB
|
||||
#define LEDOUT _BV(PORT5)
|
||||
|
||||
#define sbi(port, bit) (port) |= (1 << (bit))
|
||||
#define cbi(port, bit) (port) &= ~(1 << (bit))
|
||||
#define sbi(port, bit) (port) |= (1 << (bit)) // Set bit (i.e. to 1)
|
||||
#define cbi(port, bit) (port) &= ~(1 << (bit)) // Clear bit (i.e. set bit to 0)
|
||||
|
||||
/*--------------------------------------------------------------------------------------------------
|
||||
Type definitions
|
||||
|
||||
BIN
Schematic.png
Normal file
BIN
Schematic.png
Normal file
Binary file not shown.
|
After Width: | Height: | Size: 16 KiB |
@ -125,14 +125,6 @@ int main ( void )
|
||||
sprintf( UsartMsgBuffer, "\t\t Firmware %s, %s\r\n\r\n", FIRMWARE_VERSION, FIRMWARE_DATE );
|
||||
UsartPutStr( UsartMsgBuffer );
|
||||
|
||||
bool success = AvcRegisterMe();
|
||||
if (!success) {
|
||||
UsartPutCStr( PSTR("\r\nRegister failed.\r\n"));
|
||||
}
|
||||
else {
|
||||
UsartPutCStr( PSTR("\r\nRegister succeeded.\r\n"));
|
||||
}
|
||||
|
||||
while ( 1 )
|
||||
{
|
||||
// Reset watchdog.
|
||||
|
||||
933
avclandrv.c
Normal file
933
avclandrv.c
Normal file
@ -0,0 +1,933 @@
|
||||
/*
|
||||
Copyright (C) 2015 Allen Hill <allenofthehills@gmail.com>.
|
||||
|
||||
Portions of the following source code are:
|
||||
Copyright (C) 2006 Marcin Slonicki <marcin@softservice.com.pl>.
|
||||
|
||||
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 2
|
||||
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, write to the Free Software Foundation,
|
||||
Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
|
||||
-----------------------------------------------------------------------
|
||||
this file is a part of the TOYOTA Corolla MP3 Player Project
|
||||
-----------------------------------------------------------------------
|
||||
http://www.softservice.com.pl/corolla/avc
|
||||
|
||||
May 28 / 2009 - version 2
|
||||
|
||||
*/
|
||||
|
||||
#include <avr/io.h>
|
||||
#include <avr/interrupt.h>
|
||||
//#include <avr/pgmspace.h> // Unnecessary?
|
||||
#include "avclandrv.h"
|
||||
#include "com232.h"
|
||||
#include "GlobalDef.h"
|
||||
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
|
||||
#define AVC_OUT_EN() sbi(PORTD, 6); sbi(DDRD, 6); sbi(DDRD, 7); sbi(ACSR, ACD);
|
||||
#define AVC_OUT_DIS() cbi(PORTD, 6); cbi(DDRD, 6); cbi(DDRD, 7); cbi(ACSR, ACD);
|
||||
#define AVC_SET_1() sbi(PORTD, 6);
|
||||
#define AVC_SET_0() cbi(PORTD, 6);
|
||||
|
||||
|
||||
byte CD_ID_1;
|
||||
byte CD_ID_2;
|
||||
|
||||
byte HU_ID_1;
|
||||
byte HU_ID_2;
|
||||
|
||||
byte parity_bit;
|
||||
|
||||
byte repeatMode;
|
||||
byte randomMode;
|
||||
|
||||
byte playMode;
|
||||
|
||||
byte cd_Disc;
|
||||
byte cd_Track;
|
||||
byte cd_Time_Min;
|
||||
byte cd_Time_Sec;
|
||||
|
||||
byte answerReq;
|
||||
|
||||
// we need check answer (to avclan check) timeout
|
||||
// when is more then 1 min, FORCE answer.
|
||||
byte check_timeout;
|
||||
|
||||
#define SW_ID 0x11 // 11 For my stereo
|
||||
|
||||
// commands
|
||||
const byte stat1[] = { 0x4, 0x00, 0x00, 0x01, 0x0A };
|
||||
const byte stat2[] = { 0x4, 0x00, 0x00, 0x01, 0x08 };
|
||||
const byte stat3[] = { 0x4, 0x00, 0x00, 0x01, 0x0D };
|
||||
const byte stat4[] = { 0x4, 0x00, 0x00, 0x01, 0x0C };
|
||||
|
||||
// Updated avclandrv.c had these
|
||||
const u08 stat5[] = { 0x6, 0x00, 0x12, 0x5C, 0x43, 0x02, 0x00 };
|
||||
const u08 stat6[] = { 0x4, 0x00, 0x58, 0x63, 0xE0 };
|
||||
|
||||
// broadcast
|
||||
const byte lan_stat1[] = { 0x3, 0x00, 0x01, 0x0A };
|
||||
const byte lan_reg[] = { 0x3, SW_ID, 0x01, 0x00 };
|
||||
const byte lan_init[] = { 0x3, SW_ID, 0x01, 0x01 };
|
||||
const byte lan_check[] = { 0x3, SW_ID, 0x01, 0x20 };
|
||||
const byte lan_playit[] = { 0x4, SW_ID, 0x01, 0x45, 0x63 };
|
||||
|
||||
|
||||
|
||||
const byte play_req1[] = { 0x4, 0x00, 0x25, 0x63, 0x80 };
|
||||
|
||||
#ifdef __AVENSIS__
|
||||
const byte play_req2[] = { 0x6, 0x00, SW_ID, 0x63, 0x42 };
|
||||
#else
|
||||
const byte play_req2[] = { 0x6, 0x00, SW_ID, 0x63, 0x42, 0x01, 0x00 };
|
||||
#endif
|
||||
|
||||
const byte play_req3[] = { 0x6, 0x00, SW_ID, 0x63, 0x42, 0x41, 0x00 };
|
||||
const byte stop_req[] = { 0x5, 0x00, SW_ID, 0x63, 0x43, 0x01 };
|
||||
const byte stop_req2[] = { 0x5, 0x00, SW_ID, 0x63, 0x43, 0x41 };
|
||||
|
||||
|
||||
// answers
|
||||
const byte CMD_REGISTER[] = {0x1, 0x05, 0x00, 0x01, SW_ID, 0x10, 0x63 };
|
||||
const byte CMD_STATUS1[] = {0x1, 0x04, 0x00, 0x01, 0x00, 0x1A };
|
||||
const byte CMD_STATUS2[] = {0x1, 0x04, 0x00, 0x01, 0x00, 0x18 };
|
||||
const byte CMD_STATUS3[] = {0x1, 0x04, 0x00, 0x01, 0x00, 0x1D };
|
||||
const byte CMD_STATUS4[] = {0x1, 0x05, 0x00, 0x01, 0x00, 0x1C, 0x00 };
|
||||
byte CMD_CHECK[] = {0x1, 0x06, 0x00, 0x01, SW_ID, 0x30, 0x00, 0x00 };
|
||||
|
||||
const byte CMD_STATUS5[] = {0x1, 0x05, 0x00, 0x5C, 0x12, 0x53, 0x02 };
|
||||
const byte CMD_STATUS5A[] = {0x0, 0x05, 0x5C, 0x31, 0xF1, 0x00, 0x00 };
|
||||
|
||||
const byte CMD_STATUS6[] = {0x1, 0x06, 0x00, 0x5C, 0x32, 0xF0, 0x02, 0x00 };
|
||||
|
||||
|
||||
const byte CMD_PLAY_OK1[] = {0x1, 0x05, 0x00, 0x63, SW_ID, 0x50, 0x01 };
|
||||
const byte CMD_PLAY_OK2[] = {0x1, 0x05, 0x00, 0x63, SW_ID, 0x52, 0x01 };
|
||||
const byte CMD_PLAY_OK3[] = {0x0, 0x0B, 0x63, 0x31, 0xF1, 0x01, 0x00, 0x01, 0xFF, 0xFF, 0xFF, 0x00, 0x80 };
|
||||
byte CMD_PLAY_OK4[] = {0x0, 0x0B, 0x63, 0x31, 0xF1, 0x01, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80 };
|
||||
|
||||
const byte CMD_STOP1[] = {0x1, 0x05, 0x00, 0x63, SW_ID, 0x53, 0x01 };
|
||||
byte CMD_STOP2[] = {0x0, 0x0B, 0x63, 0x31, 0xF1, 0x00, 0x30, 0x00, 0x00,0x00, 0x00, 0x00, 0x80 };
|
||||
|
||||
const byte CMD_BEEP[] = {0x1, 0x05, 0x00, 0x63, 0x29, 0x60, 0x02 };
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
|
||||
|
||||
// DONE: Timing adjusted, however refactoring may make code more clear/efficient
|
||||
//------------------------------------------------------------------------------
|
||||
void AVC_HoldLine()
|
||||
{
|
||||
STOPEvent;
|
||||
|
||||
// wait for free line
|
||||
byte line_busy = 1;
|
||||
|
||||
TCNT0 = 0;
|
||||
do {
|
||||
while (INPUT_IS_CLEAR) {
|
||||
/* The comparison value was originally 25 with CK64 (tick period of 4.34 us)
|
||||
at a clock frequency 14.7456MHz.
|
||||
For a more accurate tick period of .5 us at 16MHz, the value should be approximately 225*/
|
||||
if (TCNT0 >= 225) break;
|
||||
}
|
||||
if (TCNT0 > 216) line_busy=0;
|
||||
} while (line_busy);
|
||||
|
||||
// switch to out mode
|
||||
AVC_OUT_EN();
|
||||
AVC_SET_1();
|
||||
|
||||
STARTEvent;
|
||||
}
|
||||
|
||||
// DONE: No changes necessary
|
||||
//------------------------------------------------------------------------------
|
||||
void AVC_ReleaseLine()
|
||||
{
|
||||
AVC_SET_0();
|
||||
AVC_OUT_DIS();
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
|
||||
|
||||
// DONE: No changes necessary
|
||||
//------------------------------------------------------------------------------
|
||||
void AVCLan_Init()
|
||||
{
|
||||
// OUTPUT ( set as input for comparator )
|
||||
cbi(PORTD, 6);
|
||||
cbi(DDRD, 6);
|
||||
|
||||
// INPUT
|
||||
cbi(PORTD, 7);
|
||||
cbi(DDRD, 7);
|
||||
|
||||
// Analog comparator
|
||||
|
||||
cbi(ADCSRB, ACME); // Analog Comparator Multiplexer Enable - NO
|
||||
/*
|
||||
cbi(ACSR, ACBG); // Analog Comparator Bandgap Select
|
||||
// ACI: Analog Comparator Interrupt Flag
|
||||
|
||||
cbi(ACSR, ACIE); // Analog Comparator Interrupt Enable - NO
|
||||
cbi(ACSR, ACIC); // Analog Comparator Input Capture Enable - NO
|
||||
*/
|
||||
cbi(ACSR, ACIS1); // Analog Comparator Interrupt Mode Select
|
||||
cbi(ACSR, ACIS0); // Comparator Interrupt on Output Toggle
|
||||
|
||||
cbi(ACSR, ACD); // Analog Comparator Disable - NO
|
||||
|
||||
TCCR0B = _BV(CS01); // Timer 0 prescaler = 8 ( 2 count / us )
|
||||
|
||||
message_len = 0;
|
||||
answerReq = cmNull;
|
||||
check_timeout = 0;
|
||||
|
||||
cd_Disc = 1;
|
||||
cd_Track = 1;
|
||||
cd_Time_Min = 0;
|
||||
cd_Time_Sec = 0;
|
||||
repeatMode = 0;
|
||||
randomMode = 0;
|
||||
playMode = 0;
|
||||
CD_Mode = stStop;
|
||||
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted, however refactoring may make code more clear/efficient
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Read_Byte(byte length)
|
||||
{
|
||||
byte bite = 0;
|
||||
|
||||
while (1) {
|
||||
while (INPUT_IS_CLEAR);
|
||||
TCNT0 = 0;
|
||||
while (INPUT_IS_SET);
|
||||
if ( TCNT0 < 72 ) {
|
||||
bite++;
|
||||
parity_bit++;
|
||||
}
|
||||
length--;
|
||||
if (!length) return bite;
|
||||
bite = bite << 1;
|
||||
}
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Send_StartBit()
|
||||
{
|
||||
AVC_SET_1();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 333 );
|
||||
|
||||
AVC_SET_0();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 61 );
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted. Comparison values are timer ticks, not us.
|
||||
//------------------------------------------------------------------------------
|
||||
void AVCLan_Send_Bit1()
|
||||
{
|
||||
AVC_SET_1();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 41 );
|
||||
|
||||
AVC_SET_0();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 33 ); // 12-21 us
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted
|
||||
//------------------------------------------------------------------------------
|
||||
void AVCLan_Send_Bit0()
|
||||
{
|
||||
AVC_SET_1();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 65 ); // 28-37 us
|
||||
|
||||
AVC_SET_0();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 9 ); // 00-09 us
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Read_ACK()
|
||||
{
|
||||
byte time = 0;
|
||||
|
||||
AVC_SET_1();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 39 );
|
||||
|
||||
AVC_SET_0();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 3 );
|
||||
|
||||
|
||||
AVC_OUT_DIS(); // switch to read mode
|
||||
TCNT0 = 1;
|
||||
while(1) {
|
||||
time = TCNT0;
|
||||
if (INPUT_IS_SET && (TCNT0 > 1)) break;
|
||||
if (TCNT0 > 41) return 1; // Not sure if this fix is intent correct
|
||||
}
|
||||
|
||||
while(INPUT_IS_SET);
|
||||
AVC_OUT_EN(); // back to write mode
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Send_ACK()
|
||||
{
|
||||
TCNT0 = 0;
|
||||
while (INPUT_IS_CLEAR) {
|
||||
if (TCNT0 >= 225) return 0; // max wait time
|
||||
}
|
||||
|
||||
AVC_OUT_EN();
|
||||
|
||||
AVC_SET_1();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 65 ); //28-37
|
||||
|
||||
AVC_SET_0();
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 9 ); //00-09
|
||||
|
||||
AVC_OUT_DIS();
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
// DONE: var 'byte' adjusted to 'bite' to avoid reserved word conflict
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Send_Byte(byte bite, byte len)
|
||||
{
|
||||
byte b;
|
||||
if (len==8) {
|
||||
b = bite;
|
||||
} else {
|
||||
b = bite << (8-len);
|
||||
}
|
||||
|
||||
while (1) {
|
||||
if ( (b & 128)!=0 ) {
|
||||
AVCLan_Send_Bit1();
|
||||
parity_bit++;
|
||||
} else {
|
||||
AVCLan_Send_Bit0();
|
||||
}
|
||||
len--;
|
||||
if (!len) {
|
||||
//if (INPUT_IS_SET) RS232_Print("SBER\n"); // Send Bit ERror
|
||||
return 1;
|
||||
}
|
||||
b = b << 1;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Send_ParityBit()
|
||||
{
|
||||
if ( (parity_bit & 1)!=0 ) {
|
||||
AVCLan_Send_Bit1();
|
||||
//parity_bit++;
|
||||
} else {
|
||||
AVCLan_Send_Bit0();
|
||||
}
|
||||
parity_bit=0;
|
||||
return 1;
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte CheckCmd(byte *cmd)
|
||||
{
|
||||
byte i;
|
||||
byte *c;
|
||||
byte l;
|
||||
|
||||
c = cmd;
|
||||
l = *c++;
|
||||
|
||||
for (i=0; i<l; i++) {
|
||||
if (message[i] != *c) return 0;
|
||||
c++;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Read_Message()
|
||||
{
|
||||
STOPEvent; // disable timer1 interrupt
|
||||
|
||||
byte i;
|
||||
byte for_me = 0;
|
||||
|
||||
//RS232_Print("$ ");
|
||||
|
||||
// check start bit
|
||||
TCNT0 = 0;
|
||||
while (INPUT_IS_SET) {
|
||||
if ( TCNT0 > 2286 ) { // Originally 254
|
||||
STARTEvent;
|
||||
RS232_Print("LAN>T1\n");
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
if ( TCNT0 < 90 ) { // !!!!!!! 20 !!!!!!!!!!! (Originally 10)
|
||||
STARTEvent;
|
||||
RS232_Print("LAN>T2\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
broadcast = AVCLan_Read_Byte(1);
|
||||
|
||||
parity_bit = 0;
|
||||
master1 = AVCLan_Read_Byte(4);
|
||||
master2 = AVCLan_Read_Byte(8);
|
||||
if ((parity_bit&1)!=AVCLan_Read_Byte(1)) {
|
||||
STARTEvent;
|
||||
return 0;
|
||||
}
|
||||
|
||||
parity_bit = 0;
|
||||
slave1 = AVCLan_Read_Byte(4);
|
||||
slave2 = AVCLan_Read_Byte(8);
|
||||
if ((parity_bit&1)!=AVCLan_Read_Byte(1)) {
|
||||
STARTEvent;
|
||||
return 0;
|
||||
}
|
||||
// is this command for me ?
|
||||
if ((slave1==CD_ID_1)&&(slave2==CD_ID_2)) {
|
||||
for_me=1;
|
||||
}
|
||||
|
||||
if (for_me) AVCLan_Send_ACK();
|
||||
else AVCLan_Read_Byte(1);
|
||||
|
||||
parity_bit = 0;
|
||||
AVCLan_Read_Byte(4); // control - always 0xF
|
||||
if ((parity_bit&1)!=AVCLan_Read_Byte(1)) {
|
||||
STARTEvent;
|
||||
return 0;
|
||||
}
|
||||
if (for_me) AVCLan_Send_ACK();
|
||||
else AVCLan_Read_Byte(1);
|
||||
|
||||
parity_bit = 0;
|
||||
message_len = AVCLan_Read_Byte(8);
|
||||
if ((parity_bit&1)!=AVCLan_Read_Byte(1)) {
|
||||
STARTEvent;
|
||||
return 0;
|
||||
}
|
||||
if (for_me) AVCLan_Send_ACK();
|
||||
else AVCLan_Read_Byte(1);
|
||||
|
||||
if (message_len > MAXMSGLEN) {
|
||||
// RS232_Print("LAN> Command error");
|
||||
STARTEvent;
|
||||
return 0;
|
||||
}
|
||||
|
||||
for (i=0; i<message_len; i++) {
|
||||
parity_bit = 0;
|
||||
message[i] = AVCLan_Read_Byte(8);
|
||||
if ((parity_bit&1)!=AVCLan_Read_Byte(1)) {
|
||||
STARTEvent;
|
||||
return 0;
|
||||
}
|
||||
if (for_me) {
|
||||
AVCLan_Send_ACK();
|
||||
} else {
|
||||
AVCLan_Read_Byte(1);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
STARTEvent;
|
||||
|
||||
if (showLog) ShowInMessage();
|
||||
|
||||
if (for_me) {
|
||||
|
||||
if (CheckCmd((byte*)stat1)) { answerReq = cmStatus1; return 1; }
|
||||
if (CheckCmd((byte*)stat2)) { answerReq = cmStatus2; return 1; }
|
||||
if (CheckCmd((byte*)stat3)) { answerReq = cmStatus3; return 1; }
|
||||
if (CheckCmd((byte*)stat4)) { answerReq = cmStatus4; return 1; }
|
||||
// if (CheckCmd((byte*)stat5)) { answerReq = cmStatus5; return 1; }
|
||||
|
||||
if (CheckCmd((byte*)play_req1)) { answerReq = cmPlayReq1; return 1; }
|
||||
if (CheckCmd((byte*)play_req2)) { answerReq = cmPlayReq2; return 1; }
|
||||
if (CheckCmd((byte*)play_req3)) { answerReq = cmPlayReq3; return 1; }
|
||||
if (CheckCmd((byte*)stop_req)) { answerReq = cmStopReq; return 1; }
|
||||
if (CheckCmd((byte*)stop_req2)) { answerReq = cmStopReq2; return 1; }
|
||||
|
||||
} else { // broadcast check
|
||||
|
||||
if (CheckCmd((byte*)lan_playit)) { answerReq = cmPlayIt; return 1; }
|
||||
if (CheckCmd((byte*)lan_check)) {
|
||||
answerReq = cmCheck;
|
||||
CMD_CHECK[6]=message[3];
|
||||
return 1;
|
||||
}
|
||||
if (CheckCmd((byte*)lan_reg)) { answerReq = cmRegister; return 1; }
|
||||
if (CheckCmd((byte*)lan_init)) { answerReq = cmInit; return 1; }
|
||||
if (CheckCmd((byte*)lan_stat1)) { answerReq = cmStatus1; return 1; }
|
||||
|
||||
|
||||
}
|
||||
answerReq = cmNull;
|
||||
return 1;
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_SendData()
|
||||
{
|
||||
byte i;
|
||||
|
||||
STOPEvent;
|
||||
|
||||
// wait for free line
|
||||
byte line_busy = 1;
|
||||
|
||||
TCNT0 = 0;
|
||||
do {
|
||||
while (INPUT_IS_CLEAR) {
|
||||
if ( TCNT0 >= 225 ) break;
|
||||
}
|
||||
if ( TCNT0 > 216 ) line_busy=0;
|
||||
} while (line_busy);
|
||||
|
||||
|
||||
// switch to output mode
|
||||
AVC_OUT_EN();
|
||||
|
||||
AVCLan_Send_StartBit();
|
||||
AVCLan_Send_Byte(0x1, 1); // regular communication
|
||||
|
||||
|
||||
parity_bit = 0;
|
||||
AVCLan_Send_Byte(CD_ID_1, 4); // CD Changer ID as master
|
||||
AVCLan_Send_Byte(CD_ID_2, 8);
|
||||
AVCLan_Send_ParityBit();
|
||||
|
||||
AVCLan_Send_Byte(HU_ID_1, 4); // HeadUnit ID as slave
|
||||
AVCLan_Send_Byte(HU_ID_2, 8);
|
||||
|
||||
AVCLan_Send_ParityBit();
|
||||
|
||||
if (AVCLan_Read_ACK()) {
|
||||
AVC_OUT_DIS();
|
||||
STARTEvent;
|
||||
RS232_Print("E1\n");
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
AVCLan_Send_Byte(0xF, 4); // 0xf - control -> COMMAND WRITE
|
||||
AVCLan_Send_ParityBit();
|
||||
if (AVCLan_Read_ACK()) {
|
||||
AVC_OUT_DIS();
|
||||
STARTEvent;
|
||||
RS232_Print("E2\n");
|
||||
return 2;
|
||||
}
|
||||
|
||||
AVCLan_Send_Byte(data_len, 8);// data length
|
||||
AVCLan_Send_ParityBit();
|
||||
if (AVCLan_Read_ACK()) {
|
||||
AVC_OUT_DIS();
|
||||
STARTEvent;
|
||||
RS232_Print("E3\n");
|
||||
return 3;
|
||||
}
|
||||
|
||||
for (i=0;i<data_len;i++) {
|
||||
AVCLan_Send_Byte(data[i], 8);// data byte
|
||||
AVCLan_Send_ParityBit();
|
||||
if (AVCLan_Read_ACK()) {
|
||||
AVC_OUT_DIS();
|
||||
STARTEvent;
|
||||
RS232_Print("E4(");
|
||||
RS232_PrintDec(i);
|
||||
RS232_Print(")\n");
|
||||
return 4;
|
||||
}
|
||||
}
|
||||
|
||||
// back to read mode
|
||||
AVC_OUT_DIS();
|
||||
|
||||
STARTEvent;
|
||||
if (showLog) ShowOutMessage();
|
||||
return 0;
|
||||
}
|
||||
|
||||
// DONE: Timing adjusted.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_SendDataBroadcast()
|
||||
{
|
||||
byte i;
|
||||
|
||||
STOPEvent;
|
||||
|
||||
// wait for free line
|
||||
byte line_busy = 1;
|
||||
|
||||
TCNT0 = 0;
|
||||
do {
|
||||
while (INPUT_IS_CLEAR) {
|
||||
if ( TCNT0 >= 225 ) break;
|
||||
}
|
||||
if ( TCNT0 > 216 ) line_busy=0;
|
||||
} while (line_busy);
|
||||
|
||||
|
||||
AVC_OUT_EN();
|
||||
|
||||
AVCLan_Send_StartBit();
|
||||
AVCLan_Send_Byte(0x0, 1); // broadcast
|
||||
|
||||
parity_bit = 0;
|
||||
AVCLan_Send_Byte(CD_ID_1, 4); // CD Changer ID as master
|
||||
AVCLan_Send_Byte(CD_ID_2, 8);
|
||||
AVCLan_Send_ParityBit();
|
||||
|
||||
AVCLan_Send_Byte(0x1, 4); // all audio devices
|
||||
AVCLan_Send_Byte(0xFF, 8);
|
||||
AVCLan_Send_ParityBit();
|
||||
AVCLan_Send_Bit1();
|
||||
|
||||
AVCLan_Send_Byte(0xF, 4); // 0xf - control -> COMMAND WRITE
|
||||
AVCLan_Send_ParityBit();
|
||||
AVCLan_Send_Bit1();
|
||||
|
||||
AVCLan_Send_Byte(data_len, 8); // data lenght
|
||||
AVCLan_Send_ParityBit();
|
||||
AVCLan_Send_Bit1();
|
||||
|
||||
for (i=0;i<data_len;i++) {
|
||||
AVCLan_Send_Byte(data[i], 8); // data byte
|
||||
AVCLan_Send_ParityBit();
|
||||
AVCLan_Send_Bit1();
|
||||
}
|
||||
|
||||
AVC_OUT_DIS();
|
||||
STARTEvent;
|
||||
if (showLog) ShowOutMessage();
|
||||
return 0;
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_SendAnswerFrame(byte *cmd)
|
||||
{
|
||||
byte i;
|
||||
byte *c;
|
||||
byte b;
|
||||
|
||||
c = cmd;
|
||||
|
||||
b = *c++;
|
||||
data_control = 0xF;
|
||||
data_len = *c++;
|
||||
for (i=0; i<data_len; i++) {
|
||||
data[i]= *c++;
|
||||
}
|
||||
if (b)
|
||||
return AVCLan_SendData();
|
||||
else
|
||||
return AVCLan_SendDataBroadcast();
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_SendMyData(byte *data_tmp, byte s_len)
|
||||
{
|
||||
byte i;
|
||||
byte *c;
|
||||
|
||||
c = data_tmp;
|
||||
|
||||
data_control = 0xF;
|
||||
data_len = s_len;
|
||||
for (i=0; i<data_len; i++) {
|
||||
data[i]= *c++;
|
||||
}
|
||||
return AVCLan_SendData();
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_SendMyDataBroadcast(byte *data_tmp, byte s_len)
|
||||
{
|
||||
byte i;
|
||||
byte *c;
|
||||
|
||||
|
||||
c = data_tmp;
|
||||
|
||||
data_control = 0xF;
|
||||
data_len = s_len;
|
||||
for (i=0; i<data_len; i++) {
|
||||
data[i]= *c++;
|
||||
}
|
||||
return AVCLan_SendDataBroadcast();
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_SendInitCommands()
|
||||
{
|
||||
byte r;
|
||||
|
||||
const byte c1[] = { 0x0, 0x0B, 0x63, 0x31, 0xF1, 0x00, 0x80, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x80 };
|
||||
const byte c2[] = { 0x0, 0x0A, 0x63, 0x31, 0xF3, 0x00, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x02 };
|
||||
const byte c3[] = { 0x0, 0x0A, 0x63, 0x31, 0xF3, 0x00, 0x3F, 0x00, 0x01, 0x00, 0x01, 0x02 };
|
||||
const byte c4[] = { 0x0, 0x0A, 0x63, 0x31, 0xF3, 0x00, 0x3D, 0x00, 0x01, 0x00, 0x01, 0x02 };
|
||||
const byte c5[] = { 0x0, 0x0A, 0x63, 0x31, 0xF3, 0x00, 0x39, 0x00, 0x01, 0x00, 0x01, 0x02 };
|
||||
const byte c6[] = { 0x0, 0x0A, 0x63, 0x31, 0xF3, 0x00, 0x31, 0x00, 0x01, 0x00, 0x01, 0x02 };
|
||||
const byte c7[] = { 0x0, 0x0A, 0x63, 0x31, 0xF3, 0x00, 0x21, 0x00, 0x01, 0x00, 0x01, 0x02 };
|
||||
const byte c8[] = { 0x0, 0x0B, 0x63, 0x31, 0xF1, 0x00, 0x90, 0x01, 0xFF, 0xFF, 0xFF, 0x00, 0x80 };
|
||||
const byte c9[] = { 0x0, 0x0A, 0x63, 0x31, 0xF3, 0x00, 0x01, 0x00, 0x01, 0x00, 0x01, 0x02 };
|
||||
const byte cA[] = { 0x0, 0x0B, 0x63, 0x31, 0xF1, 0x00, 0x30, 0x01, 0xFF, 0xFF, 0xFF, 0x00, 0x80 };
|
||||
|
||||
r = AVCLan_SendAnswerFrame((byte*)c1);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c2);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c3);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c4);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c5);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c6);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c7);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c8);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)c9);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)cA);
|
||||
|
||||
//const byte c1[] = { 0x0, 0x0B, 0x63, 0x31, 0xF1, 0x00, 0x80, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x80 };
|
||||
//r = AVCLan_SendAnswerFrame((byte*)c1);
|
||||
return r;
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
void AVCLan_Send_Status()
|
||||
{
|
||||
// disc track t_min t_sec
|
||||
byte STATUS[] = {0x0, 0x0B, 0x63, 0x31, 0xF1, 0x01, 0x10, 0x01, 0x01, 0x00, 0x00, 0x00, 0x80 };
|
||||
|
||||
STATUS[7] = cd_Disc;
|
||||
STATUS[8] = cd_Track;
|
||||
STATUS[9] = cd_Time_Min;
|
||||
STATUS[10] = cd_Time_Sec;
|
||||
|
||||
STATUS[11] = 0;
|
||||
|
||||
AVCLan_SendAnswerFrame((byte*)STATUS);
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_SendAnswer()
|
||||
{
|
||||
byte r = 0 ;
|
||||
|
||||
switch (answerReq) {
|
||||
case cmStatus1: r = AVCLan_SendAnswerFrame((byte*)CMD_STATUS1);
|
||||
break;
|
||||
case cmStatus2: r = AVCLan_SendAnswerFrame((byte*)CMD_STATUS2);
|
||||
break;
|
||||
case cmStatus3: r = AVCLan_SendAnswerFrame((byte*)CMD_STATUS3);
|
||||
break;
|
||||
case cmStatus4: r = AVCLan_SendAnswerFrame((byte*)CMD_STATUS4);
|
||||
break;
|
||||
case cmRegister: r = AVCLan_SendAnswerFrame((byte*)CMD_REGISTER);
|
||||
break;
|
||||
case cmInit: //RS232_Print("INIT\n");
|
||||
r = AVCLan_SendInitCommands();
|
||||
break;
|
||||
case cmCheck: r = AVCLan_SendAnswerFrame((byte*)CMD_CHECK);
|
||||
check_timeout = 0;
|
||||
CMD_CHECK[6]++;
|
||||
RS232_Print("AVCCHK\n");
|
||||
break;
|
||||
case cmPlayReq1: playMode = 0;
|
||||
r = AVCLan_SendAnswerFrame((byte*)CMD_PLAY_OK1);
|
||||
break;
|
||||
case cmPlayReq2:
|
||||
case cmPlayReq3: playMode = 0;
|
||||
r = AVCLan_SendAnswerFrame((byte*)CMD_PLAY_OK2);
|
||||
if (!r) r = AVCLan_SendAnswerFrame((byte*)CMD_PLAY_OK3);
|
||||
CD_Mode = stPlay;
|
||||
break;
|
||||
case cmPlayIt: playMode = 1;
|
||||
RS232_Print("PLAY\n");
|
||||
CMD_PLAY_OK4[7]=cd_Disc;
|
||||
CMD_PLAY_OK4[8]=cd_Track;
|
||||
CMD_PLAY_OK4[9]=cd_Time_Min;
|
||||
CMD_PLAY_OK4[10]=cd_Time_Sec;
|
||||
r = AVCLan_SendAnswerFrame((byte*)CMD_PLAY_OK4);
|
||||
if (!r) AVCLan_Send_Status();
|
||||
CD_Mode = stPlay;
|
||||
break;
|
||||
case cmStopReq:
|
||||
case cmStopReq2: CD_Mode = stStop;
|
||||
playMode = 0;
|
||||
|
||||
r = AVCLan_SendAnswerFrame((byte*)CMD_STOP1);
|
||||
CMD_STOP2[7]=cd_Disc;
|
||||
CMD_STOP2[8]=cd_Track;
|
||||
CMD_STOP2[9]=cd_Time_Min;
|
||||
CMD_STOP2[10]=cd_Time_Sec;
|
||||
r = AVCLan_SendAnswerFrame((byte*)CMD_STOP2);
|
||||
break;
|
||||
case cmBeep: AVCLan_SendAnswerFrame((byte*)CMD_BEEP);
|
||||
break;
|
||||
}
|
||||
|
||||
answerReq = cmNull;
|
||||
return r;
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
void AVCLan_Register()
|
||||
{
|
||||
RS232_Print("REG_ST\n");
|
||||
AVCLan_SendAnswerFrame((byte*)CMD_REGISTER);
|
||||
RS232_Print("REG_END\n");
|
||||
//AVCLan_Command( cmRegister );
|
||||
AVCLan_Command( cmInit );
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte AVCLan_Command(byte command)
|
||||
{
|
||||
byte r;
|
||||
|
||||
answerReq = command;
|
||||
r = AVCLan_SendAnswer();
|
||||
/*
|
||||
RS232_Print("ret=");
|
||||
RS232_PrintHex8(r);
|
||||
RS232_Print("\n");
|
||||
*/
|
||||
return r;
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte HexInc(byte data)
|
||||
{
|
||||
if ((data & 0x9)==0x9)
|
||||
return (data + 7);
|
||||
|
||||
return (data+1);
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
byte HexDec(byte data)
|
||||
{
|
||||
if ((data & 0xF)==0)
|
||||
return (data - 7);
|
||||
|
||||
return (data-1);
|
||||
}
|
||||
|
||||
// DONE: Nothing needed.
|
||||
//------------------------------------------------------------------------------
|
||||
// encode decimal valute to 'toyota' format :-)
|
||||
// ex. 42 (dec) = 0x42 (toy)
|
||||
byte Dec2Toy(byte data)
|
||||
{
|
||||
byte d,d1;
|
||||
d = (u32)data/(u32)10;
|
||||
d1 = d * 16;
|
||||
d = d1 + (data - 10*d);
|
||||
return d;
|
||||
}
|
||||
|
||||
// DONE: No timing adjustment needed.
|
||||
//------------------------------------------------------------------------------
|
||||
void ShowInMessage()
|
||||
{
|
||||
if (message_len==0) return;
|
||||
|
||||
AVC_HoldLine();
|
||||
|
||||
|
||||
RS232_S((u16)PSTR("HU < ("));
|
||||
|
||||
if (broadcast==0) RS232_S((u16)PSTR("bro) "));
|
||||
else RS232_Print("dir) ");
|
||||
|
||||
RS232_PrintHex4(master1);
|
||||
RS232_PrintHex8(master2);
|
||||
RS232_Print("| ");
|
||||
RS232_PrintHex4(slave1);
|
||||
RS232_PrintHex8(slave2);
|
||||
RS232_Print("| ");
|
||||
|
||||
byte i;
|
||||
for (i=0;i<message_len;i++) {
|
||||
RS232_PrintHex8(message[i]);
|
||||
RS232_Print(" ");
|
||||
}
|
||||
RS232_Print("\n");
|
||||
|
||||
AVC_ReleaseLine();
|
||||
}
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
void ShowOutMessage()
|
||||
{
|
||||
byte i;
|
||||
|
||||
AVC_HoldLine();
|
||||
|
||||
RS232_S((u16)PSTR("out > "));
|
||||
for (i=0; i<data_len; i++) {
|
||||
RS232_PrintHex8(data[i]);
|
||||
RS232_SendByte(' ');
|
||||
}
|
||||
RS232_Print("\n");
|
||||
|
||||
AVC_ReleaseLine();
|
||||
}
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
135
avclandrv.h
Normal file
135
avclandrv.h
Normal file
@ -0,0 +1,135 @@
|
||||
/*
|
||||
Copyright (C) 2015 Allen Hill <allenofthehills@gmail.com>.
|
||||
|
||||
Portions of the following source code are:
|
||||
Copyright (C) 2006 Marcin Slonicki <marcin@softservice.com.pl>.
|
||||
|
||||
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 2
|
||||
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, write to the Free Software Foundation,
|
||||
Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
|
||||
-----------------------------------------------------------------------
|
||||
this file is a part of the TOYOTA Corolla MP3 Player Project
|
||||
-----------------------------------------------------------------------
|
||||
http://www.softservice.com.pl/corolla/avc
|
||||
|
||||
May 28 / 2009 - version 2
|
||||
|
||||
*/
|
||||
|
||||
|
||||
#ifndef __AVCLANDRV_H
|
||||
#define __AVCLANDRV_H
|
||||
//------------------------------------------------------------------------------
|
||||
#include "GlobalDef.h"
|
||||
|
||||
#define STOPEvent cbi(TIMSK1, TOIE1); cbi(UCSR0B, RXCIE0);
|
||||
#define STARTEvent sbi(TIMSK1, TOIE1); sbi(UCSR0B, RXCIE0);
|
||||
|
||||
|
||||
#define CHECK_AVC_LINE if (INPUT_IS_SET) AVCLan_Read_Message();
|
||||
|
||||
void AVC_HoldLine();
|
||||
void AVC_ReleaseLine();
|
||||
|
||||
#define MAXMSGLEN 32
|
||||
|
||||
// Head Unid ID
|
||||
extern byte HU_ID_1; // 0x01
|
||||
extern byte HU_ID_2; // 0x40
|
||||
|
||||
extern byte CD_ID_1; // 0x03
|
||||
extern byte CD_ID_2; // 0x60
|
||||
|
||||
|
||||
// DVD CHANGER
|
||||
//#define CD_ID_1 0x02
|
||||
//#define CD_ID_2 0x50
|
||||
|
||||
#define cmNull 0
|
||||
#define cmStatus1 1
|
||||
#define cmStatus2 2
|
||||
#define cmStatus3 3
|
||||
#define cmStatus4 4
|
||||
|
||||
|
||||
#define cmRegister 100
|
||||
#define cmInit 101
|
||||
#define cmCheck 102
|
||||
#define cmPlayIt 103
|
||||
#define cmBeep 110
|
||||
|
||||
#define cmNextTrack 120
|
||||
#define cmPrevTrack 121
|
||||
#define cmNextDisc 122
|
||||
#define cmPrevDisc 123
|
||||
|
||||
#define cmScanModeOn 130
|
||||
#define cmScanModeOff 131
|
||||
|
||||
#define cmPlayReq1 5
|
||||
#define cmPlayReq2 6
|
||||
#define cmPlayReq3 7
|
||||
#define cmStopReq 8
|
||||
#define cmStopReq2 9
|
||||
|
||||
typedef enum { stStop=0, stPlay=1 } cd_modes;
|
||||
cd_modes CD_Mode;
|
||||
|
||||
|
||||
byte broadcast;
|
||||
byte master1;
|
||||
byte master2;
|
||||
byte slave1;
|
||||
byte slave2;
|
||||
byte message_len;
|
||||
byte message[MAXMSGLEN];
|
||||
|
||||
byte data_control;
|
||||
byte data_len;
|
||||
byte data[MAXMSGLEN];
|
||||
|
||||
byte AVCLan_Read_Message();
|
||||
void AVCLan_Send_Status();
|
||||
|
||||
void AVCLan_Init();
|
||||
void AVCLan_Register();
|
||||
byte AVCLan_SendData();
|
||||
byte AVCLan_SendAnswer();
|
||||
byte AVCLan_SendDataBroadcast();
|
||||
byte AVCLan_Command(byte command);
|
||||
|
||||
byte HexInc(byte data);
|
||||
byte HexDec(byte data);
|
||||
byte Dec2Toy(byte data);
|
||||
|
||||
extern byte check_timeout;
|
||||
|
||||
extern byte cd_Disc;
|
||||
extern byte cd_Track;
|
||||
extern byte cd_Time_Min;
|
||||
extern byte cd_Time_Sec;
|
||||
|
||||
extern byte playMode;
|
||||
|
||||
|
||||
byte AVCLan_SendMyData(byte *data_tmp, byte s_len);
|
||||
byte AVCLan_SendMyDataBroadcast(byte *data_tmp, byte s_len);
|
||||
|
||||
void ShowInMessage();
|
||||
void ShowOutMessage();
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
extern byte answerReq;
|
||||
//------------------------------------------------------------------------------
|
||||
#endif
|
||||
122
com232.c
Normal file
122
com232.c
Normal file
@ -0,0 +1,122 @@
|
||||
/*
|
||||
Copyright (C) 2006 Marcin Slonicki <marcin@softservice.com.pl>.
|
||||
|
||||
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 2
|
||||
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, write to the Free Software Foundation,
|
||||
Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
|
||||
-----------------------------------------------------------------------
|
||||
this file is a part of the TOYOTA Corolla MP3 Player Project
|
||||
-----------------------------------------------------------------------
|
||||
http://www.softservice.com.pl/corolla/avc
|
||||
|
||||
May 28 / 2009 - version 2
|
||||
|
||||
*/
|
||||
|
||||
#include <avr/io.h>
|
||||
#include <avr/interrupt.h>
|
||||
#include <avr/pgmspace.h>
|
||||
#include "com232.h"
|
||||
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_Init(void)
|
||||
{
|
||||
// init LED
|
||||
sbi(DDRB, 5);
|
||||
cbi(PORTB, 5);
|
||||
|
||||
RS232_RxCharBegin = RS232_RxCharEnd = 0;
|
||||
|
||||
UCSR0A = 0;
|
||||
UCSR0B = ((1<<RXCIE0) | (1<<RXEN0) | (1<<TXEN0)); // enable RxD/TxD and interrupts
|
||||
UCSR0C = ((1<<UCSZ01)|(1<<UCSZ00)); // 8N1
|
||||
UBRR0L = 3; // 250000
|
||||
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
SIGNAL(SIG_USART_RECV)
|
||||
{
|
||||
RS232_RxCharBuffer[RS232_RxCharEnd] = UDR0; // Store received character to the End of Buffer
|
||||
RS232_RxCharEnd++;
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_SendByte(u08 Data)
|
||||
{
|
||||
while ((UCSR0A & _BV(UDRE0)) != _BV(UDRE0)); // wait for UART to become available
|
||||
UDR0 = Data; // send character
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_S(u16 str_addr)
|
||||
{
|
||||
register u08 c;
|
||||
while ( (c = pgm_read_byte(str_addr++) ) )
|
||||
{
|
||||
if (c == '\n')
|
||||
RS232_SendByte('\r');
|
||||
RS232_SendByte(c);
|
||||
}
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_Print(char* pBuf)
|
||||
{
|
||||
register u08 c;
|
||||
while ((c = *pBuf++))
|
||||
{
|
||||
if (c == '\n')
|
||||
RS232_SendByte('\r');
|
||||
RS232_SendByte(c);
|
||||
}
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_PrintHex4(u08 Data)
|
||||
{
|
||||
u08 Character = Data & 0x0f;
|
||||
Character += '0';
|
||||
if (Character > '9')
|
||||
Character += 'A' - '0' - 10;
|
||||
RS232_SendByte(Character);
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_PrintHex8(u08 Data)
|
||||
{
|
||||
RS232_PrintHex4(Data >> 4);
|
||||
RS232_PrintHex4(Data);
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_PrintDec(u08 Data)
|
||||
{
|
||||
if (Data>99) {
|
||||
RS232_SendByte('*');
|
||||
return;
|
||||
}
|
||||
if (Data<10) {
|
||||
RS232_SendByte('0'+Data);
|
||||
return;
|
||||
}
|
||||
u08 c;
|
||||
u16 v,v1;
|
||||
v = Data;
|
||||
v1 = v/10;
|
||||
c = '0' + (v-v1*10);
|
||||
RS232_SendByte('0'+v1);
|
||||
RS232_SendByte(c);
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
void RS232_PrintDec2(u08 Data)
|
||||
{
|
||||
if (Data<10) RS232_SendByte('0');
|
||||
RS232_PrintDec(Data);
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
54
com232.h
Normal file
54
com232.h
Normal file
@ -0,0 +1,54 @@
|
||||
/*
|
||||
Copyright (C) 2006 Marcin Slonicki <marcin@softservice.com.pl>.
|
||||
|
||||
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 2
|
||||
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, write to the Free Software Foundation,
|
||||
Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
|
||||
-----------------------------------------------------------------------
|
||||
this file is a part of the TOYOTA Corolla MP3 Player Project
|
||||
-----------------------------------------------------------------------
|
||||
http://www.softservice.com.pl/corolla/avc
|
||||
|
||||
May 28 / 2009 - version 2
|
||||
|
||||
*/
|
||||
|
||||
#ifndef __COM232_H
|
||||
#define __COM232_H
|
||||
//------------------------------------------------------------------------------
|
||||
|
||||
#include "const.h"
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
|
||||
u08 RS232_RxCharBuffer[25], RS232_RxCharBegin, RS232_RxCharEnd;
|
||||
u08 readkey;
|
||||
//------------------------------------------------------------------------------
|
||||
|
||||
void RS232_Init(void);
|
||||
extern void RS232_S(u16 str_addr);
|
||||
extern void RS232_SendByte(u08 Data);
|
||||
extern void RS232_Print(char* pBuf);
|
||||
extern void RS232_PrintHex4(u08 Data);
|
||||
extern void RS232_PrintHex8(u08 Data);
|
||||
extern void RS232_PrintDec(u08 Data);
|
||||
extern void RS232_PrintDec2(u08 Data);
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
// LED
|
||||
#define LED_ON() cbi(PORTB, 5)
|
||||
#define LED_OFF() sbi(PORTB, 5)
|
||||
|
||||
//------------------------------------------------------------------------------
|
||||
#endif
|
||||
288
sniffer.c
Normal file
288
sniffer.c
Normal file
@ -0,0 +1,288 @@
|
||||
/*
|
||||
Copyright (C) 2006 Marcin Slonicki <marcin@softservice.com.pl>.
|
||||
|
||||
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 2
|
||||
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, write to the Free Software Foundation,
|
||||
Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
|
||||
-----------------------------------------------------------------------
|
||||
this file is a part of the TOYOTA Corolla MP3 Player Project
|
||||
-----------------------------------------------------------------------
|
||||
http://www.softservice.com.pl/corolla/avc
|
||||
|
||||
May 28 / 2009 - version 2
|
||||
|
||||
*/
|
||||
|
||||
|
||||
|
||||
#include <avr/io.h>
|
||||
#include <avr/interrupt.h>
|
||||
#include <avr/pgmspace.h>
|
||||
|
||||
#include "GlobalDef.h"
|
||||
#include "com232.h"
|
||||
#include "avclandrv.h"
|
||||
|
||||
|
||||
// -------------------------------------------------------------------------------------
|
||||
void Setup();
|
||||
|
||||
byte rcv_command[5];
|
||||
byte rcv_pos = 0;
|
||||
byte rcv_time_clr = 0;
|
||||
|
||||
// -------------------------------------------------------------------------------------
|
||||
|
||||
|
||||
|
||||
|
||||
// -------------------------------------------------------------------------------------
|
||||
// MAIN PROGRAM
|
||||
//
|
||||
int main()
|
||||
{
|
||||
// byte h;
|
||||
|
||||
|
||||
byte readSeq = 0;
|
||||
byte s_len = 0;
|
||||
byte s_dig = 0;
|
||||
byte s_c[2];
|
||||
byte i;
|
||||
byte data_tmp[32];
|
||||
|
||||
Setup();
|
||||
|
||||
|
||||
|
||||
RS232_S((u16)PSTR("AVCLan reader 1.00\nReady\n\n"));
|
||||
LED_OFF();
|
||||
RS232_S((u16)PSTR("T - device id\n"));
|
||||
RS232_S((u16)PSTR("H - HU id\n"));
|
||||
RS232_S((u16)PSTR("S - read sequence\n"));
|
||||
RS232_S((u16)PSTR("W - send command\n"));
|
||||
RS232_S((u16)PSTR("Q - send broadcast\n"));
|
||||
RS232_S((u16)PSTR("L/l - log on/off\n"));
|
||||
RS232_S((u16)PSTR("K/k - seq. echo on/off\n"));
|
||||
RS232_S((u16)PSTR("R/r - register device\n"));
|
||||
|
||||
|
||||
|
||||
while (1) {
|
||||
|
||||
if (INPUT_IS_SET) { // if message from some device on AVCLan begin
|
||||
LED_ON();
|
||||
AVCLan_Read_Message();
|
||||
// show message
|
||||
} else {
|
||||
LED_OFF();
|
||||
// check command from HU
|
||||
if (answerReq != 0) AVCLan_SendAnswer();
|
||||
}
|
||||
|
||||
// HandleEvent
|
||||
switch (Event) {
|
||||
case EV_STATUS: Event &= ~EV_STATUS;
|
||||
AVCLan_Send_Status();
|
||||
break;
|
||||
}
|
||||
|
||||
|
||||
// Key handler
|
||||
if (RS232_RxCharEnd) {
|
||||
cbi(UCSR0B, RXCIE0); // disable RX complete interrupt
|
||||
readkey = RS232_RxCharBuffer[RS232_RxCharBegin];// read begin of received Buffer
|
||||
RS232_RxCharBegin++;
|
||||
if (RS232_RxCharBegin == RS232_RxCharEnd) // if Buffer is empty
|
||||
RS232_RxCharBegin = RS232_RxCharEnd = 0; // do reset Buffer
|
||||
sbi(UCSR0B, RXCIE0); // enable RX complete interrupt
|
||||
switch (readkey) {
|
||||
case 'T': if (readSeq) {
|
||||
CD_ID_1 = data_tmp[0];
|
||||
CD_ID_2 = data_tmp[1];
|
||||
RS232_Print("DEV ID SET: 0x");
|
||||
RS232_PrintHex8(CD_ID_1);
|
||||
RS232_PrintHex8(CD_ID_2);
|
||||
RS232_Print("\n");
|
||||
showLog = 1;
|
||||
readSeq=0;
|
||||
} else {
|
||||
showLog = 0;
|
||||
RS232_Print("DEV ID > \n");
|
||||
readSeq = 1;
|
||||
s_len=0;
|
||||
s_dig=0;
|
||||
s_c[0]=s_c[1]=0;
|
||||
}
|
||||
break;
|
||||
|
||||
case 'H': if (readSeq) {
|
||||
HU_ID_1 = data_tmp[0];
|
||||
HU_ID_2 = data_tmp[1];
|
||||
RS232_Print("HU ID SET: 0x");
|
||||
RS232_PrintHex8(HU_ID_1);
|
||||
RS232_PrintHex8(HU_ID_2);
|
||||
RS232_Print("\n");
|
||||
showLog = 1;
|
||||
readSeq=0;
|
||||
} else {
|
||||
showLog = 0;
|
||||
RS232_Print("HU ID > \n");
|
||||
readSeq = 1;
|
||||
s_len=0;
|
||||
s_dig=0;
|
||||
s_c[0]=s_c[1]=0;
|
||||
}
|
||||
break;
|
||||
|
||||
case 'S': showLog = 0;
|
||||
RS232_Print("READ SEQUENCE > \n");
|
||||
readSeq = 1;
|
||||
s_len=0;
|
||||
s_dig=0;
|
||||
s_c[0]=s_c[1]=0;
|
||||
break;
|
||||
case 'W' : showLog = 1;
|
||||
readSeq=0;
|
||||
AVCLan_SendMyData(data_tmp, s_len);
|
||||
break;
|
||||
case 'Q' : showLog = 1;
|
||||
readSeq=0;
|
||||
AVCLan_SendMyDataBroadcast(data_tmp, s_len);
|
||||
break;
|
||||
|
||||
|
||||
case 'R': RS232_Print("REGIST:\n");
|
||||
AVCLan_Command( cmRegister );
|
||||
TCNT0 = 0;
|
||||
while( TCNT0 < 135 );
|
||||
CHECK_AVC_LINE;
|
||||
break;
|
||||
case 'r': AVCLan_Register();
|
||||
break;
|
||||
|
||||
|
||||
case 'l': RS232_Print("Log OFF\n");
|
||||
showLog = 0;
|
||||
break;
|
||||
case 'L': RS232_Print("Log ON\n");
|
||||
showLog = 1;
|
||||
break;
|
||||
|
||||
case 'k': RS232_Print("str OFF\n");
|
||||
showLog2 = 0;
|
||||
break;
|
||||
case 'K': RS232_Print("str ON\n");
|
||||
showLog2 = 1;
|
||||
break;
|
||||
|
||||
default :
|
||||
if (readSeq==1) {
|
||||
s_c[s_dig]=readkey;
|
||||
|
||||
s_dig++;
|
||||
if (s_dig==2) {
|
||||
if (s_c[0]<':') s_c[0] -= 48;
|
||||
else s_c[0] -= 55;
|
||||
data_tmp[s_len] = 16 * s_c[0];
|
||||
if (s_c[1]<':') s_c[1] -= 48;
|
||||
else s_c[1] -= 55;
|
||||
data_tmp[s_len] += s_c[1];
|
||||
s_len++;
|
||||
s_dig=0;
|
||||
s_c[0]=s_c[1]=0;
|
||||
}
|
||||
if (showLog2) {
|
||||
RS232_Print("CURRENT SEQUENCE > ");
|
||||
for (i=0; i<s_len; i++) {
|
||||
RS232_PrintHex8(data_tmp[i]);
|
||||
RS232_SendByte(' ');
|
||||
}
|
||||
RS232_Print("\n");
|
||||
}
|
||||
}
|
||||
} // switch (readkey)
|
||||
|
||||
}// if (RS232_RxCharEnd)
|
||||
|
||||
|
||||
|
||||
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
// -------------------------------------------------------------------------------------
|
||||
|
||||
|
||||
// -------------------------------------------------------------------------------------
|
||||
// Setup - uP: ATMega328p
|
||||
//
|
||||
void Setup()
|
||||
{
|
||||
// GIMSK = 0; // (GICR ?) disable external interupts
|
||||
|
||||
CD_ID_1 = 0x02;
|
||||
CD_ID_2 = 0x80;
|
||||
|
||||
HU_ID_1 = 0x01;
|
||||
HU_ID_2 = 0x40;
|
||||
|
||||
showLog = 1;
|
||||
showLog2 = 1;
|
||||
|
||||
MCUCR = 0;
|
||||
|
||||
// Timer 1
|
||||
TIMSK1 = 0;
|
||||
sbi(TIMSK1, OCIE1A); // Enable timer1 compare interrupt
|
||||
TCCR1A = 0;
|
||||
TCCR1B |= (1 << WGM12)|(1 << CS12); // Set CTC, prescaler at 256
|
||||
//TCNT1 = 0xFFFF - 0x7080;
|
||||
OCR1A = 62499; // Compare match at 1sec intervals
|
||||
|
||||
|
||||
RS232_Init();
|
||||
|
||||
|
||||
AVCLan_Init();
|
||||
|
||||
Event = EV_NOTHING;
|
||||
sei();
|
||||
|
||||
|
||||
}
|
||||
// -------------------------------------------------------------------------------------
|
||||
|
||||
|
||||
byte s1=0;
|
||||
//------------------------------------------------------------------------------
|
||||
ISR(TIMER1_COMPA_vect) // Timer1 compare match every 1Sec
|
||||
{
|
||||
s1++;
|
||||
if (s1==2) {
|
||||
s1=0;
|
||||
if (CD_Mode==stPlay) {
|
||||
cd_Time_Sec=HexInc(cd_Time_Sec);
|
||||
if (cd_Time_Sec==0x60) {
|
||||
cd_Time_Sec = 0;
|
||||
cd_Time_Min=HexInc(cd_Time_Min);
|
||||
if (cd_Time_Min==0xA0) {
|
||||
cd_Time_Min=0x0;
|
||||
}
|
||||
}
|
||||
Event |= EV_STATUS;
|
||||
}
|
||||
}
|
||||
}
|
||||
//------------------------------------------------------------------------------
|
||||
Loading…
x
Reference in New Issue
Block a user