/*
 * Copyright 2018-present Open Networking Foundation

 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at

 * http://www.apache.org/licenses/LICENSE-2.0

 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

package core

import (
	"gerrit.opencord.org/voltha-bbsim/common/logger"
)

type OmciMsg struct {
	IntfId uint32
	OnuId  uint32
	Pkt    []byte
}

const NumMibUploads byte = 9

type OnuKey struct {
	IntfId, OnuId uint32
}

type OnuState struct {
	mibUploadCtr uint16
	uniGInstance uint8
	pptpInstance uint8
}

func OmciRun(omciOut chan OmciMsg, omciIn chan OmciMsg) {

	onus := make(map[OnuKey]*OnuState)

	for {
		var resp OmciMsg

		m := <-omciOut

		msgType, transactionId, meClass, meInstance := ParsePkt(m.Pkt)

		logger.Debug("OmciRun - transactionId: %d msgType: %d, ME Class: %d, ME Instance: %d",
			transactionId, msgType, meClass, meInstance)

		key := OnuKey{m.IntfId, m.OnuId}
		if _, ok := onus[key]; !ok {
			onus[key] = NewOnuState()
		}
		switch msgType {
		case 15:
			resp.Pkt = MibReset()
		case 13:
			resp.Pkt = MibUpload()
		case 14:
			resp.Pkt = MibUploadNext(onus[key])
		case 8:
			resp.Pkt = Set()
		case 4:
			resp.Pkt = Create()
		case 9:
			resp.Pkt = Get()
		default:
			logger.Debug("Omci msg type not handled: %d", msgType)
		}

		resp.Pkt[0] = byte(transactionId >> 8)
		resp.Pkt[1] = byte(transactionId & 0xFF)
		resp.IntfId = m.IntfId
		resp.OnuId = m.OnuId
		omciIn <- resp
	}
}

func ParsePkt(pkt []byte) (byte, uint16, uint16, uint16) {
	p := make([]byte, len(pkt)/2)
	for i, j := 0, 0; i < len(pkt); i, j = i+2, j+1 {
		u := (pkt[i] & 15) + (pkt[i]>>6)*9
		l := (pkt[i+1] & 15) + (pkt[i+1]>>6)*9
		p[j] = u<<4 + l
	}
	logger.Debug("Omci decoded: %x.", p)
	msgType := p[2] & 0x0F
	transactionId := (uint16(p[0]) << 8) | uint16(p[1])
	meClass := (uint16(p[4]) << 8) | uint16(p[5])
	meInstance := (uint16(p[6]) << 8) | uint16(p[7])
	return msgType, transactionId, meClass, meInstance
}

func NewOnuState() *OnuState {
	return &OnuState{mibUploadCtr: 0, uniGInstance: 1, pptpInstance: 1}
}

func MibReset() []byte {
	var pkt []byte

	logger.Debug("Omci MibReset")

	pkt = []byte{
		0x00, 0x01, 0x2f, 0x0a, 0x00, 0x02, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x28, 0x1f, 0x75, 0x69, 0xaa}
	return pkt
}

func MibUpload() []byte {
	var pkt []byte

	logger.Debug("Omci MibUpload")

	pkt = []byte{
		0x00, 0x02, 0x2d, 0x0a, 0x00, 0x02, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x28, 0x0c, 0x63, 0x21, 0x65}

	pkt[9] = NumMibUploads // Number of subsequent MibUploadNext cmds

	return pkt
}

func MibUploadNext(state *OnuState) []byte {
	var pkt []byte

	logger.Debug("Omci MibUploadNext")

	switch state.mibUploadCtr {
	case 0:
		// ANI-G
		pkt = []byte{
			0x00, 0x03, 0x2e, 0x0a, 0x00, 0x02, 0x00, 0x00,
			0x01, 0x07, 0x80, 0x01, 0xff, 0xff, 0x01, 0x00,
			0x08, 0x00, 0x30, 0x00, 0x00, 0x05, 0x09, 0x00,
			0x00, 0xe0, 0x54, 0xff, 0xff, 0x00, 0x00, 0x0c,
			0x63, 0x81, 0x81, 0x00, 0x00, 0x00, 0x00, 0x00,
			0x00, 0x00, 0x00, 0x28, 0x2c, 0x4d, 0xa9, 0xc8}
	case 1, 2, 3, 4:
		// UNI-G
		pkt = []byte{
			0x00, 0x04, 0x2e, 0x0a, 0x00, 0x02, 0x00, 0x00,
			0x01, 0x08, 0x01, 0x01, 0xf8, 0x00, 0x00, 0x00,
			0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
			0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
			0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
			0x00, 0x00, 0x00, 0x28, 0x05, 0x19, 0xae, 0x66}
		pkt[11] = state.uniGInstance // ME Instance
		state.uniGInstance++
	case 5, 6, 7, 8:
		pkt = []byte{
			0x00, 0x16, 0x2e, 0x0a, 0x00, 0x02, 0x00, 0x00,
			0x00, 0x0b, 0x01, 0x01, 0xff, 0xfe, 0x00, 0x2f,
			0x00, 0x00, 0x00, 0x00, 0x03, 0x05, 0xee, 0x00,
			0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00,
			0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
			0x00, 0x00, 0x00, 0x28, 0x6f, 0x10, 0x9b, 0x27}
		pkt[11] = state.pptpInstance // ME Instance
		state.pptpInstance++
	default:
		logger.Error("Invalid MibUpload request %d", state.mibUploadCtr)
	}

	state.mibUploadCtr++

	return pkt
}

func Set() []byte {
	var pkt []byte

	pkt = []byte{
		0x01, 0x15, 0x28, 0x0a, 0x01, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x28, 0x41, 0xb3, 0x95, 0x12}

	logger.Debug("Omci Set")

	return pkt
}

func Create() []byte {
	var pkt []byte

	pkt = []byte{
		0x01, 0x17, 0x24, 0x0a, 0x01, 0x10, 0x00, 0x01,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x28, 0x85, 0xcb, 0x98, 0x86}

	logger.Debug("Omci Create")

	return pkt
}

func Get() []byte {
	var pkt []byte

	pkt = []byte{
		0x01, 0x26, 0x29, 0x0a, 0x00, 0x2d, 0x02, 0x01,
		0x00, 0x20, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
		0x00, 0x00, 0x00, 0x28, 0xbc, 0x0c, 0xa4, 0x18}

	logger.Debug("Omci Get")

	return pkt
}