nxt

LibSidServo/ssii.c

@@ -0,0 +1,70 @@
+/*
+ * This file is part of the libsidservo project.
+ * Copyright 2025 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 "serial.h"
+#include "ssii.h"
+
+uint16_t SScalcChecksum(uint8_t *buf, int len){
+    uint16_t checksum = 0;
+    for(int i = 0; i < len; i++)
+        checksum += *buf++;
+    checksum ^= 0xFF00; // invert high byte
+    //DBG("Checksum of %d bytes: 0x%04x", len, checksum);
+    return checksum;
+}
+
+// send short/long binary command
+static int bincmd(uint8_t *cmd, int len){
+    data_t d;
+    if(len == sizeof(SSscmd)){
+        ((SSscmd*)cmd)->checksum = SScalcChecksum(cmd, len-2);
+        DBG("Short command");
+        d.buf = CMD_SHORTCMD;
+        d.len = sizeof(CMD_SHORTCMD) - 1;
+        if(!MountWriteRead(&d, NULL)) return -1;
+    }else if(len == sizeof(SSlcmd)){
+        ((SSlcmd*)cmd)->checksum = SScalcChecksum(cmd, len-2);
+        DBG("Long command");
+        d.buf = CMD_LONGCMD;
+        d.len = sizeof(CMD_LONGCMD) - 1;
+        if(!MountWriteRead(&d, NULL)) return -1;
+    }else{
+        return -1;
+    }
+    DBG("Write %d bytes and wait for ans", len);
+    d.buf = cmd;
+    d.len = d.maxlen = len;
+    return MountWriteRead(&d, &d);
+}
+// return TRUE if OK
+int SScmdS(SSscmd *cmd){
+    return bincmd(cmd, sizeof(SSscmd));
+}
+int SScmdL(SSlcmd *cmd){
+    return bincmd(cmd, sizeof(SSlcmd));
+}
+
+
+/**
+ * @brief SSconvstat - convert stat from SSII format to human
+ * @param status (i) - just read data
+ * @param mountdata (o) - output
+ */
+void SSconvstat(const SSstat *status, mountdata_t *mountdata){
+    ;
+}