Вообщем истори такая: нашёл на польском сайте проект приборки : плагин на основе SDK SCS (насколько мой переводчик мне подсказал) => ардуинка, которая получет инфу с плагина ( там все кнтрольные лампочки приборки и стрелочные приборы)=> собствено приборка.
С контрольными лампочками всё понятно, раскидал по портам - всё работает. Но вот стрелочные приборы сделаны на сервоприводах, а это получаеться не красиво: задержки при движении стрелок, угол 180...
Собственно загвоздка как в прошивкЕ ардуины переписать серво на ШИМ?
Алгорит я понимаю: считать данные с порта, преобразовать в ШИМ, выставить нужное значение для приборов, и выкинуть на порт. Но что-то не хватает знаний как это всё связать.
Вот прошивка ардуинки:
#include <LiquidCrystal.h>
#include <Servo.h>const int SPEEDO_PIN = A1;
const int RPM_PIN = A0;
const int LEFT_INDICATOR = 2;
const int RIGHT_INDICATOR = 0;
const int high_beam = 5;
const int low_beam = 1;
const int PARKING_BREAK = 7;
const int battery_warning = 3;
const int brake_air_warning = 4;
const int brake_air_emergency = 8;
const int electric_enabled = 11;
const int engine_enabled = 10;// Servo variables
Servo speedo;
Servo rpm;#define PACKET_SYNC 0xFF
#define PACKET_VER 2#define SERVO_DIR_INVERT false
#define SERVO_DIR_NORMAL trueint serial_byte;
LiquidCrystal lcd( 28, 25, 21, 22, 27, 29);
void setup()
{
Serial.begin(115200);
lcd.begin(16, 2);
lcd.print("Self Test");
// Initialise servos
speedo.attach(SPEEDO_PIN);
speedo.write(180);
rpm.attach(RPM_PIN);
rpm.write(180);
// Initialise LEDs
pinMode(LEFT_INDICATOR, OUTPUT);
pinMode(RIGHT_INDICATOR, OUTPUT);
pinMode(electric_enabled, OUTPUT);
pinMode(PARKING_BREAK, OUTPUT);
pinMode(battery_warning, OUTPUT);
pinMode(engine_enabled, OUTPUT);
pinMode(low_beam, OUTPUT);
pinMode(high_beam, OUTPUT);
pinMode(brake_air_warning, OUTPUT);
pinMode(brake_air_emergency, OUTPUT);
digitalWrite(LEFT_INDICATOR, 0);
digitalWrite(RIGHT_INDICATOR, 0);
digitalWrite(electric_enabled, 0);
digitalWrite(PARKING_BREAK, 0);
digitalWrite(battery_warning, 0);
digitalWrite(engine_enabled, 0);
digitalWrite(low_beam, 0);
digitalWrite(high_beam, 0);
digitalWrite(brake_air_warning, 0);
digitalWrite(brake_air_emergency, 0);
delay(500);
speedo.write(0);
rpm.write(0);
digitalWrite(LEFT_INDICATOR, 1);
digitalWrite(RIGHT_INDICATOR, 1);
digitalWrite(electric_enabled, 1);
digitalWrite(PARKING_BREAK, 1);
digitalWrite(battery_warning, 1);
digitalWrite(engine_enabled, 1);
digitalWrite(low_beam, 1);
digitalWrite(high_beam, 1);
digitalWrite(brake_air_warning, 1);
digitalWrite(brake_air_emergency, 1);
delay(500);
speedo.write(180);
rpm.write(180);
digitalWrite(LEFT_INDICATOR, 0);
digitalWrite(RIGHT_INDICATOR, 0);
digitalWrite(electric_enabled, 0);
digitalWrite(PARKING_BREAK, 0);
digitalWrite(battery_warning, 0);
digitalWrite(engine_enabled, 0);
digitalWrite(low_beam, 0);
digitalWrite(high_beam, 0);
digitalWrite(brake_air_warning, 0);
digitalWrite(brake_air_emergency, 0);
lcd.clear();
lcd.print("Wait");
// Wait a second to ensure serial data isn't from re-programming
delay(1000);
lcd.clear();
lcd.print("Ready");
}void read_serial_byte_set_servo(Servo& servo, bool invert)
{
serial_byte = Serial.read();
serial_byte = (serial_byte < 0) ? 0 : ((serial_byte > 180) ? 180 : serial_byte);
if (invert)
servo.write(180 - serial_byte);
else
servo.write(serial_byte);
}void skip_serial_byte()
{
(void)Serial.read();
}void digitalWriteFromBit(int port, int value, int shift)
{
digitalWrite(port, (value >> shift) & 0x01);
}void loop()
{
if (Serial.available() < 16)
return;
serial_byte = Serial.read();
if (serial_byte != PACKET_SYNC)
return;
serial_byte = Serial.read();
if (serial_byte != PACKET_VER)
{
lcd.clear();
lcd.print("PROTOCOL VERSION ERROR");
return;
}
read_serial_byte_set_servo(speedo, SERVO_DIR_INVERT); // Speed
read_serial_byte_set_servo(rpm, SERVO_DIR_NORMAL); // RPM
skip_serial_byte(); // Brake air pressure
skip_serial_byte(); // Brake temperature
skip_serial_byte(); // Fuel ratio
skip_serial_byte(); // Oil pressure
skip_serial_byte(); // Oil temperature
skip_serial_byte(); // Water temperature
skip_serial_byte(); // Battery voltage
// Truck lights byte
serial_byte = Serial.read();
digitalWriteFromBit(LEFT_INDICATOR, serial_byte, 5);
digitalWriteFromBit(RIGHT_INDICATOR, serial_byte, 4);
digitalWriteFromBit(low_beam, serial_byte, 3);
digitalWriteFromBit(high_beam, serial_byte, 2);
// Warning lights bytesserial_byte = Serial.read();
digitalWriteFromBit(PARKING_BREAK, serial_byte, 7);
digitalWriteFromBit(brake_air_warning, serial_byte, 5);
digitalWriteFromBit(brake_air_emergency, serial_byte, 4);
digitalWriteFromBit(battery_warning, serial_byte, 2);
// Enabled flags
serial_byte = Serial.read();
digitalWriteFromBit(electric_enabled, serial_byte, 1);
digitalWriteFromBit(engine_enabled, serial_byte, 0);
// Text length
int text_len = Serial.read();
// Followed by text
if (0 < text_len && text_len < 127)
{
lcd.clear();
for (int i = 0; i < text_len; ++i)
{
while (Serial.available() == 0) // Wait for data if slow
{
delay(2);
}
serial_byte = Serial.read();
if (serial_byte < 0 && serial_byte > 127)
return;
if (serial_byte == '\n')
lcd.setCursor(0, 1);
else
lcd.print(char(serial_byte));
// delay(2);
}
}
}
Может что-то упустил? добавить требуеться...
Отредактировано Мишаня666 (2014-11-16 21:49:01)
