mirror of
https://github.com/eddyem/stm32samples.git
synced 2025-12-06 18:55:13 +03:00
105 lines
3.0 KiB
C
105 lines
3.0 KiB
C
/*
|
|
* geany_encoding=koi8-r
|
|
* can_process.c
|
|
*
|
|
* Copyright 2018 Edward V. Emelianov <eddy@sao.ru, edward.emelianoff@gmail.com>
|
|
*
|
|
* 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., 51 Franklin Street, Fifth Floor, Boston,
|
|
* MA 02110-1301, USA.
|
|
*
|
|
*/
|
|
#include "adc.h"
|
|
#include "can.h"
|
|
#include "can_process.h"
|
|
#include "proto.h"
|
|
|
|
extern volatile uint32_t Tms; // timestamp data
|
|
/*
|
|
// v==0 - send V12 & V5
|
|
static void senduival(){
|
|
uint8_t buf[5];
|
|
uint16_t *vals = getUval();
|
|
buf[0] = CMD_GETUVAL; // V12 and V5
|
|
buf[1] = vals[0] >> 8; // H
|
|
buf[2] = vals[0] & 0xff;// L
|
|
buf[3] = vals[1] >> 8; // -//-
|
|
buf[4] = vals[1] & 0xff;
|
|
SEND_CAN(buf, 5);
|
|
}
|
|
|
|
static void sendu16(uint8_t cmd, uint16_t data){
|
|
uint8_t buf[3];
|
|
buf[0] = cmd;
|
|
buf[1] = data >> 8;
|
|
buf[2] = data & 0xff;
|
|
SEND_CAN(buf, 3);
|
|
}
|
|
*/
|
|
|
|
void can_messages_proc(){
|
|
CAN_message *can_mesg = CAN_messagebuf_pop();
|
|
if(!can_mesg) return; // no data in buffer
|
|
uint8_t len = can_mesg->length;
|
|
#ifndef EBUG
|
|
if(can_mesg->fifoNum == 1){ // not my data - just show it
|
|
#endif
|
|
if(monitCAN){
|
|
printu(Tms);
|
|
SEND(" #");
|
|
printuhex(can_mesg->ID);
|
|
SEND(" (F#"); printu(can_mesg->fifoNum); SEND(")");
|
|
for(uint8_t ctr = 0; ctr < len; ++ctr){
|
|
SEND(" ");
|
|
printuhex(can_mesg->data[ctr]);
|
|
}
|
|
IWDG->KR = IWDG_REFRESH;
|
|
newline(); sendbuf();
|
|
}
|
|
#ifndef EBUG
|
|
return;
|
|
}
|
|
#endif
|
|
IWDG->KR = IWDG_REFRESH;
|
|
/*
|
|
if(!len) return; // no data in message
|
|
uint8_t *data = can_mesg->data;
|
|
switch(data[0]){
|
|
case CMD_PING: // pong
|
|
SEND_CAN(data, 1);
|
|
break;
|
|
case CMD_GETMCUTEMP:
|
|
sendu16(CMD_GETMCUTEMP, (int16_t)getMCUtemp());
|
|
break;
|
|
case CMD_GETUVAL:
|
|
senduival();
|
|
break;
|
|
case CMD_GETU3V3:
|
|
sendu16(CMD_GETU3V3, (uint16_t)getVdd());
|
|
break;
|
|
}
|
|
*/
|
|
}
|
|
|
|
// try to send messages, wait no more than 100ms
|
|
CAN_status try2send(uint8_t *buf, uint8_t len, uint16_t id){
|
|
uint32_t Tstart = Tms;
|
|
while(Tms - Tstart < SEND_TIMEOUT_MS){
|
|
if(CAN_OK == can_send(buf, len, id)) return CAN_OK;
|
|
IWDG->KR = IWDG_REFRESH;
|
|
}
|
|
SEND("CAN_BUSY\n");
|
|
return CAN_BUSY;
|
|
}
|