summaryrefslogtreecommitdiff
path: root/src/input/vcd/libvcd/sector.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/input/vcd/libvcd/sector.c')
-rw-r--r--src/input/vcd/libvcd/sector.c290
1 files changed, 290 insertions, 0 deletions
diff --git a/src/input/vcd/libvcd/sector.c b/src/input/vcd/libvcd/sector.c
new file mode 100644
index 000000000..19393e9cd
--- /dev/null
+++ b/src/input/vcd/libvcd/sector.c
@@ -0,0 +1,290 @@
+/*
+ $Id: sector.c,v 1.1 2003/10/13 11:47:12 f1rmb Exp $
+
+ Copyright (C) 2000 Herbert Valerio Riedel <hvr@gnu.org>
+ (C) 1998 Heiko Eissfeldt <heiko@colossus.escape.de>
+ portions used & Chris Smith
+
+ 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 2 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, write to the Free Software
+ Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+*/
+
+#ifdef HAVE_CONFIG_H
+# include "config.h"
+#endif
+
+#include <string.h>
+
+#include <cdio/cdio.h>
+
+#include <libvcd/types.h>
+
+#include <libvcd/sector.h>
+
+/* Private includes */
+#include "assert.h"
+#include "bytesex.h"
+#include "salloc.h"
+#include "sector_private.h"
+
+static const char _rcsid[] = "$Id: sector.c,v 1.1 2003/10/13 11:47:12 f1rmb Exp $";
+
+static const uint8_t sync_pattern[12] = {
+ 0x00, 0xff, 0xff, 0xff,
+ 0xff, 0xff, 0xff, 0xff,
+ 0xff, 0xff, 0xff, 0x00
+};
+
+static void
+build_address (void *buf, sectortype_t sectortype, uint32_t address)
+{
+ raw_cd_sector_t *sector = buf;
+
+ vcd_assert (sizeof(raw_cd_sector_t) == CDIO_CD_FRAMESIZE_RAW-DATA_LEN);
+
+ cdio_lba_to_msf(address, &(sector->msf));
+
+ switch(sectortype) {
+ case MODE_0:
+ sector->mode = 0;
+ break;
+ case MODE_2:
+ case MODE_2_FORM_1:
+ case MODE_2_FORM_2:
+ sector->mode = 2;
+ break;
+ default:
+ vcd_assert_not_reached ();
+ break;
+ }
+}
+
+static uint32_t
+build_edc (const void *in, unsigned from, unsigned upto)
+{
+ const uint8_t *p = (uint8_t*)in+from;
+ uint32_t result = 0;
+
+ for (; from <= upto; from++)
+ result = EDC_crctable[(result ^ *p++) & 0xffL] ^ (result >> 8);
+
+ return result;
+}
+
+static void
+encode_L2_Q (uint8_t inout[4 + L2_RAW + 4 + 8 + L2_P + L2_Q])
+{
+ uint8_t *Q;
+ int i,j;
+
+ Q = inout + 4 + L2_RAW + 4 + 8 + L2_P;
+ memset (Q, 0, L2_Q);
+ for (j = 0; j < 26; j++) {
+ for (i = 0; i < 43; i++) {
+ uint8_t data;
+
+ /* LSB */
+ data = inout[(j*43*2+i*2*44) % (4 + L2_RAW + 4 + 8 + L2_P)];
+ if (data != 0) {
+ uint32_t base = rs_l12_log[data];
+
+ uint32_t sum = base + DQ[0][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ Q[0] ^= rs_l12_alog[sum];
+
+ sum = base + DQ[1][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ Q[26*2] ^= rs_l12_alog[sum];
+ }
+ /* MSB */
+ data = inout[(j*43*2+i*2*44+1) % (4 + L2_RAW + 4 + 8 + L2_P)];
+ if (data != 0) {
+ uint32_t base = rs_l12_log[data];
+
+ uint32_t sum = base+DQ[0][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ Q[1] ^= rs_l12_alog[sum];
+
+ sum = base + DQ[1][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ Q[26*2+1] ^= rs_l12_alog[sum];
+ }
+ }
+ Q += 2;
+ }
+}
+
+static void
+encode_L2_P (uint8_t inout[4 + L2_RAW + 4 + 8 + L2_P])
+{
+ uint8_t *P;
+ int i,j;
+
+ P = inout + 4 + L2_RAW + 4 + 8;
+ memset(P, 0, L2_P);
+ for (j = 0; j < 43; j++) {
+ for (i = 0; i < 24; i++) {
+ uint8_t data;
+
+ /* LSB */
+ data = inout[i*2*43];
+ if (data != 0) {
+ uint32_t base = rs_l12_log[data];
+
+ uint32_t sum = base + DP[0][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ P[0] ^= rs_l12_alog[sum];
+
+ sum = base + DP[1][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ P[43*2] ^= rs_l12_alog[sum];
+ }
+ /* MSB */
+ data = inout[i*2*43+1];
+ if (data != 0) {
+ uint32_t base = rs_l12_log[data];
+
+ uint32_t sum = base + DP[0][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ P[1] ^= rs_l12_alog[sum];
+
+ sum = base + DP[1][i];
+ if (sum >= ((1 << RS_L12_BITS)-1))
+ sum -= (1 << RS_L12_BITS)-1;
+
+ P[43*2+1] ^= rs_l12_alog[sum];
+ }
+ }
+ P += 2;
+ inout += 2;
+ }
+}
+
+/* Layer 2 Product code en/decoder */
+static void
+do_encode_L2 (void *buf, sectortype_t sectortype, uint32_t address)
+{
+ raw_cd_sector_t *raw_sector = buf;
+
+ vcd_assert (buf != NULL);
+
+ vcd_assert (sizeof (sync_pattern) == SYNC_LEN);
+ vcd_assert (sizeof (mode2_form1_sector_t) == CDIO_CD_FRAMESIZE_RAW);
+ vcd_assert (sizeof (mode2_form2_sector_t) == CDIO_CD_FRAMESIZE_RAW);
+ vcd_assert (sizeof (mode0_sector_t) == CDIO_CD_FRAMESIZE_RAW);
+ vcd_assert (sizeof (raw_cd_sector_t) == SYNC_LEN+HEADER_LEN);
+
+ memset (raw_sector, 0, SYNC_LEN+HEADER_LEN);
+ memcpy (raw_sector->sync, sync_pattern, sizeof (sync_pattern));
+
+ switch (sectortype) {
+ case MODE_0:
+ {
+ mode0_sector_t *sector = buf;
+
+ memset(sector->data, 0, sizeof(sector->data));
+ }
+ break;
+ case MODE_2:
+ break;
+ case MODE_2_FORM_1:
+ {
+ mode2_form1_sector_t *sector = buf;
+
+ sector->edc = uint32_to_le(build_edc(buf, 16, 16+8+2048-1));
+
+ encode_L2_P((uint8_t*)buf+SYNC_LEN);
+ encode_L2_Q((uint8_t*)buf+SYNC_LEN);
+ }
+ break;
+ case MODE_2_FORM_2:
+ {
+ mode2_form2_sector_t *sector = buf;
+
+ sector->edc = uint32_to_le(build_edc(buf, 16, 16+8+2324-1));
+ }
+ break;
+ default:
+ vcd_assert_not_reached ();
+ }
+
+ build_address (buf, sectortype, address);
+}
+
+void
+_vcd_make_mode2 (void *raw_sector, const void *data, uint32_t extent,
+ uint8_t fnum, uint8_t cnum, uint8_t sm, uint8_t ci)
+{
+ uint8_t *subhdr = (uint8_t*)raw_sector+16;
+
+ vcd_assert (raw_sector != NULL);
+ vcd_assert (data != NULL);
+ vcd_assert (extent != SECTOR_NIL);
+
+ memset (raw_sector, 0, CDIO_CD_FRAMESIZE_RAW);
+
+ subhdr[0] = subhdr[4] = fnum;
+ subhdr[1] = subhdr[5] = cnum;
+ subhdr[2] = subhdr[6] = sm;
+ subhdr[3] = subhdr[7] = ci;
+
+ if (sm & SM_FORM2)
+ {
+ memcpy ((char*)raw_sector+CDIO_CD_XA_SYNC_HEADER, data,
+ M2F2_SECTOR_SIZE);
+ do_encode_L2 (raw_sector, MODE_2_FORM_2, extent+CDIO_PREGAP_SECTORS);
+ }
+ else
+ {
+ memcpy ((char*)raw_sector+CDIO_CD_XA_SYNC_HEADER, data,
+ CDIO_CD_FRAMESIZE);
+ do_encode_L2 (raw_sector, MODE_2_FORM_1, extent+CDIO_PREGAP_SECTORS);
+ }
+}
+
+void
+_vcd_make_raw_mode2 (void *raw_sector, const void *data, uint32_t extent)
+{
+ vcd_assert (raw_sector != NULL);
+ vcd_assert (data != NULL);
+ vcd_assert (extent != SECTOR_NIL);
+
+ memset (raw_sector, 0, CDIO_CD_FRAMESIZE_RAW);
+
+ memcpy ((char*)raw_sector+12+4, data, M2RAW_SECTOR_SIZE);
+ do_encode_L2 (raw_sector, MODE_2, extent+CDIO_PREGAP_SECTORS);
+}
+
+
+/*
+ * Local variables:
+ * c-file-style: "gnu"
+ * tab-width: 8
+ * indent-tabs-mode: nil
+ * End:
+ */
generated by cgit v1.2.3 (git 2.25.1) at 2025-04-28 20:59:24 +0000