mirror of
https://github.com/eddyem/stm32samples.git
synced 2025-12-06 18:55:13 +03:00
101 lines
2.6 KiB
C
101 lines
2.6 KiB
C
/*
|
|
* This file is part of the I2Cscan project.
|
|
* Copyright 2020 Edward V. Emelianov <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 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 <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "i2cscan.h"
|
|
#include "i2c.h"
|
|
#include "hardware.h"
|
|
#include "proto.h"
|
|
#include "usb.h"
|
|
#include "usb_lib.h"
|
|
|
|
#define USBBUFSZ 127
|
|
|
|
volatile uint32_t Tms = 0;
|
|
|
|
/* Called when systick fires */
|
|
void sys_tick_handler(void){
|
|
++Tms;
|
|
}
|
|
|
|
// usb getline
|
|
static char *get_USB(){
|
|
static char tmpbuf[USBBUFSZ+1], *curptr = tmpbuf;
|
|
static int rest = USBBUFSZ;
|
|
int x = USB_receive(curptr);
|
|
curptr[x] = 0;
|
|
if(!x) return NULL;
|
|
if(curptr[x-1] == '\n'){
|
|
curptr = tmpbuf;
|
|
rest = USBBUFSZ;
|
|
return tmpbuf;
|
|
}
|
|
curptr += x; rest -= x;
|
|
if(rest <= 0){ // buffer overflow
|
|
curptr = tmpbuf;
|
|
rest = USBBUFSZ;
|
|
USB_send("USB buffer overflow\n");
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
int main(void){
|
|
uint32_t lastT = 0;
|
|
sysreset();
|
|
StartHSE();
|
|
hw_setup();
|
|
SysTick_Config(72000);
|
|
|
|
RCC->CSR |= RCC_CSR_RMVF; // remove reset flags
|
|
|
|
USBPU_OFF();
|
|
USB_setup();
|
|
i2c_setup();
|
|
iwdg_setup();
|
|
USBPU_ON();
|
|
|
|
while (1){
|
|
IWDG->KR = IWDG_REFRESH; // refresh watchdog
|
|
if(lastT > Tms || Tms - lastT > 499){
|
|
LED_blink(LED0);
|
|
lastT = Tms;
|
|
}
|
|
usb_proc();
|
|
if(scanmode){ // get next address & print it
|
|
uint8_t addr;
|
|
int ok = scan_next_addr(&addr);
|
|
if(addr == I2C_ADDREND) USB_send("Scan ends\n");
|
|
else if(ok){
|
|
USB_send(u2hexstr(addr));
|
|
USB_send(" ("); USB_send(u2str(addr));
|
|
USB_send(") - found device\n");
|
|
}
|
|
}
|
|
char *txt, *ans;
|
|
if((txt = get_USB())){
|
|
IWDG->KR = IWDG_REFRESH;
|
|
ans = (char*)parse_cmd(txt);
|
|
if(ans){
|
|
uint16_t l = 0; char *p = ans;
|
|
while(*p++) l++;
|
|
USB_send(ans);
|
|
}
|
|
}
|
|
}
|
|
return 0;
|
|
}
|