private void messageToMcu(String message) {
        System.out.println("message - " + message);
        if (message.charAt(0)==0x03) {
            if (message.charAt(1)==0x01) { //kompas
                float angle=message.charAt(2);
                if (angle>130) angle=0xFF-(65535-angle);
                
                angle*=360;
                angle/=256;
                System.out.println(angle);
                
                System.out.println("Angle: "+angle);
                bridge.getAppRef().compasAngle(360-angle);
            }
        }
        if (message.charAt(0)==0x04) { //battery
            int batteryH=(int)message.charAt(1);
            if (batteryH>130) batteryH=0xFF-(65535-batteryH);
            int batteryL=(int)message.charAt(2);
            if (batteryL>130) batteryL=0xFF-(65535-batteryL);

            System.out.println("Battery: "+batteryH +" "+batteryL);
        }
    }