parent
445af3bf9c
commit
0ae8922e72
@ -1,158 +0,0 @@
|
||||
// SerNum.h Formats avec zéros enlever
|
||||
//Dans PP #include "SerNum.h" SetupSerNum();
|
||||
void SetupSerNum() {
|
||||
UBRR0=F_CPU/(9600*16L)-1; // set speed
|
||||
UCSR0B=0x18; // -- -- -- rxe txe -- -- --
|
||||
UCSR0C=0x06; // set mode: 8 data bits, no parity, 1 stop bit
|
||||
}
|
||||
//Rx S1 est toujours en sortie
|
||||
//Tx S2 aussi, sous controle du 328 si TerOn (S2 ignoré);
|
||||
#define TerOn UBRR0=F_CPU/(9600*16L)-1; UCSR0C=0x06; UCSR0B=0x08
|
||||
#define TerOff DelMs(3); UCSR0C=0x06; UCSR0B=0
|
||||
|
||||
void TerCar( byte dd) { // write bloquant Ok initial
|
||||
while(!(UCSR0A&0x20));// wait
|
||||
UDR0=dd; // OK, send it now!
|
||||
}
|
||||
void TerCR() {
|
||||
TerCar(13);TerCar(10);
|
||||
}
|
||||
void TerText(const char str[]) {
|
||||
for (byte i=0; i< strlen(str); i++) {
|
||||
TerCar(str[i]);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
void TerBin8 (byte bb) {
|
||||
for (byte i=0;i<8;i++) {
|
||||
if (bb&0x80) TerCar('1');
|
||||
else TerCar('0');
|
||||
bb <<= 1;
|
||||
}
|
||||
TerCar(' ');
|
||||
}
|
||||
char TerConvNibble (byte nn) { // converti 4 bit hexa en Ascii
|
||||
byte cc;
|
||||
if (nn<10) {cc = nn + '0';}
|
||||
else {cc = nn-10 + 'A';}
|
||||
return cc;
|
||||
}
|
||||
void TerHex8 (byte hh) {
|
||||
byte cc;
|
||||
cc = TerConvNibble (hh >> 4) ; // ne modifie pas hh
|
||||
TerCar(cc);
|
||||
cc = TerConvNibble (hh & 0x0F) ;
|
||||
TerCar(cc);
|
||||
TerCar(' '); // space
|
||||
}
|
||||
void TerHex16 (uint16_t hh) {
|
||||
byte cc;
|
||||
cc = TerConvNibble (hh >> 12) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 8)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 4)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh )&0x0F) ; TerCar(cc);
|
||||
TerCar(' ');
|
||||
}
|
||||
void TerHex12 (uint16_t hh) {
|
||||
byte cc=0;
|
||||
cc = TerConvNibble ((hh >> 8)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 4)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble (hh & 0x0F) ; TerCar(cc);
|
||||
TerCar(' ');
|
||||
}
|
||||
void TerHex20 (uint32_t hh) {
|
||||
byte cc;
|
||||
cc = TerConvNibble ((hh >> 16)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 12)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 8 )&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 4 )&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble (hh & 0x0F) ; TerCar(cc);
|
||||
TerCar(' ');
|
||||
}
|
||||
void TerHex32 (uint32_t hh) {
|
||||
byte cc;
|
||||
|
||||
cc = TerConvNibble ((hh >> 28)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 24)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 20)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 16)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 12)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 8)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh >> 4)&0x0F) ; TerCar(cc);
|
||||
cc = TerConvNibble ((hh )&0x0F) ; TerCar(cc);
|
||||
TerCar(' ');
|
||||
}
|
||||
uint16_t TerBinDec8 (uint8_t bb) {
|
||||
uint16_t dd=0;
|
||||
for (byte i=0; i<8; i++) {
|
||||
if ((dd & 0x0F)>0x04) {dd += 0x03;}
|
||||
if ((dd & 0xF0)>0x40) {dd += 0x30;}
|
||||
dd=dd<<1;
|
||||
if ((bb & 0x80)) {dd += 1;} //inject bit
|
||||
bb=bb<<1; // prepare next bit
|
||||
}
|
||||
return dd;
|
||||
}
|
||||
/*#define TerDec8(v) \
|
||||
do { const int8_t vv = (v); \
|
||||
if(vv<0) { TerDec8S(vv); } \
|
||||
else { TerDec8U(vv); } \
|
||||
} while(0)
|
||||
*/
|
||||
void TerDec8 (uint8_t hh) {
|
||||
TerHex12(TerBinDec8(hh));
|
||||
}
|
||||
|
||||
void TerDec8S (int8_t hh) {
|
||||
if (hh<0) { // négatif
|
||||
TerCar('-'); hh = -hh;
|
||||
} else {
|
||||
TerCar('+');
|
||||
}
|
||||
TerHex12(TerBinDec8(hh));
|
||||
}
|
||||
uint16_t BinDec9999 (uint16_t bb) { //0x270F max
|
||||
uint32_t dd=0;
|
||||
for (byte i=0; i<16; i++) {
|
||||
if ((dd & 0x000F)>0x0004) {dd += 0x0003;}
|
||||
if ((dd & 0x00F0)>0x0040) {dd += 0x0030;}
|
||||
if ((dd & 0x0F00)>0x0400) {dd += 0x0300;}
|
||||
if ((dd & 0xF000)>0x4000) {dd += 0x3000;}
|
||||
dd=dd<<1;
|
||||
if ((bb & 0x8000)) {dd += 1; } //inject bit
|
||||
bb<<=1; // prepare next bit
|
||||
}
|
||||
return dd;
|
||||
}
|
||||
|
||||
uint32_t BinDec16 (uint16_t bb) {
|
||||
uint32_t dd=0;
|
||||
for (byte i=0; i<16 ; i++) {
|
||||
if ((dd & 0x000F)>0x0004) {dd += 0x0003;}
|
||||
if ((dd & 0x00F0)>0x0040) {dd += 0x0030;}
|
||||
if ((dd & 0x0F00)>0x0400) {dd += 0x0300;}
|
||||
if ((dd & 0xF000)>0x4000) {dd += 0x3000;}
|
||||
dd=dd<<1;
|
||||
if ((bb & 0x8000)) {dd += 1; } //inject bit
|
||||
bb<<=1; // prepare next bit
|
||||
}
|
||||
return dd;
|
||||
}
|
||||
void TerDec9999 (uint16_t hh) { // limité à 0x2703
|
||||
if (hh>9999) { TerText("over "); }
|
||||
else TerHex16(BinDec9999(hh));
|
||||
}
|
||||
void TerDec16 (uint32_t hh) { //
|
||||
TerHex20(BinDec16(hh));
|
||||
}
|
||||
|
||||
void TerDec16S (int16_t hh) { // signé
|
||||
if (hh<0) { // negatif
|
||||
TerCar('-'); hh = -hh;
|
||||
} else {
|
||||
TerCar('+');
|
||||
}
|
||||
TerHex20(BinDec16(hh));
|
||||
}
|
||||
|
||||
Loading…
Reference in new issue